一种基于双机测距的海面物体定位方法
【专利摘要】本发明涉及一种基于双机测距的海面物体定位方法，该方法通过两架飞机实时测量自身的位置信息，并利用机载测距设备测量飞机与海面物体之间的距离，在通过多源数据融合技术，实现测量数据的时间统一，在此基础上，利用测距交汇原理建立海面物体位置方程组，迭代解出方程组的解，并滤除方程组的模糊解，最终得出海面物体在WGS-84坐标系下的坐标，该方法减少了测距信息的维数，降低了系统的复杂性，使得数据处理过程更加简单可靠，实时性增强。
【专利说明】一种基于双机测距的海面物体定位方法
【技术领域】
[0001] 本发明涉及一种基于双机测距的海面物体方法，适用于对海面物体检测和定位， 属于天地信息一体化信息探测领域。
【背景技术】
[0002] 目前海面物体的定位方法主要包括以下两种：飞机携带单个主动雷达定位、基于 辐射源的多雷达协同无源定位、飞机携带可见光/红外+激光测距定位等定位方法。
[0003] 其中飞机携带单个主动雷达定位是通过主动雷达测量物体相对于飞机的方位角、 俯仰角和距离，辅以平台的位置、姿态信息实现对目标的定位。单个主动雷达定位精度易受 平台的位置参数、平台的姿态信息、雷达测角信息、雷达测距信息等多个因素影响，特别是 平台的姿态误差和雷达的测角信息受外部环境的影响较大难以实现对物体的精确定位，另 夕卜，主动雷达容易受到物体的材质影响。
[0004] 基于多雷达的无源定位仅与飞机的位置信息、辐射源到雷达的时间及各飞机的时 间同步相关，该方法具有作用距离远，隐蔽性好等优点，但是该方法要求物体必须辐射相应 的电磁波，对无辐射源物体无法实现定位。
[0005] 飞机携带可见光/红外+激光测距定位方法使用可见光/红外成像的方式测量物 体相对于飞机的方位角和俯仰角，再结合激光测距仪测量的距离和飞机测量的偏航角、滚 转角和俯仰角，实现物体的定位。该方法对角度测量信息的精度要求较高，且易收到气象等 外界因素的影响，且每次只能定位一个目标。
【发明内容】
[0006] 本发明的目的在于克服现有技术的上述不足，提供一种基于双机测距的海面物 体定位方法，该方法通过双机携带的测距设备持续测量飞机与海面物体之间的距离，同时 利用机载定位设备确定飞机自身的位置，综合上述测量信息建立关于海面物体位置的方程 组，解方程组实现对物体的定位，该方法减少了测距信息的维数，降低了系统的复杂性，使 得数据处理过程更加简单可靠，实时性增强。
[0007] 本发明的上述目的主要是通过如下技术方案予以实现的：
[0008] -种基于双机测距的海面物体定位方法，包括如下步骤：
[0009] 步骤（一）、对两架飞机位置进行持续测量并记录对应的测量时刻，得到一系列飞 机测量位置与对应的测量时刻的测量值；
[0010] 步骤（二）、利用两架飞机分别对海面物体进行连续测距并记录对应的测距时刻 和测距方向，得到一系列测距值和测距方向与对应的测距时刻的测量值；
[0011] 步骤（三）、采用线性插值法得到同一时刻对应的两架飞机在WGS-84大地直角坐 标系下的测量位置坐标P1 (Xl，yi，Z1)、P2 (x2,y2,Z2);两架飞机与海面物体之间的测距值Γι、 r2 ；
[0012]步骤（四）、利用WGS-84椭球模型,位置坐标P1 (X1,Y1,Z1)、P2 (x2,y2,ζ2),两架飞 机与海面物体之间的测距值r2，建立海面物体位置方程组，具体方法如下：
[0013] (I)、WGS_84椭球模型的表示形式如下：
[0014]
【权利要求】
1. 一种基于双机测距的海面物体定位方法，其特征在于包括如下步骤： 步骤（一）、对两架飞机位置进行持续测量并记录对应的测量时刻，得到一系列飞机测 量位置与对应的测量时刻的测量值； 步骤（二）、利用两架飞机分别对海面物体进行连续测距并记录对应的测距时刻和测 距方向，得到一系列测距值和测距方向与对应的测距时刻的测量值； 步骤（三）、采用线性插值法得到同一时刻对应的两架飞机在WGS-84大地直角坐标系 下的测量位置坐标P1 (X1,Y1,Z1KP2U2,y2,z2);两架飞机与海面物体之间的测距值I^r2 ; 步骤（四）、利用WGS-84椭球模型，位置坐标P1(X1, Y1, Z1)、P2(x2,y2,z2)，两架飞机与 海面物体之间的测距值r2，建立海面物体位置方程组，具体方法如下： (1) 、WGS-84椭球模型的表示形式如下：
其中： N为当地卯酉圈曲率半径；
地球长半径a= 6378137m; 第一偏心率平方e2 =(λ00669437999013 ; Lt为WGS-84地球大地坐标系下的经度； Bt为WGS-84地球大地坐标系下的纬度； Ht为WGS-84地球大地坐标系下的高程； 对于在海面漂浮物体，其高程Ht = 0,因此，WGS-84椭球模型可改写为如下标准形式：
(2) 、根据测量位置坐标P1 (Xl，yi，Z1)、P2 (x2,y2,Z2);两架飞机与海面物体之间的测距 值A、r2建立海面物体的测量球体模型，具体表达形式如下：
(3) 、将公式（3)、（4)、（5)联立，建立海面物体的位置方程组，如下所示：
步骤（五）、解算得出海面物体的位置坐标T(X，y，z)，具体方法如下： ⑴、设定海面物体的初始位置坐标TtlUtl,y(l，Ztl); (2) 、以测量的任一架飞机的纬度Bt代入公式（2)计算得到卯酉圈半径N; (3) 、将N带入公式（6)得到三元二次方程组，解出两组x、y、z值，即得到两个海面物体 的位置坐标，保留与测距方向相同的位置坐标Τ'（X'，y'，z'），去除另外一个位置坐标，计 算两个位置坐标TtlO^ytl,Ztl)与Τ'（x'，y'，z'）之间的距离； (4) 、判断步骤（3)计算得到的距离是否小于设定阈值； (5) 若小于设定的阈值，则海面物体位置坐标Τ'（X'，y'，z'）即为海面物体最终的位 置坐标T(x，y，z)，若大于设定的阈值，则计算海面物体位置坐标Τ'（x'，y'，z'）对应的纬 度Β'τ，将纬度B'TR入公式（2)计算得到卯酉圈半径N，返回步骤（3)。
2. 根据权利要求1所述的一种基于双机测距的海面物体定位方法，其特征在于：将步 骤（五）得到的海面物体在WGS-84大地直角坐标系下的位置T(x，y，z)变换为WGS-84大 地坐标系下的坐标T(B，L，H)，具体方法如下：
式中，
a为地球椭球的长半径，b为地球 椭球短半径，e是椭球的第一偏心率； (B，L，H)即为海面物体在WGS-84大地坐标系下的坐标。
3. 根据权利要求1所述的一种基于双机测距的海面物体定位方法，其特征在于：所述 步骤（一）中飞机位置采用GPS、BD-2或惯导信息进行测量。
4. 根据权利要求1所述的一种基于双机测距的海面物体定位方法，其特征在于：所述 步骤（二）中的连续测距方法采用激光测距仪或主动雷达测距方法。
【文档编号】G01C21/20GK104457756SQ201410681912
【公开日】2015年3月25日 申请日期:2014年11月24日 优先权日:2014年11月24日
【发明者】王 华, 顾鑫, 李潇, 张尧, 邓志均, 岑小锋 申请人:中国运载火箭技术研究院