|
|
论文:2020,Vol:38,Issue(3):550-557 |
|
|
引用本文： |
|
|
蒋维, 章卫国, 史静平, 吕永玺, 陈华坤. 一种基于MEMS传感器的全局渐进稳定的姿态估计算法[J]. 西北工业大学学报 |
|
|
JIANG Wei, ZHANG Weiguo, SHI Jingping, LYU Yongxi, CHEN Huakun. Globally Asymptotic Stable Attitude Estimation with Application to MEMS Sensors[J]. Northwestern polytechnical university |
|
|
|
|
|
|
|
| 一种基于MEMS传感器的全局渐进稳定的姿态估计算法 |
|
| 蒋维, 章卫国, 史静平, 吕永玺, 陈华坤 |
|
| 西北工业大学 自动化学院, 陕西 西安 710129 |
| 摘要: |
| 针对微小型无人飞行器的控制对高精度、小体积、低功耗的姿态信息的需求，提出了一种实用的基于MEMS传感器的姿态解算算法，实现了在低加速度状态下对飞行器姿态的精准估计。该算法将MEMS陀螺仪、加速度计和磁力计的数据作为输入，采用一种全局渐进稳定的状态观测器方法对3种传感器数据进行融合，进而得到欧拉角输出。首先，针对实际航姿参考系统（AHRS）设计的需求，改进了TRIAD算法，使用加速度计和磁力计的量测向量来估计姿态旋转矩阵。与传统方法相比，该方法避免了矩阵的求逆过程。其次，在获得了量测向量确定的姿态旋转矩阵的基础上，设计了无需观测陀螺仪零偏的状态观测器，并证明了姿态角的收敛性。最后，基于实际MEMS传感器采样数据的仿真结果表明，在存在陀螺仪噪声和零偏的情况下，文中设计的状态观测器输出依然具有较高的精度和较好的动态特性。 |
| 关键词:
MEMS传感器
状态观测器
状态估计
陀螺仪零偏
|
|
| Globally Asymptotic Stable Attitude Estimation with Application to MEMS Sensors |
|
| JIANG Wei, ZHANG Weiguo, SHI Jingping, LYU Yongxi, CHEN Huakun |
|
| School of Automation, Northwestern Polytechnical University, Xi'an 710129, China |
| Abstract: |
| 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. |
| Key words:
MEMS sensor
state observer
state estimation
gyroscope bias
miniature UAV
attitude estimation
|
|
| 收稿日期: 2019-06-10
修回日期:
|
| DOI: 10.1051/jnwpu/20203830550 |
| 基金项目: 国家自然科学基金（61573286，61374032）资助 |
| 通讯作者:
Email： |
| 作者简介: 蒋维(1994-),西北工业大学博士研究生,主要从事导航制导、信息融合与路径规划研究。
|
|
|
|
|
|
|
|
参考文献: |
|
|
[1] HAMEL T, MAHONY R. Attitude Estimation on SO
[3] Based on Direct Inertial Measurements[C]//ICRA 2006. Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006
[2] 秦永元. 卡尔曼滤波与组合导航原理[M]. 西安:西北工业大学出版社, 2015 QIN Yongyuan. The Principle of Kalman Filter and Integrated Navigation[M]. Xi'an:Northwestern Polytechnical University Publishing House, 2015(in Chinese)
[3] LEFFERTS E J, MARKLEY F L, SHUSTER M D. Kalman Filtering for Spacecraft Attitude Estimation[C]//Proc AIAA 20th Aerospace Sciences Meeting, 1982:1-16
[4] CRASSIDIS J L, MARKLEY F L, CHENG Y. Survey of Nonlinear Attitude Estimation Methods[J]. Journal of Guidance Control and Dynamics, 2007, 30(1):12-28
[5] MADGWICK S O H, HARRISON A J L, VAIDYANATHAN A. Estimation of IMU and MARG Orientation Using a Gradient Descent Algorithm[C]//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[J]. Journal of Geophysics and Engineering,2018,15(6):2614-2624
[7] SALCUDEAN S. A Globally Convergent Angular Velocity Observer for Rigid Body Motion[J]. IEEE Trans on Automatic Control, 1991, 36(12):1493-1497
[8] BLACK H D. A Passive system for Determining the Attitude of a Satellite[J]. AIAA Journal, 1964, 2(7):1350-1351
[9] BAR-ITZHACK I Y, HARMAN R R. Optimized TRIAD Algorithm for Attitudedetermination[J]. Journal of Guidance, Control, and Dynamics, 1997, 20(1):208-211
[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[C]//American Control Conference, 2012
[11] NAGY S B, ARNE J T, FOSSEN T I, et al. Attitude Estimation by Multiplicative Exogenous Kalman Filter[J]. Automatica, 2018, 95:347-355
[12] 黄小平. 卡尔曼滤波原理及应用:MATLAB仿真[M]. 北京:电子工业出版社, 2015 HUANG Xiaopeng. Principles of Kalman Filter and Applications:MATLAB Simulation[M]. Beijing:Publishing House of Electronics Industry, 2015(in Chinses)
[13] BATISTA P, SILVESTRE C, OLIVEIRA P. Globally Exponentially Stable Cascade Observers for Attitude Estimation[J]. Control Engineering Practice, 2012, 20(2):148-155
[14] SHUSTER M D, OH S D. Three-Axis Attitude Determination From Vector Observations[J]. Journal of Guidance, Control, and Dynamics, 1981, 4(1):70-77
[15] LORÍA A, PANTELEY E. 2 Cascaded Nonlinear Time-Varying Systems:Analysis and Design[J]. Lecture Notes in Control & Information Sciences, 2001, 311:579-579 |
|
|
|
|
|
|
|
