一种机载多主动雷达测距的地面物体高精度定位方法

文档序号:8222607阅读:1047来源:国知局
一种机载多主动雷达测距的地面物体高精度定位方法
【技术领域】
[0001] 本发明涉及一种机载多主动雷达测距的地面物体高精度定位方法,尤其涉及一种 基于多主动雷达组网通过对物体的测距信息对地面物体进行定位解算的方法,属于物体探 测技术领域。
【背景技术】
[0002] 对地面物体的高精度定位,在诸多民用系统中具有极其重要的意义,可以为物体 提供可靠的服务,起到安全保障作用。目前的机载雷达对地面物体的定位方法主要包括以 下两种:单个主动雷达定位、基于辐射源的多雷达协同无源定位。其中机载单个主动雷达定 位是通过测量物体相对于飞机的方位角、俯仰角和距离,辅以飞机的位置信息实现对物体 的定位;基于辐射源的多雷达无源定位通过多个雷达组网接收辐射源信号源到达各机载被 动雷达接收机之间的时间差以及飞机的位置信息来最终确定物体的位置。
[0003] 单个主动雷达定位精度易受平台的位置参数、平台的姿态信息、雷达测角信息、雷 达测距信息等多个因素影响,特别是平台的姿态误差和雷达的测角信息受外部环境的影响 较大难以实现对物体的精确定位。基于辐射源的多雷达无源定位仅与平台的位置信息、辐 射源到雷达的时间及各平台的时间同步相关,该方法具有作用距离远,隐蔽性好等优点,但 是该方法要求跟踪物体必须辐射相应的电磁波,对无辐射源物体或者雷达静默的物体无法 实现定位。本发明采用多个机载主动雷达组网实现对地面物体的定位,该方法的解算结果 仅与平台位置信息、雷达测距信息和平台的时间同步相关,与平台的姿态和雷达的测角信 息无关,其定位原理与基于福射源的多雷达无源定位原理相似定位的精度较高,且对自身 没有辐射源的物体也可以高精度定位,目前该方法还未见报道。
[0004] 目前,国内的机载主动雷达定位都是基于单个机载雷达,通过载机的导航信息和 雷达的测量信息解算物体的位置,如《雷达科学与技术》2011年第1期第9卷发表的"机载 雷达探测精度评估方法研宄"对载机的导航误差(载机的定位精度、姿态角误差)和机载雷 达本身的量测误差(距离误差、方位角误差和俯仰角误差)在机载雷达探测数据在不同坐 标系中的影响进行系统分析。国内的机载多雷达协同定位都是基于物体是有辐射源的无源 定位,通过解算物体到多个机载雷达之间的时差实现定位,如《电子信息对抗技术》2012年 第4期发表的"一种机载无源雷达组网定位技术" 一文,主要提出了一种战斗机机载无源雷 达协同组网测时差定位的策略,分析了影响多机协同高度假设测时差定位算法的定位精度 的因素,该文章是对多个机载被动雷达组网实现对地面物体进行定位的算法进行研宄,解 决的是基于有辐射源物体的高精度定位问题,没有涉及到主动雷达组网对物体定位算法的 研宄。上述的研宄内容和成果与本发明的实现方法不同,与本发明的权利要求没有冲突。

【发明内容】

[0005] 本发明的目的在于克服现有技术的上述不足,提供一种机载多主动雷达测距的地 面物体高精度定位方法,该方法解决了目前机载主动雷达受载机姿态和雷达测角信息影响 较大、基于辐射源的多雷达无源定位对物体的辐射源有要求等问题,实现对地面静止物体 和慢速移动物体的高精度定位。
[0006] 本发明的上述目的主要是通过如下技术方案予以实现的:
[0007] 一种机载多主动雷达测距的地面物体高精度定位方法,包括如下步骤:
[0008] 步骤(一)、采用三架无人机对同一地面物体进行搜索,将首先搜索到所述地面物 体的无人机定义为主机,主机根据在WGS-84坐标系中自身的位置坐标、对物体的测距值和 对物体的测角值解算出所述地面物体的位置坐标S(l,并将位置坐标\发送给其余两架无人 机,其余两架无人机根据位置坐标\对所述地面物体进行搜素,当搜索到地面物体后,其余 两架无人机将对地面物体的测距值和无人机在WGS-84坐标系中自身的位置坐标发送给 主机;
[0009]步骤(二)、设主机在WGS-84坐标系中自身的位置坐标为Pi(Xl,yi,Zl)、其余两架 无人机自身的位置坐标分别为P2 (x2,y2,z2),P3 (x3,y3,z3),主机对地面物体的测距值为A, 其余两架无人机对地面物体的测距值分别为r2,r3,求解地面物体的位置坐标S(x,y,z),具 体方法如下:
【主权项】
1. 一种机载多主动雷达测距的地面物体高精度定位方法,其特征在于:包括如下步 骤: 步骤(一)、采用三架无人机对同一地面物体进行搜索,将首先搜索到所述地面物体 的无人机定义为主机,主机根据在WGS-84坐标系中自身的位置坐标、对物体的测距值和对 物体的测角值解算出所述地面物体的位置坐标S tl,并将位置坐标Stl发送给其余两架无人 机,其余两架无人机根据位置坐标Stl对所述地面物体进行搜素,当搜索到地面物体后,其余 两架无人机将对地面物体的测距值和无人机在WGS-84坐标系中自身的位置坐标发送给主 机; 步骤(二)、设主机在WGS-84坐标系中自身的位置坐标为P1 (X1,yi,Z1)、其余两架无人 机自身的位置坐标分别为Pjxy zJ,h,z3),主机对地面物体的测距值为ri,其余 两架无人机对地面物体的测距值分别为r 2, r3,求解地面物体的位置坐标S (X,y,z),具体方 法如下:
其中屯,d2, d3均为中间变量,无含义;X,Y,Z均为中间变量,无含义;a九,Cl,a2, b2, C2 均为中间变量,无含义; 结合式⑴和式⑵可以得到: Cl1= X2+Y2+Z2 (3) d2= (X_a D2+(YHd1) 2+(Z-C1)2 (4) d3 = (X_a 2)2+ (Y_b2)2+ (Z-C2)2 (5) 令式(3)减去式⑷得到式(7),式(3)减去式(5)得到式(8): Cl1= X2+Y2+Z2 (3) Cl1-C^a1Wb1Wc12= 2a 4+213,+2(^ (7) dfC^+aJ+bZ+c/= 2a 2X+2b2Y+2c2Z (8) 令02= ((!「c^+aJ+bJ+cD/^Ds= (d「d3+a22+b22+c 22)/2,则上式变为: Cl1= X2+Y2+Z2 (3) D2= a iX+bJ+CiZ (10) D3= a2X+b2Y+c2Z (11) 其中D2, D3均为中间变量,无含义; 联立式(10)和式(11)可以得出如下公式: X = (h2D2-hJ)3) / (h2a1~a2h^ + Ch1C2-C^2) / (b2a1-a2b1)Z (12) Y = (B2D2-B1D3)/ (a2b1-b2a1) + (B1C2-Cja2) / (a2b1-b2al)Z (13)
其中β,δ,U均为中间变量,无含义; 舍去Z为负数的值,将Z的值分别代入式(12)和式(13)即可解得X,Y的值,根据式 (2)进一步解算出地面物体的坐标S (X,y,z)。
2. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述无人机上加装探测载荷为主动单脉冲雷达;无人机的自身位置坐标通过GPS 测量得到;其余无人机向主机通过机载数据链传输自身的位置坐标和对地面物体的测距 值;三架无人机的时间同步通过GPS授时实现。
3. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述三架无人机自身的位置坐标和对地面物体的测距值均为同一时刻的测量值。
4. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述步骤(一)中若两架无人机同时搜索到地面物体,定义其中一架无人机为主 机,主机根据在WGS-84坐标系中自身的位置坐标、对地面物体的测距值和对地面物体的测 角值解算出所述地面物体的位置坐标S tl,并将位置坐标Stl发送给未搜索到地面发现物体的 无人机,所述未搜索到地面发现物体的无人机根据位置坐标S tl对地面物体进行搜素,搜索 到地面物体后将无人机对地面物体的测距值和无人机在WGS-84坐标系中自身的位置坐标 发送给主机;同时另外一架搜索到地面物体的无人机也将对地面物体的测距值和无人机在 WGS-84坐标系中自身的位置坐标发送给主机。
5. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述步骤(一)中若三架无人机同时搜索到地面物体,定义其中一架无人机为主 机,其余两架无人机将对地面物体的测距值和无人机自身在WGS-84坐标系的位置坐标发 送给主机。
6. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述地面物体包括地面静止物体和地面移动物体。
7. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其特 征在于:所述步骤(一)中采用三架以上无人机对同一地面物体进行搜索和定位解算。
8. 根据权利要求1所述的一种机载多主动雷达测距的地面物体高精度定位方法,其 特征在于:采用步骤(一)与步骤(二)的解算方法得到一系列地面物体的位置坐标Sn S2......Sk,对位置坐标Si、S2......Sk进行最小二乘滤波处理得到地面物体的最终位置点 § , k为测量次数,具体方法如下: (1) 、地面物体的最终位置点S作为量测值,地面物体位置坐标SpS2......Sk作为测量 值,二者之间的关系式为:
将式(19)写成矩阵形式为:
其中V是物体速度的矩阵形式,H是测量矩阵,§为测量值的矩阵表述形式,对于匀速直 线运动的物体,H矩阵表现形式为:
其中At为时间间隔; 由上式(20)可得:V = §-H§; (2) 、根据最小二乘滤波,选择地面物体的最终位置点S使得误差平方和最小,误差平 方和的表示形式为:
求Q的极小值:
令上式等于0,可知:
即S为地面物体的最终位置点。
【专利摘要】本发明涉及一种机载多主动雷达测距的地面物体高精度定位方法,通过采用多主动雷达对物体交汇定位的方法,利用平台的位置信息和雷达的测距信息建立空间解析几何模型,通过求解方程组直接解算出物体点的大地坐标系位置信息,不涉及传统方法中利用时间差求解高次方程组和迭代初值的问题,大大降低了计算复杂度,并显著提高了定位精度;解决了目前机载主动雷达受载机姿态和雷达测角信息影响较大、基于辐射源的多雷达无源定位对物体的辐射源有要求等问题,实现对地面静止物体和慢速移动物体的高精度定位。
【IPC分类】G01S13-42
【公开号】CN104535993
【申请号】CN201410683350
【发明人】顾鑫, 王 华, 张尧, 李潇, 费智婷, 姜鹏, 邓志均, 岑小锋
【申请人】中国运载火箭技术研究院
【公开日】2015年4月22日
【申请日】2014年11月24日
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1