WEI Zhen-nan, YI Guo-xing, XU Ze-yuan. Algorithm and simulation of MEMS attitude estimation system[J]. 2017, 36(5): 149-152+160. DOI: 10.13873/j.1000-9787(2017)05-0149-04.
微机电系统姿态估计系统算法与仿真
摘要
结合陀螺仪、加速度计误差模型
实现了以微机电系统(MEMS)陀螺仪与MEMS加速度计为基础的姿态估计硬件仿真系统
可用于模拟任意噪声强度和安装偏差下三轴捷联惯导系统(INS)
即按照给定运动曲线仿真输出陀螺仪与加速度计数据
为设计姿态估计算法提供仿真验证平台。同时
以姿态四元数为状态变量
载体俯仰角与横滚角为观测值设计了基于扩展卡尔曼滤波器(EKF)的姿态估计算法
俯仰角估计误差小于0.04°
横滚角估计误差小于0.05°
偏航角漂移速度0.01(°)/s。
Abstract
An attitude estimation hardware simulation system is realized by using MEMS gyroscopes and MEMS accelerometers
which is based on error model of gyroscope and accelerometer. The system can be used to simulate three-axis strapdown inertial navigation system( INS) under the situation of any noise intensity and installation error
that is to output data of gyroscopes and accelerometers according to given motion curve
in order to supply simulation verification platform for designing attitude estimation algorithm. Meanwhile
an attitude estimation algorithm which is based on extended Kalman filter is designed. In the algorithm
the attitude quaternion is chosen as state variable
the pitching angle and roll angle are chosen as observed variables. As a result
estimation error of pitching angle is less than 0. 04°
estimation error of roll angle is less than 0. 05°