谢习华，唐　顺（.中南大学高性能复杂制造国家重点实验室，湖南长沙40083；2.山河智能装备股份有限公司，湖南长沙4000；3.南方粮油作物协同创新中心，湖南长沙4000）

双因子自适应滤波算法在四旋翼上的应用*

谢习华1，2，3，唐顺1
（1.中南大学高性能复杂制造国家重点实验室，湖南长沙410083；2.山河智能装备股份有限公司，湖南长沙410100；3.南方粮油作物协同创新中心，湖南长沙410100）

针对动力学模型的不精准和观测存在误差问题，建立四旋翼的动力学模型和双因子自适应滤波模型，采用两个因子分别调节动力学模型和观测模型对滤波的影响，通过仿真，对比卡尔曼、扩展卡尔曼滤波算法。结果表明：双因子自适应滤波算法在误差与稳定性方面均有所提高。

四旋翼；自适应滤波；非线性滤波

0　引言

四旋翼（quadrotor）是一种特殊的无人机，具有垂直起降、结构简单、操作容易等特点，广泛地应用于侦查、救援、航拍等任务中［1］。滤波技术是制约四旋翼高精度飞行的一个重要问题，在滤波问题上，国内外很多学者进行了广泛的研究，提出了一系列的滤波算法，如卡尔曼滤波、扩展卡尔曼滤波、自适应滤波、粒子滤波等，并取得了显著的成果［2～5］。四旋翼的动力学模型复杂，具有强耦合和非线性等特点，卡尔曼滤波广泛应用与线性模型中，对于四旋翼其滤波误差较大。扩展卡尔曼滤波可适用于非线性模型，但其高阶截断误差会较大程度地影响四旋翼的精度和稳定性［6］。自适应滤波是引入一个调节因子来均衡调节动力学模型的不精准和观测模型的误差对滤波估计值的影响［7］。……