CN111609849A - 一种多站交会定位方法和系统 - Google Patents

一种多站交会定位方法和系统 Download PDF

Info

Publication number
CN111609849A
CN111609849A CN202010513820.6A CN202010513820A CN111609849A CN 111609849 A CN111609849 A CN 111609849A CN 202010513820 A CN202010513820 A CN 202010513820A CN 111609849 A CN111609849 A CN 111609849A
Authority
CN
China
Prior art keywords
station
detection
detection target
ith
geocentric
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010513820.6A
Other languages
English (en)
Other versions
CN111609849B (zh
Inventor
李晓平
石春雷
杨文佳
马勇辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Environmental Features
Original Assignee
Beijing Institute of Environmental Features
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Environmental Features filed Critical Beijing Institute of Environmental Features
Priority to CN202010513820.6A priority Critical patent/CN111609849B/zh
Publication of CN111609849A publication Critical patent/CN111609849A/zh
Application granted granted Critical
Publication of CN111609849B publication Critical patent/CN111609849B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C1/00Measuring angles
    • G01C1/02Theodolites
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C5/00Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Analysis (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Automation & Control Theory (AREA)
  • Pure & Applied Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Computing Systems (AREA)
  • Algebra (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

本发明提供了一种多站交会定位方法和系统。本发明的多站交会定位方法包括:每个探测站点分别获取探测目标的方位俯仰角度信息;根据各个探测站点获取的探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。本发明的多站交会定位系统包括:多个探测站点和中央处理器;每个探测站点分别获取探测目标的方位俯仰角度信息;中央处理器,设置为根据各个探测站点获取的探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。本发明的上述一种多站交会定位方法和系统,能够进行多站交会,利用多站的冗余信息提高定位精度。

Description

一种多站交会定位方法和系统
技术领域
本发明涉及多站交会定位技术领域,特别是涉及一种多站交会定位方法和系统。
背景技术
光电探测系统通常采用光电成像传感器只能获得方位和俯仰二维角度信息。无法单独实现对探测目标的空中三维定位。为了获得距离维信息,一般采用激光测距机进行主动测距,但其测量距离有限,一般在几公里到几十公里,对于上百公里的目标探测,难以实现。故通常采用多个测角光电探测系统实现距离维信息的获取。
目前多源探测利用异面交会进行两两交会,再将所得的多组数据按照交会精度融合处理,上述的数据处理方法虽然提供了丰富的数据来源,但是计算比较复杂,另外还有方法建立多站定位的非线性方程组,将其线性化后再选取适当的初始值,然后根据精度要求用迭代算法解得目标的坐标。该方法虽然实现多站定位,但是面临以下问题:初始值选择好坏直接影响迭代的收敛速度,不同的精度要求导致迭代次数不固定,球面坐标变换直角坐标带来的计算误差。所以该方法不能满足实时交会计算的要求。
发明内容
本发明所要解决的技术问题是提供一种多站交会定位方法和系统,能进行多站交会,利用多站的冗余信息提高定位精度。
本发明公开了一种多站交会定位方法,包括:
每个探测站点分别获取探测目标的方位俯仰角度信息;
根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
优选地,所述方法之前还包括:
获得多个探测站点的经纬高程。
优选地,确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure BDA0002529421980000021
探测目标地心系坐标
Figure BDA0002529421980000022
系数矩阵
Figure BDA0002529421980000023
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1PTQ。
优选地,根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure BDA0002529421980000031
其中,
Figure BDA0002529421980000032
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
优选地,所述探测站点的数量为2,确定探测目标的地心坐标系坐标信息包括:
根据第一探测站点和第二探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息O1(X1,Y1,Z1)和O2(X2,Y2,Z2);
根据第一探测站点测量的所述探测目标的第一方位俯仰角度信息M1=(A1,E1),确定第一探测站点与所述探测目标对应的方向矢量O1M1
经过方向矢量O1M1和O1O2构造平面O1M1O2,并获得平面O1M1O2的表达式A1x+B1y+C1z=D1
经过方向矢量O1M1构造与平面O1M1O2垂直的平面O1M1P;并获得平面O1M1P的表达式A2x+B2y+C2z=D2
根据第二探测站点测量的所述探测目标的第二方位俯仰角度信息M2=(A2,E2),确定第二探测站点与所述探测目标对应的方向矢量O2M2
经过方向矢量O2M2构建两个相交且相互垂直的平面O2M2O1和O2M2Q;并获得平面O2M2O1的表达式A3x+B3y+C3z=D3和平面O2M2Q的表达式A4x+B4y+C4z=D4
计算方程组
Figure BDA0002529421980000041
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1 PTQ。
优选地,确定第i个探测站点与所述探测目标对应的方向矢量OiMi包括:
利用计算式OiMi=TD,i*(sin Ai;cos Ai;tan Ei),其中TD,i为基于第i个测量站点到地心坐标系变换矩阵。
第二方面,本发明提供一种多站交会定位系统,包括:多个探测站点和中央处理器;
每个探测站点分别获取探测目标的方位俯仰角度信息;
所述中央处理器,设置为根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
优选地,所述中央处理器还设置为:
获得多个探测站点的经纬高程。
优选地,所述中央处理器确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure BDA0002529421980000051
探测目标地心系坐标
Figure BDA0002529421980000052
系数矩阵
Figure BDA0002529421980000053
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1PTQ。
优选地,所述中央处理器根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure BDA0002529421980000054
其中,
Figure BDA0002529421980000061
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
与现有技术相比,本发明具有以下优点:
首先,本发明提出了一种新的目标探测方法,基于地心系的快速实时的多站定位交会放法,计算过程采用线性方程组,不限制交会探测器的数目,且探测数目越多,越能提高交会定位精度,可实现实时快速的交会定位。
其次,本发明解决多被动光电探测器对探测目标无法多站定位或者多站定位无法实时计算的问题,应用于多个探测站点统对空间目标的三维定位,通过多个探测站点的方位俯仰和测角信息和本身的站址信息,获得空间被测试目标在地心系下的坐标,实现目标的三维定位,提供三维坐标信息。本发明是可为被动测角的多个探测站点实现空间目标定位提供有效的工程应用价值。
本发明的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
附图用来提供对本发明技术方案的进一步理解,并且构成说明书的一部分,与本申请的实施例一起用于解释本发明的技术方案,并不构成对本发明技术方案的限制。
图1为本发明实施例的多站交会定位方法的流程图;
图2为本发明实施例的多站交会定位的示意图;
图3是本发明实施例的多站交会定位系统的示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
为使本发明的目的、技术方案和优点更加清楚明白,下文中将结合附图对本发明的实施例进行详细说明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互任意组合。
在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行。并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
图1为本发明实施例的多站交会定位方法的流程图,本发明实施例的一种多站交会定位方法,包括:
S101、每个探测站点分别获取探测目标的方位俯仰角度信息;
S102、根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
本发明实施例中,所述方法之前还包括:
S0、获得多个探测站点的经纬高程。
本发明实施例中,步骤S102中确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure BDA0002529421980000081
探测目标地心系坐标
Figure BDA0002529421980000082
系数矩阵
Figure BDA0002529421980000083
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)- 1PTQ。
本发明实施例中,根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure BDA0002529421980000084
其中,
Figure BDA0002529421980000091
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
本发明实施例中,如图2所示,所述探测站点的数量为2,步骤S102中确定探测目标的地心坐标系坐标信息包括:
根据第一探测站点和第二探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息O1(X1,Y1,Z1)和O2(X2,Y2,Z2);
根据第一探测站点测量的所述探测目标的第一方位俯仰角度信息M1=(A1,E1),确定第一探测站点与所述探测目标对应的方向矢量O1M1
经过方向矢量O1M1和O1O2构造平面O1M1O2,并获得平面O1M1O2的表达式A1x+B1y+C1z=D1
经过方向矢量O1M1构造与平面O1M1O2垂直的平面O1M1P;并获得平面O1M1P的表达式A2x+B2y+C2z=D2
根据第二探测站点测量的所述探测目标的第二方位俯仰角度信息M2=(A2,E2),确定第二探测站点与所述探测目标对应的方向矢量O2M2
经过方向矢量O2M2构建两个相交且相互垂直的平面O2M2O1和O2M2Q;并获得平面O2M2O1的表达式A3x+B3y+C3z=D3和平面O2M2Q的表达式A4x+B4y+C4z=D4
计算方程组
Figure BDA0002529421980000092
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1 PTQ。
本发明实施例中,确定第i个探测站点与所述探测目标对应的方向矢量OiMi包括:
利用计算式OiMi=TD,i*(sin Ai;cos Ai;tan Ei),其中TD,i为基于第i个测量站点到地心坐标系变换矩阵。
如图3所示,本发明实施例还提供一种多站交会定位系统,包括:多个探测站点和中央处理器;
每个探测站点分别获取探测目标的方位俯仰角度信息;
所述中央处理器,设置为根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
本发明实施例中,所述中央处理器还设置为:
获得多个探测站点的经纬高程。
本发明实施例中,所述中央处理器确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure BDA0002529421980000111
探测目标地心系坐标
Figure BDA0002529421980000112
系数矩阵
Figure BDA0002529421980000113
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1PTQ。
本发明实施例中,所述中央处理器根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure BDA0002529421980000114
其中,
Figure BDA0002529421980000115
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
实施例一
下面以两个光电探测站点为例对本实施例多站交会定位的关键内容进行详细说明。
利用定位仪器获得2个光电探测站点的经纬高程(Li,Bi,Hi),i=1...N,N为光电探测站点数量,然后多个光电探测系统实时获得当前探测同一目标的方位和俯仰角度信息(Ai,Ei),i=1...N。
利用本发明实施例提供的方法获得多站交会探测目标在地心系的坐标信息(x,y,z)。
1)首先计算首先两个光电探测站点下的定位,然后再推广到多站定位。获得两个光电测量站在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为
Figure BDA0002529421980000121
其中
Figure BDA0002529421980000122
其中,其中a=6378137和f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
可以获得两站间在地心系下方位矢量O1O2=(X1-X2,Y1-Y2,Z1-Z2)。
测量时获得目标M1(x,y,z)的方位俯仰角度信息((Ai,Ei),i=1L N)。则可获得O1和O2和目标的方向矢量OiM1=(xm1,ym1,zm1)=TD,i*(sin Ai;cos Ai;tan Ei)。其中TD为基于测量站址到地心系的坐标系变换矩阵为
Figure BDA0002529421980000123
经过方向矢量O1O2和O1M1构造平面O1M1O2,可得其平面法线矢量为K1=O1O2×O1M1
Figure BDA0002529421980000131
因为O1和M1均在O1M1O2内,则有A1x+B1y+C1z=D1,其中D1=A1X1+B1Y1+C1Z1计算出。
再以法向量K1=O1O2×O1M1和向量O1M1构造一个与平面O1M1P,同上可知,平面O1M1P的法向
Figure BDA0002529421980000132
因为O1和M1均在O1M1P内,则有A2x+B2y+C2z=D2,其中D2=A2X1+B2Y1+C2Z1计算出。
同理,经过O2点构建两个相交且相互垂藏的平面O2M2O1和O2M2Q,于是得到一组关于目标位置的面方程组:A3x+B3y+C3z=D3和A4x+B4y+C4z=D4
其中
Figure BDA0002529421980000133
O2M2=(xm2,ym2,zm2)=TD,i*(sinA2;cos A2;tan E2)。
Figure BDA0002529421980000134
D3=A3X2+B3Y2+C3Z2和D4=A4X2+B4Y2+C4Z2
获得计算方程组
Figure BDA0002529421980000136
Figure BDA0002529421980000135
则有PW=Q。利用最小二乘法原理可得目标在地心系下坐标的唯一解W=(PTP)-1 PTQ。
至此,获得了目标在地心系下的空间位置,实现目标在空间的三维定位。
将双站推广到多站。相对于双站,每多增加一站数量,计算矩阵就会增加两个变量,对于N站定位,求解公式不变。站址越多,冗余数据量越多,获得的目标位置信息精度越高。
本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统、装置中的功能模块/单元可以被实施为软件、固件、硬件及其适当的组合。在硬件实施方式中,在以上描述中提及的功能模块/单元之间的划分不一定对应于物理组件的划分;例如,一个物理组件可以具有多个功能,或者一个功能或步骤可以由若干物理组件合作执行。某些组件或所有组件可以被实施为由处理器,如数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读指令、数据结构、程序模块或其他数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其他存储器技术、CD-ROM、数字多功能盘(DVD)或其他光盘存储、磁盒、磁带、磁盘存储或其他磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其他的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读指令、数据结构、程序模块或者诸如载波或其他传输机制之类的调制数据信号中的其他数据,并且可包括任何信息递送介质。

Claims (10)

1.一种多站交会定位方法,其特征在于,包括:
每个探测站点分别获取探测目标的方位俯仰角度信息;
根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
2.根据权利要求1所述的多站交会定位方法,其特征在于,所述方法之前还包括:
获得多个探测站点的经纬高程。
3.根据权利要求2所述的多站交会定位方法,其特征在于,确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure FDA0002529421970000011
探测目标地心系坐标
Figure FDA0002529421970000012
系数矩阵
Figure FDA0002529421970000021
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1PTQ。
4.根据权利要求3所述的多站交会定位方法,其特征在于,根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure FDA0002529421970000022
其中,
Figure FDA0002529421970000023
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
5.根据权利要求2所述的多站交会定位方法,其特征在于,所述探测站点的数量为2,确定探测目标的地心坐标系坐标信息包括:
根据第一探测站点和第二探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息O1(X1,Y1,Z1)和O2(X2,Y2,Z2);
根据第一探测站点测量的所述探测目标的第一方位俯仰角度信息M1=(A1,E1),确定第一探测站点与所述探测目标对应的方向矢量O1M1
经过方向矢量O1M1和O1O2构造平面O1M1O2,并获得平面O1M1O2的表达式A1x+B1y+C1z=D1
经过方向矢量O1M1构造与平面O1M1O2垂直的平面O1M1P;并获得平面O1M1P的表达式A2x+B2y+C2z=D2
根据第二探测站点测量的所述探测目标的第二方位俯仰角度信息M2=(A2,E2),确定第二探测站点与所述探测目标对应的方向矢量O2M2
经过方向矢量O2M2构建两个相交且相互垂直的平面O2M2O1和O2M2Q;并获得平面O2M2O1的表达式A3x+B3y+C3z=D3和平面O2M2Q的表达式A4x+B4y+C4z=D4
计算方程组
Figure FDA0002529421970000031
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)-1PTQ。
6.根据权利要求3所述的多站交会定位方法,其特征在于,确定第i个探测站点与所述探测目标对应的方向矢量OiMi包括:
利用计算式OiMi=TD,i*(sinAi;cosAi;tanEi),其中TD,i为基于第i个测量站点到地心坐标系变换矩阵。
7.一种多站交会定位系统,其特征在于,包括:多个探测站点和中央处理器;
每个探测站点分别获取探测目标的方位俯仰角度信息;
所述中央处理器,设置为根据各个探测站点获取的所述探测目标的方位俯仰角度信息,确定探测目标的地心坐标系坐标信息。
8.根据权利要求7所述的多站交会定位系统,其特征在于,所述中央处理器还设置为:
获得多个探测站点的经纬高程。
9.根据权利要求8所述的多站交会定位系统,其特征在于,所述中央处理器确定探测目标的地心坐标系坐标信息包括:
根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi,i=1,2……N,N为探测站点的数量;
根据第i个探测站点测量的所述探测目标的方位俯仰角度信息Mi=(Ai,Ei),确定第i个探测站点与所述探测目标对应的方向矢量OiMi
第i个站点与所述探测目标对应的方向矢量OiMi与任意选取另一个探测站点构造基准平面,并获得所述基准平面的表达式Ai1x+Bi1y+Ci1z=Di1,构造与第i个站点的基准平面垂直且通过方向矢量OiMi的法向平面;并获得所述基准平面的表达式Ai2x+Bi2y+Ci2z=Di2
根据系数矩阵
Figure FDA0002529421970000041
探测目标地心系坐标
Figure FDA0002529421970000042
系数矩阵
Figure FDA0002529421970000043
由PW=Q利用最小二乘法原理获得探测目标在地心坐标系坐标信息W=(PTP)- 1PTQ。
10.根据权利要求9所述的多站交会定位系统,其特征在于,所述中央处理器根据第i个探测站点的经纬高程确定所述探测站点的地心坐标系坐标信息Oi包括:
获得第1个探测站点的经纬高程为(Li,Bi,Hi),i=1,2……N;
获得第i个探测站点在地心直角坐标系下的坐标Oi(Xi,Yi,Zi)计算过程为:
Figure FDA0002529421970000051
其中,
Figure FDA0002529421970000052
其中,其中a=6378137,f=1/298.25722分别为参考椭球体的长半轴和第一偏心率。
CN202010513820.6A 2020-06-08 2020-06-08 一种多站交会定位方法和系统 Active CN111609849B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010513820.6A CN111609849B (zh) 2020-06-08 2020-06-08 一种多站交会定位方法和系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010513820.6A CN111609849B (zh) 2020-06-08 2020-06-08 一种多站交会定位方法和系统

Publications (2)

Publication Number Publication Date
CN111609849A true CN111609849A (zh) 2020-09-01
CN111609849B CN111609849B (zh) 2021-11-02

Family

ID=72200395

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010513820.6A Active CN111609849B (zh) 2020-06-08 2020-06-08 一种多站交会定位方法和系统

Country Status (1)

Country Link
CN (1) CN111609849B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112163307A (zh) * 2020-09-29 2021-01-01 中国船舶重工集团公司第七二四研究所 一种跨站信息保障的目标可信区标绘方法
CN113960646A (zh) * 2021-11-02 2022-01-21 中国电子科技集团公司第二十八研究所 双站式光电多目标高程匹配定位方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007031248A8 (en) * 2005-09-12 2007-05-31 Trimble Jena Gmbh Surveying instrument and method of providing survey data using a surveying instrument
CN105044669A (zh) * 2015-05-22 2015-11-11 中国电子科技集团公司第十研究所 三站测时差立体定位方法
CN105242285A (zh) * 2015-10-15 2016-01-13 北京航空航天大学 一种基于卫星通信的无人机导航数据被欺骗识别方法
CN109946729A (zh) * 2019-03-21 2019-06-28 北京环境特性研究所 一种空中目标跟踪方法及装置
CN110487266A (zh) * 2019-08-24 2019-11-22 西安应用光学研究所 一种适用于海面目标的机载光电高精度无源定位方法
CN111199280A (zh) * 2019-12-20 2020-05-26 中国人民解放军战略支援部队信息工程大学 短波信道模型误差存在下联合信号复包络和载波相位信息的多站目标源地理坐标估计方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007031248A8 (en) * 2005-09-12 2007-05-31 Trimble Jena Gmbh Surveying instrument and method of providing survey data using a surveying instrument
CN105044669A (zh) * 2015-05-22 2015-11-11 中国电子科技集团公司第十研究所 三站测时差立体定位方法
CN105242285A (zh) * 2015-10-15 2016-01-13 北京航空航天大学 一种基于卫星通信的无人机导航数据被欺骗识别方法
CN109946729A (zh) * 2019-03-21 2019-06-28 北京环境特性研究所 一种空中目标跟踪方法及装置
CN110487266A (zh) * 2019-08-24 2019-11-22 西安应用光学研究所 一种适用于海面目标的机载光电高精度无源定位方法
CN111199280A (zh) * 2019-12-20 2020-05-26 中国人民解放军战略支援部队信息工程大学 短波信道模型误差存在下联合信号复包络和载波相位信息的多站目标源地理坐标估计方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112163307A (zh) * 2020-09-29 2021-01-01 中国船舶重工集团公司第七二四研究所 一种跨站信息保障的目标可信区标绘方法
CN113960646A (zh) * 2021-11-02 2022-01-21 中国电子科技集团公司第二十八研究所 双站式光电多目标高程匹配定位方法
CN113960646B (zh) * 2021-11-02 2024-05-10 中国电子科技集团公司第二十八研究所 双站式光电多目标高程匹配定位方法

Also Published As

Publication number Publication date
CN111609849B (zh) 2021-11-02

Similar Documents

Publication Publication Date Title
US10613227B2 (en) Method and apparatus for positioning vehicle
US10438408B2 (en) Resolution adaptive mesh for performing 3-D metrology of an object
CN104820217B (zh) 一种多法向平面的多元线阵探测成像激光雷达的检校方法
CN104616292B (zh) 基于全局单应矩阵的单目视觉测量方法
CN111559372B (zh) 一种泊车系统的车位检测性能的评价方法和电子设备
US20170221210A1 (en) Devices, systems, and methods for high-resolution multi-view camera calibration
CN111609849B (zh) 一种多站交会定位方法和系统
Zhao et al. Optimization for calibration of large-scale optical measurement positioning system by using spherical constraint
Huang et al. Effective scanning range estimation for using TLS in construction projects
CN116012428A (zh) 一种雷视联合定位方法、装置及存储介质
CN115343744A (zh) 空中运动目标的光学单双星联合星上定位方法及系统
Fu et al. Calibration of multiple fish‐eye cameras using a wand
CN112781893B (zh) 一种车载传感器性能测试数据的空间同步方法、装置及存储介质
Wu et al. Multi‐camera traffic scene mosaic based on camera calibration
CN109489658B (zh) 一种运动目标定位方法、装置及终端设备
CN110148205B (zh) 一种基于众包影像的三维重建的方法和装置
CN112230194B (zh) 一种基于平移阵列的解模糊方法、设备及存储介质
CN110058211B (zh) 一种车载LiDAR测量系统检校初值的获取方法及装置
CN112987010A (zh) 一种用于机器人的多雷达建图的系统及方法
Wang et al. EMLR for multiple radars on a mobile platform
Crouse et al. Efficient 2D Sensor Location Estimation using Targets of Opportunity.
CN111366921A (zh) 基于距离加权融合的双站雷达交叉定位方法、系统及介质
Ayhan et al. Analysis of digital data obtained from raster and vector maps
CN115201779B (zh) 获取雷达的成像原点空间位置和基线水平方位角的方法
CN111093265B (zh) 一种基于到达角度测距的协作定位方法及装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant