fix: Add gyroscope drift compenstaion

morgil / madgwick_py

A Python implementation of Madgwick's IMU and AHRS algorithm.

GNU Lesser General Public License v3.0

182 stars 60 forks source link

fix: Add gyroscope drift compenstaion #8

Closed ArturBa closed 2 years ago

ArturBa commented 3 years ago

According to an extended madgwick filter, there is a missing part for gyroscope drift compensation. I've added it

morgil commented 2 years ago

Thanks for the MR! fyi: I have added a commit here to set the default value of zeta to 0, so that the default behavior of the algorithm is not changed.