基于卡尔曼滤波的四旋翼飞行器控制算法
2020-04-01胡开明李跃忠
探测与控制学报 2020年1期
关键词:卡尔曼滤波
胡开明,李跃忠,刘 薇
(1.东华理工大学放射性地质与勘探技术国防重点学科实验室,江西 南昌 330013;2.江西省新能源工艺及装备工程技术研究中心,江西 南昌 330013 )
0 引言
微型旋翼飞行器因具有飞行姿态灵活、体积小、悬停和低速性能优越等特点而受到广泛的关注,目前已成为微型无人飞行器研究领域的热点[1]。可以方便地实现垂直起降、空中悬停的功能,也可以携带摄像机、测绘仪器及各种特定装置,在自动操控或者人工操作下,按照预期的航线和姿态飞行,以完成既定的任务。但是由于飞行器姿态检测中的加速度数据掺杂着高斯白噪声干扰,致使飞行器稳定性较差[2]。目前研究大多数集中在飞行器的设计与飞行算法的研究上,没有对飞行器惯性单元产生的干扰信号进行分析处理。本文针对此问题,提出了以四元数法与卡尔曼滤波相结合对飞行器的姿态数据做互补的融合处理方法。
1 四旋翼飞行器工作原理与结构组成
1.1 四旋翼飞行器工作原理
四旋翼飞行器由四台电机组成,一号和三号电机一对按顺时针旋转,二号和四号电机一对按逆时针旋转。当四轴飞行器工作运行时,空气动力扭矩效应和陀螺效应可以相互抵消,如图1所示。四轴飞行器具有各旋翼的旋转方向与旋翼对机身所施加的反扭矩方向相反的特点,因此当一号电机和三号电机顺时针旋转时,二号电机和四号电机做逆时针旋转,用来平衡各旋翼对机身的扭矩作用。……
登录APP查看全文
