包含无效点滤波的弹道高度预测_徐瑞辰.pdf

第 卷 第期 年月探 测 与 控 制 学 报 收稿日期：作者简介：徐瑞辰（），男，陕西西安人，硕士研究生。通信作者：牛兰杰（），男，河南南阳人，硕士，研究员。包含无效点滤波的弹道高度预测徐瑞辰，牛兰杰，张珂，（西安机电信息技术研究所，陕西 西安 ；机电动态控制重点实验室，陕西 西安 ）摘要：针对对地打击弹药引信弹道高度测量中观测信号可能出现的有效数据缺失、数据更新速率低以及由于环境噪声等造成测距精度下降问题，提出包含无效点滤波的弹道高度预测算法。通过引入无效点概念，将探测漏点、干扰点、需插值点设置为两种类型的无效点，将无效点和额外预测点利用系统状态方程、扩展卡尔曼滤波、伪测量技术等处理算法进行滤波及数据更新，实现弹道高度预测。仿真实验验证结果表明，算法在提高数据更新速率、消除漏点干扰、弹道高度额外点预测、降低随机噪声干扰等方面效果显著，该经算法处理的弹道高度信息平均绝对误差和均方根误差相比原始信号均有明显降低。关键词：弹道高度预测；卡尔曼滤波；伪测量中图分类号：文献标志码：文章编号：（），（，；，）：，：；引言近炸引信对现代武器系统的作战效能具有重要作用，而弹道高度的测量精度是影响近炸引信最佳炸点起爆的重要因素。目前典型近炸引信，如无线电引信、光学引信的弹道高度测量精度要求一般小于，美军部分引信炸点控制精度小于，因此提高弹道高度测量精度具有重要实用意义。近年来，国内外学者开展了在不降低目标检测概率前提下，提升测量数据更新速率、降低弹道环境噪声引起的随机误差，进而提高测距精度的研究。文献 分别用最小二乘法或矩阵加权等方法，提出了不同形式的融合卡尔曼滤波器，用于降低信号发生丢失时的预测误差。文献 研究了利用最小二乘法、内插外推算法、三次样条插值、神经网络等改变测量数据更新速率以进行时间对准的方法，但计算复杂度和样本量需求高、抗干扰能力弱，难以在弹载平台使用。文献 在研究异步信号融合系统时利用伪测量原理，通过对高数据更新速率的传感器数据进行最小二乘估计，用量测估计值代替量测真值，调整数据更新速率，将异步数据融合转化为同步数据融合，然而此方法仅限用于均速运动模型，适用面窄，不适用于机动性较强的弹药平台。文献 分别通过建立不同采样时刻下的状态空间模型，利用融合递归的方式进行异步融合。此外，文献 研究了基于伪测量法或序贯融合法的异步融合技术，可用于改变信息更新速率。综上所述，改变信号采样间隔、提高探测精度的算法已较为成熟，经典的方法有多点插值法、状态空间分解法、伪测量法和新兴的神经网络算法等，其中异步信号融合系统中常用的卡尔曼滤波算法和伪测量法具有滤波精度高等优点，但是由于引信在对地弹道高度测量时，具有处理速度高、实时性强等特点，传统基于伪测量技术的卡尔曼滤波算法包含大量矩阵求逆运算，难以满足弹上环境对计算量的要求。本文针对弹载使用平台，以减小计算量和实现高度预测为目标，提出无效点概念，将探测漏点、干扰点、需插值点设置为两种类型的无效点，将无效点和额外预测点利用系统状态方程、扩展卡尔曼滤波、伪测量技术等处理算法进行滤波和更新，进行弹道高度预测，达到降低测量误差、降低采样间隔的效果。高度预测算法 卡尔曼滤波算法卡尔曼滤波算法在弹药制导、防空雷达航迹预测等场景中得到广泛使用，可以预测运动目标轨迹，特别是在信号受到干扰或者测量精度不够时能够有效避免因信号丢失、测量精度低、受环境噪声干扰等原因导致的测量数据失效问题。本文采用的卡尔曼滤波算法根据目标之前的运动状态推算下一步运动状态，可以降低测量误差，减少随机噪声影响，并预测后续运动状态，而且仅利用已知历史信息即可进行实时计算，具有计算实时性强等特点。预测与更新流程卡尔曼滤波（，）是最优估计理论之一，用于递推系统状态的最小方差线性无偏估计，能估计下一步状态和下一步误差协方差。在不考虑控制输入量的情况下，卡尔曼滤波的线性、离散系统方程和测量方程分别如下：，（），（）式中，为系统的状态向量，为可以实际测量的量（观测向量），为状态转移矩阵，为过程噪声分布矩阵，为观测矩阵，为过程噪声，为测量噪声，二者都是均值为零高斯白噪声，且互不相关。过程噪声协方差为（非负阵），测量噪声协方差为（正定阵）。）状态的一步预测方程为?。（）均方误差的一步预测方程为 ，（）式（）中，为状态估计误差协方差阵。）滤波增益权重方程为 （）。（）滤波估计方程（更新方程）为?（）。（）误差协方差更新方程为。（）将步骤）得到的结果，代回步骤），即可完成全状态估计。在对地近炸引信测高使用场景中，同样可以采用卡尔曼滤波算法对弹道高度进行估计，在存在干扰信号时高度预测效果示意图如图所示。图高度预测效果示意图 本文采用卡尔曼滤波算法对高度测量信息在时间 距离维度进行预测，由于卡尔曼滤波算法对非线性航迹适应力不足，且无法完成提高数据更新速率等工作，因此需要做出改进。扩展卡尔曼滤波算法卡尔曼滤波算法现有多种不同变种，其性能在徐瑞辰等：包含无效点滤波的弹道高度预测某些方面得到提升，如扩展卡尔曼滤波、无迹卡尔曼滤波等算法，因此对于滤波算法的选取应有一定考量。由于 扩展卡尔 曼滤波算法（，）对非线性航迹有良好适应性，在目标产生机动时不容易滤波发散，因此本文选取 算法进行弹道高度预测。算法将非线性系统动态方程（，）和（，）在估计值?处进行一阶泰勒展开，从而将非线性函数进行线性化。令?，则可以将离散 算法的状态方程和观测方程分别线性化为 ，（）。（）之后即可利用标准卡尔曼滤波方法进行迭代，其中状态转移矩阵，和观测矩阵分别由（）和（）的雅可比矩阵来替代。伪测量法在近炸引信对地测高过程中往往存在有效量测信息丢失的现象，因此需要通过已确定的量测信息求解在需要量测信息丢失时刻的状态向量，代替真实量测值，此算法称为伪测量法。设两个相邻有效量测信息分别出现在时刻和 时刻，在这两个时刻之间所有需要获得探测信息的时刻记为，则算法的目标为通过时刻的量测值求得时刻的“伪测量值”。根据式（）可知（）（，）（）（，），（）式（）中，（，）（，）为时刻至时刻目标运动模型的状态转移矩阵，而（，）是时刻的过程噪声。由式（）可知，可以表示为（，）（）（，）。（）为了简化公式，设（，），（）（，），（）则式（）可以简化为如下伪测量方程：（），（）且伪测量的协方差矩阵的完整形式为（，）（）（，）（）（，）（）（，）（）（，）（，）（）（）（）（，）。（）包含无效点滤波的弹道高度预测算法一组实测弹道高度信息如图所示，此实测信息存在量测数据丢包、信息更新速率不足、受到干扰等问题，因此，需要对经典滤波算法进行改进，以降低上述问题带来的测量误差，提高测量数据更新速率。图一组实测弹道高度信息 无效点预测流程本文引入无效点概念，利用伪测量方法，在不进行复杂插值计算的前提下对这些问题一次性完成处理。当检测到以下三种场景时引入无效点概念：）每次检测到输入的测量值连续不变或出现漏点时，将连续不变的点或漏点设置为 类无效点；）检测到出现超过预设阈值的极端跳变点时，将超过阈值的点设为类无效点；）在每两个采样点间进行插点，如需将测量数据更新速率提高倍，可在原离散测量值的每两个点之间插入个新点，并将这个新点设为类无效点。之后，利用系统状态方程、扩展卡尔曼滤波、伪测量算法对无效点进行预测和更新。对无效点的预测流程如下：步骤）设原始量测信息采样间隔为，判断原始量测信息中所有无效点所处时刻。对于类无效点，通过式（）求得所有 类无效点所处时刻的伪测量探 测 与 控 制 学 报值，并将 类无效点对应的量测值用伪测量值替代；如在两个有效的量测所处的时刻 和之间有若干类无效点，则将这些类无效点所处时刻的量测信息用 时刻推得的伪量测信息代替。步骤）对修改后的量测信息进行一次扩展卡尔曼滤波处理。步骤）对于类无效点，为了减少计算量和减少量测误差的影响，对步骤）中的每个采样点的卡尔曼滤波结果，代入预测方程式（）进行预测，得到连续的个类无效点中首个点的预测结果，状态转移矩阵的参数取；对其余个类无效点，每一个无效点的结果由前一个无效点通过式（）进行预测，误差协方差阵由式（）更新。步骤）用步骤）的预测结果作为高度估计结果，由于原始量测信息的每两个采样点间插入了 个预测点，因此测量数据更新速率提高了倍，理论上可以取任意正整数值。额外点预测流程实际应用中，当引信持续受到干扰时有效量测信息持续丢失。因此，需要对高度信息进行额外预测。由于无效点预测流程具有可以预测无数据点的功能，因此也可实现额外点预测，且理论可以额外预测任意点之后的结果，额外预测的点数越多，与实际值偏差越大。设原始量测信号序列长度为，则额外点预测的起始点为?，通过处理类或类无效点的方法即可进行额外点预测。为了降低计算量不妨采取对类无效点的算法流程处理额外预测点。图为类无效点预测流程和用同样方法进行额外点预测的流程。图中，：采样率提高的倍数（如采样间隔由 提高到.，则）；：原始信号序列长度；额外预测点数（）。图部分预测流程 如图所示，对预测信号?连续套用次 节中的步骤），每次预测的最后一个点作为下一个循环的首个点，即可额外进行（）个点的预测。若继续调整状态转移矩阵的参数，可任意改变额外预测的数据更新速率。在进行上述预测和更新流程后，可得到高精度、高测量数据更新速率、具有额外预测点数的高度信息，该信息可用于实现引信高精度炸点控制。仿真分析 模拟数据仿真结果假设弹道起点高度为 ，初始速度 ，先进行加速度为 的匀加速运动，后在第 和第 时因机动原因，分别开始进行变加速和匀速运动，如图所示。徐瑞辰等：包含无效点滤波的弹道高度预测图测量与滤波轨迹 仿真验证算法对高度测量信息量测精度及更新速率的提升效果，拟将更新速率从 提高至 。设信号测量误差服从均值为、方差为的正态分布，采用本文提出的包含无效点滤波的预测算法，忽略噪声相关性，选用匀加速运动模型进行滤波计算，在滤波的结果上，额外进行 点预测，即可额外预测约 的高度数据。蒙特卡洛仿 真 次 数 取 次，仿 真 结 果 如 图 图 所示。图测量与滤波轨迹局部放大图 图、图为轨迹和滤波融合处理结果示意图，图图为处理前后位置信息误差对比图。由图、图可知，本文算法可将采样间隔从 提高到 ，距离分辨率从 提高到 ，且额外预测了约 之后的高度信息。图、图、图分别为信号处理前后高度、速度和加速度信息误差对比图。相比于原始信息，使用本文提出的弹道高度预测算法可以显著降低测量误差，融合前后误差统计如表所示。图高度信息绝对误差 图速度信息绝对误差 图加速度信息绝对误差 表滤波前后误差对比 平均绝对误差均方根误差量测信息 滤波结果 带环境噪声信号仿真结果仿真模拟信号受到随机环境噪声时的滤波效果，噪声均值为，仿真得到在不同强度的环境噪声下算法对检测误差的改善效果，结果如表所示。由表数据可知，当量测信息持续受到环境噪声干扰时，算法仍有较好的收敛效果。表不同环境噪声下误差对比 环境噪声方差量测信息平均绝对误差滤波结果平均绝对误差量测信息均方根误差滤波结果均方根误差 探 测 与 控 制 学 报当环境噪声方差小于时，滤波结果均方误差相比无环境噪声时仅提高不到，可以认为此时环境噪声对算法效果无明显影响。当环境方差达到 时，滤波结果均方根误差约 ，远大于原始量测信息的均方根误差约。此时，可认为算法失去有效判断炸点的能力。图图 为环境噪声方差为 时的滤波结果，仿真验证了在环境噪声的影响下算法的有效性。图测量与滤波轨迹 图 高度信息绝对误差 图 速度信息绝对误差 图 加速度信息绝对误差 带干扰点信号仿真结果仿真模 拟 测 量 信 息 受 到 点 干 扰 时 的 滤 波 效果，设置量测信息受到方差为的随机环境噪声影响，同时受到处距离干扰，干扰持续时间分别为，干扰平均偏移为，并且信号从第 开始存在持续 的漏点，导致持续上报相同的距离信息，仿真结果如图 图 所示。图 测量与滤波轨迹 图 测量与滤波轨迹局部放大图 图 高度信息绝对误差 图 速度信息绝对误差 图 加速度信息绝对误差 图、图 为轨迹和滤波结果示意图，图 图 为滤波前后高度、速度、加速度信息误差对比图。由图 可见，本文算法能