基于航迹方向最大密度估计的红外多目标双站定位

基于航迹方向最大密度估计的红外多目标双站定位 Infrared multi-target dual-station positioning based on maximum density estimation in track direction 1 2 first-author 岳　娟（1990-），女，湖南邵阳人，博士，助理研究员，2017年于中国科学院大学获得博士学位，主要从事红外图像处理及双站定位算法研究。E-mail： yuejuan207@126.com http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246068&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246070&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246069&type= 22.01333237 32.00399780 岳　娟 （1990-），女，湖南邵阳人，博士，助理研究员，2017年于中国科学院大学获得博士学位，主要从事红外图像处理及双站定位算法研究。E-mail： yuejuan207@126.com yuejuan207@126.com 2 2 corresp E-mail： gauss_gao@sina.com E-mail： gauss_gao@sina.com 高思莉（1978-），女，河南新乡人，博士，研究员，主要研究方向为红外成像探测、图像融合及红外动态场景仿真技术。Email： gauss_gao@sina.com http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246074&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246076&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246072&type= 22.01333618 32.00400543 高思莉 （1978-），女，河南新乡人，博士，研究员，主要研究方向为红外成像探测、图像融合及红外动态场景仿真技术。Email： gauss_gao@sina.com gauss_gao@sina.com 中国科学院 智能红外感知重点实验室，上海 200083 中国科学院 智能红外感知重点实验室，上海 200083 Key Laboratory of Intelligent Infrared Perception， Chinese Academy of Sciences， Shanghai 200083， China Key Laboratory of Intelligent Infrared Perception， Chinese Academy of Sciences， Shanghai 200083， China 中国科学院上海技术物理研究所，上海 200083 中国科学院上海技术物理研究所，上海 200083 Shanghai Institute of Technical Physics of the Chinese Academy of Sciences， Shanghai 200083， China Shanghai Institute of Technical Physics of the Chinese Academy of Sciences， Shanghai 200083， China 为了抑制测量误差对多目标双站定位的影响，本文充分利用目标短时运动航迹点时空分布特点，提出基于航迹最大密度估计的红外运动多目标双站定位方法。首先，基于双站测向射线高程差进行单帧多目标初匹配。然后，基于方向二维直方图，初步估计出目标航迹方向；以此为搜索起点，开展基于Mean Shift的目标航迹方向最大密度估计。最后，基于目标航迹方向进行航迹点真假检验，抑制测量误差对目标定位结果的影响。实验结果表明：本文方法不仅能有效剔除误匹配点，而且能抑制误差偏差点；航迹最大拟合误差小于0.5 m，平均拟合误差小于0.3 m，优于其他算法；对于既有误匹配点又有误差偏差较大定位点的目标，相比于直方图法，本文方法最大拟合误差降低幅度大于50%，平均拟合误差降低27%。本文方法能有效抑制定位误差，在目标三维定位及预测、打靶训练评估等军民用领域具有重要价值。 This study aims to reduce the influence of measurement errors on the positioning of a multi-target in dual-stations. By using the spatio-temporal distribution characteristics of the motion track points of a target over a short time period， an infrared motion multi-target dual-station positioning method is proposed based on the maximum track density estimation. First， single frame multi-target matching is performed based on the elevation difference along direction-finding rays of dual-stations. Then， based on the two-dimensional direction histogram， the target track direction is preliminarily estimated， following which the maximum density of the target track direction is determined based on the mean shift. Finally， the authenticity of the track point is validated based on the target track direction to reduce the influence of measurement errors on the target positioning result. The experimental results reveal that the proposed method effectively eliminates the mismatch point and reduces the error deviation point. The maximum fit error of the track is less than 0.5 m， and the average fit error is less than 0.3 m， which represent improvements on existing algorithms. For targets that exhibit both mismatched points and larger error deviations compared with those of the histogram method， the maximum fitting error of the proposed method is reduced by more than 50%， and the average fitting error is reduced by 27%. Thus， the proposed method can effectively reduce the positioning error， which has important applications in military and civilian fields， such as three-dimensional positioning， target prediction， and hooting training evaluation. 双站定位 多目标 红外 最大密度估计 Mean Shift dual-station positioning multi-target infrared maximum density estimation mean shift 1 引　言 1 红外双站定位，作为一种无源被动光电探测技术，通过两个红外成像测站对目标进行测向交叉定位 ［ 1 1 ］ ，获取目标三维位置，具有作用距离远、抗干扰性好、穿透烟尘雾霾能力强、全天时工作等优点 ［ 2 2 ］ ，在空间碎片等目标三维定位及预测、发射任务中目标辐射特性跟踪反演、军事威胁目标甄别与对抗以及打靶训练评估等军民用领域具有重要应用价值。 红外弱小目标一直是军民用领域重点感兴趣对象 ［ 3 3 ］ ，且常常伴有多目标处理任务。因此对于红外双站定位系统，须设计多目标匹配定位算法，才能获取各目标的三维位置。由于这类目标占据红外图像像素数少，且图像形状与纹理特征弱，无法适用于基于灰度 ［ 4 4 ］ 或基于特征 ［ 5 5 ］ 的传统匹配算法，多目标匹配难度大。如何提高多目标匹配定位精度，满足应用需求，是红外双站定位面临的一项重要研究难题。 目前，多站多目标任务 ［ 6 6 - 7 7 6-7 ］ 定位算法可大体分为两类：聚类法和数据关联法。聚类法适用于测站数量大于3的定位系统，它基于多站多目标测向线两两相交交点的空间分布特性，通过不同的策略对交点集合进行聚类分析，确定交点分布密集的目标点的位置和数量 ［ 8 8 - 9 9 8-9 ］ ，消除虚假交叉点，实现多目标定位。数据关联算法主要用于判定各传感器的测量参数是否来自同一个目标，对于测向交叉定位系统，该方法主要是利用前两个测站的测向交叉点和第三个测站的测向角度值进行匹配检测，消除虚假交叉点 ［ 10 10 ］ 。 对于双站测向交叉定位系统，王成等 ［ 11 11 ］ 基于双站定位模型推导出来源于同一目标的测向角所满足的唯一方程，基于该方程定义关联残差与关联度，以衡量每组测量数据来源于同一目标的真实程度，实现两个测站多目标测量数据关联；王鲲鹏 ［ 12 12 ］ 将多视约束引入到双站多目标跟踪匹配中，将同名点匹配搜索范围从整幅图像缩小至核线上，进行两站点目标成像数据关联。上述两种方法都基于对极几何核心原理。对极几何，作为同名像点对满足的几何约束条件，是值得红外弱小多目标匹配定位借鉴的重要方向，但文献中尚未提及误匹配与测量误差处理办法。赵庆璐等 ［ 13 13 ］ 基于两站所有可能定位结果对应的距离与方位信息，构建多目标观测数据关联矩阵，在此基础上采用静态和动态相结合的方法滤除虚假航迹点。该方法的整体框架值得借鉴，但其静态滤除准则依赖于测站最大探测距离这一先验知识，且静态滤除的虚假点数量较少，然后再对候选关联进行滑窗跟踪，实现动态滤除，这在对空间相距很近的多目标定位时可能会遇到一定困难，也尚未提及测量误差处理办法。 王俊迪等 ［ 14 14 ］ 针对机载红外双站定位系统，提出基于岭回归的红外协同定位优化算法，利用岭回归算法求解出定位精度较高的两组测量子集的目标位置估计值，用以提高单目标定位精度，但尚未提及多目标匹配定位情况。 盛卫东等 ［ 15 15 ］ 立足天基分布式被动光学跟踪系统的多目标三维跟踪问题，采用两个观测平面与参考平面之间的倾角差（Hinge Angle Difference，HAD）作为数据关联准则，判断两条角轨迹是否来自于同一个目标，实现双星关联。HAD本质上是双站观测的立体几何约束，但当目标分布密集而出现多目标位于某测站同一观测方向或观测面上时，他们与另一测站的各目标HAD关联值都相同，多目标数据关联性能下降，对关联算法要求提高 ［ 16 16 ］ 。 Yang Yu等 ［ 17 17 ］ 针对异步测向交叉定位传感器网络，提出一种基于时间特征的传感器测量数据关联方法，可用于空中目标雷达监视网络系统。该方法搜索满足时间差阈值约束的测量数据，对目标进行交叉定位，论文指出其方法优于HAD方法，但是依赖于测量时间这一附加信息。 基于此，本文提出基于航迹方向最大密度估计的红外运动多目标双站定位方法。首先基于双站测向射线高程差进行单帧多目标初匹配，然后针对测量误差可能引起目标误匹配或定位位置偏差较大这一问题，充分利用目标三维运动航迹点的时空分布特点，基于Mean Shift算法 ［ 18 18 ］ 进行目标航迹方向最大密度估计，以此进行航迹点真假检验，抑制测量误差对目标定位结果的影响，提高红外多目标三维定位精度。 2 算法思想 1 基于测向交叉定位原理，当多个目标同时出现在两个测站视场中时，会产生许多虚假交叉点。假设双站定位系统两个测站的视场中同时出现 n 个目标，测站通过目标检测算法可获得当前图像中所有目标观测数据 <math id="M1"><mo stretchy="false">{</mo><msub><mrow><mi>O</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo stretchy="false">|</mo><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo stretchy="false">)</mo><mo>,</mo><mi>i</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>;</mo><mi>j</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi><mo stretchy="false">}</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246078&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246077&type= 57.82733154 4.91066647 ， <math id="M2"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246082&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246080&type= 11.76866722 4.91066647 表示目标 j 在测站 <math id="M3"><mi>i</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246086&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246084&type= 1.10066664 2.79399991 的像点位置；从每个测站中任取一个观测数据，构成双站观测数据集合 <math id="M4"><mo stretchy="false">{</mo><mo stretchy="false">(</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mo stretchy="false">|</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246103&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246087&type= 17.01799965 4.65666676 <math id="M5"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mo>,</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246093&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246105&type= 26.50066566 4.91066647 <math id="M6"><mi>j</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi><mo>;</mo><mi>k</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi><mo stretchy="false">}</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246097&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246095&type= 46.73600006 3.97933316 ，基于双站定位模型，可定位出 <math id="M7"><msup><mrow><mi>n</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246101&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246099&type= 2.96333337 3.04800010 个可能的目标位置；其中 <math id="M8"><mo stretchy="false">{</mo><mo stretchy="false">(</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mfenced open="|" close="" separators="|"><mrow><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mo>,</mo><mi>j</mi><mo>=</mo><mi>k</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi></mrow></mfenced><mo stretchy="false">}</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246109&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246118&type= 74.59133911 4.91066647 是 n 个目标的双站观测数据，可定位出 n 个真实目标位置；其余 <math id="M9"><msup><mrow><mi>n</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>-</mo><mi>n</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246121&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246110&type= 9.22866726 3.04800010 个双站观测数据 <math id="M10"><mo stretchy="false">{</mo><mo stretchy="false">(</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mo stretchy="false">|</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246123&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246122&type= 17.01799965 4.65666676 <math id="M11"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>,</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246126&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246124&type= 18.88066673 4.91066647 <math id="M12"><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo><mo>,</mo><mi>j</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi><mo>;</mo><mi>k</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi><mo>,</mo><mi mathvariant="normal">且</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246134&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246117&type= 58.08132935 4.91066647 <math id="M13"><mi>j</mi><mo>≠</mo><mi>k</mi><mo stretchy="false">}</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246137&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246130&type= 9.48266602 3.97933316 ，定位出 <math id="M14"><msup><mrow><mi>n</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>-</mo><mi>n</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246149&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246132&type= 9.73666668 3.04800010 个虚假目标位置。因此，须设计多目标双站匹配定位算法，消除虚假交叉点，筛选出目标位置，实现多目标定位。 如 图1 图1 所示，空间中存在 P 1 、 P 2 、 P 3 三个目标，基于测站 S 1 、 S 2 对目标的成像观测数据，可确定6条观测射线。根据光电成像几何原理可知，观测射线 <math id="M15"><msub><mrow><mi>S</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246152&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246141&type= 7.36600018 3.72533321 与 <math id="M16"><msub><mrow><mi>S</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246146&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246144&type= 7.36600018 3.72533321 在空间上相交于物点 P 1 ，其高程差（定义见3.1节） <math id="M17"><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">11</mn></mrow></msub><mo>=</mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246165&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246163&type= 13.97000027 4.06400013 ；观测射线 <math id="M18"><msub><mrow><mi>S</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246167&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246158&type= 7.36600018 3.72533321 与 <math id="M19"><msub><mrow><mi>S</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246160&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246169&type= 7.36600018 3.72533321 、 <math id="M20"><msub><mrow><mi>S</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246173&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246171&type= 7.36600018 3.72533321 在空间上都不相交，高程差 <math id="M21"><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">12</mn></mrow></msub><mo>></mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246177&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246175&type= 13.97000027 4.06400013 ， <math id="M22"><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">13</mn></mrow></msub><mo>></mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246180&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246179&type= 13.97000027 4.06400013 ；且大概率情况下，物点距离越远，该高程差值越大。可见理论上，基于最小高程差可实现单帧多目标初匹配。该方法的核心基础也是双站观测的立体几何约束关系，但相比于基于面面关系的HAD匹配关联方法，本文方法基于线线关系进行匹配关联，在计算量以及处理“多对一”问题上更具优势。 实际应用中，由于测站定位、目标测向等各环节都会引入测量误差，这可能导致初匹配发生误匹配或定位结果偏差较大，进而影响目标三维位置估计与预测的准确性。假设测站定位、目标测向环节引入的噪声为独立的零均值高斯白噪声，以几何稀释精度（Geometric Dilution of Precision，GDOP ［ 19 19 ］ ）为指标，对红外双站定位系统定位误差进行理论仿真，结果如 图2 图2 所示，图中星状离散点对应距离两站中心1.5 km远处目标的定位误差，由此可知，该假设前提下，系统对1.5 km远处目标定位误差约1~1.4 m。此时对于空间距离约3 m的两个物点，其对应的观测数据很可能发生误匹配，定位出目标虚假航迹点。因此，如何有效抑制测量误差，提高目标定位精度，是本文重点研究对象。 目标短时运动近似满足直线运动规律，尤其对处于非机动状态下的目标而言。假设通过连续多帧多目标匹配定位后，某目标形成 N 个参与三维航迹拟合的航迹点，其中 M 个航迹点为真实目标位置， N <math id="M23"><mo>-</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246203&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246191&type= 2.96333337 2.79399991 M 个航迹点为虚假目标位置（含误匹配点与定位偏差点，一般（ N <math id="M24"><mo>-</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246203&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246191&type= 2.96333337 2.79399991 M ）≪ M ），则从 M 个真实目标航迹点中任取两点组成 <math id="M25"><msubsup><mrow><mi mathvariant="normal">C</mi></mrow><mrow><mi>M</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246206&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246204&type= 4.57200003 3.97933316 个三维向量，其方位角与俯仰角大小接近，近似于目标实际三维航迹的方位角与俯仰角，分布比较集中；而从 N 个航迹点中任取其他两点组成 <math id="M26"><mo stretchy="false">(</mo><msubsup><mrow><mi mathvariant="normal">C</mi></mrow><mrow><mi>N</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msubsup><mo>-</mo><msubsup><mrow><mi mathvariant="normal">C</mi></mrow><mrow><mi>M</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msubsup><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246225&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246223&type= 16.67933464 4.65666676 个三维向量，其方位角与俯仰角大小不一，分布比较离散。其中航迹点 <math id="M27"><mi>A</mi><mfenced separators="|"><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246211&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246209&type= 23.45266724 4.82600021 、 <math id="M28"><mi>B</mi><mfenced separators="|"><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246227&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246214&type= 22.69066620 4.82600021 ，构成三维航迹向量 <math id="M29"><mover accent="true"><mrow><mi>A</mi><mi>B</mi></mrow><mo>⃗</mo></mover></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246229&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246216&type= 5.33400011 3.80999994 ，该向量的方位角 <math id="M30"><mi>θ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246232&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246231&type= 1.77800000 2.79399991 、俯仰角 <math id="M31"><mi>β</mi><mi mathvariant="normal">定</mi><mi mathvariant="normal">义</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246234&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246219&type= 9.31333351 3.97933316 如下： <math display="block" id="M32"><mi>θ</mi><mo>=</mo><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><mi mathvariant="normal">a</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">c</mi><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mfenced separators="|"><mrow><mfrac><mrow><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow></mfrac></mrow></mfenced><mo>,</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>≠</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mtd></mtr><mtr><mtd><mn mathvariant="normal">90</mn><mo>,</mo><mtext>                               </mtext><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>=</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246238&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246221&type= 51.64666748 16.08666801 ， <math display="block" id="M33"><mi>β</mi><mo>=</mo><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><mi mathvariant="normal">a</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">c</mi><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mfenced separators="|"><mrow><mfrac><mrow><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow><mrow><msub><mrow><mi>l</mi></mrow><mrow><mi mathvariant="normal">A</mi><mi mathvariant="normal">B</mi></mrow></msub></mrow></mfrac></mrow></mfenced><mo>,</mo><msub><mrow><mi>l</mi></mrow><mrow><mi mathvariant="normal">A</mi><mi mathvariant="normal">B</mi></mrow></msub><mo>≠</mo><mn mathvariant="normal">0</mn></mtd></mtr><mtr><mtd><mn mathvariant="normal">90</mn><mo>,</mo><mtext>                           </mtext><mo>,</mo><msub><mrow><mi>l</mi></mrow><mrow><mi mathvariant="normal">A</mi><mi mathvariant="normal">B</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">0</mn></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246253&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246237&type= 48.34466553 16.08666801 ， 其中， <math id="M34"><msub><mrow><mi>l</mi></mrow><mrow><mi mathvariant="normal">A</mi><mi mathvariant="normal">B</mi></mrow></msub><mo>=</mo><mroot><mrow><msup><mrow><mfenced separators="|"><mrow><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>+</mo><msup><mrow><mfenced separators="|"><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">B</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">A</mi></mrow></msub></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow><mrow/></mroot></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246239&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246255&type= 53.42466354 6.85799980 。 因此，基于目标三维航迹点这一时空分布特点，在多目标初匹配的基础上，对目标短时运动航迹方向进行估计；基于目标航迹方向估计结果，可对目标航迹点进行真假检验，采用最小二乘法对目标真实航迹点进行三维拟合 ［ 20 20 ］ ，结合目标运动特性即可对初匹配中定位误差较大的目标位置进行修正，以抑制测量误差对目标定位结果的影响，提高目标定位精度。 3 算法内容 1 3.1　双站多目标初匹配 2 对于三维空间中任意两条直线，本文定义它们在水平投影交点处的高程差为两直线的高程差。 双站定位系统中两站观测射线的高程差，只需在基于水平投影与左右测站俯仰模型 ［ 21 21 ］ 进行定位计算的基础上，增加一次线性运算与一次取绝对值运算： 首先，将测站 S 1 对目标 P j 以及测站 S 2 对目标 P k 成像观测的像点数据 <math id="M35"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246241&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246257&type= 24.29933357 4.91066647 转换成测向数据 <math id="M36"><mo stretchy="false">(</mo><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246245&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246243&type= 23.70666695 4.91066647 ［ 21 21 ］ 。其中，目标测向方位角 <math id="M37"><mi>θ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246248&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246246&type= 1.77800000 2.79399991 限定为：水平投影平面中从正北方向偏移至观测方向的角度，取值范围为（ - 180°，180°］，顺时针方向偏移为正，逆时针方向偏移为负； 然后，基于水平投影模型，通过水平投影面上观测射线 <math id="M38"><msub><mrow><mi>l</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246261&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246259&type= 2.37066650 3.72533321 、 <math id="M39"><msub><mrow><mi>l</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246249&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246263&type= 2.37066650 3.72533321 求交，求得交点水平坐标（ <math id="M40"><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246268&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246266&type= 12.19200039 4.48733330 ： <math display="block" id="M41"><mfenced open="{" close="" separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>l</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><mo>:</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub><mo>=</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>×</mo><mfenced separators="|"><mrow><msub><mrow><mi>Y</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub></mrow></mfenced></mtd></mtr><mtr><mtd><msub><mrow><mi>l</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><mo>:</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo>=</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>×</mo><mfenced separators="|"><mrow><msub><mrow><mi>Y</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub></mrow></mfenced></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246270&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246251&type= 56.30332947 12.69999981 ， <math display="block" id="M42"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>=</mo><mfrac><mrow><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>×</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>×</mo><mo stretchy="false">(</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo stretchy="false">)</mo></mrow><mrow><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>-</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></mrow></mfrac><mo>+</mo><mfrac><mrow><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>×</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo>-</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>×</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub></mrow><mrow><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>-</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>=</mo><mfrac><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub><mo>+</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>×</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub><mo>-</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>×</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub></mrow><mrow><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>-</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></mrow></mfrac></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246275&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246272&type= 105.07133484 20.57399940 . 最后，基于左右测站的俯仰模型，获得水平投影交点对应左右测站观测射线上物点的高程值 <math id="M43"><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246279&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246277&type= 4.06400013 3.72533321 、 <math id="M44"><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246285&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246283&type= 4.31799984 3.72533321 ，以及 <math id="M45"><mo stretchy="false">(</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246280&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246287&type= 14.56266594 4.48733330 匹配定位评价标准高程差 <math id="M46"><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246282&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246288&type= 6.77333355 4.06400013 ： <math display="block" id="M47"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>=</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub><mo>+</mo><mfenced open="|" close="|" separators="|"><mrow><mfrac><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">1</mn></mrow></msub></mrow><mrow><mi mathvariant="normal">s</mi><mi mathvariant="normal">i</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub></mrow></mfrac></mrow></mfenced><mo>×</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>β</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub></mtd></mtr><mtr><mtd><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo>=</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo>+</mo><mfenced open="|" close="|" separators="|"><mrow><mfrac><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub></mrow><mrow><mi mathvariant="normal">s</mi><mi mathvariant="normal">i</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>θ</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></mrow></mfrac></mrow></mfenced><mo>×</mo><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mtext> </mtext><msub><mrow><mi>β</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></mtd></mtr><mtr><mtd><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>=</mo><mo stretchy="false">|</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">|</mo></mtd></mtr></mtable></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246290&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246298&type= 51.73133087 28.19400024 ， 其中， <math id="M48"><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">S</mi><mi mathvariant="normal">i</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">S</mi><mi mathvariant="normal">i</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">S</mi><mi mathvariant="normal">i</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246302&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246300&type= 20.57399940 4.48733330 是测站 i 在定位坐标系下的三维位置，由其GPS坐标转换而来 ［ 22 22 ］ 。 本文基于观测射线高程差最小值搜索进行单帧双站多目标初匹配：假设两个测站同时对 n 个目标进行成像观测，对于测站 S 1 的第 j 个目标观测数据，其与测站 S 2 的 n 个观测数据依次进行匹配定位计算，得到 n 个高程差 <math id="M49"><mfenced open="{" close="}" separators="|"><mrow><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo stretchy="false">|</mo><mi>k</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246306&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246304&type= 32.00400162 4.91066647 ；搜索该高程差集合最小值，其对应的测站 S 2 目标，即为测站 S 1 目标 j 初匹配结果，记为 <math id="M50"><msub><mrow><mi>j</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246307&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246292&type= 3.47133350 4.57200003 ，则有： <math display="block" id="M51"><msub><mrow><mi>j</mi></mrow><mrow><mi mathvariant="normal">S</mi><mn mathvariant="normal">2</mn></mrow></msub><mo>=</mo><munder><mrow><mi mathvariant="normal">m</mi><mi mathvariant="normal">i</mi><mi mathvariant="normal">n</mi></mrow><mrow><mi>k</mi></mrow></munder><mfenced open="{" close="}" separators="|"><mrow><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo stretchy="false">|</mo><mi>k</mi><mo>=</mo><mn mathvariant="normal">1,2</mn><mo>,</mo><mo>…</mo><mo>,</mo><mi>n</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246294&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246309&type= 47.07466888 5.75733376 . 然而，实际应用中，测站定位、目标测向等环节都不可避免地引入测量误差，这使得即使观测像点对 <math id="M52"><mo stretchy="false">(</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>,</mo><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246296&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246311&type= 14.56266594 4.48733330 来自同一个目标，也可能会出现 <math id="M53"><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">1</mn><mi>j</mi></mrow></msub><mo>≠</mo><msub><mrow><mi>Z</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246314&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246313&type= 13.20800018 3.97933316 ， <math id="M54"><mo>∆</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>j</mi><mi>k</mi></mrow></msub><mo>></mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246316&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246315&type= 13.46199989 4.06400013 ；尤其在很多应用场景下，多目标空间位置接近，或者受相机透视变换的影响，多目标投影的像点位置相距很近甚至重叠，此时由于测量误差的存在，基于 式（6） 式（6） 进行单帧多目标匹配定位很可能会出现误匹配点或定位偏差点。因此，如何有效抑制测量误差对初匹配定位结果的影响，提高多目标定位精度，是本文重点研究对象，抑制方法如后文3.2~3.4节所述。 3.2　基于方向二维直方图的目标航迹方向初估计 2 本文基于目标短时运动三维航迹方向二维直方图，进行航迹方向初估计。从目标初匹配定位的航迹点中任取两点，构成三维航迹向量，将航迹向量的方位角 <math id="M55"><mi>θ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246318&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246317&type= 1.77800000 2.79399991 、俯仰角 <math id="M56"><mi>β</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246320&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246319&type= 1.94733346 3.64066648 在取值范围内进行区间划分、统计，可获得目标三维航迹向量方向二维直方图。 若将 <math id="M57"><mo stretchy="false">(</mo><mi>θ</mi><mo>,</mo><mi>β</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246322&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246321&type= 8.63599968 3.97933316 取值范围（ <math id="M58"><mi>θ</mi><mo>∈</mo><mo stretchy="false">(</mo><mo>-</mo><mn mathvariant="normal">90,90</mn><mo stretchy="false">]</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246324&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246323&type= 20.91266632 3.55599999 ， <math id="M59"><mi>β</mi><mo>∈</mo><mo stretchy="false">(</mo><mo>-</mo><mn mathvariant="normal">90,90</mn><mo stretchy="false">]</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246330&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246328&type= 21.08200073 3.97933316 ）均分为18×18个统计区间，搜索该方向二维直方图最大值，记录该最大值对应的直方图索引为 <math id="M60"><mo stretchy="false">(</mo><mi>i</mi><msup><mrow><mi>i</mi></mrow><mrow><mi>*</mi></mrow></msup><mo>,</mo><mi>j</mi><msup><mrow><mi>j</mi></mrow><mrow><mi>*</mi></mrow></msup><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246334&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246332&type= 11.68400002 4.14866638 ，则其对应目标航迹方向估计范围如下式所示。 <math display="block" id="M61"><mfenced open="{" close="" separators="|"><mrow><mtable><mtr><mtd><mi>i</mi><msup><mrow><mi>i</mi></mrow><mrow><mi>*</mi></mrow></msup><mo>×</mo><mn mathvariant="normal">10</mn><mo>-</mo><mn mathvariant="normal">100</mn><mo><</mo><mi>θ</mi><mo>≤</mo><mi>i</mi><msup><mrow><mi>i</mi></mrow><mrow><mi>*</mi></mrow></msup><mo>×</mo><mn mathvariant="normal">10</mn><mo>-</mo><mn mathvariant="normal">90</mn></mtd></mtr><mtr><mtd><mi>j</mi><msup><mrow><mi>j</mi></mrow><mrow><mi>*</mi></mrow></msup><mo>×</mo><mn mathvariant="normal">10</mn><mo>-</mo><mn mathvariant="normal">100</mn><mo><</mo><mi>β</mi><mo>≤</mo><mi>j</mi><msup><mrow><mi>j</mi></mrow><mrow><mi>*</mi></mrow></msup><mo>×</mo><mn mathvariant="normal">10</mn><mo>-</mo><mn mathvariant="normal">90</mn></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246325&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246336&type= 56.21866989 10.15999985 . 统计满足 式（7） 式（7） 的目标所有航迹向量方向 <math id="M62"><mo stretchy="false">(</mo><msub><mrow><mi>θ</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246327&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246326&type= 3.97933316 4.48733330 ， <math id="M63"><msub><mrow><mi>β</mi></mrow><mrow><mi>i</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246344&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246343&type= 4.31799984 4.91066647 的均值，即为目标航迹方向初估计结果 <math id="M64"><mo stretchy="false">(</mo><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246384&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246383&type= 12.69999981 4.91066647 ，如下式所示， K 表示满足（7）的目标航迹向量数量。 <math display="block" id="M65"><mfenced open="{" close="" separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mstyle displaystyle="true"><munderover><mo largeop="true">∑</mo><mrow><mi>i</mi><mo>=</mo><mn mathvariant="normal">1</mn></mrow><mrow><mi>K</mi></mrow></munderover></mstyle><mrow><msub><mrow><mi>θ</mi></mrow><mrow><mi>i</mi></mrow></msub></mrow></mrow><mrow><mi>K</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mstyle displaystyle="true"><munderover><mo largeop="true">∑</mo><mrow><mi>i</mi><mo>=</mo><mn mathvariant="normal">1</mn></mrow><mrow><mi>K</mi></mrow></munderover></mstyle><mrow><msub><mrow><mi>β</mi></mrow><mrow><mi>i</mi></mrow></msub></mrow></mrow><mrow><mi>K</mi></mrow></mfrac></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246348&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246347&type= 18.88066673 28.44799995 . 式（7） 式（7） 对应的方向区间在一定程度上描述了目标三维航迹方向最大密度分布区间，但是基于该区间直接进行定位误差抑制，存在两点局限性： 其一，当目标航迹向量方向集中分布在直方图两个区间交接处时，易将有效匹配点误判为虚假点。某目标三维航迹点及其方向二维直方图如 图3 图3 所示，其三维航迹方向分布图如 图4 图4 所示。目标航迹向量方向集中分布在直方图两个区间交接处，方向二维直方图上出现两个高峰， 图4 图4 中黑色矩形区域为该目标方向二维直方图最大值区间，图中红色点为该目标第1~10个航迹点与其他航迹点组成的三维向量的方向角分布，绿色点、蓝色点分别为该目标第11、12个航迹点和其他航迹点组成的三维向量的方向角分布。由于第11、12个航迹点相应的方向角主要分布在目标方向二维直方图最大值区间以外，故它们均被判定为测量误差引起的虚假航迹点。而从 图3 图3 可以看出，目标第11个航迹点是理想航迹点； 1,2; 1,2; 其二，方向二维直方图最大区间搜索结果易受取值区间划分方式影响，不具备目标航迹方向平移不变性。若在 <math id="M66"><mi>θ</mi><mo>∈</mo><mfenced close="]" separators="|"><mrow><mo>-</mo><mn mathvariant="normal">85,85</mn></mrow></mfenced><mo>,</mo><mi>β</mi><mo>∈</mo><mo stretchy="false">(</mo><mo>-</mo><mn mathvariant="normal">90,90</mn><mo stretchy="false">]</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246366&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246365&type= 44.45000076 4.06400013 取值范围内，进行17×18个区间统计，则 图4 图4 所示目标第1~12个航迹点都位于方向二维直方图最大值区间，导致目标第12个定位误差较大的航迹点未被有效抑制。 可见，基于方向二维直方图最大值搜索不足以很好地描述目标三维航迹方向。如第2节所述，考虑到目标真实航迹点构成的航迹向量方向角分布比较集中，而包含有较大定位误差的航迹点的航迹向量方向角分布比较分散，如 图4 图4 某目标三维航迹方向整体与局部分布图，红色与绿色点分布集中，而蓝色点分布离散，本文提出基于Mean Shift的目标航迹方向最大密度估计方法，以此进行初匹配定位误差抑制。 3.3　基于Mean Shift的目标航迹方向最大密度估计 2 Mean Shift算法是一种基于密度梯度的无参数估计方法。本文提出基于Mean Shift的目标航迹方向最大密度估计方法，该方法以方向二维直方图最大值搜索的目标航迹方向初估计结果 <math id="M67"><mo stretchy="false">(</mo><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246384&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246383&type= 12.69999981 4.91066647 为起点，以保证算法收敛至全局最优解；以高斯核函数为权重进行Mean Shift向量估计，给不同距离的方向样本分配不同的高斯权重，削弱远处方向样本的影响；经多次迭代，不断靠近目标三维航迹方向二维分布密度最集中的区域，最终搜索出目标航迹方向的最大密度区间 <math id="M68"><mfenced separators="|"><mrow><mi>C</mi><mo>,</mo><mi>r</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246370&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246369&type= 9.05933285 3.97933316 ，其中 C 为最大密度区间样本中心 <math id="M69"><mfenced separators="|"><mrow><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246372&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246371&type= 10.75266743 4.82600021 ， r 为区间半径（对应Mean Shift算法搜索半径），则最大密度区间可描述为： <math display="block" id="M70"><mfenced open="{" close="}" separators="|"><mrow><mfenced separators="|"><mrow><mi>θ</mi><mo>,</mo><mi>β</mi></mrow></mfenced><mo stretchy="false">|</mo><msup><mrow><mfenced separators="|"><mrow><mi>θ</mi><mo>-</mo><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>+</mo><msup><mrow><mfenced separators="|"><mrow><mi>β</mi><mo>-</mo><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>≤</mo><msup><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246374&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246373&type= 54.61000061 7.02733374 . 该算法流程可简单描述如下： （1）参照 式（10） 式（10） 进行Mean Shift向量 <math id="M71"><mi>m</mi><mfenced separators="|"><mrow><mi mathvariant="bold-italic">x</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246376&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246375&type= 9.05933285 3.97933316 估计，其中 <math id="M72"><mi>k</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246378&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246377&type= 1.69333339 2.79399991 为Mean Shift感兴趣区域内的方向样本数量； <math id="M73"><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246380&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246379&type= 2.87866688 3.72533321 为感兴趣区域内的目标三维航迹向量方向样本； <math id="M74"><mi mathvariant="bold-italic">x</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246382&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246381&type= 2.11666679 2.79399991 为当前感兴趣区域中心，初始值为 <math id="M75"><mo stretchy="false">(</mo><msub><mrow><mi>θ</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><msub><mrow><mi>β</mi></mrow><mrow><mi mathvariant="normal">c</mi><mn mathvariant="normal">0</mn></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246384&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246383&type= 12.69999981 4.91066647 ； <math id="M76"><msub><mrow><mi>G</mi></mrow><mrow><mi mathvariant="normal">H</mi></mrow></msub><mfenced separators="|"><mrow><mo>·</mo></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246386&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246385&type= 8.89000034 4.06400013 为权重高斯核函数， <math id="M77"><mi>σ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246339&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246338&type= 1.69333339 2.79399991 为高斯核因子； <math display="block" id="M78"><mi>m</mi><mfenced separators="|"><mrow><mi mathvariant="bold-italic">x</mi></mrow></mfenced><mo>=</mo><mfrac><mrow><mstyle displaystyle="true"><munderover><mo largeop="true">∑</mo><mrow><mi>i</mi><mo>=</mo><mn mathvariant="normal">1</mn></mrow><mrow><mi>k</mi></mrow></munderover></mstyle><mrow><msub><mrow><mi>G</mi></mrow><mrow><mi mathvariant="normal">H</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>-</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo></mrow><mo stretchy="false">(</mo><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>-</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo></mrow><mrow><mstyle displaystyle="true"><munderover><mo largeop="true">∑</mo><mrow><mi>i</mi><mo>=</mo><mn mathvariant="normal">1</mn></mrow><mrow><mi>k</mi></mrow></munderover></mstyle><mrow><msub><mrow><mi>G</mi></mrow><mrow><mi mathvariant="normal">H</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>-</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo></mrow></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246341&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246340&type= 52.23933029 18.54199982 ， <math display="block" id="M79"><msub><mrow><mi>G</mi></mrow><mrow><mi mathvariant="normal">H</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>-</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo><mo>=</mo><mfrac><mrow><mi mathvariant="normal">e</mi><mi mathvariant="normal">x</mi><mi mathvariant="normal">p</mi><mfenced separators="|"><mrow><mfrac><mrow><mo>-</mo><msup><mrow><mfenced open="|" close="|" separators="|"><mrow><msub><mrow><mi mathvariant="bold-italic">x</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>-</mo><mi mathvariant="bold-italic">x</mi></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow><mrow><mn mathvariant="normal">2</mn><msup><mrow><mi>σ</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow></mfrac></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn><mi mathvariant="normal">π</mi></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246388&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246342&type= 50.79999924 17.27199936 . （2）将Mean Shift窗口移动 <math id="M80"><mi>m</mi><mo stretchy="false">(</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246390&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246389&type= 8.89000034 3.72533321 ； <math display="block" id="M81"><mi mathvariant="bold-italic">x</mi><mo>=</mo><mi mathvariant="bold-italic">x</mi><mo>+</mo><mi>m</mi><mo stretchy="false">(</mo><mi mathvariant="bold-italic">x</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246404&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246403&type= 22.77533340 3.72533321 . （3）返回（1），直到移动距离满足下述收敛条件。 <math display="block" id="M82"><mfenced open="|" close="|" separators="|"><mrow><mi>m</mi><mfenced separators="|"><mrow><mi mathvariant="bold-italic">x</mi></mrow></mfenced></mrow></mfenced><mo><</mo><mi mathvariant="normal">门</mi><mi mathvariant="normal">限</mi><mi mathvariant="normal">值</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246394&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246392&type= 27.26266861 4.74133301 . 3.4　基于航迹方向最大密度估计的误差抑制 2 对于目标航迹点 P ，若它与其他航迹点组成的三维航迹向量的方向角多数满足 式（9） 式（9） ，则判定 P 为目标有效的真实航迹点；反之，则判定 P 为无效的虚假航迹点。 采用最小二乘法对有效的目标真实航迹点进行三维拟合，估计出目标航迹均值点 <math id="M83"><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo stretchy="false">(</mo><mover><mrow><mi>X</mi></mrow><mo>¯</mo></mover><mo>,</mo><mover><mrow><mi>Y</mi></mrow><mo>¯</mo></mover><mo>,</mo><mover><mrow><mi>Z</mi></mrow><mo>¯</mo></mover><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246399&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246397&type= 22.18266678 4.31799984 与航迹方向 <math id="M84"><mi>T</mi><mo stretchy="false">(</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>,</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>y</mi></mrow></msub><mo>,</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>z</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246402&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246401&type= 17.10266685 4.40266657 ，航迹可简单描述成 <math id="M85"><mo stretchy="false">(</mo><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><mi>T</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246407&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246418&type= 11.68400002 4.48733330 。由此可得与 <math id="M86"><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mi mathvariant="normal">距</mi><mi mathvariant="normal">离</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246420&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246409&type= 11.34533310 4.40266657 R 处的航迹点 <math id="M87"><mi>P</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246413&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246411&type= 2.45533323 2.79399991 （ <math id="M88"><mi>X</mi><mo>,</mo><mi>Y</mi><mo>,</mo><mi>Z</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246424&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246422&type= 13.29266548 3.55599999 的三维坐标位置： <math display="block" id="M89"><mfenced open="{" close="" separators="|"><mrow><mtable><mtr><mtd><mtable columnalign="left"><mtr><mtd><mi>X</mi><mo>=</mo><mover><mrow><mi>X</mi></mrow><mo>¯</mo></mover><mo>+</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>×</mo><mi>R</mi></mtd></mtr><mtr><mtd><mi>Y</mi><mo>=</mo><mover><mrow><mi>Y</mi></mrow><mo>¯</mo></mover><mo>+</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>y</mi></mrow></msub><mo>×</mo><mi>R</mi></mtd></mtr></mtable></mtd></mtr><mtr><mtd><mi>Z</mi><mo>=</mo><mover><mrow><mi>Z</mi></mrow><mo>¯</mo></mover><mo>+</mo><msub><mrow><mi>t</mi></mrow><mrow><mi>z</mi></mrow></msub><mo>×</mo><mi>R</mi></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246427&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246433&type= 27.09333420 17.78000069 . 在此基础上，结合目标运动特性，修正虚假航迹点位置，提高目标估计及预测精度。比如，根据目标第 m 、 n 帧有效航迹点 <math id="M90"><msub><mrow><mi>P</mi></mrow><mrow><mi>m</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>m</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>m</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>m</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246437&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246436&type= 24.80733490 4.48733330 、 <math id="M91"><msub><mrow><mi>P</mi></mrow><mrow><mi>n</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>n</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246432&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246439&type= 22.86000061 4.48733330 ，基于目标短时匀速直线运动假设，可估算出第 k 帧航迹点位置 <math id="M92"><msub><mrow><mi>P</mi></mrow><mrow><mi>k</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>k</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>k</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246443&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246449&type= 22.26733208 4.48733330 ；基于地面高程 <math id="M93"><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">e</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246451&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246446&type= 3.38666677 3.72533321 ，可预测目标落点位置 <math id="M94"><msub><mrow><mi>P</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246463&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246454&type= 21.25133324 4.48733330 ： <math display="block" id="M95"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi>k</mi></mrow></msub><mo>=</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>+</mo><mo stretchy="false">(</mo><mi>k</mi><mo>-</mo><mi>n</mi><mo stretchy="false">)</mo><mo>×</mo><mfrac><mrow><msub><mrow><mi>X</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>m</mi></mrow></msub></mrow><mrow><mi>n</mi><mo>-</mo><mi>m</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi>k</mi></mrow></msub><mo>=</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>+</mo><mo stretchy="false">(</mo><mi>k</mi><mo>-</mo><mi>n</mi><mo stretchy="false">)</mo><mo>×</mo><mfrac><mrow><msub><mrow><mi>Y</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>m</mi></mrow></msub></mrow><mrow><mi>n</mi><mo>-</mo><mi>m</mi></mrow></mfrac></mtd></mtr></mtable></mtd></mtr><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mi>k</mi></mrow></msub><mo>=</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>+</mo><mo stretchy="false">(</mo><mi>k</mi><mo>-</mo><mi>n</mi><mo stretchy="false">)</mo><mo>×</mo><mfrac><mrow><msub><mrow><mi>Z</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>m</mi></mrow></msub></mrow><mrow><mi>n</mi><mo>-</mo><mi>m</mi></mrow></mfrac></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246468&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246466&type= 49.10666656 28.61733437 ， <math display="block" id="M96"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo>=</mo><mover><mrow><mi>X</mi></mrow><mo>¯</mo></mover><mo>+</mo><mo stretchy="false">(</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">e</mi></mrow></msub><mo>-</mo><mover><mrow><mi>Z</mi></mrow><mo>¯</mo></mover><mo stretchy="false">)</mo><mo>×</mo><mfrac><mrow><msub><mrow><mi>t</mi></mrow><mrow><mi>x</mi></mrow></msub></mrow><mrow><msub><mrow><mi>t</mi></mrow><mrow><mi>z</mi></mrow></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo>=</mo><mover><mrow><mi>Y</mi></mrow><mo>¯</mo></mover><mo>+</mo><mo stretchy="false">(</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">e</mi></mrow></msub><mo>-</mo><mover><mrow><mi>Z</mi></mrow><mo>¯</mo></mover><mo stretchy="false">)</mo><mo>×</mo><mfrac><mrow><msub><mrow><mi>t</mi></mrow><mrow><mi>y</mi></mrow></msub></mrow><mrow><msub><mrow><mi>t</mi></mrow><mrow><mi>z</mi></mrow></msub></mrow></mfrac></mtd></mtr></mtable></mtd></mtr><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">f</mi></mrow></msub><mo>=</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">e</mi></mrow></msub></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246471&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246459&type= 39.11600113 25.23066711 . 4 实验与结果 1 本文将 图5 图5 所示红外双站定位系统安装于某靶场两个观测塔上，对飞行打靶训练进行成像观测，获取多目标定位实验数据。其中两个红外相机均为320×256规格，测角精度均为0.33 mrad，测站 S 1 （GPS（113.342 923 556°， 40.819 074 233°， 1 293.353 m），测站 S 2 （GPS（113.309 160 893°， 40.819 595 229°， 1 285.775 m）），测向参考点GPS （113.322 337 925°， 40.808 994 975°， 1 255.81 m），参考点像点位置分别为 S 1 （160，183）、 S 2 （160，180）。 本文多目标定位对比实验流程图如 图6 图6 ，其中，直接法表示直接基于3.1节初匹配结果对目标进行三维定位；直方图法表示基于方向二维直方图最大值搜索进行误差抑制（参照3.4节）。本文不关注单站红外图像目标检测与关联算法，重点研究基于成像观测数据进行多目标匹配定位。 4.1　多目标初匹配 2 如 图7 图7 和 表1 表1 所示为定位系统对某一十弹连续打靶训练观测的两帧红外成像及目标观测数据，由图可知，目标10在第12帧已落地爆炸，导致其图像位置检测不准，引入较大测向误差。 2 Target ID 4 7th frame 4 12th frame S 1 x S 1 y S 2 x S 2 y S 1 x S 1 y S 2 x S 2 y 1 12 81 59 54 78 122 101 101 2 68 94 88 69 133 134 131 116 3 29 97 71 72 95 138 113 120 4 41 115 83 94 105 156 126 142 5 84 125 76 106 148 166 117 155 6 77 133 114 114 140 173 159 165 7 121 136 145 117 183 174 190 167 8 105 140 116 122 166 179 160 173 9 112 143 116 126 174 182 160 177 10 143 156 131 143 198 189 171 187 本文基于该定位系统连续17帧成像观测数据进行多目标初匹配，获得各目标17个航迹点初始定位位置，其中目标3、7和10的航迹点初始定位位置及其最小二乘拟合结果如 图8 图8 所示，图中蓝色离散点为目标航迹点；外加绿色小框的航迹点表示被判为有效的目标航迹点，参与目标航迹拟合；红色方框内是由某个测站观测数据缺失引起的明显奇异值点，不会参与目标航迹拟合，观测数据缺失原因可能是目标能量弱、被遮挡、已落地等。由图可知，目标3无误匹配点或误差偏差较大的定位点，初匹配误差较小；目标7第4、7个航迹点发生误匹配，它们的定位结果明显偏离目标运动航迹，引起拟合航迹偏离实际航迹位置；目标7的第15个航迹点与目标10的第12个航迹点，虽然没有发生误匹配，但由于落地后目标图像位置检测不准，引入较大测向误差，进而引起初匹配位置有较大偏差。 表2 表2 为第7帧 S 1 站目标7、10与 S 2 站10个目标匹配定位结果，可见基于 式（4） 式（4） 进行初匹配时， S 1 站目标7会错误匹配至 S 2 站目标8；而目标10正确匹配，但因测向误差较大，其初匹配点成为误差偏差点。 2 Target ID in S 2 4 7th target in S 1 4 10th target in S 1 X Y Z Δ Z X Y Z Δ Z 1 -1 671.26 -1 107.93 -5.23 36.11 -1 681.88 -1 097.42 -18.54 49.07 2 -1 684.78 -1 116.89 -5.27 27.86 -1 695.36 -1 106.21 -18.68 41.00 3 -1 676.86 -1 111.64 -5.25 26.23 -1 687.46 -1 101.06 -18.60 39.32 4 -1 682.45 -1 115.35 -5.27 14.17 -1 693.04 -1 104.70 -18.66 27.42 5 -1 679.19 -1 113.19 -5.25 7.60 -1 689.79 -1 102.58 -18.62 20.87 6 -1 696.85 -1 124.89 -5.31 3.25 -1 707.39 -1 114.06 -18.82 16.71 7 -1 711.20 -1 134.40 -5.36 1.65 -1 721.69 -1 123.39 -18.97 15.24 8 -1 697.80 -1 125.50 -5.31 -1.11 -1 708.32 -1 114.67 -18.83 12.39 9 -1 697.78 -1 125.51 -5.31 -3.30 -1 708.32 -1 114.67 -18.83 10.22 10 -1 704.72 -1 130.11 -5.33 -12.56 -1 715.24 -1 119.19 -18.9 1.11 m 可见，目标3、7和10分别对应三类具有代表性的目标：无误匹配点或误差偏差较大定位点；既有误匹配点又有误差偏差较大定位点；虽没有无误匹配点但有误差偏差较大定位点。因此，为了提高目标三维位置估计与预测精度，须进一步进行误差抑制，降低测量误差对诸如目标7、10的定位影响。 4.2　误差抑制 2 4 . 2 . 1　效果评价 3 现有实验条件下，无法获得目标运动航迹点真实位置，但目标短时运动航迹拟合结果是目标真实位置估计与预测的依据，其拟合精度也很好地反映了误差抑制效果。因此，本文从目标航迹拟合效果直观图和评价指标两方面进行误差抑制效果评估。 引入目标航迹点 P 拟合误差 <math id="M97"><mi>ε</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246539&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246522&type= 1.43933344 2.79399991 ，描述 P 偏离拟合航迹 <math id="M98"><mfenced separators="|"><mrow><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><mi>T</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246584&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246567&type= 11.68400002 4.82600021 的直线距离，计算如下： <math display="block" id="M99"><mi>ε</mi><mo>=</mo><mfrac><mrow><mfenced open="|" close="|" separators="|"><mrow><mover accent="true"><mrow><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mi>P</mi></mrow><mo>⃗</mo></mover><mo>×</mo><mi>T</mi></mrow></mfenced></mrow><mrow><mo stretchy="false">|</mo><mi>T</mi><mo stretchy="false">|</mo></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246546&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246554&type= 23.36800003 11.00666618 . 引入目标航迹平均拟合误差 <math id="M100"><mover accent="true"><mi>ε</mi><mo>¯</mo></mover></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246559&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246549&type= 1.43933344 2.79399991 ，描述所有参与航迹拟合的目标航迹点 <math id="M101"><mo stretchy="false">{</mo><mi>P</mi><mo stretchy="false">}</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246564&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246552&type= 6.43466663 3.55599999 偏离拟合航迹 <math id="M102"><mfenced separators="|"><mrow><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><mi>T</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246584&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246567&type= 11.68400002 4.82600021 的平均直线距离， <math id="M103"><mi>c</mi><mi>a</mi><mi>r</mi><mi>d</mi><mo stretchy="false">(</mo><mo>·</mo><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246573&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246571&type= 11.59933376 3.55599999 表示集合中元素个数，计算如下。 <math display="block" id="M104"><mover accent="true"><mi>ε</mi><mo>¯</mo></mover><mo>=</mo><mfrac><mrow><munder><mo movablelimits="false">∑</mo><mrow><mi mathvariant="bold-italic">P</mi></mrow></munder><mrow><mfenced open="|" close="|" separators="|"><mrow><mover accent="true"><mrow><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mi>P</mi></mrow><mo>⃗</mo></mover><mo>×</mo><mi>T</mi></mrow></mfenced></mrow></mrow><mrow><mfenced open="|" close="|" separators="|"><mrow><mi>T</mi></mrow></mfenced><mo>×</mo><mi>c</mi><mi>a</mi><mi>r</mi><mi>d</mi><mo stretchy="false">(</mo><mfenced open="{" close="}" separators="|"><mrow><mi>P</mi></mrow></mfenced><mo stretchy="false">)</mo></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246576&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=30246575&type= 33.95133591 12.95400047 . 4 . 2 . 2　实验结果 3 首先，基于方向二维直方图进行目标航迹方向初估计。如 图9 图9 与 图10 图10 所示分别是目标3、7和10的方向二维分布图与二维直方图，在此基础上，参照3.2节内容可实现航迹方向初估计。测量误差引入的位置偏差点，使目标10直方图上出现两个明显峰。 然后，进行基于Mean Shift的目标航迹方向最大密度估计。搜索半径0.8 m，迭代门限0.1 m，高斯核因子20，如 图11 图11 所示是目标3、7和10航迹方向最大密度区域估计结果，对应的收敛区间中心分别为（ - 19.460 1， - 26.891 9），（ - 19.170 4， - 26.561 3）和（ - 20.090 6， - 26.730 4）。 最后，进行误差抑制对比实验及分析。直方图法及本文法误差抑制后航迹拟合效果分别如 图12 图12 与 图13 图13 所示，综合对比 图8 图8 直接法航迹拟合效果可知：两种算法都能很好地抑制误匹配点，其拟合航迹不再明显偏离真实航迹位置；但直方图法不能抑制误差偏差点，如目标7的第15个航迹点与目标10的第12个航迹点；而本文方法可以抑制误差偏差点，后续可基于航迹拟合结果，结合目标运动特性，修正误差位置偏差点，提高目标估计及预测精度，如图所示箭头所指位置为本文方法修正的落点位置，修正距离分别为3.1 m和1.8 m。 如 表3 表3 所示为三种方法目标航迹拟合误差，表中 - 1.00表示该航迹点被判定为奇异值点、误匹配点或误差偏差点等无效航迹点，不参与航迹拟合。由表中各航迹点拟合情况可知：直接法无法区分目标有效航迹点与误匹配点、误差偏差点，不能抑制测量误差；直方图法可以很好地抑制误匹配点，但不能有效抑制误差偏差点，如它没能抑制目标7第15个航迹点，同时，虽然它抑制了目标10第12个航迹点，但如前文3.3节分析，若重新限定直方图区间范围，它也不能抑制该定位偏差点；本文方法既能抑制目标7的两个误匹配点，也能抑制上述两个定位偏差点，误差抑制能力更强。由表中拟合误差可知：三种方法的目标最大拟合误差分别为11.10 m，1.05 m和0.43 m，三种方法对最具代表性的目标7的平均拟合误差分别为2.94 m，0.31 m和0.23 m。 2 Track point 3 Direct method 3 Histogram method 3 Proposed method 3rd 7th 10th 3rd 7th 10th 3rd 7th 10th 1 -1.00 3.44 0.15 -1.00 0.03 0.12 -1.00 0.09 0.15 2 -1.00 2.99 0.10 -1.00 0.20 0.06 -1.00 0.26 0.08 3 -1.00 3.17 0.07 -1.00 0.31 0.06 -1.00 0.30 0.04 4 -1.00 10.63 0.23 -1.00 -1.00 0.23 -1.00 -1.00 0.21 5 0.26 2.39 0.17 0.26 0.09 0.18 0.28 0.08 0.18 6 0.20 2.57 0.19 0.20 0.40 0.14 0.20 0.43 0.13 7 0.40 11.10 0.10 0.40 -1.00 0.06 0.40 -1.00 0.07 8 0.34 1.56 0.44 0.34 0.19 0.42 0.33 0.14 -1.00 9 0.28 1.53 0.29 0.28 0.10 0.31 0.26 0.21 0.32 10 0.34 1.20 0.16 0.34 0.21 0.02 -1.00 0.12 0.04 11 0.09 0.98 0.44 0.09 0.12 -1.00 0.11 0.23 0.28 12 0.20 0.51 0.73 0.20 0.36 -1.00 0.18 0.15 -1.00 13 0.20 0.19 -1.00 0.20 0.44 -1.00 0.20 0.33 -1.00 14 0.25 0.56 -1.00 0.25 0.58 -1.00 0.25 0.42 -1.00 15 0.08 1.30 -1.00 0.08 1.05 -1.00 0.07 -1.00 -1.00 16 0.08 -1.00 -1.00 0.08 -1.00 -1.00 0.07 -1.00 -1.00 17 0.19 -1.00 -1.00 0.19 -1.00 -1.00 0.20 -1.00 -1.00 平均 0.22 2.94 0.26 0.22 0.31 0.16 0.21 0.23 0.15 m 综上，本文提出的基于航迹最大密度估计的红外运动多目标双站定位方法，既能有效剔除误匹配点，又能抑制误差偏差点；相比于直方图法，本文方法最大拟合误差降低59%，平均拟合误差可降低26%，具有应用价值。 5 结　论 1 为了抑制测量误差对红外多目标双站定位的影响，本文充分利用目标三维运动航迹点的时空分布特点，提出了基于航迹最大密度估计的红外运动多目标双站定位方法。该方法首先基于双站测向射线高程差进行单帧多目标初匹配；然后，开展基于Mean Shift的目标航迹方向最大密度估计，以方向二维直方图最大值搜索结果为起点，进行最大密度搜索估计，以避免直方图法局限性，且能保证Mean Shift算法迭代收敛至全局最优解；最后，基于目标航迹方向估计结果，进行航迹点真假检验，采用最小二乘法对有效的目标真实航迹点进行三维拟合，结合目标运动属性进行目标三维位置估计与预测，抑制测量误差对目标定位结果的影响。实验结果表明：本文方法不仅能有效剔除误匹配点，而且能抑制误差偏差点；航迹最大拟合误差小于0.5 m，平均拟合误差小于0.3 m，优于其他算法；对于代表性强的目标7，直方图法航迹最大、平均拟合误差分别为1.05 m、0.31 m，而本文方法相应误差分别为0.43 m、0.23 m，最大拟合误差降低幅度大于50%，平均拟合误差降低26%。可见，本文方法能有效抑制定位误差，在空间碎片等目标三维定位及预测、发射任务中目标辐射特性跟踪反演、军事威胁目标甄别与对抗以及打靶训练评估等军民用领域具有重要价值。 参考文献 郝振兴 ， 罗继勋 ， 胡朝晖 ， 等 . 红外探测与追踪的双机被动定位模型 ［J］. 探测与控制学报 ， 2016 ， 38 （ 1 ）： 28 - 32 . 红外探测与追踪的双机被动定位模型 HAO Z X ， LUO J X ， HU Z H ， et al . Two-fighter passive location model for infrared search and track ［J］. Journal of Detection & Control ， 2016 ， 38 （ 1 ）： 28 - 32 . （in Chinese） Two-fighter passive location model for infrared search and track 叶振华 ， 李辉豪 ， 王进东 ， 等 . 红外光电探测器的前沿热点与变革趋势 ［J］. 红外与毫米波学报 ， 2022 ， 41 （ 1 ）： 15 - 39 . doi: 10.11972/j.issn.1001-9014.2022.01.001 http://dx.doi.org/10.11972/j.issn.1001-9014.2022.01.001 红外光电探测器的前沿热点与变革趋势 YE Z H ， LI H H ， WANG J D ， et al . Recent hotspots and innovative trends of infrared photon detectors ［J］. Journal of Infrared and Millimeter Waves ， 2022 ， 41 （ 1 ）： 15 - 39 . （in Chinese） . doi: 10.11972/j.issn.1001-9014.2022.01.001 http://dx.doi.org/10.11972/j.issn.1001-9014.2022.01.001 Recent hotspots and innovative trends of infrared photon detectors 鞠默然 ， 罗海波 ， 刘广琦 ， 等 . 采用空间注意力机制的红外弱小目标检测网络 ［J］. 光学 精密工程 ， 2021 ， 29 （ 4 ）： 843 - 853 . doi: 10.37188/OPE.20212904.0843 http://dx.doi.org/10.37188/OPE.20212904.0843 采用空间注意力机制的红外弱小目标检测网络 JU M R ， LUO H B ， LIU G Q ， et al . Infrared dim and small target detection network based on spatial attention mechanism ［J］. Opt. Precision Eng. ， 2021 ， 29 （ 4 ）： 843 - 853 . （in Chinese） . doi: 10.37188/OPE.20212904.0843 http://dx.doi.org/10.37188/OPE.20212904.0843 Infrared dim and small target detection network based on spatial attention mechanism 陈皓 ， 马彩文 ， 陈岳承 ， 等 . 基于灰度统计的快速模板匹配算法 ［J］. 光子学报 ， 2009 ， 38 （ 6 ）： 1586 - 1590 . doi: JournalArticle/5af1537fc095d718d8e0c3e5 http://dx.doi.org/JournalArticle/5af1537fc095d718d8e0c3e5 基于灰度统计的快速模板匹配算法 CHEN H ， MA C W ， CHEN Y C ， et al . Fast template matching arithmetic based on image gray statistic ［J］. Acta Photonica Sinica ， 2009 ， 38 （ 6 ）： 1586 - 1590 . （in Chinese） . doi: JournalArticle/5af1537fc095d718d8e0c3e5 http://dx.doi.org/JournalArticle/5af1537fc095d718d8e0c3e5 Fast template matching arithmetic based on image gray statistic 刘凯 ， 汪侃 ， 杨晓梅 ， 等 . 基于DoG检测图像特征点的快速二进制描述子 ［J］. 光学 精密工程 ， 2020 ， 28 （ 2 ）： 485 - 496 . 基于DoG检测图像特征点的快速二进制描述子 LIU K ， WANG K ， YANG X M ， et al . DoG keypoint detection based fast binary descriptor ［J］. Opt. Precision Eng. ， 2020 ， 28 （ 2 ）： 485 - 496 . （in Chinese） DoG keypoint detection based fast binary descriptor 王政府 . 测向体制单多目标定位的深度学习方法 ［D］. 西安 ： 西安电子科技大学 ， 2020 . 测向体制单多目标定位的深度学习方法 WANG Z F . Deep Learning Method for Single and Multiple Target Localization Based on Angle-of-arrival Measurements ［D］. Xi'an ： Xidian University ， 2020 . （in Chinese） Deep Learning Method for Single and Multiple Target Localization Based on Angle-of-arrival Measurements 王丽 . 被动侦探测下的多目标数据关联与定位算法研究 ［D］. 成都 ： 电子科技大学 ， 2021 . 被动侦探测下的多目标数据关联与定位算法研究 WANG L . Research on Multi-target Data Association and Location Algorithm under Passive Reconnaissance and Detection ［D］. Chengdu ： University of Electronic Science and Technology of China ， 2021 . （in Chinese） Research on Multi-target Data Association and Location Algorithm under Passive Reconnaissance and Detection 孙鹏 ， 熊伟 . 测向交叉定位系统中的K-means聚类融合算法 ［J］. 电光与控制 ， 2016 ， 23 （ 10 ）： 36 - 40 . doi: 10.3969/j.issn.1671-637X.2016.10.008 http://dx.doi.org/10.3969/j.issn.1671-637X.2016.10.008 测向交叉定位系统中的K-means聚类融合算法 SUN P ， XIONG W . K-means cluster and fusion algorithm for passive bearing-crossing localization system ［J］. Electronics Optics & Control ， 2016 ， 23 （ 10 ）： 36 - 40 . （in Chinese） . doi: 10.3969/j.issn.1671-637X.2016.10.008 http://dx.doi.org/10.3969/j.issn.1671-637X.2016.10.008 K-means cluster and fusion algorithm for passive bearing-crossing localization system 王冠群 ， 张春华 ， 张舒然 . 基于分治贪心思想的联合多站目标关联定位 ［J］. 兵工学报 ， 2021 ， 42 （ 12 ）： 2700 - 2709 . doi: 10.3969/j.issn.1000-1093.2021.12.018 http://dx.doi.org/10.3969/j.issn.1000-1093.2021.12.018 基于分治贪心思想的联合多站目标关联定位 WANG G Q ， ZHANG C H ， ZHANG S R . Joint multi-station target association and positioning based on divide-and-conquer and greedy thoughts ［J］. Acta Armamentarii ， 2021 ， 42 （ 12 ）： 2700 - 2709 . （in Chinese） . doi: 10.3969/j.issn.1000-1093.2021.12.018 http://dx.doi.org/10.3969/j.issn.1000-1093.2021.12.018 Joint multi-station target association and positioning based on divide-and-conquer and greedy thoughts 唐祎俊 ， 何衡湘 ， 邓洪峰 . 一种基于红外被动探测的多目标定位方法研究 ［J］. 红外技术 ， 2019 ， 41 （ 3 ）： 279 - 283 . 一种基于红外被动探测的多目标定位方法研究 TANG Y J ， HE H X ， DENG H F . A new method for multi-target localization with infrared passive detection ［J］. Infrared Technology ， 2019 ， 41 （ 3 ）： 279 - 283 . （in Chinese） A new method for multi-target localization with infrared passive detection 王成 ， 李少洪 ， 黄槐 . 测向交叉定位系统的多目标测量数据关联 ［J］. 系统工程与电子技术 ， 2002 ， 24 （ 9 ）： 104 - 106， 117 . doi: 10.3321/j.issn:1001-506X.2002.09.031 http://dx.doi.org/10.3321/j.issn:1001-506X.2002.09.031 测向交叉定位系统的多目标测量数据关联 WANG C ， LI S H ， HUANG H . Multi-target measurement data association for passive location systems based on direction of arrival ［J］. Systems Engineering and Electronics ， 2002 ， 24 （ 9 ）： 104 - 106， 117 . （in Chinese） . doi: 10.3321/j.issn:1001-506X.2002.09.031 http://dx.doi.org/10.3321/j.issn:1001-506X.2002.09.031 Multi-target measurement data association for passive location systems based on direction of arrival 王鲲鹏 . 靶场图像目标检测跟踪与定姿技术研究 ［D］. 长沙 ： 国防科学技术大学 ， 2010 . 靶场图像目标检测跟踪与定姿技术研究 WANG K P . Researches on Auto Target Detection ， Tracking and 3 -D Pose Measurement for Imagery of Shooting Range ［D］. Changsha ： National University of Defense Technology ， 2010 . （in Chinese） Researches on Auto Target Detection， Tracking and 3-D Pose Measurement for Imagery of Shooting Range 赵庆璐 ， 陈佳欣 ， 贾朝文 . 基于目标运动特征的虚假航迹滤除算法研究 ［J］. 中国电子科学研究院学报 ， 2021 ， 16 （ 3 ）： 285 - 289 . doi: 10.3969/j.issn.1673-5692.2021.03.012 http://dx.doi.org/10.3969/j.issn.1673-5692.2021.03.012 基于目标运动特征的虚假航迹滤除算法研究 ZHAO Q L ， CHEN J X ， JIA C W . Research on false track filtering algorithm based on target motion characteristics ［J］. Journal of China Academy of Electronics and Information Technology ， 2021 ， 16 （ 3 ）： 285 - 289 . （in Chinese） . doi: 10.3969/j.issn.1673-5692.2021.03.012 http://dx.doi.org/10.3969/j.issn.1673-5692.2021.03.012 Research on false track filtering algorithm based on target motion characteristics 王俊迪 ， 许蕴山 ， 彭芳 ， 等 . 基于岭回归的红外协同定位优化算法 ［J］. 北京航空航天大学学报 ， 2020 ， 46 （ 3 ）： 563 - 570 . 基于岭回归的红外协同定位优化算法 WANG J D ， XU Y S ， PENG F ， et al . Optimization algorithm of infrared cooperative location based on ridge regression ［J］. Journal of Beijing University of Aeronautics and Astronautics ， 2020 ， 46 （ 3 ）： 563 - 570 . （in Chinese） Optimization algorithm of infrared cooperative location based on ridge regression 盛卫东 ， 林两魁 ， 安玮 ， 等 . 基于全局最优的被动多传感器多目标轨迹关联算法 ［J］. 电子与信息学报 ， 2010 ， 32 （ 7 ）： 1621 - 1625 . 基于全局最优的被动多传感器多目标轨迹关联算法 SHENG W D ， LIN L K ， AN W ， et al . A passive multisensor multitarget track association algorithm based on global optimization ［J］. Journal of Electronics & Information Technology ， 2010 ， 32 （ 7 ）： 1621 - 1625 . （in Chinese） A passive multisensor multitarget track association algorithm based on global optimization 盛卫东 ， 黄源 ， 马超 . 基于可行性矩阵遍历的重叠多目标角轨迹关联算法 ［J/OL］. 信号处理 ： 1 - 13 基于可行性矩阵遍历的重叠多目标角轨迹关联算法 SHENG W D ， HUANG Y ， MA CH . An Angle Track Association Algorithm based on Feasibility Matrix Traversal ［J/OL］. Journal of Signal Processing ： 1 - 13 . （in Chinese） An Angle Track Association Algorithm based on Feasibility Matrix Traversal YU Y ， HOU Q Y ， ZHANG W ， et al . A sequential two-stage track-to-track association method in asynchronous bearings-only sensor networks for aerial targets surveillance ［J］. Sensors （Basel， Switzerland） ， 2019 ， 19 （ 14 ）： 3185 . doi: 10.3390/s19143185 http://dx.doi.org/10.3390/s19143185 A sequential two-stage track-to-track association method in asynchronous bearings-only sensor networks for aerial targets surveillance 颜佳 ， 吴敏渊 ， 陈淑珍 ， 等 . 跟踪窗口自适应的Mean Shift跟踪 ［J］. 光学 精密工程 ， 2009 ， 17 （ 10 ）： 2606 - 2611 . doi: 10.3321/j.issn:1004-924X.2009.10.038 http://dx.doi.org/10.3321/j.issn:1004-924X.2009.10.038 跟踪窗口自适应的Mean Shift跟踪 YAN J ， WU M Y ， CHEN S Z ， et al . Mean Shift tracking with adaptive tracking window ［J］. Opt. Precision Eng. ， 2009 ， 17 （ 10 ）： 2606 - 2611 . （in Chinese） . doi: 10.3321/j.issn:1004-924X.2009.10.038 http://dx.doi.org/10.3321/j.issn:1004-924X.2009.10.038 Mean Shift tracking with adaptive tracking window 刘军 ， 曾文锋 ， 江恒 ， 等 . 双站测向交叉定位精度分析 ［J］. 火力与指挥控制 ， 2010 ， 35 （ S1 ）： 12 - 14 . 双站测向交叉定位精度分析 LIU J ， ZENG W F ， JIANG H ， et al . Precision analysis for Bi-point DOA location ［J］. Fire Control and Command Control ， 2010 ， 35 （ S1 ）： 12 - 14 . （in Chinese） Precision analysis for Bi-point DOA location 薛丽红 . 三维空间点中基于最小二乘法的分段直线拟合方法 ［J］. 齐齐哈尔大学学报（自然科学版） ， 2015 ， 31 （ 4 ）： 84 - 85， 89 . 三维空间点中基于最小二乘法的分段直线拟合方法 XUE L H . Three-dimensional point piecewise linear fitting method based on least square method ［J］. Journal of Qiqihar University （Natural Science Edition） ， 2015 ， 31 （ 4 ）： 84 - 85， 89 . （in Chinese） Three-dimensional point piecewise linear fitting method based on least square method 岳娟 ， 高思莉 ， 李范鸣 ， 等 . 基于GPS的红外成像测向交叉定位方法 ［J］. 激光与红外 ， 2019 ， 49 （ 12 ）： 1447 - 1454 . 基于GPS的红外成像测向交叉定位方法 YUE J ， GAO S L ， LI F M ， et al . GPS-based infrared imaging direction finding cross-location ［J］. Laser & Infrared ， 2019 ， 49 （ 12 ）： 1447 - 1454 . （in Chinese） GPS-based infrared imaging direction finding cross-location 肖体琼 ， 陈怡群 ， 常春 . GPS经纬度坐标转平面坐标的简化计算方法及精度分析 ［C］. 中国农业工程学会 ， 2005 ： 56 - 59 . GPS经纬度坐标转平面坐标的简化计算方法及精度分析 XIAO T Q ， CHEN Y Q ， CHANG CH . Simplified calculation method and accuracy analysis of GPS longitude and latitude coordinates turning to planar coordinates ［C］. Chinese Society of Agricultural Engineering ， 2005 ： 56 - 59 . （in Chinese） Simplified calculation method and accuracy analysis of GPS longitude and latitude coordinates turning to planar coordinates 10.37188/OPE.20223012.1509 TP391.4 A 1004-924X（2022）12-1509-14 岳娟,李范鸣,高思莉.基于航迹方向最大密度估计的红外多目标双站定位[J].光学精密工程,2022,30(12):1509-1522. 岳娟,李范鸣,高思莉.基于航迹方向最大密度估计的红外多目标双站定位[J].光学精密工程,2022,30(12):1509-1522. YUE Juan,LI Fanming,GAO Sili.Infrared multi-target dual-station positioning based on maximum density estimation in track direction[J].Optics and Precision Engineering,2022,30(12):1509-1522. YUE Juan,LI Fanming,GAO Sili.Infrared multi-target dual-station positioning based on maximum density estimation in track direction[J].Optics and Precision Engineering,2022,30(12):1509-1522. 国家十四五预研项目（No.514010405-207） 2022-02-23 2022-04-08 2022-06-25 2022-06-25 光学精密工程 12 30