[发明专利]一种基于全向搜索的航迹关联方法

摘要

本发明公开了一种基于全向搜索的航迹关联方法，包括：每一个处理周期输入一个实测结果产生实测矩阵；每一个处理周期会由实测矩阵和预测矩阵计算得到滤波矩阵，每一个处理周期由上一个处理周期的滤波矩阵计算预测矩阵，初始滤波矩阵有前两个处理周期的实测结果计算得到；每一个处理周期判断实测矩阵是否在预测窗范围内，从而形成一个完整地稳定的航迹。本发明克服了系统航迹混乱引起的关联质量下降的问题，根据航迹信息预测下一时刻目标位置，有效地提高了全向搜索效果。

主权项

1.一种基于全向搜索的航迹关联方法，其特征在于，包括：获取特征点，全空域360度旋转搜索完成一次记为一个周期，每周期记录搜索到的特征点，特征点的信息包括：距离、方位角、俯仰角，得到第n周期特征点的实测球坐标记为Q_t(n)(r_n,fy_n,fz_n)，r_n、fy_n、fz_n分别表示第n周期特征点的距离、方位角和俯仰角，n>0；所述特征点实测球坐标Q_t(n)(r_n,fy_n,fz_n)经过坐标转换得到特征点的位置xyz坐标，所述位置xyz坐标建立实测矩阵，特征点的实测矩阵记为H_t(n)[(ax_n,ay_n,az_n)]，ax_n、ay_n、az_n分别表示第n周期特征点的位置x坐标、位置y坐标和位置z坐标，n>0；所述第1周期和第2周期特征点的实测矩阵记为H_t(1)[(ax₁,ay₁,az₁)]、H_t(2)[(ax₂,ay₂,az₂)]；根据所述第1周期和第2周期特征点的实测矩阵计算得到第2周期特征点的滤波矩阵，由位置xyz坐标和速度xyz坐标建立滤波矩阵，所述第2周期特征点的滤波矩阵表示为H_f(2)[(ax₂,ay₂,az₂)；(vx₂,vy₂,vz₂)]，vx₂、vy₂、vz₂分别第2周期特征点的速度x坐标、速度y坐标和速度z坐标；所述第n‑1周期特征点的滤波矩阵计算得到第n周期特征点的预测矩阵，n>2；由所述第n周期特征点的实测矩阵和所述第n周期特征点的预测矩阵计算得到第n周期特征点的滤波矩阵；根据所述第n周期特征点预测矩阵计算得到特征点的预测球坐标，建立第n周期的预测窗；判断所述第n周期特征点的实测球坐标是否在第n周期的预测窗内，如果是，将n周期特征点实测球坐标记录到航迹上，如果否，将n周期特征点预测球坐标记录到航迹上，n>2。