JIA Rui-cai,. Attitude estimation base on gravity/magnetic assisted Euler angle UKF[J]. Editorial Office of Optics and Precision Engineering, 2014,22(12): 3280-3286
To overcome the linearizated errors from the attitude estimation algorithm based on Extended Kalman Filter (EKF)
a new attitude estimation algorithm based on gravity/magnetic assisted Euler angle Unscented Kalman Filter (UKF)algorithm was proposed to improve the attitude measuring accuracy of a low cost Micro-electro-mechanic System(MEMS). The gravity and magnetic data were used to inhibit the rapid divergence of attitude error for the MEMS. The Euler angles were taken as UKF states and the quaternion was used to calculate the attitude in time update
so that the algorithm avoids the quaternion standardized problem and solves the low attitude accuracy of Euler angles. Without linearization errors of the UKF
it has better stability and attitude estimation accuracy. By taking measured MEMS Inertial Measurement Unit (IMU)data for experiments
the results show that the measuring accuracy of pitch and roll angles by proposed algorithm has improved nearly 20 percent respectively and the heading accuracy improved by 12.1 percent as compared with that of the attitude estimation algorithm based on the EKF. It concludes that the proposed method has better precision. However
the convergence time of UKF has increased due to the insufficient estimation for state variances.
关键词
Keywords
references
周婧, 高印寒, 刘长英,等. 基于自适应算法的单目视觉系统的姿态解算[J]. 光学 精密工程, 2012, 20(12):2796-2803. ZHAO J, GAO Y H, LIU CH Y, et al.. Attitude calculation of single camera visual system based on adaptive algorithm[J]. Opt. Precision Eng., 2012, 20(12):2796-2803. (in Chinese)
王彬,何昕,魏仲慧. 采用多站图像直线特征的飞机姿态估计[J]. 光学 精密工程, 2013,21(7):1831-1839. WANG B, HE X, WEI ZH H. Attitude estimation of aircrafts using line features on multi-camera images [J]. Opt. Precision Eng., 2013,21(7):1831-1839. (in Chinese)
WANG M,YANG Y C, HATCH R R. Adaptive filter for a miniature MEMS based attitude and heading reference system[C]. Position Location and Navigation Symposium, 2004.
EGZIABHER D G, HAYWARD R C, POWELL J D. Design of multisensory attitude determination systems[J]. Aerospace and Electronic Systems, IEEE Transactions, 2004,40(2):627- 649.
YANG Y, FARRELL J A. Two antennas GPS-aided INS for attitude determination[C]. IEEE Transactions on Control Systems Technology, 2003.
CASTELLANOS J F G, LESECQ S, MARCHAND N, et al.. A low cost air data attitude heading reference system for the tourism airplane applications[C]. Sensors, IEEE, 2005.
张荣辉,贾宏光,陈涛,等. 基于四元数法的捷联式惯性导航系统的姿态解算[J]. 光学 精密工程,2008,16(10):1963-1970. ZHANG R H, JIA H G, CHEN T, et al.. Attitude solution for strapdown inertial navigation system based on quaternion algorithm [J].Opt. Precision Eng., 2008,16(10):1963-1970. (in Chinese)
ANGRISANO A. GNSS/INS Integration Methods[D]. Canada:University of Calcary,2010.
GUERRERO C J F. Design and implementation of an attitude and heading reference system[C]. 8th International Conference on Electrical Engineering, Computing Science and Automatic Control, Program and Abstract Book, 2011.
GAO Z Y, NIU X J, GUO M F. Quaternion-based kalman filter for micro-machined strapdown attitude heading reference system[J]. Chinese Journal of Aeronautics, 2002,15(3):171-175.
KLEIN I, FILIN S, TOLEDO T. Pseudo- measurements as aiding to INS during GPS outages[J]. Navigation,2010,57(1):25-34.
PAHADIA A. GPS/INS Integration Aided with Gyroscope-Free IMU for Pedestrian Applications[D]. Canada:Department of Geomatics Engineering, University of Calgary, UCGE Report, 2010.
乔相伟,周卫东,吉宇人. 用四元数状态切换无迹卡尔曼滤波器估计的飞行器姿态[J]. 控制理论与应用,2012,29(1):97-103. QIAO X W, ZHOU W D, JI Y R. Aircraft attitude estimation based on quaternion state-switching unscented Kalman filter [J]. Control Theory & Applications, 2012,29(1):97-103.(in Chinese)
DAH J J,TA S. Critical remarks on the linearised and extended kalman filters with geodetic navigation examples[J]. Measurement, 2010,43(9):1077-1089.
HONG H Q, MOORE J B. Direct kalamn filtering approach for GPS/INS integration. Aerospace and Electronic Systems [J].IEEE Transactions on, 2002,38(2):687-693.
EL-SHEIMY N. Inertial techniques and INS/DGPS Integration[D]. Canada:Department of Geomatics Engineering, University of Calgary, 2004.
GEBRE D, ELKAIM G H, POWELL J D, et al.. A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors[C]. Position Location and Navigation Symposium, IEEE 2000.