一种雷达和光电联动反低慢小目标3D地图画面消抖方法

摘要

本发明提出一种雷达和光电联动反低慢小目标的3D地图画面消抖算法，设定目标状态转移方程与目标状态量测方程；显示终端设备提取出目标的距离量测信息，基于该量测新息对目标状态值与状态协方差进行初始化；基于量测预测值计算量测信息，基于状态预测协方差矩阵与量测预测协方差矩阵计算增益；计算状态滤波值与协方差滤波值；使用状态滤波值作为最终的距离量测值进行距离信息的显示。本发明对光电3D地图显示中的距离测量误差进行平滑，从而达到画面消抖的目的，实现更好的3D视觉跟踪展示效果。