Attitude Determination Algorithm Based on Combination of Attitude-GPS and Electronic Compass

Da-yong ZHANG,Wen-qi WU,Mei-ping WU,Liang-qing LU

DOI: https://doi.org/10.3969/j.issn.1000-4653.2007.04.008

2007-01-01

Abstract:The attitude determination algorithm based on the combination of Multi-Antenna GPS and Electronic Compass is studied for a need of low-cost attitude measurement application.In the algorithm equivalent tilt angle error denotes attitude error and its propagation equations are deduced with a quaternion differential equation.Also,starting from the physical significances of observed quantities,a non-linear observation equation,in which the equivalent tilt angle error as a state parameter is estimated with extend Kalman Filter,is deduced,based on double differential carrier phase measurement equation and electronic compass geomagnetism vector equation.Vehicle experiments indicate that the algorithm can effectively improve attitude determination precision and robustness of system.