计算机应用 ›› 2013, Vol. 33 ›› Issue (07): 2078-2082.DOI: 10.11772/j.issn.1001-9081.2013.07.2078

• 典型应用 • 上一篇    下一篇

基于改进互补滤波器的低成本微小飞行器姿态估计方法

阎世梁1,2,王银玲2,张华2   

  1. 1. 电子科技大学 计算机科学与工程学院,成都 611731
    2. 西南科技大学 工程技术中心,四川 绵阳 621010
  • 收稿日期:2013-01-14 修回日期:2013-02-17 出版日期:2013-07-01 发布日期:2013-07-06
  • 通讯作者: 阎世梁
  • 作者简介:阎世梁(1980-),男,四川绵阳人,讲师,博士研究生,主要研究方向:智能机器人、模式识别;王银玲(1979-),女,陕西渭南人,讲师,博士研究生,主要研究方向:航空发动机及推进技术;张华(1969-),男,四川绵阳人,教授,博士,主要研究方向:模式识别、智能机器人。
  • 基金资助:

    四川省科技厅科技支撑项目(2010GZ0229);四川省应用基础基金资助项目(2011JY0059)

Improved complementary filter for attitude estimation of micro air vehicles using low-cost inertial measurement units

YAN Shiliang1,2,WANG Yinling1,ZHANG Hua1   

  1. 1. Engineering and Technology Center, Southwest University of Science and Technology, Mianyang Sichuan 621010, China
    2. School of Computer Science and Engineering, University of Electronic Science and Technology of China, Chengdu Sichuan 611731, China
  • Received:2013-01-14 Revised:2013-02-17 Online:2013-07-06 Published:2013-07-01
  • Contact: YAN Shiliang

摘要: 针对微飞行器(MAV)在不同机动状态下如何获得对重力加速度的有效估计这一问题,提出一种具有增益调节机制的显性互补滤波器,对微飞行器类似周期性盘旋等典型状态,利用陀螺仪的测量和指示空速的估计构建了向心加速度补偿机制,使得基于重力加速度估计的互补滤波器能获得较为精确的姿态估计,并克服了传统互补滤波器对姿态估计进行重构的缺点。在比例积分补偿环节中,对俯仰角和横滚角的估计赋予不同的截止频率,使得比例增益和积分增益具有较好的自适应性。对比实验表明,姿态角估计误差能保持在±2°之内,与现有的典型滤波算法相比,该方法在算法效率和估计误差方面具有良好的综合性能,并适合用低成本的微惯性测量单元实现微飞行器的精确姿态估计。

关键词: 微飞行器, 姿态估计, 互补滤波器, 重力场, 增益调整

Abstract: Concerning the issue of how to achieve effective estimation of gravitational acceleration for attitude estimation of Micro Air Vehicle (MAV) under all dynamic conditions, an improved explicit complementary filter was proposed in combination with stepped-gain schedule. In order to validate the nonlinear complementary filter in the case when a MAV circled for an extended period, a centripetal acceleration mode was built using gyroscopes and indicated airspeed data, which resulted in precise estimation based on the estimation of gravitational acceleration and avoided reconstructing an estimation of the attitude. In the phase of Proportional-Integral (PI) compensation, the proportional gain and integral gain can achieve better adaptability by assigning different cut-off frequency value to the estimation of pitch and roll angles respectively. The experimental results show that the attitude angle estimation can be maintained under the range of ±2°. Compared with the typical filter algorithm, a better performance was achieved with respect to the efficiency and estimation error, so the algorithm proposed in this paper can be applied to accurate attitude estimation for MAV with low-cost inertial measurement units.

Key words: Micro Air Vehicle (MAV), attitude estimation, complementary filter, gravity, gain-schedule

中图分类号: