用于微机械捷联式航姿系统的四元素算法卡尔曼滤波器

介绍了一种卡尔曼滤波器 ,它适用于由微机械惯性传感器构成的捷联式航姿系统。文中阐述了系统构成和原理 ,基于四元素算法公式推导了姿态算法和系统误差模型 ,并设计了实时卡尔曼滤波器。仿真结果表明 ,当没有横向加速度干扰时系统精度优于 0 .0 4度 ,当出现 0 .1g/1Hz的横向交变加速度干扰时 ,精度降为 0 .4 4度。初步测试结果表明系统的静态精度为 :俯仰和横滚 /-0 .2度 ,航向 /- 0 .3度。

Quaternion-Based Kalman Filter for Micro-machined Strapdown Attitude Heading Reference System

A Kalman filter used in strapdown AHRS (Attitude Heading Reference System) based on micro machined inertial sensors is introduced. The composition and principle of the system are described. The attitude algorithm and error model of the system are derived based on the quaternion formulation. The real time quaternion based Kalman filter is designed. Simulation results show that accuracy of the system is better than 0.04 degree without disturbance of lateral acceleration and reduced to 0.44 degree with lateral acceleration of 0.1\%g\%/1Hz. Primary tests show that the static accuracy of the system is +/-0.2 degree for pitch and roll, and +/-0.3 degree for azimuth.