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

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

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

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.