MIMU/Magnetometer Attitude Estimation Filtering Algorithm Based on State Constraint

薛亮,姜澄宇,常洪龙,袁广民,苑伟政
2009-01-01
Abstract:The attitude measurement system was constructed for micro aerial vehicles(MAV) based on the MEMS gyroscope,accelerometer,magnetometer and airspeed meter.The quaternion-based extended Kalman filter was investigated.Attitude quaternion errors and drift bias of gyroscope were selected to construct state vector,and then the state equation was established through quaternion error differential equation and stochastic error model of gyroscope.The gravitational vector was obtained to get horizontal attitude by compensating the outputs of accelerometers with airspeed meter,and then the attitude errors were calibrated by Kalman filter which reduced the performance requirement of gyroscope.The constraint relationship between state vector variables was regarded as pseudo-measurement equation in the measurement model,which could solve the problem of filtering divergence and singularity arisen from constraint.The adaptive adjustment of dynamic filter noise improved the accuracy of attitude estimation.The simulations and experimental results indicate that the proposed algorithm can effectively improve the system accuracy and stability.
What problem does this paper attempt to address?