系统工程与电子技术

• 制导、导航与控制 • 上一篇    下一篇

基于扩展卡尔曼滤波器的低成本航姿系统设计

盛汉霖, 张天宏, 刘冬冬   

  1. 南京航空航天大学能源与动力学院, 江苏 南京 210016
  • 出版日期:2013-10-25 发布日期:2010-01-03

Low-cost AHRS design based on extending Kalman filter

SHENG Han-lin, ZHANG Tian-hong, LIU Dong-dong   

  1. College of Energy and Power, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China
  • Online:2013-10-25 Published:2010-01-03

摘要:

针对传统的航姿系统(attitude and heading reference system, AHRS)在微型无人飞行器、机器人等应用上所体现的成本高、体积大、功耗大的问题,提出了一种低成本高精度AHRS。该系统以数字信号处理器为硬件平台,集成了陀螺仪、加速度计、磁罗盘等9自由度微机电系统传感器,采用了基于四元数的姿态估计方法,建立了传感器输出模型和系统状态空间模型,考虑了加速度对系统精度的影响,解决了四元数协方差奇异性问题,通过扩展卡尔曼滤波〖JP3〗器进行数据融合以获得姿态的准确输出。经数值仿真分析和三轴飞行转台测试,姿态角的静态精度优于0.5°、动态精度优于2°,并在微型无人飞行器上进行了飞行验证,结果表明其能够满足小型无人飞行器等的应用需求。

Abstract:

A low-cost, high-accuracy attitude and heading reference system (AHRS) is proposed for the problem of high cost, big volume and high power consumption on the traditional AHRS which is applied in micro unmanned aerial vehicle (MUAV) and robots. Using a digital signal processor (DSP) as a hardware platform, 9-degree of freedom micro-electro-mechanical system (MEMS) sensors including gyroscope, accelerator and compass are integrated. An attitude estimation method based on quaternion is adopted. Sensor model and state space model are built. The impact of acceleration on the system accuracy is considered. The singularity problem of quaternion covariance is solved, and the accurate output of attitude and heading by applying an extending Kalman filter to data fusion is acquired. The result indicates that the static accuracy and dynamic accuracy of the attitude angle are better than 0.5° and 2°, respectively. The system is also tested on the MUAV and the outcome meets the application demand of MUAV.