CN111076700B - 一种基于车载经纬仪的自定位定向系统及方法 - Google Patents

一种基于车载经纬仪的自定位定向系统及方法 Download PDF

Info

Publication number
CN111076700B
CN111076700B CN201911233451.9A CN201911233451A CN111076700B CN 111076700 B CN111076700 B CN 111076700B CN 201911233451 A CN201911233451 A CN 201911233451A CN 111076700 B CN111076700 B CN 111076700B
Authority
CN
China
Prior art keywords
gps receiver
vehicle
gps
satellite
ith
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.)
Active
Application number
CN201911233451.9A
Other languages
English (en)
Other versions
CN111076700A (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.)
XiAn Institute of Optics and Precision Mechanics of CAS
Original Assignee
XiAn Institute of Optics and Precision Mechanics of CAS
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 XiAn Institute of Optics and Precision Mechanics of CAS filed Critical XiAn Institute of Optics and Precision Mechanics of CAS
Priority to CN201911233451.9A priority Critical patent/CN111076700B/zh
Publication of CN111076700A publication Critical patent/CN111076700A/zh
Application granted granted Critical
Publication of CN111076700B publication Critical patent/CN111076700B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C1/00—Measuring angles
    • G01C1/02—Theodolites
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/40—Correcting position, velocity or attitude
    • G01S19/41—Differential correction, e.g. DGPS [differential GPS]
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明公开了一种基于车载经纬仪的自定位定向系统及方法，解决了现有经纬仪是采用落地方式进行定位定向测量时所存在的操作过程复杂，计算量大，测量误差大且机动性差的问题。该系统包括两台相同的定位设备以及上位机，每台定位设备均包括车载经纬仪、两台BD/GPS接收机；两台BD/GPS接收机设置在车载经纬仪的U型支架开口侧的两个顶面上；通过两台BD/GPS接收机通过接收BD和或GPS卫星的电磁波，在通过上位机解算得到各自的坐标位置，从而得到该车载经纬仪的位置坐标，通过两台车载经纬仪可获取任意目标的方位角与俯仰角。

Description

一种基于车载经纬仪的自定位定向系统及方法
技术领域
本发明属于设备定位定向技术领域，具体为一种基于车载经纬仪的自定位定向系统及方法。
背景技术
光电经纬仪是一种用于精密测角的光电望远镜，集跟踪、弹道测量、目标姿态测量为一体，是靶场重要的光学测量设备。光电经纬仪能够给导弹和运载火箭研制部门提供精确的弹道数据，为型号试验的精度分析，评定和性能改进提供重要的依据，在相关实验中发挥着重要作用。
现有车载经纬仪是采用落地方式对目标进行定位定向测量，使用前首先采用专用定位定向装置对车载经纬仪落地的位置进行测量，之后再将车载经纬仪安装在该位置，最后利用车载经纬仪对目标位置进行测量。
该方式操作复杂，现有定位定向装置计算量大，同时由于该方式需要依赖于专用的定位定向装置先定出车载经纬仪的位置，再将车载经纬仪移动到该位置，会导致出现测量误差，并且车载经纬仪需在指定的地点工作，大大限制了车载经纬仪的机动性。
发明内容
为了解决现有经纬仪是采用落地方式进行定位定向测量时所存在的操作过程复杂，计算量大，测量误差大且机动性差的问题，本发明提供了一种基于车载经纬仪的自定位定向系统及方法。
本发明的具体技术方案是：
本发明提供了一种基于车载经纬仪的自定位定向系统，包括第一车载经纬仪、第二车载经纬仪、第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机以及上位机；
第一车载经纬仪、第二车载经纬仪完全相同；
第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机完全相同；
第一BD/GPS接收机和第二BD/GPS接收机分别安装在第一车载经纬仪的U型支架开口侧的两个顶面上，且第一BD/GPS接收机和第二BD/GPS接收机中心等高；U型支架开口侧的两个顶面的平面度均为0.02mm，且两台接收机之间的位置公差为0.1mm；
第三BD/GPS接收机和第四BD/GPS接收机分别安装在第二车载经纬仪的U型支架开口侧的两个顶面上，且第三BD/GPS接收机和第四BD/GPS接收机中心等高；U型支架开口侧的两个顶面的平面度均为0.02mm，且两台接收机之间的位置公差为0.1mm；
第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机均包括双频测量天线、低噪放大器以及信号处理主板；
第一BD/GPS接收机通过双频测量天线接收公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第一数字信号上传至上位机；
第二BD/GPS接收机通过双频测量天线接收与第一BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第二数字信号上传至上位机；
上位机对第一数字信号和第二数字信号进行处理得到第一车载经纬仪的当前位置坐标；
第三BD/GPS接收机通过双频测量天线接收公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第三数字信号上传至上位机；
第四BD/GPS接收机通过双频测量天线接收与第三BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第四数字信号上传至上位机；
上位机对第三数字信号和第四数字信号进行处理得到第二车载经纬仪的当前位置坐标；
上位机通过第一车载经纬仪的当前位置坐标和第二车载经纬仪的当前位置坐标计算得到两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角。
进一步地，上述第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机还包括数据通信模块；信号处理主板通过数据通信模块将第一数字信号、第二数字信号、第三数字信号、第四数字信号发送至上位机。
进一步地，上述第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机还包括电源模块；所述电源模块用于向信号处理主板供电。
本发明还提供了基于上述系统的自定位定向方法，定位定向方法具体步骤如下：
步骤1：获取第一车载经纬仪的位置坐标；
步骤1.1：第一BD/GPS接收机接收任意第i个BD或GPS卫星的电磁波信号经过放大处理、下变频处理和AD模数转换处理后转化为第一数字信号上传至上位机；
步骤1.2：上位机通过第一数字信号建立第一BD/GPS接收机对应任意第i个BD或GPS卫星的载波相位观测方程：
Figure GDA0002702206870000051
式中：
λ—第i个BD或GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure GDA0002702206870000052
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure GDA0002702206870000053
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xi yi zi—第i颗BD或GPS卫星的三轴坐标，该参数第一数字信号自身携带；
xR1 yR1 zR1—第一BD/GPS接收机的坐标；
dri—第i个BD或GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure GDA0002702206870000054
—第i个BD或GPS卫星伪距的电离层误差；
Figure GDA0002702206870000055
—第i个BD或GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure GDA0002702206870000056
—第一BD/GPS接收机对第i个BD或GPS卫星的观测噪声；
将上式线性化后：
Figure GDA0002702206870000061
式中：
Figure GDA0002702206870000062
Figure GDA0002702206870000063
Figure GDA0002702206870000064
其中，
Figure GDA0002702206870000065
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure GDA0002702206870000066
表示
Figure GDA0002702206870000067
线性化后的加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个BD或GPS卫星的线性化后的载波相位观测方程：
Figure GDA0002702206870000068
Figure GDA0002702206870000069
—第二BD/GPS接收机第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure GDA00027022068700000610
—第二BD/GPS接收机第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2 yR2 zR2—第二BD/GPS接收机的坐标；
Figure GDA0002702206870000071
—第i个BD或GPS卫星伪距的电离层误差；
Figure GDA0002702206870000072
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure GDA0002702206870000073
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：将步骤1.2和步骤1.3线性化后的两个载波相位观测方程进行差分处理，消去两个线性化后的载波相位观测方程中dri、
Figure GDA0002702206870000074
δti，得到第i个BD或GPS卫星的单差方程：
Figure GDA0002702206870000075
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个BD或GPS卫星的单差方程；
Figure GDA0002702206870000076
步骤1.6：对第i个BD或GPS卫星的单差方程和第j个BD或GPS卫星的单差方程再次进行双差处理，消去δtR1、δtR2以及系统的装配误差，得到双差方程：
Figure GDA0002702206870000077
步骤1.7：当第一BD/GPS接收机和第二BD/GPS接收机可观测到的公共BD/GPS卫星的数量为M时，则双差观测方程可以表示成如下矩阵形式：
Figure GDA0002702206870000081
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure GDA0002702206870000082
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure GDA0002702206870000083
式中，
Figure GDA0002702206870000084
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure GDA0002702206870000085
为其协方差阵，
Figure GDA0002702206870000086
为无约束的最小二乘残差矢量；
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure GDA0002702206870000087
根据上式求解得到模糊度整数解
Figure GDA0002702206870000091
根据上式求解得到模糊度整数解
Figure GDA0002702206870000092
进而求解位置坐标修正向量的固定解
Figure GDA0002702206870000093
具体公式如下：
Figure GDA0002702206870000094
Figure GDA0002702206870000095
为第一BD/GPS接收机和第二BD/GPS接收机之间坐标值，即车载经纬仪的当前坐标；
步骤2：按照步骤1.1至步骤1.9相同的方式，获取第二车载经纬仪的位置坐标；
步骤3：通过第一车载经纬仪位置坐标和第二车载经纬仪的位置坐标，求解两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角。
本发明的有益效果在于：
1、本发明采用的基于车载经纬仪定位定向系统，彻底摆脱了固定点的限制，拓宽了测量范围，使多站联测布网更合理，这种定位系统不仅以载车为运输平台，还以载车为工作平台，不仅能够实况记录，而且能够进行弹道测量，测量精度高，结果可靠。与传统的经纬仪仅实现车载运输相比，省去了烦琐的就位过程，不需要地基环和方位标。
2、本发明通过对可见的BD/GPS卫星进行不间断的观测，然后将观测数据通过无线电装置实时动态的传送给流动观测站，通过对观测数据进行差分相对定位，实时动态计算三维坐标，提高了定位和定向精度和系统的实时性。
3、本发明采用RTK技术来实现经纬仪的5厘米以下误差的定位精度，采用两套车载经纬仪之间RTK测量来实现车载经纬仪4″以内的定向精度。
4、本发明采用的系统结构简单，体积小，安装方便，便于携带；
5、本发明采用的系统采用BD与GPS两种定位定向方式，受限程度小，测试结果可靠性高。
附图说明
图1为一台定位设备(M1或M2)的结构图；
图2为BD/GPS接收机的原理图；
图3为定向原理图。
具体实施方式
为使本发明的目的、优点和特征更加清楚，以下结合附图和具体实施例对本发明提出的一种基于车载经纬仪的自定位定向系统及方法。作进一步详细说明。根据下面说明，本发明的优点和特征将更清楚。需要说明的是：附图均采用非常简化的形式且均使用非精准的比例，仅用以方便、明晰地辅助说明本发明实施例的目的；其次，附图所展示的结构往往是实际结构的一部分；再次，各附图需要展示的侧重点不同，有时会采用不同的比例。
基于全球定位系统(Global Positioning System，简称GPS)的定位定向技术被广泛采用，众所周知，GPS具有全球地面连续覆盖、全天候、功能多、抗干扰性能好等特点。北斗卫星导航系统(BeiDou satellite navigation system，简称BD)的研制成功，解决了我国无自主导航系统的问题，标志着我国拥有自己的第一代卫星导航定位系统。BD是一种全天候、全天时提供卫星导航信息的双星定位区域导航系统，具有完全的独立性，其可在服务区域内的任何时间、任何地点，为用户确定其所在的地理经纬度信息，并可提供双向短报文通信和精密授时服务。
在实际工程应用中，用户对于定位与定向的精度和实时性要求越来越高，基于观测文件进行事后处理的模式已经无法满足工程应用需求。实时动态测量系统(Real TimeKinematic,简称RTK)是一种实时差分GPS测量技术，它的基础是载波相位观测量。RTK系统通过对观测数据进行差分相对定位，实时动态计算三维坐标，可以提高定位定向精度和系统的实时性。
本发明将车载经纬仪、BD/GPS接收机结合在一起，构建一种自定位定向系统，包括完全相同的第一车载经纬仪、第二车载经纬仪、完全相同的第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机以及上位机；第一车载经纬仪、第一BD/GPS接收机、第二BD/GPS接收机构成一台定位设备M1；第二车载经纬仪、第三BD/GPS接收机以及第四BD/GPS接收机构成另外一台定位设备M2；M1和M2的完全相同；
定位设备M1和M2的具体结构如图1所示(以M1为例)：
第一BD/GPS接收机2和第二BD/GPS3接收机分别安装在第一车载经纬仪1的U型支架4开口侧的两个顶面上(如图中所示A、B两点)，且第一BD/GPS接收机2和第二BD/GPS接收机3中心等高；U型支架4开口侧的两个顶面的平面度均为0.02mm，且两台接收机之间的位置公差为0.1mm；这里需要注意的是第一BD/GPS接收机2和第二BD/GPS接收机3之间(即A、B两点之间)基线距离较短(安装在U型架两个顶端，基线长1m左右)，通过结构设计可以保证得到微米级基线长度信息，但是还要保证A、B两点的定位误差不会影响线段AB的方向才能够得到较高的定向精度，即要消除随机误差影响。
如图2所示，第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机均包括双频测量天线、低噪放大器以及信号处理主板；
第一BD/GPS接收机通过双频测量天线接收公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，(由于卫星信号十分微弱，不能直接进行处理)需要通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第一数字信号通过数据通信模块上传至上位机；
第二BD/GPS接收机通过双频测量天线接收与第一BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，(由于卫星信号十分微弱，不能直接进行处理)需要通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第二数字信号通过数据通信模块上传至上位机；
上位机对第一数字信号和第二数字信号进行处理得到第一车载经纬仪的当前位置坐标；
第三BD/GPS接收机通过双频测量天线接收与第一BD/GPS接收机相同公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，(由于卫星信号十分微弱，不能直接进行处理)需要通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第三数字信号通过数据通信模块上传至上位机；
第四BD/GPS接收机通过双频测量天线接收与第三BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，(由于卫星信号十分微弱，不能直接进行处理)需要通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第四数字信号通过数据通信模块上传至上位机；
上位机对第三数字信号和第四数字信号进行处理得到第二车载经纬仪的当前位置坐标；
上位机通过第一车载经纬仪的当前位置坐标和第二车载经纬仪的当前位置坐标计算得到两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角。
下述内容是进行定位定向的具体方法：
步骤1：获取第一车载经纬仪的位置坐标；
步骤1.1：第一BD/GPS接收机接收任意第i个BD或GPS卫星的电磁波信号经过放大处理、下变频处理和AD模数转换处理后转化为第一数字信号上传至上位机；
步骤1.2：上位机通过第一数字信号建立第一BD/GPS接收机对应任意第i个BD或GPS卫星的载波相位观测方程；
以任意GPS卫星i为例的载波相位观测方程可表示为：
Figure GDA0002702206870000141
式中：
λL1—第i个GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure GDA0002702206870000142
—第一BD/GPS接收机对应的第i颗GPS卫星的载波相位观测量，单位：周；
Figure GDA0002702206870000143
—第一BD/GPS接收机对应的第i颗GPS卫星的载波整周模糊度，单位：周；
xGi yGi zGi—第i颗GPS卫星的三轴坐标；
xR1 yR1 zR1—第一BD/GPS接收机的坐标；
dri—第i颗GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure GDA0002702206870000151
—第i颗GPS卫星伪距的电离层误差；
Figure GDA0002702206870000152
—第i颗GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δtGi—第i颗GPS卫星的钟差；
Figure GDA0002702206870000153
—第一BD/GPS接收机对第i颗GPS卫星的观测噪声。
将上式线性化后：
Figure GDA0002702206870000154
式中，
Figure GDA0002702206870000155
Figure GDA0002702206870000156
Figure GDA0002702206870000157
其中，
Figure GDA0002702206870000158
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure GDA0002702206870000159
线性化后加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个GPS卫星的线性化后的载波相位观测方程：
Figure GDA0002702206870000161
Figure GDA0002702206870000162
—第二BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure GDA0002702206870000163
—第二BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2 yR2 zR2—第二BD/GPS接收机的坐标；
Figure GDA0002702206870000164
—第i个BD或GPS卫星伪距的电离层误差；
Figure GDA0002702206870000165
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第二BD/GPS接收机自身的钟差；
δtGi—第i个BD或GPS卫星的钟差；
Figure GDA0002702206870000166
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：对于同一颗GPS卫星i，在两个接收机之间进行差分处理，得到单差方程：
Figure GDA0002702206870000167
单差方程可消去消去两个线性化后的载波相位观测方程中dri、
Figure GDA0002702206870000168
Figure GDA0002702206870000169
δti；
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个GPS卫星的单差方程；
Figure GDA00027022068700001610
步骤1.6：对第i个GPS卫星的单差方程和第j个GPS卫星的单差方程再次进行双差处理，
Figure GDA0002702206870000171
双差方程可以消去δtR1、δtR2以及系统的装配误差；
步骤1.7：当两个接收机观测到M颗公共的GPS可用卫星，则这M对载波相位观测值(即M个单差观测值)的两两之间总共能产生M(M-1)个双差测量值，但只有其中的M-1个双差值相互独立。M(M-1)个独立的双差观测方程可以表示成如下矩阵形式：
Figure GDA0002702206870000172
与GPS双差方程类似，北斗卫星导航系统的双差方程及双差观测矩阵可表示为：
Figure GDA0002702206870000173
Figure GDA0002702206870000174
将北斗和GPS观测矩阵组合实现定位，当接收到M颗GPS卫星和N颗北斗卫星，则组合观测模型为：
Figure GDA0002702206870000181
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure GDA0002702206870000182
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure GDA0002702206870000183
式中，
Figure GDA0002702206870000184
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure GDA0002702206870000185
为其协方差阵，
Figure GDA0002702206870000186
为无约束的最小二乘残差矢量。
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure GDA0002702206870000187
根据上式求解得到模糊度整数解
Figure GDA0002702206870000191
进而求解位置坐标修正向量的固定解
Figure GDA0002702206870000192
具体公式如下：
Figure GDA0002702206870000193
Figure GDA0002702206870000194
为第一BD/GPS接收机和第二BD/GPS接收机之间坐标值，即第一车载经纬仪的当前坐标；
步骤2：按照步骤1.1至步骤1.9相同的方式，获取第二车载经纬仪的位置坐标；
步骤3：通过第一车载经纬仪位置坐标和第二车载经纬仪的位置坐标，求解两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角，具体过程如图3所示，在图中A、B两点为分别代表第一车载经纬仪上第一BD/GPS接收机和第二BD/GPS接收机的位置坐标，C点为第二车载经纬仪上的任意第三BD/GPS接收机或第四BD/GPS接收机的位置坐标，D点为A、B的中心点(即第一车载经纬仪的位置)。A、B、C构成的三角形，AC、BC通过RTK方式求得，AB为固定基线，长度已知。进而通过三角形角度对应关系，求得∠4。具体求解方程如下式所示：
Figure GDA0002702206870000195
AB基线与第一车载经纬仪的编码器关系固定，所以∠4即可以校正第一车载经纬仪的编码器零位,从而精确定向第一车载经纬仪的大地北向。角度求解的主要依据不是A、B、C的精确点位坐标，而是三角形的三个边长，通过边长来求解角度,所以利用RTK精确得到相对位置就非常重要。影响测向精度的主要是定位矢量偏差，按照基线2000m计算如下：
Figure GDA0002702206870000201
其中ΔA为定位矢量偏差，N为基线长度。如上所示定位矢量按照5cm计算，能够在2000mm以上的基线长度满足定向精度0.09″(2.5×10-5)的要求，由于系统有BD/GPS接收机具有安装误差、信号影响等因素，本发明测得不大于4″(1.1×10-5)的定向精度。
按照经验值估算系统误差后，预期该系统测距精度值约为3.5-5.5mm左右。按照中等基线布局后，扣除载波相位差分误差，短时间(10分钟)可达到的精度约为8cm左右，45分钟时可以达到3cm以内，60分钟时可以达到1cm以内，150分钟时接近最优值可以达到5mm左右。
通过实验数据处理得到车载经纬仪定位与定向值，在与给定的真值进行比较得到：相对定位精度≤5cm(1σ)(静态连续跟踪条件下，载波相位差分，位置滤波大于45分钟，收星PDOP值优于2.5)；测向精度≤4秒(1σ，2000米基线)，由此可见，本发明的定位定向系统能够满足实际精度要求。
最后所应说明的是，上述描述仅是对本发明较佳实施例的描述，并非对本发明范围的任何限定，本发明领域普通技术人员根据上述揭示内容做的任何变更、修饰，均属于权利要求书的保护范围。

Claims (4)

1.一种基于车载经纬仪的自定位定向系统，其特征在于：包括第一车载经纬仪、第二车载经纬仪、第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机以及上位机；
第一车载经纬仪、第二车载经纬仪完全相同；
第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机完全相同；
第一BD/GPS接收机和第二BD/GPS接收机分别安装在第一车载经纬仪的U型支架开口侧的两个顶面上，且第一BD/GPS接收机和第二BD/GPS接收机中心等高；U型支架开口侧的两个顶面的平面度均为0.02mm，且两台接收机之间的位置公差为0.1mm；
第三BD/GPS接收机和第四BD/GPS接收机分别安装在第二车载经纬仪的U型支架开口侧的两个顶面上，且第三BD/GPS接收机和第四BD/GPS接收机中心等高；U型支架开口侧的两个顶面的平面度均为0.02mm，且两台接收机之间的位置公差为0.1mm；
第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机均包括双频测量天线、低噪放大器以及信号处理主板；
第一BD/GPS接收机通过双频测量天线接收公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第一数字信号上传至上位机；
第二BD/GPS接收机通过双频测量天线接收与第一BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第二数字信号上传至上位机；
上位机对第一数字信号和第二数字信号进行处理得到第一车载经纬仪的当前位置坐标；
第三BD/GPS接收机通过双频测量天线接收公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第三数字信号上传至上位机；
第四BD/GPS接收机通过双频测量天线接收与第三BD/GPS接收机相同的公共BD卫星或GPS卫星的电磁波信号并将其转化为电流信号，再通过低噪放大器对电流信号放大送入信号处理主板，信号处理主板先对电流信号进行下变频和AD模数转换处理后，获得第四数字信号上传至上位机；
上位机对第三数字信号和第四数字信号进行处理得到第二车载经纬仪的当前位置坐标；
上位机通过第一车载经纬仪的当前位置坐标和第二车载经纬仪的当前位置坐标计算得到两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角。
2.根据权利要求1所述的一种基于车载经纬仪的自定位定向系统，其特征在于：所述第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机还包括数据通信模块；信号处理主板通过数据通信模块将第一数字信号、第二数字信号、第三数字信号、第四数字信号发送至上位机。
3.根据权利要求1所述的一种基于车载经纬仪的自定位定向系统，其特征在于：所述第一BD/GPS接收机、第二BD/GPS接收机、第三BD/GPS接收机、第四BD/GPS接收机还包括电源模块；所述电源模块用于向信号处理主板供电。
4.一种基于车载经纬仪的自定位定向方法，其特征在于，采用如权利要求1所述的自定位定向系统，具体的执行步骤如下：
步骤1：获取第一车载经纬仪的位置坐标；
步骤1.1：第一BD/GPS接收机接收任意第i个BD或GPS卫星的电磁波信号经过放大处理、下变频处理和AD模数转换处理后转化为第一数字信号上传至上位机；
步骤1.2：上位机通过第一数字信号建立第一BD/GPS接收机对应任意第i个BD或GPS卫星的载波相位观测方程：
Figure FDA0002702206860000041
式中：
λ—第i个BD或GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure FDA0002702206860000042
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure FDA0002702206860000043
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xi yi zi—第i颗BD或GPS卫星的三轴坐标，该参数第一数字信号自身携带；
xR1 yR1 zR1—第一BD/GPS接收机的坐标；
dri—第i个BD或GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure FDA0002702206860000044
—第i个BD或GPS卫星伪距的电离层误差；
Figure FDA0002702206860000045
—第i个BD或GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure FDA0002702206860000046
—第一BD/GPS接收机对第i个BD或GPS卫星的观测噪声；
将上式线性化后：
Figure FDA0002702206860000051
式中：
Figure FDA0002702206860000052
Figure FDA0002702206860000053
Figure FDA0002702206860000054
其中，
Figure FDA0002702206860000055
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure FDA0002702206860000056
表示
Figure FDA0002702206860000057
线性化后的加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个BD或GPS卫星的线性化后的载波相位观测方程：
Figure FDA0002702206860000058
Figure FDA0002702206860000059
—第二BD/GPS接收机第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure FDA00027022068600000510
—第二BD/GPS接收机第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2 yR2 zR2—第二BD/GPS接收机的坐标；
Figure FDA0002702206860000061
—第i个BD或GPS卫星伪距的电离层误差；
Figure FDA0002702206860000062
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure FDA0002702206860000063
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：将步骤1.2和步骤1.3线性化后的两个载波相位观测方程进行差分处理，消去两个线性化后的载波相位观测方程中dri、
Figure FDA0002702206860000064
δti，得到第i个BD或GPS卫星的单差方程：
Figure FDA0002702206860000065
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个BD或GPS卫星的单差方程；
Figure FDA0002702206860000066
步骤1.6：对第i个BD或GPS卫星的单差方程和第j个BD或GPS卫星的单差方程再次进行双差处理，消去δtR1、δtR2以及系统的装配误差，得到双差方程：
Figure FDA0002702206860000067
步骤1.7：当第一BD/GPS接收机和第二BD/GPS接收机可观测到的公共BD/GPS卫星的数量为M时，则双差观测方程可以表示成如下矩阵形式：
Figure FDA0002702206860000071
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure FDA0002702206860000072
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure FDA0002702206860000073
式中，
Figure FDA0002702206860000074
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure FDA0002702206860000075
为其协方差阵，
Figure FDA0002702206860000076
为无约束的最小二乘残差矢量；
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure FDA0002702206860000077
根据上式求解得到模糊度整数解
Figure FDA0002702206860000081
进而求解位置坐标修正向量的固定解
Figure FDA0002702206860000082
具体公式如下：
Figure FDA0002702206860000083
Figure FDA0002702206860000084
为第一BD/GPS接收机和第二BD/GPS接收机之间坐标值，即车载经纬仪的当前坐标；
步骤2：按照步骤1.1至步骤1.9相同的方式，获取第二车载经纬仪的位置坐标；
步骤3：通过第一车载经纬仪位置坐标和第二车载经纬仪的位置坐标，求解两个车载经纬仪的大地北向，从而确定第一车载经纬仪或第二车载经纬仪在当地北天东坐标系下对任意目标的方位角与俯仰角。
CN201911233451.9A 2019-12-05 2019-12-05 一种基于车载经纬仪的自定位定向系统及方法 Active CN111076700B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911233451.9A CN111076700B (zh) 2019-12-05 2019-12-05 一种基于车载经纬仪的自定位定向系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911233451.9A CN111076700B (zh) 2019-12-05 2019-12-05 一种基于车载经纬仪的自定位定向系统及方法

Publications (2)

Publication Number Publication Date
CN111076700A CN111076700A (zh) 2020-04-28
CN111076700B true CN111076700B (zh) 2020-12-25

Family

ID=70313003

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911233451.9A Active CN111076700B (zh) 2019-12-05 2019-12-05 一种基于车载经纬仪的自定位定向系统及方法

Country Status (1)

Country Link
CN (1) CN111076700B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111562596A (zh) * 2020-06-15 2020-08-21 中国人民解放军63660部队 一种长基线高精度外场定位定向方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CH651661A5 (en) * 1981-06-30 1985-09-30 Contraves Ag Mobile flight-path surveying device
JPH04175605A (ja) * 1990-11-08 1992-06-23 Asahi Seimitsu Kk Ｔｓ測定機能を備えたｇｐｓ受信装置
JPH08178652A (ja) * 1994-12-26 1996-07-12 Furuno Electric Co Ltd 測量装置
JPH1082638A (ja) * 1996-05-27 1998-03-31 Nikon Corp Ｇｐｓ測量機
CN101227235A (zh) * 2008-01-22 2008-07-23 长春理工大学 机载激光通信系统捕获模拟装置
CN102819028A (zh) * 2012-08-31 2012-12-12 北京航天计量测试技术研究所 一种差分gps定向方位引入方法
CN107860401A (zh) * 2017-10-27 2018-03-30 中国科学院西安光学精密机械研究所 一种用于实时修正光电经纬仪指向值的测量装置及方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CH651661A5 (en) * 1981-06-30 1985-09-30 Contraves Ag Mobile flight-path surveying device
JPH04175605A (ja) * 1990-11-08 1992-06-23 Asahi Seimitsu Kk Ｔｓ測定機能を備えたｇｐｓ受信装置
JPH08178652A (ja) * 1994-12-26 1996-07-12 Furuno Electric Co Ltd 測量装置
JPH1082638A (ja) * 1996-05-27 1998-03-31 Nikon Corp Ｇｐｓ測量機
CN101227235A (zh) * 2008-01-22 2008-07-23 长春理工大学 机载激光通信系统捕获模拟装置
CN102819028A (zh) * 2012-08-31 2012-12-12 北京航天计量测试技术研究所 一种差分gps定向方位引入方法
CN107860401A (zh) * 2017-10-27 2018-03-30 中国科学院西安光学精密机械研究所 一种用于实时修正光电经纬仪指向值的测量装置及方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于船姿测量的舰载光电经纬仪视轴稳定方法研究;李哲，等;《光子学报》;20090630;第38卷(第6期);1552-1556 *
车载经纬仪的静态指向误差补偿;李增，等;《光学 精密工程》;20100430;第18卷(第4期);921-927 *

Also Published As

Publication number Publication date
CN111076700A (zh) 2020-04-28

Similar Documents

Publication Publication Date Title
CN106255065B (zh) 智能手机室内外无缝定位系统及其方法
CN101295014B (zh) 基于gnss的远距离高精度实时/快速定位方法和系统
CN106842268B (zh) 双gnss接收机载波相位双差整周模糊度浮点解向量估计方法
CN101806906A (zh) 基于gnss的位置坐标实时动态组合测量装置及方法
CN110320540A (zh) 高精度集中式差分定位方法
CN108181630B (zh) 一种北斗双天线旋转快速定向方法
EP2064567A1 (en) Relative positioning
CN103529459A (zh) 一种采用单频gps和glonass组合精准定位的方法及其系统
US11693120B2 (en) System and method for providing GNSS corrections
CN104459744A (zh) 一种虚拟稳定基线卫星定向方法及装置
Anjasmara et al. Accuracy analysis of GNSS (GPS, GLONASS and BEIDOU) obsevation for positioning
CN111076700B (zh) 一种基于车载经纬仪的自定位定向系统及方法
CN114779301A (zh) 一种基于广播星历的卫星导航实时精密单点定位方法
TW202208881A (zh) 超長基線即時動態
CN111077554A (zh) 一种基于车载经纬仪的自定位系统及方法
CN109116396B (zh) 一种多天线gnss差分定位方法
Tarig Positioning with wide-area GNSS networks: Concept and application
CN111288990A (zh) 一种架空检修机器人组合姿态测量方法
Pham et al. Accuracy assessment of the single CORS technology for establishing the large-scale cadastral map
CN110307854B (zh) 一种基于cors技术的高精度电商物流地图定位方法及系统
CN113176596A (zh) 气压高程约束定位方法
CN110646817A (zh) 计算定位误差的方法和高精度定位方法
CN116088021B (zh) 一种基于天线布局的测姿方法
CN113933879B (zh) 一种无人机抗磁导航方法和系统
CN112987048B (zh) 一种适用于Andriod智能终端的高精度定位方法、智能终端以及存储介质

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