Globally Asymptotic Stable Attitude Estimation with Application to MEMS Sensors

被引：1
|
作者：
Jiang W. [1 ]
Zhang W. [1 ]
Shi J. [1 ]
Lyu Y. [1 ]
Chen H. [1 ]
机构：
[1] School of Automation, Northwestern Polytechnical University, Xi'an
来源：
Xibei Gongye Daxue Xuebao/Journal of Northwestern Polytechnical University | 2020年 / 38卷 / 03期
关键词：
Attitude estimation; Gyroscope bias; MEMS sensor; Miniature UAV; State estimation; State observer;
D O I：
10.1051/jnwpu/20203830550
中图分类号：
学科分类号：
摘要：
Aiming at the requirement of attitude information module with high precision, small size and low power consumption for the control of miniature UAV, a practical attitude estimation algorithm based on the micro-electro-mechanical sensor is proposed in this paper, which realizes the accurate estimation of the attitude of the UAV under the condition of low acceleration. A low-cost MEMS gyroscope, accelerometer, and magnetometer are used in the system. The Euler angle is obtained by the state observer method based on Direction Cosine Matrix (DCM) which can be got by fusing the sensor data. Firstly, based on the basic idea of TRIAD algorithm, a method to determine the attitude rotation matrix by accelerometer and magnetometric measurement is proposed. Compared with the traditional method, this method does not have to calculate the inverse of the matrix. Secondly, a state observer is intended to estimate the attitude of the system. The state observer doesn't have to observe the bias of the gyroscope, but still ensures the convergence of the Euler angle. Finally, the simulation based on the actual sampling data of the MEMS sensor shows that the output of the state observer designed in this paper still has high accuracy and good dynamic characteristics under the condition of gyroscope noise and bias. © 2020 Journal of Northwestern Polytechnical University.
引用
收藏
页码：550 / 557
页数：7
相关论文
共 15 条
  • [1] HAMEL T, MAHONY R., Attitude Estimation on SO[3] Based on Direct Inertial Measurements, ICRA 2006. Proceedings 2006 IEEE International Conference on Robotics and Automation, (2006)
  • [2] QIN Yongyuan, The Principle of Kalman Filter and Integrated Navigation, (2015)
  • [3] LEFFERTS E J, MARKLEY F L, SHUSTER M D., Kalman Filtering for Spacecraft Attitude Estimation, Proc AIAA 20th Aerospace Sciences Meeting, pp. 1-16, (1982)
  • [4] CRASSIDIS J L, MARKLEY F L, CHENG Y., Survey of Nonlinear Attitude Estimation Methods, Journal of Guidance Control and Dynamics, 30, 1, pp. 12-28, (2007)
  • [5] MADGWICK S O H, HARRISON A J L, VAIDYANATHAN A., Estimation of IMU and MARG Orientation Using a Gradient Descent Algorithm, IEEE International Conference on Rehabilitation Robotics, (2011)
  • [6] ZHU Yadongyang, LIN Jun, ZHAO Fa, Et al., A least Squares Method Based on Quaternions to Derive Absolute Orientation of Geophones with AHRS, Journal of Geophysics and Engineering, 15, 6, pp. 2614-2624, (2018)
  • [7] SALCUDEAN S., A Globally Convergent Angular Velocity Observer for Rigid Body Motion, IEEE Trans on Automatic Control, 36, 12, pp. 1493-1497, (1991)
  • [8] BLACK H D., A Passive system for Determining the Attitude of a Satellite, AIAA Journal, 2, 7, pp. 1350-1351, (1964)
  • [9] BAR-ITZHACK I Y, HARMAN R R., Optimized TRIAD Algorithm for Attitudedetermination, Journal of Guidance, Control, and Dynamics, 20, 1, pp. 208-211, (1997)
  • [10] GRIP H F, FOSSEN T I, JOHANSEN T A, Et al., A Nonlinear Observer for Integration of GNSS and IMU Measurements with Gyro Bias Estimation, American Control Conference, (2012)
12