一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法技术

本发明专利技术公开了一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，属于多旋翼飞行器导航、制导与控制领域。该方法首先采集GPS、惯导数据和旋翼转速；其次基于多旋翼飞行器动力学模型方程和牛顿力学方程，构建卡尔曼滤波器的状态方程和量测方程；然后对卡尔曼滤波器进行离散化，并进行状态更新，输出对参数的最优估计。本发明专利技术解决了传统的动力学模型参数辨识方法实现复杂，对试验设备要求过高的问题。

【技术实现步骤摘要】
一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法
本专利技术涉及了一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，属于多旋翼飞行器导航、制导与控制领域。
技术介绍
多旋翼飞行器具有垂直起降、操控性好、成本较低等特性，对不同环境具有良好的适应性，是诸多应用的理想平台，例如其在农业播种、航空拍摄、气象监测、城市反恐、灾区救援、军事侦察等方面已展现出广阔的应用前景。多旋翼飞行器动力学模型是多旋翼控制系统设计与实现的基础，因此对动力学模型参数的准确辨识对飞行器性能的提高有重大意义。目前多旋翼飞行器动力学模型参数的获取方式主要分为机理推导法和风洞试验法两种。前者基于流体力学与叶素理论计算其动力学模型参数，计算复杂且存在近似计算导致的误差；后者利用风洞进行参数辨识试验，对设备条件的要求较高，试验周期较长。而且这两种方法得到的参数并不能完全反映多旋翼飞行器作为一个整体飞行时的真实状态。
技术实现思路
为了解决上述
技术介绍
提出的技术问题，本专利技术提出了一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，解决了传统参数辨识方法未将飞行器作为整体考虑，实现困难的问题。本专利技术为解决其技术问题采用如下技术方案：一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，包括以下步骤：(1)采集机载传感器信息，包括GPS信息、三轴加速度计的输出、三轴陀螺仪的输出和各旋翼转速信息；(2)根据多旋翼动力学模型特性与牛顿力学原理建立辨识动力学模型参数的卡尔曼滤波器状态方程与量测方程；(3)对所建立的卡尔曼滤波器进行离散化，更新卡尔曼滤波器，对动力学参数进行辨识与输出。在步骤(2)中，所述建立的卡尔曼滤波状态方程如下：上式中为机体系相对于导航系的角速度在机体系x轴上的投影对时间的一阶微分，为机体系相对于导航系的角速度在机体系y轴上的投影对时间的一阶微分，为机体系相对于导航系的角速度在机体系z轴上的投影对时间的一阶微分；为飞行器机体系相对于导航系的速度在机体系x轴上的投影对时间的一阶微分，为飞行器机体系相对于导航系的速度在机体系y轴上的投影对时间的一阶微分，为飞行器机体系相对于导航系的速度在机体系z轴上的投影对时间的一阶微分；为机体系x轴阻力参数对时间的一阶微分，为机体系y轴阻力参数对时间的一阶微分，为升力参数对时间的一阶微分，为绕机体系x轴旋转的角加速度参数对时间的一阶微分，为绕机体系y轴旋转的角加速度参数对时间的一阶微分，为绕机体系z轴旋转的角加速度参数对时间的一阶微分，机体系y轴上气动阻力引起的绕机体系x轴旋转的角加速度参数对时间的一阶微分，为机体系x轴上气动阻力引起的绕机体系y轴旋转的角加速度参数对时间的一阶微分；kx为机体系x轴阻力参数，ky为机体系y轴阻力参数，kT为升力参数,kp为绕机体系x轴旋转的角加速度参数，kq为绕机体系y轴旋转的角加速度参数，kr为绕机体系z轴旋转的角加速度参数，kpy为机体系y轴上气动阻力引起的绕机体系x轴旋转的角加速度参数，kqx为机体系x轴上气动阻力引起的绕机体系y轴旋转的角加速度参数；g为当地重力加速度；m为飞行器质量；φ为飞行器的横滚角，θ为飞行器的俯仰角；ωi为飞行器第i个旋翼的转速，ω1为飞行器第1个旋翼的转速，ω2为飞行器第2个旋翼的转速，ω3为飞行器第3个旋翼的转速，ω4为飞行器第4个旋翼的转速；为飞行器机体系相对于导航系的速度在机体系x轴上的投影，为飞行器机体系相对于导航系的速度在机体系y轴上的投影。在步骤(2)中，所述建立的卡尔曼滤波量测方程如下：式中，为陀螺仪x轴的输出，为陀螺仪y轴的输出，为陀螺仪z轴的输出；为GPS输出的飞行器机体系相对于导航系的速度在机体系x轴上的投影，为GPS输出的飞行器机体系相对于导航系的速度在机体系y轴上的投影，为GPS输出的飞行器机体系相对于导航系的速度在机体系z轴上的投影；fbx为加计x轴的输出，fby为加计y轴的输出，fbz为加计z轴的输出；p为机体系相对于导航系的角速度在机体系x轴上的投影，q为机体系相对于导航系的角速度在机体系y轴上的投影，r为机体系相对于导航系的角速度在机体系z轴上的投影；为飞行器机体系相对于导航系的速度在机体系z轴上的投影。在步骤(3)中，对所建立的卡尔曼滤波器进行离散化，得到状态方程：上式中，为X对时间的一阶微分，状态量，控制量U＝g，W为系统噪声向量，是均值为0的高斯白噪声，其中：在步骤(3)中，对卡尔曼滤波器状态进行更新：Xk+1＝Φk+1,kXk+BkUk+WkZk+1＝Hk+1Xk+1+Vk+1上式中，Xk+1为k+1时刻的状态向量，Φk+1,k为k到k+1时刻的系统一步转移矩阵，Xk为k时刻的状态向量，Bk为Uk的系数矩阵，Uk为k时刻的控制向量，Wk为k时刻的系统噪声向量；Zk+1为k+1时刻的状态向量，Hk+1为k+1时刻的量测矩阵，Vk+1为k+1时刻的量测噪声向量。本专利技术的有益效果如下：(1)本专利技术相较于传统的动力学模型参数辨识方法，不依赖专业的设备，且更易于实现。(2)本专利技术采用卡尔曼滤波器进行参数辨识，实现对参数的最优估计。附图说明图1是本专利技术的流程框架示意图。具体实施方式下面将结合附图对本专利技术创造做进一步详细说明。一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，如图1所示，步骤如下：步骤1：采集机载传感器信息，包括GPS输出的飞行器机体系相对于导航系的速度信息在机体系x、y、z轴上的投影三轴加速度计的输出[fbxfbxfbx]，三轴陀螺仪的输出和多旋翼飞行器各旋翼的转速ωi。步骤2：以X型四旋翼为例，建立如下动力学特性方程：上式中，T是由旋翼旋转产生的升力之和，方向沿机体系z轴负向；Fbx为飞行器在机体系x轴方向上受到的阻力，方向与的方向相反；Fby为飞行器在机体系y轴方向上受到的阻力，方向与的方向相反；P为旋翼升力引起的横滚力矩，Q为旋翼升力引起的俯仰力矩；R为旋翼旋转时产生的反扭矩；kx为机体系x轴阻力参数，ky为机体系y轴阻力参数，kT为升力参数,kp为绕机体系x轴旋转的角加速度参数，kq为绕机体系y轴旋转的角加速度参数，kr为绕机体系z轴旋转的角加速度参数；Ixx为绕机体系x轴的转动惯量，Iyy为绕机体系y轴的转动惯量，Izz为绕机体系z轴的转动惯量；ω1为飞行器第1个旋翼的转速，ω2为飞行器第2个旋翼的转速，ω3为飞行器第3个旋翼的转速，ω4为飞行器第4个旋翼的转速；为飞行器机体系相对于导航系的速度在机体系x轴上的投影，为飞行器机体系相对于导航系的速度在机体系y轴上的投影。在本专利技术中，机体系：原点与载体质心重合，x轴沿载体纵轴向前，y轴沿载体横轴向右，z轴沿载体竖轴向下，即“前右下”坐标系，用b表示；导航坐标系：原点与载体质心重合，x轴和y轴在当地水平面内分别沿当地经线和纬线的切线方向，z轴沿当地地理垂线方向指向地面，即“北东地”坐标系，用n表示。步骤3：根据牛顿力学原理，得到如下力与力矩方程：上式中g为当地重力加速度；m为飞行器的质量；φ为飞行器的横滚角，θ为飞行器的俯仰角；Fbylx为由于质心不在机体系水平面上从而由气动阻力引起的横滚力矩，lx为质心到机体系x轴的距离；Fbxly为由于质心不在机体系水平面上从而由气动阻力引起的俯仰力矩，ly为质心到机体系y轴的距离；为机体系本文档来自技高网...

【技术保护点】
一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，其特征在于，包括以下步骤：(1)采集机载传感器信息，包括GPS信息、三轴加速度计的输出、三轴陀螺仪的输出和各旋翼转速信息；(2)根据多旋翼动力学模型特性与牛顿力学原理建立辨识动力学模型参数的卡尔曼滤波器状态方程与量测方程；(3)对所建立的卡尔曼滤波器进行离散化，更新卡尔曼滤波器，对动力学参数进行辨识与输出。

【技术特征摘要】
1.一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，其特征在于，包括以下步骤：(1)采集机载传感器信息，包括GPS信息、三轴加速度计的输出、三轴陀螺仪的输出和各旋翼转速信息；(2)根据多旋翼动力学模型特性与牛顿力学原理建立辨识动力学模型参数的卡尔曼滤波器状态方程与量测方程；(3)对所建立的卡尔曼滤波器进行离散化，更新卡尔曼滤波器，对动力学参数进行辨识与输出。2.根据权利要求1所述一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法，其特征在于：在步骤(2)中，所述建立的卡尔曼滤波状态方程如下：上式中为机体系相对于导航系的角速度在机体系x轴上的投影对时间的一阶微分，为机体系相对于导航系的角速度在机体系y轴上的投影对时间的一阶微分，为机体系相对于导航系的角速度在机体系z轴上的投影对时间的一阶微分；为飞行器机体系相对于导航系的速度在机体系x轴上的投影对时间的一阶微分，为飞行器机体系相对于导航系的速度在机体系y轴上的投影对时间的一阶微分，为飞行器机体系相对于导航系的速度在机体系z轴上的投影对时间的一阶微分；为机体系x轴阻力参数对时间的一阶微分，为机体系y轴阻力参数对时间的一阶微分，为升力参数对时间的一阶微分，为绕机体系x轴旋转的角加速度参数对时间的一阶微分，为绕机体系y轴旋转的角加速度参数对时间的一阶微分，为绕机体系z轴旋转的角加速度参数对时间的一阶微分，机体系y轴上气动阻力引起的绕机体系x轴旋转的角加速度参数对时间的一阶微分，为机体系x轴上气动阻力引起的绕机体系y轴旋转的角加速度参数对时间的一阶微分；kx为机体系x轴阻力参数，ky为机体系y轴阻力参数，kT为升力参数,kp为绕机体系x轴旋转的角加速度参数，kq为绕机体系y轴旋转的角加速度参数，kr为绕机体系z轴旋转的角加速度参数，kpy为机体系y轴上气动阻力引起的绕机体系x轴旋转的角加速度参数，kqx为机体系x轴上气动阻力引起的绕机体系y轴旋转的角加速度参数；g为当地重力加速度；m为飞行器质量；φ为飞行器的横滚角，θ为飞行...

【专利技术属性】
技术研发人员：包胜，吕品，赖际舟，刘士超，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：江苏,32