CN108845345B - 利用gnss测速原理的双天线定向测姿的方法 - Google Patents
利用gnss测速原理的双天线定向测姿的方法 Download PDFInfo
- Publication number
- CN108845345B CN108845345B CN201810611106.3A CN201810611106A CN108845345B CN 108845345 B CN108845345 B CN 108845345B CN 201810611106 A CN201810611106 A CN 201810611106A CN 108845345 B CN108845345 B CN 108845345B
- Authority
- CN
- China
- Prior art keywords
- antenna
- carrier
- guide rail
- gnss
- speed
- 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
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 54
- 238000000691 measurement method Methods 0.000 title claims abstract description 7
- 230000003068 static effect Effects 0.000 claims abstract description 13
- 238000006243 chemical reaction Methods 0.000 claims abstract description 5
- 238000004891 communication Methods 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 22
- 150000001875 compounds Chemical class 0.000 claims description 18
- 238000000034 method Methods 0.000 claims description 15
- 230000000694 effects Effects 0.000 claims description 7
- 230000009977 dual effect Effects 0.000 claims description 6
- 238000005516 engineering process Methods 0.000 claims description 5
- 239000002131 composite material Substances 0.000 claims description 3
- 235000013290 Sagittaria latifolia Nutrition 0.000 claims 1
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 235000015246 common arrowhead Nutrition 0.000 claims 1
- 239000003550 marker Substances 0.000 claims 1
- 238000003786 synthesis reaction Methods 0.000 claims 1
- 238000001514 detection method Methods 0.000 abstract description 5
- 239000000969 carrier Substances 0.000 abstract description 3
- 238000013507 mapping Methods 0.000 abstract description 3
- 238000012937 correction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000005672 electromagnetic field Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- 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/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
- G01S19/55—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)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种利用GNSS测速原理的双天线定向测姿的方法,包括六个步骤。其中步骤一公开了一种双天线定向测姿装置,包括GNSS双天线、接收机、电动导轨、滑块、步进电机、运动控制器,GNSS天线a和电动导轨设于载体上,GNSS天线b通过滑块固设于电动导轨上,调节天线a和天线b高度使之与电动导轨平面平行,运动控制器与天线b相连,自动控制天线b沿电动导轨运动。其余步骤为数据通讯、位置测量、速度测量、站心速度换算和姿态估计。本发明属于GNSS卫星导航定位和测绘科学技术领域,所提供的GNSS双天线三维姿态测量方案降低了天线数和装置成本,避免了模糊度固定和周跳探测修复难题,适用于静态和动态载体定向测姿。
Description
技术领域
本发明属于GNSS卫星导航定位和测绘科学技术领域,具体是指一种利用GNSS测速原理的双天线定向测姿的方法。
背景技术
在GNSS卫星导航定位和测绘科学技术及其应用领域中,如车载、机载、船载导航定位、地下工程贯通测量以及武器系统机动发射等,均需要确定载体方位或姿态。传统的方法有磁罗盘、寻北陀螺仪、惯性导航系统。其中,磁罗盘实际测姿精度易受周边电磁场环境影响,寻北陀螺仪测姿受到地域限且其造价成本较高,惯性导航系统测姿误差会随时间积累且其造价非常高。卫星导航系统具有全球、全天候、抗干扰性能好的特点,广泛应用于授时、定位和测速。同时高精度GNSS设备迅速发展,使得以GNSS构建载体测姿系统成为全新的定向测姿技术途径。
目前,现有GNSS定向测姿系统均是通过测量天线间基线向量实现载体定向或测姿(简称为基线向量测姿)。因此,若需确定载体方位,至少需要安装两个GNSS天线;若需确定载体三个姿态角,至少需要安装三个GNSS天线。如:专利CN1632465A采用两个天线实现了卫星定向;专利CN104597471A采用任意布置同一平面的三个GNSS天线,并通过载波单差观测方差估算载体姿态矩阵;专利CN102998690A将三个GNSS天线布置成直角三角形,利用载波双差方程估算测姿矩阵。需指出的是,现有定向测姿方法利用GNSS载波相对定位原理获得高精度基线向量,必须处理整周模糊度固定和周跳探测修复等棘手难题。而且,对于动态载体,模糊度固定和周跳探测修复的实时理论算法仍属于开放性研究难题。
发明内容
为解决上述现有难题,本发明提出了利用GNSS测速原理的双天线定向测姿的方法,首先避免了模糊度固定和周跳探测修复难题,其次降低了三维测姿对GNSS天线数量的要求,其三同时适用于静态和动态载体的定向测姿需求。本发明同时适用于静态和动态载体的定向(二维测姿)和定姿(三维测姿),且天线数量和装置成本均较低。
本发明采取的技术方案如下:步骤一、在载体上安装GNSS双天线定向测姿装置,所述双天线定向测姿装置包括GNSS双天线、接收机、电动导轨、滑块、步进电机、运动控制器,所述GNSS双天线包括天线a和天线b,天线a和电动导轨设于载体上,天线b通过滑块固设于电动导轨上,调节天线a和天线b高度使之与电动导轨平面平行,运动控制器与天线b连接,通过运动控制器使天线b在电动导轨上运动;
步骤二、通过通讯数据线连接双天线定向测姿装置和计算机,实时接收GNSS载波、伪距和多普勒数据;
步骤三、GNSS载体位置伪距测量;
式中,为t时刻天线近似位置至卫星j方向上的方向余弦,(x0,y0,z0)表示天线近似三维坐标,(Xj,Yj,Zj)为卫星j坐标,表示天线到卫星j的近似距离,dx(t)=(δx,δy,δz)T为天线坐标改正值;
由此,可得线性化伪距定位观测方程:
当同步观测n颗卫星,n大于四颗,将上式写成矩阵形式并由最小二乘估计可得GNSS天线三维空间直角坐标改正数:
通过空间直角坐标与大地坐标转换公式,将天线空间直角坐标(x,y,z)转换成大地坐标(B,L,H);由于测姿应用中两个天线距离一般很小,采用GNSS天线a或b得到的经纬度(Ba,La)或(Bb,Lb)均可用来表示载体位置;空间直角坐标与大地坐标迭代变换公式如下:
式中,N为该点的卯酉圈曲率半径;e分别为椭球第一偏心率;
步骤四、GNSS天线多普勒测速;
忽略天线下标,伪距变化率进行一阶泰勒级数展开,可表示为:
由此,可得GNSS天线多普勒测速线性化方程:
当同步观测n颗卫星(大于四颗),写成矩阵形式并由最小二乘估计可得GNSS天线速度估计公式:
步骤五、GNSS天线站心系速度换算;
式中,Na(t),Ea(t),Ua(t)分别表示天线a在站心系下三个方向速度;Norb(t),Eorb(t),Uorb(t)分别表示天线b导轨在站心系下三个方向速度;
或者
步骤六、动态载体三维姿态实时估计;
根据天线a载体的站心速度和天线b导轨的站心系速度可构建载体姿态矩阵,为姿态矩阵第一列向量,为姿态矩阵第二列向量,姿态矩阵第二列向量与第一列向量叉乘作为姿态矩阵第三列向量,从而得到动态载体的三维姿态估计公式:
采用上述方案本发明取得的有益效果如下:本方案利用GNSS测速原理的双天线定向测姿的方法,与现有GNSS定向测姿方法相比,首先,本发明只需要GNSS双天线即可实现动态三维姿态测量,减少了测姿系统对GNSS天线数的要求,因而降低了系统成本。其次,本发明除了适用于动态载体的三维测姿需求,还适用于静态情况下的俯仰角和方位角的静态定向(二维测姿)需求,而且此时仅仅需要一个GNSS天线。再次,该发明避免了载波相位模糊度固定和周跳探测修复难题,适用于高动态载体定向测姿需求。
附图说明
图1为本发明方法流程图;
图2为直线往返式GNSS双天线定向测姿装置图;
图3为圆弧旋转式GNSS双天线定向测姿装置图;
图4为本发明实施例计算得到的方位、俯仰和横滚角结果图。
具体实施方式
下面结合具体实施对本专利的技术方案作进一步详细地说明,本发明所述的技术特征或连接关系没有进行详细描述的部分均为采用的现有技术。
以下结合附图,对本发明做进一步详细说明。
如图1所示,一种利用GNSS测速原理的双天线定向测姿装置及方法,包括以下步骤:
第一步、在载体上安装GNSS双天线定向测姿装置。该装置包括以下主要部件:GNSS双天线、接收机、电动导轨、滑块、步进电机、运动控制器等。天线a和电动导轨直接安装在载体上,天线b通过滑块固连在电动导轨上,调节天线a、b高度使之与电动导轨平面平行,通过运动控制器使天线b在电动导轨上运动。
第二步、通过通讯数据线连接双天线定向测姿装置和计算机,实时接收GNSS载波、伪距和多普勒数据。
第三步、GNSS载体位置伪距测量
式中,为t时刻天线近似位置至卫星j方向上的方向余弦,(x0,y0,z0)表示天线近似三维坐标,(Xj,Yj,Zj)为卫星j坐标,表示天线到卫星j的近似距离,dx(t)=(δx,δy,δz)T为天线坐标改正值。
由此,可得线性化伪距定位观测方程:
当同步观测n颗卫星(大于四颗),将上式写成矩阵形式并由最小二乘估计可得GNSS天线三维空间直角坐标改正数:
通过空间直角坐标与大地坐标转换公式,将天线空间直角坐标(x,y,z)转换成大地坐标(B,L,H)。由于测姿应用中两个天线距离一般很小,采用GNSS天线a或b得到的经纬度(Ba,La)或(Bb,Lb)均可用来表示载体位置。空间直角坐标与大地坐标迭代变换公式如下:
式中,N为该点的卯酉圈曲率半径;e分别为椭球第一偏心率。
第四步、GNSS天线多普勒测速
忽略天线下标,伪距变化率进行一阶泰勒级数展开,可表示为:
由此,可得GNSS天线多普勒测速线性化方程:
当同步观测n颗卫星(大于四颗),写成矩阵形式并由最小二乘估计可得GNSS天线速度估计公式:
第五步、GNSS天线站心系速度换算
式中,Na(t),Ea(t),Ua(t)分别表示天线a在站心系下三个方向速度;Norb(t),Eorb(t),Uorb(t)分别表示天线b导轨在站心系下三个方向速度。
或者
第六步、动态载体三维姿态实时估计
根据天线a载体的站心速度和天线b导轨的站心系速度可构建载体姿态矩阵,为姿态矩阵第一列向量,为姿态矩阵第二列向量,姿态矩阵第二列向量与第一列向量叉乘作为姿态矩阵第三列向量,从而得到动态载体的三维姿态估计公式:
本发明所述的电动导轨可以采用多种形式,两种典型形式为直线往返式(如图2所示)和圆弧旋转式(如图3所示)电动导轨。其中,直线往返式要求控制器具有自动往返功能,圆弧旋转式则无此要求。其次,当滑块为精密数控滑块,精确获得GNSS天线b(精密数控滑块)相对导轨速率数据后,则利用附约束参数估计方法可进一步提高定向测姿精度。再次,所述的双天线可以采用独立时钟双天线或者共时钟双天线技术、所述的多普勒可以采用原始多普勒观测值或者导出多普勒观测值、所述的GNSS可采用GPS、GALILEO、GLONSS、BDS或者组合技术。最后,本发明适用于静态载体定向(二维测姿),也适用于动态载体测姿(三维测姿)。
以直线往返式电动导轨、独立时钟GPS双天线多普勒观测值的动态车载三维测姿为实施例(华测X91,采样率5Hz,载体平均时速约50km/h),图4为本发明实施例计算得到的方位、俯仰和横滚角结果图。参见图4可知,车辆在略微下坡道路上基本沿直线行驶,所得方位角约47.75°、俯仰和横滚角都很小,与动态载体行驶过程中的姿态情况相一致。
以上对本发明及其实施方式进行了描述,这种描述没有限制性,附图中所示的也只是本发明的实施方式之一,实际的结构并不局限于此。总而言之,如果本领域的技术人员受其启示,在不脱离本发明创造宗旨的情况下能够想到的变化和优点都被包含在本发明中,均应属于本发明的保护范围。
Claims (5)
1.利用GNSS测速原理的双天线定向测姿的方法,其特征在于,包括如下步骤:
步骤一、在载体上安装GNSS双天线定向测姿装置,所述双天线定向测姿装置包括GNSS双天线、接收机、电动导轨、滑块、步进电机、运动控制器,所述GNSS双天线包括天线a和天线b,天线a和电动导轨设于载体上,天线b通过滑块固设于电动导轨上,调节天线a和天线b高度使之与电动导轨共面,运动控制器与天线b连接,通过运动控制器使天线b在导轨平面上运动;
步骤二、通过通讯数据线连接双天线定向测姿装置和计算机,实时接收GNSS载波、伪距和多普勒数据;
步骤三、用GNSS单点定位实时获得载体位置[B(t),L(t),H(t)];以GNSS天线a或者天线b的位置表示载体位置,载体上GNSS天线a或者天线b的位置分别表示为[Ba(t),La(t),Ha(t)]、[Bb(t),Lb(t),Hb(t)],可采用伪距单点定位或精密单点定位求解载体空间直角坐标,进而由空间直角坐标与大地坐标转换公式实时计算载体大地坐标;
忽略GNSS天线标记,当同步观测n颗卫星(大于四颗),写成矩阵形式并由最小二乘估计可得GNSS天线速度估计公式:
式中,为t时刻天线近似位置至卫星j方向上的方向余弦,(x0,y0,z0)表示天线近似三维坐标,(Xj,Yj,Zj)为卫星j坐标,表示天线到卫星j的近似距离,表示卫星j的速度,表示GNSS天线的速度,表示多普勒观测值的权阵;
步骤五、GNSS天线站心系速度换算;
天线a安装在载体上,则天线a速度即为载体速度;而天线b是通过滑块固连在导轨上,则天线b速度是载体速度和相对导轨速度的合成;将天线b导轨速度记为则天线b导轨速度为将天线a速度和天线b轨速换算到站心系速度,需分别采用如下公式:
式中,Na(t),Ea(t),Ua(t)分别表示天线a在站心系下三个方向速度;Norb(t),Eorb(t),Uorb(t)分别表示天线b导轨在站心系下三个方向速度;
或者
步骤六、动态载体三维姿态实时估计;
根据天线a载体的站心速度和天线b导轨的站心系速度可构建载体姿态矩阵,为姿态矩阵第一列向量,为姿态矩阵第二列向量,姿态矩阵第二列向量与第一列向量叉乘作为姿态矩阵第三列向量,从而得到动态载体的三维姿态估计公式:
5.根据权利要求1所述的利用GNSS测速原理的双天线定向测姿的方法,其特征在于,步骤一所述的GNSS双天线可以采用独立时钟双天线或者共时钟双天线技术,步骤四所述的多普勒观测值可以采用原始多普勒观测值或者导出多普勒观测值,步骤一至步骤六所述的GNSS可采用GPS、GALILEO、GLONSS、BDS或者组合技术。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810611106.3A CN108845345B (zh) | 2018-06-12 | 2018-06-12 | 利用gnss测速原理的双天线定向测姿的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810611106.3A CN108845345B (zh) | 2018-06-12 | 2018-06-12 | 利用gnss测速原理的双天线定向测姿的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108845345A CN108845345A (zh) | 2018-11-20 |
CN108845345B true CN108845345B (zh) | 2022-04-12 |
Family
ID=64201732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810611106.3A Active CN108845345B (zh) | 2018-06-12 | 2018-06-12 | 利用gnss测速原理的双天线定向测姿的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108845345B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3827286A4 (en) * | 2018-12-20 | 2021-10-27 | SZ DJI Technology Co., Ltd. | METHOD AND DEVICE FOR DETERMINATION OF POSITION ON THE BASIS OF LAYING DATA |
CN111487659B (zh) * | 2019-01-28 | 2022-07-05 | 广州市中海达测绘仪器有限公司 | 状态识别方法、装置、计算机设备和存储介质 |
CN110793518B (zh) * | 2019-11-11 | 2021-05-11 | 中国地质大学(北京) | 一种海上平台的定位定姿方法及系统 |
CN111221013B (zh) * | 2019-11-29 | 2023-06-09 | 中国兵器装备集团自动化研究所 | 一种可变基线双天线定向系统及其使用方法 |
CN112255648B (zh) * | 2020-10-20 | 2022-03-25 | 腾讯科技(深圳)有限公司 | 运动状态检测方法、装置、电子设备及存储介质 |
CN116540285B (zh) * | 2023-07-06 | 2023-08-29 | 中国科学院空天信息创新研究院 | 惯性辅助的gnss双天线定向方法、装置与电子设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106483535A (zh) * | 2016-11-30 | 2017-03-08 | 华南农业大学 | 一种双天线接收机位置姿态精度测试平台及测试方法 |
CN106990424A (zh) * | 2017-06-07 | 2017-07-28 | 重庆重邮汇测通信技术有限公司 | 一种双天线gps测姿方法 |
CN107315345A (zh) * | 2017-06-23 | 2017-11-03 | 华南农业大学 | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 |
FR3051900A1 (fr) * | 2016-05-24 | 2017-12-01 | Robert Schegerin | Dispositif et procede de pilotage pour aeronef |
CN207396749U (zh) * | 2017-11-16 | 2018-05-22 | 成都天合世纪科技有限责任公司 | 一种基站天线姿态测量系统 |
-
2018
- 2018-06-12 CN CN201810611106.3A patent/CN108845345B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3051900A1 (fr) * | 2016-05-24 | 2017-12-01 | Robert Schegerin | Dispositif et procede de pilotage pour aeronef |
CN106483535A (zh) * | 2016-11-30 | 2017-03-08 | 华南农业大学 | 一种双天线接收机位置姿态精度测试平台及测试方法 |
CN106990424A (zh) * | 2017-06-07 | 2017-07-28 | 重庆重邮汇测通信技术有限公司 | 一种双天线gps测姿方法 |
CN107315345A (zh) * | 2017-06-23 | 2017-11-03 | 华南农业大学 | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 |
CN207396749U (zh) * | 2017-11-16 | 2018-05-22 | 成都天合世纪科技有限责任公司 | 一种基站天线姿态测量系统 |
Non-Patent Citations (3)
Title |
---|
GNSS 3D Attitude Measurement System Based on Dual-Antenna Receiver with Common Clock;Xiang Ji等;《CPGPS 2017 Forum on Cooperative Positioning and Service》;20171231;全文 * |
基于GPS双天线的弹体姿态测量方法;丁传炳等;《探测与控制学报》;20171031;第39卷(第5期);全文 * |
基于双天线GPS接收机航向姿态测量方法;郭万禄等;《无线电工程》;20120531;第42卷(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN108845345A (zh) | 2018-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108845345B (zh) | 利用gnss测速原理的双天线定向测姿的方法 | |
CN106291639B (zh) | 一种gnss接收机实现定位的方法及装置 | |
CN106990424B (zh) | 一种双天线gps测姿方法 | |
Han et al. | Single-epoch ambiguity resolution for real-time GPS attitude determination with the aid of one-dimensional optical fiber gyro | |
CN102590839B (zh) | 一种三天线定位定向的方法 | |
Sun et al. | Precise vehicle dynamic heading and pitch angle estimation using time-differenced measurements from a single GNSS antenna | |
CN108181630B (zh) | 一种北斗双天线旋转快速定向方法 | |
CN101446634A (zh) | 一种高精度位置、方位角和俯仰角的组合测量方法及装置 | |
CN109613582B (zh) | 一种车载实时单频米级伪距定位方法 | |
CN108490474A (zh) | 基于阵列天线求解整周模糊度以实现单频测姿的方法 | |
CN111288983B (zh) | 一种适于多源融合的室内狭长地带定位方法 | |
CN117192578A (zh) | 一种跟踪无人机的船载测控天线轴系参数标定方法 | |
CN108205151B (zh) | 一种低成本gps单天线姿态测量方法 | |
CN105043389A (zh) | 一种基于单个外辐射源的组合导航方法 | |
CN110109163B (zh) | 一种附有高程约束的精密单点定位方法 | |
CN105068104A (zh) | 一种基于惯性/双星间断伪距约束的定位方法 | |
Hermann et al. | Kinematic On‐the‐Fly GPS Positioning Relative to a Moving Reference | |
CN101793529B (zh) | 一种双伪卫星辅助惯性导航系统位置校准方法 | |
CN114353835A (zh) | 惯性轨道测量仪动态校准系统、方法及其应用 | |
CN107356952A (zh) | 一种利用单接收机自主进行基于gnss的高精度相对导航方法 | |
Kulikov et al. | Navigation of vehicle in urban canyon via two-satellite GNSS and map aiding | |
CN111076700A (zh) | 一种基于车载经纬仪的自定位定向系统及方法 | |
CN112824830A (zh) | 水下管道定位方法及装置 | |
CN110646817A (zh) | 计算定位误差的方法和高精度定位方法 | |
CN110082800B (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 |