光雷多站测元数据极大似然实时交会算法

  • 罗成强 1, 2 ,
  • 胡秋平 2 ,
  • 张华 2 ,
  • 胡文华 1
展开
  • 1 陆军工程大学石家庄校区, 石家庄 050003
  • 2 中国华阴兵器试验中心, 陕西华阴 714200

罗成强(1983-),男,四川德阳人,研究方向:外弹道测试技术。

收稿日期: 2018-07-18

  网络出版日期: 2025-05-12

Maximum Likelihood Estimation Intersection Method for Multi-station Optical and Radar External Ballistic Test Data

  • LUO Chengqiang 1, 2 ,
  • HU Qiuping 2 ,
  • ZHANG Hua 2 ,
  • HU Wenhua 1
Expand
  • 1 Shijiazhuang Campus of Army Engineering University, Shijiazhuang 050003, China
  • 2 Huayin Ordnance Test Center of China, Shaanxi Huayin 714200, China

Received date: 2018-07-18

  Online published: 2025-05-12

摘要

针对外弹道组网测量模式下,中心引导数据交会算法坐标解算精度不能满足10 m、时间大于50 ms的情况,提出一种基于距离估计的交会算法,采用基于立体网格的实时求解方法,通过限定待求目标空间坐标范围,使目标大概率位于以初值为中心,以3倍精度为半径的保精度立体网格内,采用遍历法求出似然函数值最大的网格点。仿真结果表明,坐标解算精度与多站最小二乘相当,6站交会解算时间优于15 ms,精度优于3 m。

本文引用格式

罗成强 , 胡秋平 , 张华 , 胡文华 . 光雷多站测元数据极大似然实时交会算法[J]. 弹箭与制导学报, 2019 , 39(5) : 27 -30 . DOI: 10.15892/j.cnki.djzdxb.2019.05.007

Abstract

In external ballistic networking measurement mode, the coordinate precision of the center-guided data rendezvous algorithm cannot meet the requirement of 10 meters and the solving time is more than 50 ms. To solve this problem,this paper proposed a distance-based rendezvous algorithm, which uses a real-time solution method based on solid mesh to obtain the target’s probabilistic position by limiting the space coordinate range of the target to be solved. In the three-dimensional mesh with the initial value as the center and a radius which is 3 times of the accuracy, the maximum vaule of likelihood function in the mesh can be obtained by the ergodic method. The simulation results show that the coordinate solution precision is equivalent to that of multi station least square method. The calculation time of 6-station intersection is better than 15 ms and the precision is higher than 3 m.

0 引言

常规兵器外弹道测量,常采用多台套光测(测元为AE,A指方位角,E指俯仰角)、雷测(测元为R,指雷达距目标的距离)设备联合组网/接力、中心引导的测量模式,完成武器系统外弹道测试。在这种模式下,中心引导需要实时完成武器系统的外弹道参数解算,并为组网/接力测量设备提供引导数据,数据解算要求解算精度达到米级,实时性要求处理时间≤50 ms。针对光、雷多站测元数据实时处理算法,目前还没有统一的处理方式,一般根据具体任务采取相应的办法(如R-AE交会处理,多站最小二乘算法(NLSE))[1],上述算法一般受布站方式影响,存在较大的限制,如R-AE交会垂直角度盲区引起交会误差急剧增加、最小二乘迭代不收敛引起死循环使得解算时间长等,在数据故障的情况下需要人工挑选组网/接力测量设备或者切换其它计算方法,不能够完全满足武器装备外弹道测试实时性和测量精度要求。
对此,文中从概率角度出发提出一种基于距离估计的光电经纬仪-雷达多站测量数据极大似然交会算法,采用基于立体网格的模型实时求解方法,通过限定待求目标的空间坐标范围,使得目标以目标初值为中心,以3倍的交会精度为半径的保精度立体网格内,通过遍历法求出每个网格的似然函数值,似然函数值最大的网格点就是解算出的目标坐标,网格划分越小,定位精度越高。该方法避免了求解时间过长和可能发生的迭代死循环,仿真结果表明,目标坐标解算精度与多站最小二乘估计方法相当,6站交会情况下解算时间优于15 ms。

1 基于距离估计的光-雷多站测元数据交会算法(NMLE)

参看图1,测量坐标系为Oc(X,Y,Z),假定目标称为 M x , y , z(注:x为运动方向;y为高程;z为偏向;三者满足右手法则);假设现有光测观测设备N台,称为光测分站Oi,其中i=1,2,…,N,站址坐标 x i , y i , z i,各分站测元数据为(Ai,Ei)(注:Ai指方位角,Ei指俯仰角),光测设备分站角度观测指向误差为ϑi,指向精度为σi,过M作光学观测向量 ( A i , E i ) 的垂线交射线于Ρi,记 O i Ρ i = l i M Ρ i = d i;假设现有雷测设备M台,称为雷测分站Oj,其中j=1,2,…,M,各分站测元数据为Rj(注:Rj指分站距目标的距离),测距精度为σRj,记雷达径向距离最小观测误差为dRj
图1 设备观测示意图
对光测设备:实际观测向量 ( A i , E i ) 应是以真实观测向量 M O i 为中心,以分站观测指向精度σi为均值的正态分布。即分站观测角度指向误差ϑi服从正态分布 N ( ϑ i ; 0 , σ i 2 ),密度函数为:
f ( ϑ i ) = 1 2 π σ i e ϑ i 2 2 σ i 2
由几何关系可知 tan ϑ i = d i l i,由于ϑi值属于极小量,关系式可以简化成 ϑ i d i l i, d i = ϑ i l i σ ( d i ) = l i σ i + ϑ i σ l i l i σ i,则统计量di的密度函数为:
f ( d i ) = 1 2 π σ   d i e d i 2 2 σ d i 2 = 1 2 π σ i l i e d i 2 2 σ i 2 l i 2
其中:
d i 2 = n i 2 + h i 2   x x i 2 + m i 2 + h i 2 y y i 2 + m i 2 + n i 2 z z i   2 2 ( ( x x i ) ( y y i ) m i n i + ( x x i ) ( z z i ) m i h i + ( y y i ) ( z z i ) n i h i ) ,
l i 2 = m i 2 ( x x i ) 2 + n i 2 ( y y i ) 2 + h i 2 ( z z i ) 2 + 2 ( ( x x i ) ( y y i ) m i n i + ( x x i ) ( z z i ) m i h i + ( y y i ) ( z z i ) n i h i ) ,
m i = cos A i cos E i , n i = sin E i , h i = sin A i cos E i
对雷达设备:实际观测向量(Rj)应是以真实观测向量 M O j 为中心,以分站观测精度σRj为均值的正态分布。即分站观测误差服从正态分布 N ( d R j ; 0 , σ R j 2 ),密度函数为:
f ( d R j ) = 1 2 π σ R j e d R j 2 2 σ R j 2
式中: d R j = ( x x j ) 2 + ( y y j ) 2 + ( z z j ) 2 R j 2
现有光测分站N台,雷测分站M台,则(N+M)台观测设备的多站似然函数为:
L d 1 , d 2 , , d N , d R 1 , , d R M = i = 1 N f d i j = 1 M f d R j
似然方程为:
lnL d 1 , d 2 , , d N , d R 1 , , d R M = i = 1 N ln f d i + j = 1 M f d R j = i = 1 N d i 2 2 σ i 2 l i 2 + ln 2 π σ i l i j = 1 M d R j 2 2 σ R j 2 + ln 2 π σ R j
根据极大似然原理,目标最有可能落在使似然方程极大的位置上,该位置即为目标的最优估计;即目标的最优估计模型为:
Min f M = i = 1 N d i 2 2 σ i 2 l i 2 + ln 2 π σ i l i + j = 1 M d R j 2 2 σ R j 2 + ln 2 π σ R j
式中:f(M):多站似然方程f(M)=-ln[L(d1,d2,…,dN,dN+1,…,dN+M)]; d i 2 l i 2minihi表示式同式(2), d R i = ( x - x i ) 2 + ( y - y i ) 2 + ( z - z i ) 2 - R i 2

2 基于立体网格的模型实时求解

从式(6)可以看出,该模型为一无约束最优化求解问题,可以使用非线性无约束最优化解算方法进行解算迭代求解,要求初值(M0)要具有较好的精度值,使得迭代收敛较快,并且不易产生迭代死循环。理论上初值解算有两种情况:一是两站为光测站,则采用两站极大似然算法求解M0;二是两站为一台光测、一台雷达,则采用单站光雷算法(R-AE)[1]求解M0。但是从实时融合处理角度出发,为避免求解时间过长和可能发生的迭代死循环,采用通过限定待求目标的空间坐标范围,使得目标按照初值大概率位于以初值为中心,以交会精度为半径的保精度立体网格内,其中交会精度的给出根据初值求解算法精度按照实时系统的散布程度确定,这样处理后就把式(6)转化成有约束最优化问题,再通过遍历法相结合求解, 求出每个网格的似然函数值,似然函数值最大的网格点就是解算出的目标坐标。

2.1 保精度立体网格的确定

保精度立体网格的确定采用优选方法,方法是先从多站光雷中确定初值,该初值应该是所有采用两站交会方法得出初值中精度最高的。初值确定后,根据相应的精度ε确定搜索网格半径长度为3ε。当中心引导系统在某一时刻接收到各测量站的测元数据时,若第i站和第j站为不同的测站,则可依据参考文献[1]计算其交会坐标M0和交会精度ε的值。

2.2 遍历法求解

采用“遍历法”求解式(6),遍历程序如下:
①接收多站测量数据,计算两两交会精度形成精度矩阵A
②对精度矩阵A按照冒泡法排序得到精度最高测站精度ε
③按照两站交会得到初始点M0及立体网格半径3ε
④命k=0;定义遍历步长H
⑤计算f(Mk;令P=f(Mk)。
⑥若(k+1)H<3ε,否则Mk即为所求M(x,y,z);计算f(Mk+H),若f(Mk+H)< P,P=f(Mk+H),进行⑦。
⑦命k=k+1,Mk+1=Mk+H;进行⑤。

3 算法分析

1)算法验证
假定待求目标为M(x,y,z),现有光测观测设备N=2台;现有雷测设备M=1台,称为测量分站O3,测元数据为R3。测元数据如下:
O1=(0,0,-1 000),σ1=0.005,(A1,E1)=(90.005,45);O2=(0,0,1 000), σ2=0.005, (A2,E2)=(270.005,45); O3=(0,0,0), σR3=1, R3=999。
选取初始点(0,0,999)及网格步长0.2;最终求得MM(-0.087 2,1 000,0)。从结果可以看出,求解值M(-0.087 2,0,1 000)与真值M(0,1 000,0)误差小于0.1 m,计算结果是可信的。
2)仿真分析
为了评价算法是否满足实时性和解算精度要求,设计以下仿真方案:仿真生成测元数据,包括理论弹道、分站站址坐标、分站测角精度、分站测元数据(加入观测误差)。针对某时刻数据,首先进行两站(精度最高的两站)交会计算估计坐标参数M0,并计算交会精度值,同时确定网格大小和遍历步长;利用两站交会初始值,进行多站最小二乘估计和极大似然估计,估计空间坐标参数,计算交会精度值;通过增加分站数量,改变布站方式,检查有无无法求解的情况出现,最后统计NMLE算法的计算时间和处理精度。以某型火箭弹数据为例,理论弹道数据为帧频20 Hz,时间25 s,距离0~15 km。
仿真结果如下:
图2 3种交会方法弹道坐标处理误差比对可以看出,NMLE算法交会误差精度相比两站交会具有处理精度较高的优势,与NSLE算法相当,6测站交会结果相对3测站也具有处理精度高的特点。从表1结果看出,6站交会情况下,NMLE算法交会精度在15 km范围内优于3 m,处理时间优于15 ms。仿真结果表明,该算法实时处理时间、解算精度满足要求。
图2 3种交会方法弹道坐标处理误差比对
表1 NMLE极大似然算法数据处理结果表
参数 测站数目
3 4 5 6
处理时间/ms 10 11 13 15
处理精度/m 3.0 2.4 2.1 1.9

4 结束语

文中提出一种基于距离估计的多站光雷数据极大似然交会算法,面向中心引导实时处理系统对处理时间和精度的需求,建立了基于立体网格的数值解算求解方法,算法不涉及迭代处理,没有过基线、布站局限大、计算盲区等影响,通过对数值计算区域的限制(立体网格)解决了计算不收敛问题,满足实时数据处理的要求。仿真结果表明,目标坐标解算精度与多站最小二乘估计方法相当,6站交会情况下解算时间优于15 ms,坐标解算精度优于3 m,目前该算法已经成功应用于某型外弹道测量数据实时融合处理系统中。
[1]
杨增学. 常规兵器试验交会测量方法及应用[M]. 西安: 西安交通大学出版社, 2010:86-126.

[2]
中国人民解放军总装备部军事训练教材编辑工作委员会. 外弹道测量数据处理[M]. 北京: 国防工业出版社, 2002:38-65.

[3]
张贤达. 矩阵分析与应用[M]. 北京: 清华大学出版社, 2004:65-97.

[4]
许晓剑, 田康生, 范锦勇, 等. 基于极大似然估计的最优航迹关联算法[J]. 空军雷达学院学报, 2010, 24(1):22-24.

[5]
安其昌, 张景旭, 孙敬伟. 基于极大似然估计的TMT三镜轴系装调[J]. 红外与激光工程, 2013, 42(11):3002-3007.

文章导航

/