基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法技术

本发明专利技术提出了一种基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，具体步骤为：首先，建立高速旋转弹四自由度动力学模型；然后将待辨识参数加入状态变量中形成增广状态向量，得到增广之后的状态方程和量测方程，根据实际工程的初始值以及增广之后的状态方程和量测方程进行滤波计算，得到每一时刻的增广状态变量的估计值以及待辨识参数估计值。本发明专利技术在已经获得观测值的情况下，通过弹丸的运动方程和滤波算法就可以获得相应的气动参数。

【技术实现步骤摘要】
基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法
本专利技术涉及参数辨识
，特别是一种基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法。
技术介绍
火炮武器在战场中反应迅速，能够提供强大且持续的火力支援，是未来部队联合作战的重要组成单元。获取传统高速旋转稳定弹丸准确的气动参数，对于提高火炮射表精度、减小落点散布、增强打击精度具有重要的意义。获取弹丸气动参数的方法主要有三种：第一种方法通过理论计算得出气动参数，第二种方法采用风洞吹风法，第三种方法利用弹丸的自由飞行数据对弹丸的气动参数进行离线辨识。其中，理论计算方法虽然简单，但由于模型中的未建模因素和不确定因素导致计算结果存在一定的误差；风洞吹风法作用于弹丸模型，结果较为准确但由于其成本较高，不能够精准地模拟高速旋转等状态，因而该方法也有缺陷；利用弹丸自由飞行数据辨识弹丸的气动参数，不仅符合实际情况，还能根据辨识结果，及时对弹丸进行调整，从而提高炮弹的打击精度。用于参数辨识的方法通常有递推最小二乘法、递推极大似然法、卡尔曼滤波法等。史继刚基于粒子群初值选取的牛顿迭代优化算法辨识弹丸的零升阻力系数，该方法基于最大似然准则，相比于卡尔曼滤波法实现更加困难；管军等提出一种新的自适应混沌变异粒子群算法来求解该准则下的气动参数最优解，进而得到弹丸的气动参数，但是其在工程上比较难以实现；Rogers等提出了一种基于证据理论的参数估计方法，偏于理论计算；史金光等利用扩展卡尔曼滤波法对弹道修正弹的阻力和升力符合系数进行了辨识，并且由此对后续弹道进行了修正，然而该方法要求较高，难以在实际应用中实现。
技术实现思路
本专利技术提出了一种基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法。实现本专利技术的技术解决方案为：一种基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，具体步骤为：步骤1、建立高速旋转弹四自由度动力学模型；步骤2、根据高速旋转弹四自由度动力学模型，利用扩展卡尔曼滤波辨识气动参数，具体为：步骤2-1、将待辨识参数加入状态变量中形成增广状态向量，得到增广之后的状态方程和量测方程；步骤2-2、根据实际工程的初始值以及增广之后的状态方程和量测方程进行滤波计算，得到每一时刻的增广状态变量的估计值以及待辨识参数估计值。进一步地，建立的高速旋转弹四自由度动力学模型具体为：式中，Vx、Vy、Vz分别为弹丸在x、y、z方向的速度，x、y、z为弹丸的位置坐标；γ为滚转角，为滚转角速度；m为弹丸质量；d为弹丸最大横截面直径；l为弹长；g为重力加速度；ρ为空气密度；S为特征面积，通常取为弹丸的最大横截面积；Cx0和Cx2分别为零升阻力系数和诱导阻力系数；αe为动力平衡角；Vr为弹丸相对于空气的速度；C′y为升力系数导数；C″z为马氏力系数的联合偏导数；C为极转动惯量；A为赤道转动惯量；m′xz为极阻尼力矩系数导数；Wx、Wz分别为x和z方向的风速；m″y为马格努斯力矩系数的联合偏导数；m′z为静力矩系数导数，Vr为弹丸相对于空气的速度。进一步地，步骤2-1中得到的增广之后的状态方程和量测方程为：y(t)＝ga[xa(t),u(t)]z(k)＝y(k)+Gv(k)式中，F为系统噪声转移矩阵，G为量测噪声转移矩阵，w(t)为系统噪声，v(k)为量测噪声，xa(t)为增广状态变量，u(t)为外部输入，β为待辨识参数，y(t)为连续时间下的观测向量，z(k)为量测向量。进一步地，步骤2-2中得到每一时刻的增广状态变量的估计值以及待辨识参数估计值的具体步骤为：步骤2-2-1、确定初始时刻的增广状态变量估计值及增广状态变量误差协方差矩阵估计值；步骤2-2-2、根据k-1时刻的增广状态变量估计值及增广状态变量误差协方差矩阵估计值得到k时刻的增广状态变量预测值及增广状态变量误差协方差矩阵的预测值；优选地，k时刻的增广状态变量预测值及增广状态变量误差协方差矩阵的预测值具体为：表示k时刻的增广状态变量的预测值，为外部输入，表示连续时间t时刻下的估计的增广状态变量，t(k)表示对应着k时刻的时间，为k时刻的增广状态变量误差协方差矩阵的预测值，Δt为k-1时刻到k时刻的时间间隔，为k-1时刻的增广状态变量误差协方差矩阵的估计值，Φa(k)为状态转移矩阵，且Aa(k)为增广后的状态函数fa对xa的雅克比矩阵。步骤2-2-3、根据求得的k时刻的增广状态变量误差协方差矩阵预测值以及k时刻的增广状态变量的预测值得到k时刻的增广状态变量误差协方差矩阵估计值以及k时刻的增广状态变量的估计值；优选地，k时刻的增广状态变量误差协方差矩阵估计值以及k时刻的增广状态变量的估计值具体为：增广状态变量误差协方差矩阵估计值：k时刻的增广状态变量的估计值：式中，u(k)为外部输入，I为单位矩阵，z(k)为k时刻的量测向量，Ka(k)为k时刻的滤波增益矩阵，Ca(k)为ga对xa的雅克比矩阵，增广状态变量误差协方差矩阵预测值，G为噪声转移矩阵。步骤2-2-4、返回步骤2-2-2，直至量测向量完结。在实际运用中，根据实际情况选定初始条件，进行参数辨识，运用本方法时，要先确定炮弹发射时的气象条件，对应不同型号的高速旋转弹，具有不同的物理参数。确定高速旋转弹发射的初速度、射角、初始滚转角速度，确定观测值和量测方程，选择计算机语言进行编程实现。本专利技术与现有技术相比，其显著优点为：本专利技术采用扩展卡尔曼滤波进行参数辨识，基于实际项目测得的数据，具有实际性能；同时，用扩展卡尔曼滤波辨识的成本较低，精度更高；扩展卡尔曼滤波法适合于各种各样的弹道模型，对于不同控制系统的炮弹还能做出及时调整；本专利技术根据炮弹前半段的飞行数据辨识出气动参数，然后根据辨识结果对炮弹进行及时调整以提高射击精度，具有实时性；本专利技术适用于非线性系统，其算法简单、实用性强、精度高，在已经获得观测值的情况下，通过弹丸的运动方程和滤波算法就可以获得相应的气动参数。下面结合说明书附图对本专利技术做进一步说明。附图说明图1为本专利技术的流程图。图2为实施例1中辨识零升阻力系数的结果示意图。具体实施方式下面结合附图对本专利技术作进一步详细描述。如图1所示，一种基于扩展卡尔曼滤波的辨识高速旋转弹气动参数滤波方法，包括以下步骤：步骤1、建立高速旋转弹四自由度动力学模型，四自由度动力学模型建立在地面坐标系下。进一步的实施例中，所述高速旋转弹四自由度动力学模型具体为：弹丸相对于空气的速度为：动力平衡角αe的直接计算公式为：直接计算公式中的参数为：式中，Vx、Vy、Vz分别为弹丸在x、y、z方向的速度；x、y、z为弹丸的位置坐标；γ为滚转角，为滚转角速度；m为弹丸质量；d为弹丸最大横截面直径；l为弹长；g为重力加速度；ρ为空气密度；S为特征面积，通常取为弹丸的最大横截面积；Cx0和Cx2分别为零升阻力系数和诱导阻力系数；αe为动力平衡角；Vr为弹丸相对于空气的速度；C′y为升力系数导数；C″z为马氏力系数的联合偏导数；C为极转动惯量；A为赤道转动惯量；m′xz为极阻尼力矩系数导数；Wx、Wz分别为x和z方向的风速；m″y为马格努斯力矩系数的联合偏导数；m′z为静力矩系数导数。步骤2、根据高速旋转弹四自由度动力学模型，利用扩展卡尔曼滤波辨识气动参数，具体为：步骤2-1、将待辨识参数加入状态变量中形成增广状态向量，得到增广本文档来自技高网...

【技术保护点】
1.基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，具体步骤为：步骤1、建立高速旋转弹四自由度动力学模型；步骤2、根据高速旋转弹四自由度动力学模型，利用扩展卡尔曼滤波辨识气动参数，具体为：步骤2‑1、将待辨识参数加入状态变量中形成增广状态向量，得到增广之后的状态方程和量测方程；步骤2‑2、根据实际工程的初始值以及增广之后的状态方程和量测方程进行滤波计算，得到每一时刻的增广状态变量的估计值以及待辨识参数估计值。

【技术特征摘要】
1.基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，具体步骤为：步骤1、建立高速旋转弹四自由度动力学模型；步骤2、根据高速旋转弹四自由度动力学模型，利用扩展卡尔曼滤波辨识气动参数，具体为：步骤2-1、将待辨识参数加入状态变量中形成增广状态向量，得到增广之后的状态方程和量测方程；步骤2-2、根据实际工程的初始值以及增广之后的状态方程和量测方程进行滤波计算，得到每一时刻的增广状态变量的估计值以及待辨识参数估计值。2.根据权利要求1所述的基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，建立的高速旋转弹四自由度动力学模型具体为：式中，Vx、Vy、Vz分别为弹丸在x、y、z方向的速度，x、y、z为弹丸的位置坐标；γ为滚转角，为滚转角速度；m为弹丸质量；d为弹丸最大横截面直径；l为弹长；g为重力加速度；ρ为空气密度；S为特征面积，通常取为弹丸的最大横截面积；Cx0和Cx2分别为零升阻力系数和诱导阻力系数；αe为动力平衡角；Vr为弹丸相对于空气的速度；C′y为升力系数导数；C″z为马氏力系数的联合偏导数；C为极转动惯量；A为赤道转动惯量；m′xz为极阻尼力矩系数导数；Wx、Wz分别为x和z方向的风速；m″y为马格努斯力矩系数的联合偏导数；m′z为静力矩系数导数，Vr为弹丸相对于空气的速度。3.根据权利要求2所述的基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，弹丸相对于空气的速度具体为：4.根据权利要求2所述的基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，动力平衡角αe的计算公式为：式中，各参数具体为：5.根据权利要求1所述的基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法，其特征在于，步骤2-1中得到的增广之后的状态方程和量测方程为：y(t)＝ga[xa(t),u(t)]z(k)＝y(k)+Gv(k)式中，F为系统噪声转移矩阵，G为量测噪声转移矩阵，w(t)为系统噪声，v(k)为量测噪声，xa(t)为增...

【专利技术属性】
技术研发人员：郑宇程，易文俊，管军，余春华，袁丹丹，孙蕾，吕一品，穆青，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32