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

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

Info

Publication number
CN111076700A
CN111076700A CN201911233451.9A CN201911233451A CN111076700A CN 111076700 A CN111076700 A CN 111076700A CN 201911233451 A CN201911233451 A CN 201911233451A CN 111076700 A CN111076700 A CN 111076700A
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.)
Granted
Application number
CN201911233451.9A
Other languages
English (en)
Other versions
CN111076700B (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 BDA0002304219440000051
式中：
λ—第i个BD或GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure BDA0002304219440000052
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure BDA0002304219440000053
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xi yi zi—第i颗BD或GPS卫星的三轴坐标，该参数第一数字信号自身携带；
xR1 yR1 zR1—第一BD/GPS接收机的坐标；
dri—第i个BD或GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure BDA0002304219440000054
—第i个BD或GPS卫星伪距的电离层误差；
Figure BDA0002304219440000055
—第i个BD或GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure BDA0002304219440000056
—第一BD/GPS接收机对第i个BD或GPS卫星的观测噪声；
将上式线性化后：
Figure BDA0002304219440000061
式中：
Figure BDA0002304219440000062
Figure BDA0002304219440000063
Figure BDA0002304219440000064
其中，
Figure BDA0002304219440000065
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure BDA0002304219440000066
表示
Figure BDA0002304219440000067
线性化后的加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个BD或GPS卫星的线性化后的载波相位观测方程：
Figure BDA0002304219440000068
Figure BDA0002304219440000069
—第二BD/GPS接收机第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure BDA00023042194400000610
—第二BD/GPS接收机第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2 yR2 zR2—第二BD/GPS接收机的坐标；
Figure BDA0002304219440000071
—第i个BD或GPS卫星伪距的电离层误差；
Figure BDA0002304219440000072
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure BDA0002304219440000073
—
Figure BDA0002304219440000074
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：将步骤1.2和步骤1.3线性化后的两个载波相位观测方程进行差分处理，消去两个线性化后的载波相位观测方程中dri、
Figure BDA0002304219440000075
δti，得到第i个BD或GPS卫星的单差方程：
Figure BDA0002304219440000076
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个BD或GPS卫星的单差方程；
Figure BDA0002304219440000077
步骤1.6：对第i个BD或GPS卫星的单差方程和第j个BD或GPS卫星的单差方程再次进行双差处理，消去δtR1、δtR2以及系统的装配误差，得到双差方程：
Figure BDA0002304219440000078
步骤1.7：当第一BD/GPS接收机和第二BD/GPS接收机可观测到的公共BD/GPS卫星的数量为M时，则双差观测方程可以表示成如下矩阵形式：
Figure BDA0002304219440000081
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure BDA0002304219440000082
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure BDA0002304219440000083
式中，
Figure BDA0002304219440000084
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure BDA0002304219440000085
为其协方差阵，
Figure BDA0002304219440000086
为无约束的最小二乘残差矢量；
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure BDA0002304219440000087
根据上式求解得到模糊度整数解
Figure BDA0002304219440000091
根据上式求解得到模糊度整数解
Figure BDA0002304219440000092
进而求解位置坐标修正向量的固定解
Figure BDA0002304219440000093
具体公式如下：
Figure BDA0002304219440000094
Figure BDA0002304219440000095
为第一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 BDA0002304219440000141
式中：
λL1—第i个GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure BDA0002304219440000142
—第一BD/GPS接收机对应的第i颗GPS卫星的载波相位观测量，单位：周；
Figure BDA0002304219440000143
—第一BD/GPS接收机对应的第i颗GPS卫星的载波整周模糊度，单位：周；
xGi yGi zGi—第i颗GPS卫星的三轴坐标；
xR1 yR1 zR1—第一BD/GPS接收机的坐标；
dri—第i颗GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure BDA0002304219440000151
—第i颗GPS卫星伪距的电离层误差；
Figure BDA0002304219440000152
—第i颗GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δtGi—第i颗GPS卫星的钟差；
Figure BDA0002304219440000153
—第一BD/GPS接收机对第i颗GPS卫星的观测噪声。
将上式线性化后：
Figure BDA0002304219440000154
式中，
Figure BDA0002304219440000155
Figure BDA0002304219440000156
Figure BDA0002304219440000157
其中，
Figure BDA0002304219440000158
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure BDA0002304219440000159
—
Figure BDA00023042194400001510
线性化后加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个GPS卫星的线性化后的载波相位观测方程：
Figure BDA0002304219440000161
Figure BDA0002304219440000162
—第二BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure BDA0002304219440000163
—第二BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2 yR2 zR2—第二BD/GPS接收机的坐标；
Figure BDA0002304219440000164
—第i个BD或GPS卫星伪距的电离层误差；
Figure BDA0002304219440000165
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第二BD/GPS接收机自身的钟差；
δtGi—第i个BD或GPS卫星的钟差；
Figure BDA0002304219440000166
—
Figure BDA0002304219440000167
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：对于同一颗GPS卫星i，在两个接收机之间进行差分处理，得到单差方程：
Figure BDA0002304219440000168
单差方程可消去消去两个线性化后的载波相位观测方程中dri、
Figure BDA0002304219440000169
Figure BDA00023042194400001610
δti；
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个GPS卫星的单差方程；
Figure BDA00023042194400001611
步骤1.6：对第i个GPS卫星的单差方程和第j个GPS卫星的单差方程再次进行双差处理，
Figure BDA0002304219440000171
双差方程可以消去δtR1、δtR2以及系统的装配误差；
步骤1.7：当两个接收机观测到M颗公共的GPS可用卫星，则这M对载波相位观测值(即M个单差观测值)的两两之间总共能产生M(M-1)个双差测量值，但只有其中的M-1个双差值相互独立。M(M-1)个独立的双差观测方程可以表示成如下矩阵形式：
Figure BDA0002304219440000172
与GPS双差方程类似，北斗卫星导航系统的双差方程及双差观测矩阵可表示为：
Figure BDA0002304219440000173
Figure BDA0002304219440000174
将北斗和GPS观测矩阵组合实现定位，当接收到M颗GPS卫星和N颗北斗卫星，则组合观测模型为：
Figure BDA0002304219440000181
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure BDA0002304219440000182
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure BDA0002304219440000183
式中，
Figure BDA0002304219440000184
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure BDA0002304219440000185
为其协方差阵，
Figure BDA0002304219440000186
为无约束的最小二乘残差矢量。
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure BDA0002304219440000187
根据上式求解得到模糊度整数解
Figure BDA0002304219440000191
进而求解位置坐标修正向量的固定解
Figure BDA0002304219440000192
具体公式如下：
Figure BDA0002304219440000193
Figure BDA0002304219440000194
为第一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 BDA0002304219440000195
AB基线与第一车载经纬仪的编码器关系固定，所以∠4即可以校正第一车载经纬仪的编码器零位,从而精确定向第一车载经纬仪的大地北向。角度求解的主要依据不是A、B、C的精确点位坐标，而是三角形的三个边长，通过边长来求解角度,所以利用RTK精确得到相对位置就非常重要。影响测向精度的主要是定位矢量偏差，按照基线2000m计算如下：
Figure BDA0002304219440000201
其中Δ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：第一BD/GPS接收机接收任意第i个BD或GPS卫星的电磁波信号经过放大处理、下变频处理和AD模数转换处理后转化为第一数字信号上传至上位机；
步骤1.2：上位机通过第一数字信号建立第一BD/GPS接收机对应任意第i个BD或GPS卫星的载波相位观测方程：
Figure FDA0002304219430000041
式中：
λ—第i个BD或GPS卫星的载波波长，该参数第一数字信号自身携带；
Figure FDA0002304219430000042
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure FDA0002304219430000043
—第一BD/GPS接收机对应的第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xiyizi—第i颗BD或GPS卫星的三轴坐标，该参数第一数字信号自身携带；
xR1yR1zR1—第一BD/GPS接收机的坐标；
dri—第i个BD或GPS卫星的轨道误差，该参数第一数字信号自身携带；
Figure FDA0002304219430000044
—第i个BD或GPS卫星伪距的电离层误差；
Figure FDA0002304219430000045
—第i个BD或GPS卫星伪距的对流层误差；
δtR1—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure FDA0002304219430000046
—第一BD/GPS接收机对第i个BD或GPS卫星的观测噪声；
将上式线性化后：
Figure FDA0002304219430000051
式中：
Figure FDA0002304219430000052
Figure FDA0002304219430000053
Figure FDA0002304219430000054
其中，
Figure FDA0002304219430000055
表示两台接收机基线向量与卫星方向的单位向量；
(x0,y0,z0)表示卫星位置坐标初始值；
(xSi,ySi,zSi)表示两台接收机之间的基线向量；
Figure FDA0002304219430000056
表示
Figure FDA0002304219430000057
线性化后的加入的截断误差；
步骤1.3：按照步骤1.1和1.2，在上位机上建立第二BD/GPS接收机对应任意第i个BD或GPS卫星的线性化后的载波相位观测方程：
Figure FDA0002304219430000058
Figure FDA0002304219430000059
—第二BD/GPS接收机第i颗BD或GPS卫星的载波相位观测量，单位：周；
Figure FDA00023042194300000510
—第二BD/GPS接收机第i颗BD或GPS卫星的载波整周模糊度，单位：周；
xR2yR2zR2—第二BD/GPS接收机的坐标；
Figure FDA0002304219430000061
—第i个BD或GPS卫星伪距的电离层误差；
Figure FDA0002304219430000062
—第i个BD或GPS卫星伪距的对流层误差；
δtR2—第一BD/GPS接收机自身的钟差；
δti—第i个BD或GPS卫星的钟差；
Figure FDA0002304219430000063
线性化后加入的截断误差；
c代表真空中光速；
步骤1.4：将步骤1.2和步骤1.3线性化后的两个载波相位观测方程进行差分处理，消去两个线性化后的载波相位观测方程中dri、
Figure FDA0002304219430000064
δti，得到第i个BD或GPS卫星的单差方程：
Figure FDA0002304219430000065
步骤1.5：重复执行步骤1.1至步骤1.4，得到第j个BD或GPS卫星的单差方程；
Figure FDA0002304219430000066
步骤1.6：对第i个BD或GPS卫星的单差方程和第j个BD或GPS卫星的单差方程再次进行双差处理，消去δtR1、δtR2以及系统的装配误差，得到双差方程：
Figure FDA0002304219430000067
步骤1.7：当第一BD/GPS接收机和第二BD/GPS接收机可观测到的公共BD/GPS卫星的数量为M时，则双差观测方程可以表示成如下矩阵形式：
Figure FDA0002304219430000071
将上式写成矩阵简化形式为：
Φ＝AX+BY
其中，Φ表示载波相位观测量向量，A表示基线向量卫星方向的单位向量矩阵，X表示两台接收机组成的基线向量，B表示载波波长矩阵，Y表示双差模糊度向量；
步骤1.8：根据步骤1.7的双差观测方程矩阵简化式，计算第一BD/GPS接收机和第二BD/GPS接收机之间的坐标值；
利用最小二乘法求解位置坐标修正向量X及双差模糊度向量Y，使得：
Figure FDA0002304219430000072
由于整周模糊度向量Y是整数，上式可以分解为三项：
Figure FDA0002304219430000073
式中，
Figure FDA0002304219430000074
是以整周模糊度Y为约束的最小二乘的位置坐标修正向量，
Figure FDA0002304219430000075
为其协方差阵，
Figure FDA0002304219430000076
为无约束的最小二乘残差矢量；
在上述分解情况下，由于模糊度整数特性的限制，上式的第二项可完全消除，相应的目标函数变为：
Figure FDA0002304219430000077
根据上式求解得到模糊度整数解
Figure FDA0002304219430000081
进而求解位置坐标修正向量的固定解
Figure FDA0002304219430000082
具体公式如下：
Figure FDA0002304219430000083
Figure FDA0002304219430000084
为第一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 true CN111076700A (zh) 2020-04-28
CN111076700B 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)

Cited By (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
李哲，等: "基于船姿测量的舰载光电经纬仪视轴稳定方法研究", 《光子学报》 *
李增，等: "车载经纬仪的静态指向误差补偿", 《光学 精密工程》 *

Cited By (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部队 一种长基线高精度外场定位定向方法

Also Published As

Publication number Publication date
CN111076700B (zh) 2020-12-25

Similar Documents

Publication Publication Date Title
CN106255065B (zh) 智能手机室内外无缝定位系统及其方法
US8768617B2 (en) Method and system for a data interface for aiding a satellite positioning system receiver
CN106842268B (zh) 双gnss接收机载波相位双差整周模糊度浮点解向量估计方法
CN101806906A (zh) 基于gnss的位置坐标实时动态组合测量装置及方法
CN108181630B (zh) 一种北斗双天线旋转快速定向方法
Bill et al. Indoor and outdoor positioning in mobile environments a review and some investigations on wlan positioning
CN103529459A (zh) 一种采用单频gps和glonass组合精准定位的方法及其系统
Bae et al. Performance analysis of Network-RTK techniques for drone navigation considering ionospheric conditions
CN107703527B (zh) 一种基于北斗三频单历元宽巷/超宽巷的组合定位方法
Anjasmara et al. Accuracy analysis of GNSS (GPS, GLONASS and BEIDOU) obsevation for positioning
Maciuk Advantages of combined GNSS processing involving a limited number of visible satellites
CN111076700B (zh) 一种基于车载经纬仪的自定位定向系统及方法
TW202208881A (zh) 超長基線即時動態
CN103543454A (zh) 一种嵌入在移动通讯网中的卫星定轨系统
US20230288569A1 (en) System and method for providing gnss corrections
CN111077554A (zh) 一种基于车载经纬仪的自定位系统及方法
CN109116396B (zh) 一种多天线gnss差分定位方法
Tarig Positioning with wide-area GNSS networks: Concept and application
Khai et al. Accuracy assessment of the single CORS technology for establishing the large-scale cadastral map
CN113176596A (zh) 气压高程约束定位方法
CN116088021B (zh) 一种基于天线布局的测姿方法
CN113933879B (zh) 一种无人机抗磁导航方法和系统
CN110307854B (zh) 一种基于cors技术的高精度电商物流地图定位方法及系统
Davronovna et al. INFORMATION ON GNSS RECEIVERS AND THEIR ADVANTAGE
KR100496811B1 (ko) Ｇｐｓ를 이용한 건물 높이 정보 취득 및 실시간 수치지도 제작방법

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