Algorithm of Attitude Determination and Drift Estimation of Gyro Based on Sun Sensor and Magnetometer
Aiming at the problem that magnetometer or sun sensors can only estimate the attitude of two axes,the observed quantity is presented by using the method of taking advantage of the observation vector measured by sun sensors and magnetometer,the attitude error is gained by using sun vector which is com-pared with the geomagnetic field vector estimated based on the orbit and the attitude angular velocity of the satellite.The integrated attitude of the gyro is corrected by the attitude error estimated based on the sun vec-tor and the geomagnetic field vector,and the gyro drift is estimated based on PI filter.The simulation result shows that the attitude determination precision reaches about 1°.
NETL
NSTL
万方数据
