[发明专利]一种面向多旋翼飞行器的多信息融合实时风速估计方法

说明书

本发明公开了一种面向多旋翼飞行器的多信息融合实时风速估计方法，首先采集机载传感器数据和各旋翼转速数据；其次构建多旋翼飞行器的动力学模型，得到多旋翼飞行器阻力与风速的关系；建立基于多旋翼飞行器动力学模型特性、惯性传感器信息和GPS信息的多信息融合导航系统的状态方程和量测方程；最后采用卡尔曼滤波对导航信息进行更新，得到风速的实时估计。本发明针对现有风速估计方法的不足，充分利用动力学模型气动阻力对风速的敏感特性，与惯性器件、GPS构建卡尔曼滤波器，实现对风速较准确的实时估计。

技术领域

本发明属于飞行器导航技术领域，特别涉及了一种面向多旋翼飞行器的风速估计方法。

背景技术

多旋翼飞行器具有结构简单、体积小、操控性好、垂直起降等特性，对不同环境具有良好的适应性。目前，其在农业播种、航空拍摄、气象监测、城市反恐、灾区救援、军事侦察等方面均已有广泛的应用，展现出广阔的前景。

难以预计的风是多旋翼飞行器稳定飞行最主要的干扰因素。风会增加飞行的控制难度，当风速较大时，如果飞控没有良好的容错能力，会导致多旋翼飞行器极不稳定，甚至出现失控的危险。此外，风也会降低多旋翼飞行器的定点与定高精度，因此对风速的估计对多旋翼飞行器导航、制导与控制有重要的意义。

目前，空速管是飞行器通常采用的风速估计设备。但将空速管应用于多旋翼飞行器中存在以下限制：1、成本、体积的限制，一方面多旋翼能量转换效率低下，搭载过多的传感器会极大牺牲续航时间，另一方面增加新的传感器会减小微小型多旋翼飞行器体积、成本的优势。2、气流干扰，与固定翼飞行器不同，多旋翼飞行器旋翼的旋转会扰乱气流，干扰空速管的测量。

除空速管估计风速外，还有采用构建风场模型的方法来估计风速，但结果不够精确，效果一般。

发明内容

为了解决上述背景技术提出的技术问题，本发明旨在提供一种面向多旋翼飞行器的多信息融合实时风速估计方法，针对现有风速估计方法的不足，充分利用动力学模型气动阻力对风速的敏感特性，与惯性器件、GPS构建卡尔曼滤波器，实现对风速较准确的实时估计。

为了实现上述技术目的，本发明的技术方案为：

一种面向多旋翼飞行器的多信息融合实时风速估计方法，包括以下步骤：

(1)采集机载传感器数据，包括三轴加速度计的输出数据、三轴陀螺仪的输出数据和各旋翼转速数据；

(2)根据步骤(1)获取的数据，构建多旋翼飞行器的动力学模型，得到多旋翼飞行器阻力与风速的关系；

(3)基于多旋翼飞行器动力学模型特性、惯性传感器信息和GPS信息，根据多旋翼飞行器运动学模型，建立多信息融合导航系统的状态方程和量测方程；

(4)采用卡尔曼滤波对导航信息进行更新，得到风速的实时估计。

进一步地，在步骤(2)中，所述多旋翼飞行器的动力学模型：

上式中，F_H为多旋翼飞行器受到的阻力，m为飞行器质量，k为阻力系数，Ω_i为飞行器第i个旋翼的转速，l为飞行器的旋翼总数，V_A^H为空速在机体系下的水平分量，为地速在机体系下的水平分量，为风速在机体系下的水平分量。

进一步地，在步骤(3)中，所述多信息融合导航系统的状态方程：