应用科学学报 ›› 2016, Vol. 34 ›› Issue (2): 190-202.doi: 10.3969/j.issn.0255-8297.2016.02.009

• 控制与系统 • 上一篇    下一篇

多传感器融合四旋翼协同控制算法及其实现

张磊, 陆宇平, 殷明   

  1. 南京航空航天大学自动化学院, 南京 211106
  • 收稿日期:2015-03-18 修回日期:2015-09-14 出版日期:2016-03-30 发布日期:2016-03-30
  • 通信作者: 陆宇平,教授,博导,研究方向:先进飞行器的建模与控制、高超声速飞行控制、网络与远程控制技术,E-mail:yplac@nuaa.edu.cn E-mail:yplac@nuaa.edu.cn
  • 基金资助:

    国家自然科学基金(No.91016017)资助

Cooperative Control off Our-Rotor UAV Based on Multi-sensor Fusion

ZHANG Lei, LU Yu-ping, YIN Ming   

  1. College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, Nanjing 211106, China
  • Received:2015-03-18 Revised:2015-09-14 Online:2016-03-30 Published:2016-03-30

摘要: 针对四旋翼无人机定点悬停控制,从应用层面提出了多传感器数据融合方案,设计了相应的协同控制算法.在飞行器整体硬件架构基础上分析量测系统的各个传感器,对于姿态测量通道提出卡尔曼滤波算法,对于高度测量通道提出互补滤波算法,对于水平位置测量通道提出双传感器融合算法.基于四旋翼无人机的状态空间及其小扰动线性化模型,设计了与之相结合的协同控制算法并进行仿真.最后在物理平台上对设计的算法进行验证,表明多传感器融合与协同控制相结合的方法能有效提高四旋翼无人机的定点悬停精度.

关键词: 四旋翼无人机, 数据融合, 卡尔曼滤波, 互补滤波, 协同控制

Abstract: To deal with hovering control of four-rotor UAV from a practical point of view, a scheme of multi-sensor data fusion and a corresponding law of cooperative control are proposed. Based on the overall hardware frame of the aircraft, and within-depth analysis of each sensor in the measurement system, a Kalman filtering algorithm is developed for attitude measurement and a complementary filtering algorithm developed for height measurement. A dual sensor fusion algorithm is proposed to measure horizontal position. A four-rotor UAV model is established using small perturbation linearization. Based on the model, a corresponding cooperative control algorithm is designed. Simulation is performed to test the practicability. All algorithms are applied to a physical platform to verify effectiveness. The results show that the multi-sensor fusion algorithm combined with a coordination controller is reliable and effective. It can effectively improve accuracy of fixed-point hovering of four-rotor UAVs.

Key words: four-rotor UAV, data fusion, Kalman filter, complementary filter, cooperative control

中图分类号: