CN106443744B - Gnss双天线姿态的标定和校准方法 - Google Patents
Gnss双天线姿态的标定和校准方法 Download PDFInfo
- Publication number
- CN106443744B CN106443744B CN201610860920.XA CN201610860920A CN106443744B CN 106443744 B CN106443744 B CN 106443744B CN 201610860920 A CN201610860920 A CN 201610860920A CN 106443744 B CN106443744 B CN 106443744B
- Authority
- CN
- China
- Prior art keywords
- angle
- course
- gnss double
- dcm
- inertial navigation
- 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
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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Variable-Direction Aerials And Aerial Arrays (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种GNSS双天线姿态的标定和校准方法,包括:步骤1,获取观测数据;步骤2,GNSS双天线姿态偏角的标定,本步骤进一步包括:利用惯导提供的偏航角、俯仰角和横滚角构建DCM矩阵利用GNSS双天线提供的航向角和俯仰角,构建DCM矩阵求GNSS双天线和惯导间的角度相对关系矩阵;根据角度相对关系矩阵反求GNSS双天线和惯导间的航向角和俯仰角的差异,获得差异序列;对所求的航向角和俯仰角的差异序列分别求平均,即得航向偏角和俯仰偏角的标定值。本发明实现了捷联惯性导航***与GNSS双天线在同一平台完成安装的状态下,对误差角进行标定,对数据进行校正,大大简化了标定过程,降低了操作难度。
Description
技术领域
本发明属于测绘、导航、制导与控制技术领域,尤其涉及一种GNSS双天线姿态的标定和校准方法。
背景技术
惯性导航***(后文简称为“惯导”)可以测量载体的位置、姿态以及速度,其优点在于具有良好的短期精度,不受外界环境影响,不足是导航精度随着观测时间发散。GNSS卫星导航具有长期精度稳定,导航误差不随时间发散等优点,缺点在于GNSS观测信号易受环境干扰和遮挡。将二者结合起来组成GNSS/INS组合导航***,取长补短,既可以保证短期精度与长期精度,又大大增强了***的抗干扰能力。
高精度GNSS/INS定位定姿定向***,可以提供高精度三维位置、速度和姿态,在开阔天空环境下,动态观测可达厘米级定位精度,结合高精度惯导设备,即使GNSS信号失锁一分钟,在后处理模式下,仍然可以将位置精度控制在1dm以内。目前,在无人机测图、车载移动测绘以及水上测绘领域,都在大范围使用组合导航***。
实际使用中,惯导的精度等级千差万别,有售价高昂精度非常高的激光惯导,也有价格便宜精度较低的MEMS惯导。发挥低等级精度惯导的最优性能,从而降低组合导航***成本,无论从市场推广还是科学研究的角度来看,都具有重大的实际使用价值。
组合导航***中,当处于直线运动时,***在航向上没有可观测量,将会导致航向精度随着时间发散,这种发散对于低等级惯导更为致命。实验表明,在***中增加双天线观测,可以起到很好的辅助作用。
实际使用双天线时,必须处理好双天线的标定问题,否则,新引入的误差将会导致设备无法发挥应用的性能甚至损害导航精度。图1所示为双天线和航向与惯导航向间的几何关系。
现阶段惯性测量单元与双GNSS天线航向之间的偏角标定大多采用光学手段进行,即利用光学手段分别对惯导航向及双天线航向进行标定,并由航向差得到惯导航向和双天线航向间的偏角。然而,GNSS天线相位中心位于仪器内部,难以准确确定双天线的轴线,由于惯导结构限制,也难以直接测量惯导的航向,实际中,很难测量双天线和INS设备间的航向角关系。而且每当设备拆卸重装后,都需要对设备进行再次标定,操作较为复杂,难以简单快速的完成标定需求。
发明内容
本发明的目的是提供一种简单快捷精准的GNSS双天线姿态的标定和校准方法。
本发明充分利用GNSS双天线提供的航向角和俯仰角,结合GNSS/INS设备在未使用航向辅助时解算的姿态,通过DCM矩阵变换,求取GNSS双天线和惯导间的姿态差异。现阶段GNSS双天线辅助中,对于GNSS双天线数据校正的不严谨,没有考虑横滚角带来的误差,当载体存在横滚角时,GNSS双天线和惯导间的航向差异随着载体运动而变化。如,载体水平放置时,二者的航向差异为惯导轴线与GNSS双天线轴线角度差异;当横滚角等于90度时,二者在航向上重合,不存在差异。所以,数据使用中,不能单一的以航向差异评定,还必须考虑到横滚角带来的影响。
本发明的技术方案如下:
一、GNSS双天线姿态的标定方法,包括:
步骤1,获取观测数据,所述的观测数据包括GNSS双天线和惯导的姿态;
步骤2,GNSS双天线姿态偏角的标定,本步骤进一步包括:
利用惯导提供的偏航角、俯仰角和横滚角构建DCM矩阵
利用GNSS双天线提供的航向角和俯仰角,令横滚角为零,构建DCM矩阵
求GNSS双天线和惯导间的角度相对关系矩阵 表示的转置矩阵;
根据反求GNSS双天线和惯导间的航向角和俯仰角的差异,获得差异序列;
对所求的航向角和俯仰角的差异序列分别求平均,即得航向偏角和俯仰偏角的标定值。
进一步的,观测数据为10分钟以上连续有效的观测数据,在开阔天空下获取。
二、GNSS双天线姿态的校准方法,包括:
利用权利要求1所获得的航向偏角和俯仰偏角的标定值构建DCM矩阵
利用DCM矩阵将惯导姿态转换到与GNSS双天线航向一致的方向上;
令GNSS双天线的横滚角为转换后惯导的横滚角,结合GNSS双天线提供的航向角和俯仰角,构造完整的DCM矩阵
将DCM矩阵的转置矩阵和DCM矩阵相乘,得DCM矩阵
利用DCM矩阵反求GNSS双天线的航向角,即校准后的GNSS双天线航向角。
本发明用于惯性导航***与GNSS双天线航向偏角的标定与校准,实现了捷联惯性导航***与GNSS双天线在同一平台完成安装的状态下,对误差角进行标定,对数据进行校正,大大简化标定过程,降低操作难度。
本发明具有如下特点和有益效果:
(1)本发明无需使用全站仪等光学测量仪器,大大降低了标定的难度和成本。
(2)本发明操作简单快捷,仅需在开阔天空环境下观测10分钟即可完成标定。
(3)本发明考虑了横滚角的影响,提高了双天线校准的精准度。
附图说明
图1为GNSS双天线航向与惯导航向间的几何关系示意图。
具体实施方式
下面结合附图,对本发明的技术方案作进一步具体的说明。
为便于描述,下文中将“GNSS双天线”均简写为“双天线”。
步骤1,在开阔天空下,获取10分钟以上连续有效的观测数据,即标定数据。所述的观测数据包括双天线和惯导提供的姿态。
步骤2,双天线姿态偏角的标定。
首先,利用惯导提供的姿态,包括偏航角、俯仰角和横滚角,构建DCM矩阵利用双天线提供的航向角和俯仰角,令横滚角为零,构建DCM矩阵
DCM矩阵的形式见式(1):
式(1)中,θ表示航向角,为俯仰角,φ为横滚角。
然后,将DCM矩阵的转置矩阵和DCM矩阵相乘,获得双天线和惯导间的角度相对关系矩阵
式(2)中,表示的转置矩阵。
接着,根据角度相对关系矩阵反求双天线和惯导间的航向角和俯仰角的差异,见式(3):
式(3)中,θ、φ表示航向角、俯仰角、横滚角的差异,-π<θ≤π,-π<φ≤π;C11、C22、C31、C32、C33为角度相对关系矩阵中元素。
最后,将所求的航向角和俯仰角的差异序列求平均,即航向偏角和俯仰偏角的标定值。
步骤3,双天线航向数据的校准。
本步骤最关键的一步的是,如何给双天线补充横滚角,以构建完整的DCM矩阵,从而消除横滚角缺失带来的转换误差。
首先,利用步骤2所获的姿态差异构建DCM矩阵DCM矩阵即转换矩阵,利用转换矩阵将惯导姿态转换到与双天线航向一致的方向上。这里,姿态差异即航向偏角和俯仰偏角的标定值。
然后,令双天线的横滚角为转换后惯导的横滚角,结合双天线提供的航向角和俯仰角,构造完整的DCM矩阵
接着,将转换矩阵的转置矩阵和DCM矩阵相乘,即将双天线航向角转换到与惯导一致的方向上:
最后,结合式(3),利用求取双天线的航向角,从而得到校准后的双天线航向角,此时航向与惯导不存在***差异。
Claims (3)
1.GNSS双天线姿态的标定方法,其特征是,包括:
步骤1,获取观测数据,所述的观测数据包括GNSS双天线和惯导的姿态;
步骤2,GNSS双天线姿态偏角的标定,本步骤进一步包括:
利用惯导提供的偏航角、俯仰角和横滚角构建DCM矩阵
利用GNSS双天线提供的航向角和俯仰角,令横滚角为零,构建DCM矩阵
求GNSS双天线和惯导间的角度相对关系矩阵 表示的转置矩阵;
根据反求GNSS双天线和惯导间的航向角和俯仰角的差异,获得差异序列;
对所求的航向角和俯仰角的差异序列分别求平均,即得航向偏角和俯仰偏角的标定值。
2.如权利要求1所述的GNSS双天线姿态的 标定方法,其特征是:
所述的观测数据为10分钟以上连续有效的观测数据,在开阔天空下获取。
3.GNSS双天线姿态的校准方法,其特征是,包括:
利用权利要求1所获得的航向偏角和俯仰偏角的标定值构建DCM矩阵
利用DCM矩阵将惯导姿态转换到与GNSS双天线航向一致的方向上;
令GNSS双天线的横滚角为转换后惯导的横滚角,结合GNSS双天线提供的航向角和俯仰角,构造完整的DCM矩阵
将DCM矩阵的转置矩阵和DCM矩阵相乘,得DCM矩阵利用DCM矩阵反求GNSS双天线的航向角,即校准后的GNSS双天线航向角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860920.XA CN106443744B (zh) | 2016-09-28 | 2016-09-28 | Gnss双天线姿态的标定和校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860920.XA CN106443744B (zh) | 2016-09-28 | 2016-09-28 | Gnss双天线姿态的标定和校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106443744A CN106443744A (zh) | 2017-02-22 |
CN106443744B true CN106443744B (zh) | 2018-07-27 |
Family
ID=58170806
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610860920.XA Active CN106443744B (zh) | 2016-09-28 | 2016-09-28 | Gnss双天线姿态的标定和校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106443744B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107907900A (zh) * | 2017-11-07 | 2018-04-13 | 长光卫星技术有限公司 | 一种gnss双天线辅助的多传感器组合导航***及方法 |
CN107677295B (zh) * | 2017-11-22 | 2023-09-26 | 马玉华 | 一种飞行器惯性导航***误差校准***和方法 |
DE102017222912A1 (de) * | 2017-12-15 | 2019-06-19 | Continental Teves Ag & Co. Ohg | Verfahren und Vorrichtung zur Ermittlung von Korrekturinformationen für eine Antenne eines Fahrzeugs |
CN108051835B (zh) * | 2018-01-12 | 2024-02-09 | 武汉桓参工程科技有限公司 | 一种基于双天线的倾斜测量装置及测量与放样方法 |
DE102018205205A1 (de) * | 2018-04-06 | 2019-10-10 | Continental Teves Ag & Co. Ohg | Verfahren zur Ermittlung der Position eines Fahrzeugs |
CN109556604A (zh) * | 2018-11-20 | 2019-04-02 | 东南大学 | 一种旋转mimu/gnss短基线双天线的定位定向装置 |
CN109490932B (zh) * | 2018-12-26 | 2022-08-23 | 上海司南卫星导航技术股份有限公司 | 判断rtk定向结果可靠性的方法、oem板卡、接收机及存储介质 |
CN110106755B (zh) * | 2019-04-04 | 2020-11-03 | 武汉大学 | 利用姿态重构铁轨几何形态的高铁轨道不平顺性检测方法 |
CN111221013B (zh) * | 2019-11-29 | 2023-06-09 | 中国兵器装备集团自动化研究所 | 一种可变基线双天线定向***及其使用方法 |
CN112147656B (zh) * | 2020-09-09 | 2021-05-04 | 无锡卡尔曼导航技术有限公司 | 一种gnss双天线航向安装角度偏置估计方法 |
CN112649023B (zh) * | 2021-01-08 | 2022-12-09 | 中国船舶重工集团公司第七0七研究所 | 适用于中小型船舶捷联惯性导航***安装标校的方法 |
CN114001705B (zh) * | 2021-11-02 | 2024-03-12 | 成都国卫通信技术有限公司 | 一种卫通天线与载体安装误差自动校准的方法 |
CN113900126B (zh) * | 2021-12-07 | 2022-03-25 | 广东皓行科技有限公司 | 双天线位置确定方法及装置 |
CN114370872B (zh) * | 2022-01-14 | 2024-04-09 | 苏州挚途科技有限公司 | 车辆姿态确定方法和车辆 |
CN116381633B (zh) * | 2023-06-05 | 2023-08-15 | 南京隼眼电子科技有限公司 | 雷达横滚角的自标定方法、装置及存储介质 |
CN117928569A (zh) * | 2024-03-25 | 2024-04-26 | 华芯拓远(天津)科技有限公司 | 一种基于车载组合导航安装角实时计算方法及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101566477A (zh) * | 2009-06-03 | 2009-10-28 | 哈尔滨工程大学 | 舰船局部捷联惯导***初始姿态快速测量方法 |
CN101694389A (zh) * | 2009-10-20 | 2010-04-14 | 哈尔滨工程大学 | 无陀螺捷联惯导***的初始姿态快速测量方法 |
CN103389092A (zh) * | 2013-08-13 | 2013-11-13 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
-
2016
- 2016-09-28 CN CN201610860920.XA patent/CN106443744B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101566477A (zh) * | 2009-06-03 | 2009-10-28 | 哈尔滨工程大学 | 舰船局部捷联惯导***初始姿态快速测量方法 |
CN101694389A (zh) * | 2009-10-20 | 2010-04-14 | 哈尔滨工程大学 | 无陀螺捷联惯导***的初始姿态快速测量方法 |
CN103389092A (zh) * | 2013-08-13 | 2013-11-13 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
Non-Patent Citations (3)
Title |
---|
INS/GPS Integration System with DCM Based Orientation Measurement;Ho Quoc Phuong Nguyen et al.;《ICIC 2009, LNCS 5754》;20091231;856-869 * |
一种GPS测姿***的设计及精度分析;刘新明 等;《中国惯性技术学报》;20130228;第21卷(第1期);76-79 * |
空间应用的GPS/INS自主导航***;Robert L.Bunn;《控制工程》;20001231(第6期);41,48-56 * |
Also Published As
Publication number | Publication date |
---|---|
CN106443744A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106443744B (zh) | Gnss双天线姿态的标定和校准方法 | |
CN109556632B (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
Li et al. | Magnetic sensors for navigation applications: an overview | |
CN1928567B (zh) | 速度检测、位置检测和导航*** | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航***对准方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
TR201801964A2 (zh) | ||
WO2014186636A1 (en) | Automatic compass calibration system and corresponding method | |
CN110672131B (zh) | 一种大失准角下惯性/偏振光组合导航***ukf对准方法 | |
JP6470314B2 (ja) | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN110672130B (zh) | 一种大失准角下惯性/偏振光组合导航***ekf对准方法 | |
CN103017755A (zh) | 一种水下导航姿态测量方法 | |
CN103954303B (zh) | 一种用于磁力计导航***航向角动态计算及校正方法 | |
Wang et al. | Analysis and verification of rotation modulation effects on inertial navigation system based on MEMS sensors | |
CN105300404A (zh) | 一种舰船基准惯性导航***标校方法 | |
CN104776847B (zh) | 一种适用于水下导航***单点估计陀螺漂移的方法 | |
CN103941274A (zh) | 一种导航方法及导航终端 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合***进行航向校正的方法 | |
CN108151765B (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
Zhang et al. | A multi-position calibration algorithm for inertial measurement units | |
Wang et al. | Land vehicle navigation using odometry/INS/vision integrated system | |
CN112747770B (zh) | 一种基于速度量测的载体机动中初始对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |