Attitude Measurement of Permanent Magnet Spherical Motors Based on Adaptive Mahony Complementary Filtering

Xiwen Guo,Yuming Sun,Qunjing Wang,Ao Tan,Qiyong Yang
DOI: https://doi.org/10.1016/j.measurement.2023.113608
IF: 5.6
2023-01-01
Measurement
Abstract:An adaptive attitude measurement algorithm called adaptive mahony complementary filter(AMCF) is proposed to address the issues of drift and noise in gyroscope measurements, as well as the high computational complexity, error accumulation, and sensitivity to noise in the quaternion extended kalman filter(QEKF) within the permanent magnet spherical motor(PMSM) inertial measurement unit. Firstly, this method corrects the gyroscope's angular velocity bias by utilizing the error between theoretical and actual accelerations. Subsequently, the covariance is adjusted by comparing dynamic accelerations to mitigate disturbances. The fourth-order Runge -Kutta method is employed to continuously update the quaternion, thereby achieving higher accuracy in attitude measurement. Finally, static and dynamic experimental investigations are conducted on the PMSM. The experimental results demonstrate that the AMCF offers faster computation speed compared to the QEKF and higher accuracy than the fast complementary filtering(FCF). This indicates that utilizing the AMCF enables better real-time attitude measurement for three-degree-of-freedom mechanical structures.
What problem does this paper attempt to address?