[发明专利]一种基于判断机动的运动状态估计方法

说明书

技术领域

本发明涉及一种状态估计方法，特别是在交互多模型的目标跟踪领域，应用于目标跟踪领域。

背景技术

随着现代科技的进步，各种高机动性能的飞行器、舰艇等高机动的运动目标相继问世。这些类型的运动目标的机动范围很大，这就对跟踪系统提出了很高的要求，要求跟踪系统能够对目标的各种运动状态都有着良好的状态估计性能。但是现有的目标跟踪交互式多模型算法仅仅是还原出目标的运动轨迹，不仅具有一定的延迟性，而且对于目标信息的短暂缺失，没有采取任何弥补措施，系统的抗干扰能力较差。

传统的状态估计算法的缺点：首先是单模型算法，而对于传统的单模型滤波器，当目标的运动模式同该模型不符合的时候只能通过增加系统的过程噪声等方式加以解决，但是当目标的机动超出模型的跟踪范围的时候就会导致跟踪丢失的现象发生，因此应用范围比较窄。其次对于传统的交互式多模型的过程中，为了提高算法的滤波精度，就要覆盖尽可能多的运动模型，但是这样算法计算量的成倍的提高。而且模型集合中过多的模型又会导致模型之间出现竞争，从而降低算法的精度，而且在复杂的环境下，由于传感器的不稳定因素，容易出现目标的短暂缺失，而在传统的状态估计算法中，没有对此方面进行处理，稳定性较差。

发明内容

本发明技术解决问题：克服现有技术的不足，提供一种精简的基于判断机动的运动状态估计方法，本发明提供一种较高精度的运动状态估计方法，采用精简的交互式多模型的方式，使得本发明能够应对复杂多变的环境的同时，不会降低精度；并且本发明中采用的预测验证机制，能够在目标短暂缺失后，仍然能够得到较好的状态估计效果，提高算法的稳定性。

该方法采用的技术方案为：该技术在过程上分为以下五个步骤：输入交互，kalman滤波，判断机动，概率预测，数据融合。首先输入交互是在已经获得模型上一时刻的状态估计值，协方差的估计值并获取新的量测值z(k)之后对模型进行重新的初始化运算，根据模型之间的转移概率来获得新的初始值。根据上一步输入交互的结果，将X_j(k-1|k-1)和P_j(k-1|k-1)作为k时刻模型的输入，采用kalman滤波算法得到输出的结果，然后进入判断机动阶段，每一个模型用相应的算法对未来一段时间的结果进行预测，并且判断目标是否发生了机动性较强的运动，在此基础上，设定了一个概率函数，对预测值进行约束，产生相应的预测概率，根据这些预测概率将kalman滤波的输出结果进行加权求和。接下来是用当前的观测值去验证过去时刻的预测值是否在误差的允许的范围内；

步骤一：输入交互：将系统的观测数据作为本算法的输入，若本算法没有经过第一轮迭代，则将此时的输入不做任何处理，直接作为步骤二的输入；否则，根据上一轮的步骤四产生的预测概率p_i和步骤二中的经过kalman滤波器后目标状态，经过概率和状态信息的加权求和后，得到模型j在k时刻的输入。

步骤二：根据步骤一的k时刻的输入，利用这些输入信息，启动kalman滤波，对系统状态进行最优估计的算法。由于观测数据中包括系统中的噪声和干扰的影响，所以最优估计也可看作是滤波过程。利用kalman滤波修正观测数据中含有误差的值。

步骤三：判断机动：经过步骤二后，模型的kalman滤波器已经启动，利用卡尔曼滤波的预测性，预测出目标坐标的下一个位置坐标，用下一时刻的目标坐标的观测值与预测的下一个位置坐标进行对比；判断目标观测值与预测的距离是否达到最大容忍的误差范围；并修改概率公式的参数。

步骤四：概率预测：结合当前滤波值，预测接下来N个时刻的状态信息；根据步骤二的目标状态估计信息，利用概率计算公式，用计算出来预测概率p_j为每一个预测值进行约束，其中概率公式如下：