基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法技术

本发明专利技术提供一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，包括：根据拦截导弹的运动特性建立拦截导弹末制导运动模型；根据导引头获取的测量距离和角度信息建立飞航导弹导引头对拦截导弹的测量模型；选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数；相对于传统的常速、常加速模型，拦截导弹的运动模型增加了制导控制环节，突出体现拦截导弹的拦截特性，模型的精确性有利于粒子滤波精度的提高。

【技术实现步骤摘要】
基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法
本专利技术涉及导弹攻防对抗建模与武器装备体系作战效能分析与评估领域，尤其涉及一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法。
技术介绍
机动突防可以减少飞行器对隐身、低空、远程发射的技术需求等，各国研究学者对其相关的策略设计、制导、控制等关键技术展开热烈讨论与深入研究。现有研究均是基于拦截导弹飞行信息可精确获取的前提下完成，尽管微分对策的方法实现了拦截参数未知时的突防制导指令求解，但由于微分对策存在过于保守的缺点导致机动突防所需的能量消耗较大，不利于工程实现。状态估计属于滤波问题，现有研究成果包括卡尔曼滤波KF、扩展卡尔曼滤波EKF、无迹卡尔曼滤波UKF、粒子滤波PF。KF由于结构简单易于实现，最早应用于目标跟踪中，但仅适用于线性高斯系统的滤波。为扩展KF在非线性系统的应用，EKF法通过泰勒级数展开法将非线性系统进行线性化改进，以解决非线性滤波问题，通常仅选择一阶EKF以降低计算量，但易导致精度较差且易发散。粒子滤波是N.J.Gordon基于贝叶斯理论和蒙特卡洛采样提出的，为解决非线性非高斯问题而产生，且滤波性能卓越。其主要思想是使用带权值的随机粒子近似前一时刻的系统后验概率密度，在状态转移模型的基础上预测当前时刻的状态先验概率密度，并采用当前时刻的观测值修正当前时刻状态的后验密度。粒子滤波为解决非线性、非高斯滤波问题提供了有效的方法，但重要性密度函数的选取和重采样方案的设计是粒子滤波的两大难题，制约了滤波的精度及收敛性。
技术实现思路
在下文中给出关于本专利技术的简要概述，以便提供关于本专利技术的某些方面的基本理解。应当理解，这个概述并不是关于本专利技术的穷举性概述。它并不是意图确定本专利技术的关键或重要部分，也不是意图限定本专利技术的范围。其目的仅仅是以简化的形式给出某些概念，以此作为稍后论述的更详细描述的前序。为解决上述问题，本专利技术提出一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法。一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，包括：根据拦截导弹的运动特性建立拦截导弹末制导运动模型；根据导引头获取的测量距离和角度信息建立飞航导弹导引头对拦截导弹的测量模型；选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数。本专利技术提供的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，相对于传统的常速、常加速模型，拦截导弹的运动模型增加了制导控制环节，突出体现拦截导弹的拦截特性，模型的精确性有利于粒子滤波精度的提高。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1为本专利技术提供的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法一种实施例的流程图。图2为本专利技术提供的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法中计算攻角和侧滑角的流程图。图3为本专利技术提供的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法中粒子滤波算法流程图。具体实施方式下面参照附图来说明本专利技术的实施例。在本专利技术的一个附图或一种实施方式中描述的元素和特征可以与一个或者更多个其他附图或实施方式中示出的元素和特征相结合。应当注意，为了清楚目的，附图和说明中省略了与本专利技术无关的、本领域普通技术人员已知的部件和处理的表示和描述。参考图1，本实施例提供一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，包括：步骤S101，根据拦截导弹的运动特性建立拦截导弹末制导运动模型；步骤S102，根据导引头获取的测量距离和角度信息建立飞航导弹导引头对拦截导弹的测量模型；步骤S103，选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数。精确的系统模型是参数辨识和跟踪预测的重要保障，因此，先通过分析拦截导弹在末制导段的工作原理，以装备主动雷达导引头并采用比例导引律的拦截导弹为例，建立同时含有飞行特性和控制特性的拦截导弹末制导运动模型。由于此模型的状态除与自身参数有关，还受飞航导弹的运动影响，因此，其非线性较强。进一步地，拦截导弹末制导运动模型如下：其中，[xyzvθψcm]T分别表示拦截弹的位置在三个方向的分量、速度、弹道倾角、弹道偏角及导弹质量；P为拦截弹的推力，假设末制导段推力为常值；Is为推进剂的比冲；Fxv,Fyv,Fzv为拦截弹速度系下的气动力。参考图2，计算所需的等效攻角αc和侧滑角βc，由拦截弹的指令加速度ay_cmd,az_cmd决定。假设拦截弹采用真比例导引法，则指令加速度为：其中，K为比例系数；分别为相对速度、视线高低角角速度、视线方位角角速度，由拦截导弹制导计算机根据导引头的探测信息R,qε,qβ计算得到。自动驾驶仪根据指令加速度由牛顿迭代算法获得指令攻角αcmd和侧滑角βcmd，并在简化的二阶舵环节后形成实际等效攻角αc和侧滑角βc。因此，改进拦截弹的飞行状态方程为：进一步地，将惯性系下视线矢量转到速度系下，得到：则速度系下的飞航导弹测量模型如下：其中，Rv、qεv、qβv分别为速度系下拦截弹与飞航导弹的相对距离、视线的高低角和方位角；ΔR、Δqε、Δqβ为拦截导弹导引头的测量噪声特性。进一步地，参考图3，选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数，包括：依次计算每个粒子i第k次观测矢量与实际观测值的偏差，记设其权重并进行归一化计算粒子估计状态值Xestimate(i)的协方差矩阵S，并由A'A＝S求解A阵；定义后验粒子的范围及更新步长：Xreg(1)＝min(Xestimate(i))-std(Xestimate(i))Xreg(Nreg)＝max(Xestimate(i))+std(Xestimate(i))dX＝(Xreg(Nreg)-Xreg(1))/(Nreg-1)；更新后验粒子：Xreg(i)＝Xreg(i-1)+dX定义高斯核密度：定义阈值：normXij＝norm(A-1*(Xreg(j)-Xestimate(i)))；其中，j＝1,...,Nreg，i＝1,...,N。当阈值小于高斯核密度时，更新后验概率密度：归一化后验概率密度：根据后验概率密度进行重采样。对采样粒子进行粗糙化：x'_resample＝x_resample+N(0,σ2)；其中，σ由前一时刻Np个粒子估计的系统状态Xestimate决定：E＝(max(Xestimate)-min(Xestimate))/2k为调整系数，k∈(0,1)。本专利技术提供的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，相对于传统的常速、常加速模型，拦截导弹的运动模型增加了制导控制环节，突出体现拦截导弹的拦截特性，模型的精确性有利于粒子滤波精度的提高。采用正则粒子滤波法从连续近似分布中采样，使粒子多位于后验概率分布的中部，从而实现粒子权值变化趋于稳定。通过粗糙化重采样粒子，实现增加重采样粒子多样性的功能，改进的粒子滤波可以很好地抑制“粒子衰竭”现象的发生。虽然已经详细说明了本专利技术及其优点，但本文档来自技高网...

【技术保护点】
一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，其特征在于，包括：根据拦截导弹的运动特性建立拦截导弹末制导运动模型；根据导引头获取的测量距离和角度信息建立飞航导弹导引头对拦截导弹的测量模型；选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数。

【技术特征摘要】
1.一种基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，其特征在于，包括：根据拦截导弹的运动特性建立拦截导弹末制导运动模型；根据导引头获取的测量距离和角度信息建立飞航导弹导引头对拦截导弹的测量模型；选择观测值的协方差作为重要性密度函数，采用基于高斯核密度的正则方法改进重要性密度函数。2.根据权利要求1所述的基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法，其特征在于，所述拦截导弹末制导运动模型如下：其中，[xyzvθψcm]T分别表示拦截弹的位置在三个方向的分量、速度、弹道倾角、弹道偏角及导弹质量；P为拦截弹的推力，假设末制导段推力为常值；Is为推进剂的比冲；Fxv,Fyv,Fzv为拦截弹速度系下的气动力。3.根据权利要求1所述的...

【专利技术属性】
技术研发人员：王芳，涂震飚，魏佳宁，
申请(专利权)人：北京机电工程研究所，
类型：发明
国别省市：北京,11