Application of Extended Kalman Filter Algorithm in Attitude Estimation Based on Modified Rodrigues Parameters

Lin ZHAO,Hai-jing YUAN,Fu-qiang LIU,Feng-ming LIU
2009-01-01
Abstract:An all-attitude estimation algorithm for low cost attitude and heading reference system using extended Kalman filter based on modified Rodrigues parameters is designed. In view of the shortage of redundancy when using quaternion to describe attitude, the modified Rodrigues parameter, which is three-dimensional independent vector, is put forward for attitude computation. By switching between the modified Rodrigues parameters and their shadow parameters, the problem of singularity is solved. Considering the characteristics of the system sensors, the estimation algorithm is established with the gyroscope bias and modified Rodrigues parameters as state vector and the outputs of accelerometer and magnetometer as observation vectors, which avoids the state error covariance matrix being singularity. At last, an all-attitude numerical simulation and a swing movement numerical simulation are used to demonstrate the efficacy of the algorithm.
What problem does this paper attempt to address?