CN112050807B - 一种基于时间同步补偿的sins_gnss组合导航方法 - Google Patents
一种基于时间同步补偿的sins_gnss组合导航方法 Download PDFInfo
- Publication number
- CN112050807B CN112050807B CN202010766041.7A CN202010766041A CN112050807B CN 112050807 B CN112050807 B CN 112050807B CN 202010766041 A CN202010766041 A CN 202010766041A CN 112050807 B CN112050807 B CN 112050807B
- Authority
- CN
- China
- Prior art keywords
- speed
- position information
- inertial navigation
- compensation
- 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
- 238000000034 method Methods 0.000 title claims abstract description 10
- 238000001914 filtration Methods 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims abstract description 9
- 238000006243 chemical reaction Methods 0.000 claims abstract description 8
- 238000005259 measurement Methods 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000001360 synchronised effect Effects 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000000872 buffer Substances 0.000 description 1
- 239000007853 buffer solution Substances 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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/393—Trajectory determination or predictive tracking, e.g. Kalman filtering
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于时间同步补偿的SINS_GNSS组合导航方法,在接收到有效秒脉冲信号的中断内,导航计算机读取惯性测量单元数据进行纯惯性解算得到惯导速度和位置信息,并缓存解算前的惯导速度和位置信息;确定秒脉冲信号接收时刻,计算所述秒脉冲信号接收时刻的惯导速度和位置信息并缓存,同时缓存解算后的姿态转换矩阵和角速度;在接收到有效卫星速度和位置信息的中断内,通过杆臂以及缓存的角速度、姿态转换矩阵进行杆臂补偿,得到卫星速度和位置信息;判别是否进行时间同步补偿;若进行补偿,则对同步后的速度和位置信息进行滤波输出,若不补偿,则对同步前的速度和位置信息进行滤波输出。本发明提高了组合导航***的精度。
Description
技术领域
本发明属于惯性导航技术领域,具体涉及一种基于时间同步补偿的SINS_GNSS组合导航方法。
背景技术
捷联惯导***(SINS)由陀螺、加速度计、导航计算机等组成可实现自主导航的***,通过其导航计算机的导航计算,能够提供包括姿态、速度和位置信息,但其误差随时间积累,不能单独长时间工作,需要利用外部传感器的观测信息通过滤波算法来修正补偿SINS***,以抑制其随时间积累的误差。
考虑到全球导航卫星***(GNSS)的便捷性和实用性,SINS_GNSS组合导航***是一种利用GNSS长期定位精度高及SINS短期定位定向精度高实现优势互补的组合导航***。通常采用卡尔曼滤波去估计惯性导航***的各误差状态,再用误差状态估值来校正***,通常需要对导航解算出的姿态、速度、位置误差进行反馈校正,可以在长时间内提供高精度的导航数据。
在实际运行中SINS和GNSS有不同的数据更新率,组合导航中需要考虑到时间同步问题,而大机动环境和杆臂效应的存在会影响时间同步。所以在组合导航中,需要综合考虑大机动环境和杆臂效应的影响来补偿时间同步,最终提高组合导航的精度。
发明内容
有鉴于此,本发明提供了一种基于时间同步补偿的SINS_GNSS组合导航方法,提高了组合导航***的精度。
本发明采取的技术方案如下:
一种基于时间同步补偿的SINS_GNSS组合导航方法,所述方法步骤如下:
步骤一,在接收到有效秒脉冲信号的中断内,导航计算机读取惯性测量单元数据进行纯惯性解算得到惯导速度和位置信息,并缓存解算前的惯导速度和位置信息;确定所述秒脉冲信号接收时刻,根据解算得到的惯导速度和位置信息以及解算前的惯导速度和位置信息计算所述秒脉冲信号接收时刻的惯导速度和位置信息并缓存,同时缓存解算后的姿态转换矩阵和角速度;
步骤二,在接收到有效卫星速度和位置信息的中断内,通过惯导与卫星之间的杆臂以及步骤一缓存的角速度、姿态转换矩阵进行杆臂补偿,得到卫星速度和位置信息;
步骤三,若有效秒脉冲信号接收时刻与有效卫星速度和位置信息接收时刻的时间差不大于卫星信号的更新时间,且惯导在这两个时刻的速度差值和位置差值均不大于设定上限时,则利用惯导在这两个时刻的速度差值和位置差值与步骤二中的卫星速度和位置相加即可得到同步后的速度和位置信息;否则不进行时间同步补偿;
步骤四,若进行时间同步补偿,则对同步后的速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置;若未进行时间同步补偿,则对步骤二中的卫星速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置。
进一步地,所述秒脉冲信号接收时刻采用数字信号处理定时器测量,即有效秒脉冲信号接收时刻与中断开始的间隔时间。
有益效果:
本发明考虑大机动环境、杆臂效应和时间不同步问题,在几乎不占用DSP资源的情况下,得到了准确的量测信息进行卡尔曼滤波,最终提高了组合导航***的精度。
附图说明
图1为本发明的算法流程图;
图2为中断示意图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
本发明提供了一种基于时间同步补偿的SINS_GNSS组合导航方法,如图1所示,步骤如下:
步骤一,在接收到有效秒脉冲(PPS)信号的中断内,导航计算机读取惯性测量单元IMU数据进行纯惯性解算得到惯导速度和位置信息,并缓存解算前的惯导速度和位置信息。通过数字信号处理(DSP)定时器测量PPS信号落在中断内的位置,如图2所示,即有效PPS信号接收时刻与中断开始的间隔时间,采用线性插值法根据解算得到的惯导速度和位置信息以及解算前的惯导速度和位置信息计算PPS信号接收时刻的速度和位置信息并缓存,同时缓存解算后的姿态转换矩阵和角速度。
式中,v1和P1为PPS信号接收时刻SINS的速度和位置,vPre和PPre为缓存的解算前SINS的速度和位置,vPost和PPost为纯惯性解算后SINS的速度和位置,Tpps为采用DSP定时器测量的PPS信号接收时刻与中断开始的间隔时间,其中定时器采用脉冲计数,dt为中断周期。
步骤二,在接收到有效GNSS速度和位置信息的中断内,首先通过测量的杆臂以及步骤一中缓存的角速度、缓存的姿态转换矩阵进行杆臂补偿,得到GNSS的速度和位置信息,此为PPS信号接收时刻考虑各因素后的准确信息。
其中GNSS速度为:
有考虑到在实际应用中/>的影响很小,上式可以简化为
GNSS位置为:
其中,为GNSS杆臂补偿后的速度,/>为GNSS杆臂补偿前的速度,/>为缓存的姿态转换矩阵,/>为载体系相对地球坐标系在载体系投影的角速度,/>为地球自转角速度在载体系的投影,/>为缓存的角速度,δlb为测量的杆臂,具体为GNSS中心相对于IMU在载体坐标系中的位置,δln为杆臂在地理系的投影,δlE、δlN和δlU分别为杆臂的东向、北向和天向投影分量,RMh、RNh分别为由GNSS位置计算的子午圈主曲率半径和卯酉圈主曲率半径。L′GNSS为GNSS补偿后的纬度,L″GNSS为GNSS补偿前的纬度,λ′GNSS为GNSS补偿后的经度,λ″GNSS为GNSS补偿前的经度,h′GNSS为GNSS补偿后的高度,h″GNSS为GNSS补偿前的高度。
步骤三,接下来补偿时间不同步,利用SINS短期精度高的性质,在接收到GNSS速度和位置信息的中断内,导航计算机读取IMU数据进行纯惯性解算得到速度和位置信息,与PPS信号接收时刻的速度和位置信息分别作差,该差值等价于GNSS从PPS信号接收时刻到中断完成时刻的增量,与接收到的GNSS速度和位置信息(即步骤二杆臂补偿后的GNSS速度和位置信息)相加即可得到与SINS相匹配的量测信息。
其中,v1和P1为PPS信号接收时刻SINS的速度和位置,v2和P2为在GNSS速度和位置信息接收时刻SINS解算出的速度和位置。
但在时间同步补偿之前,需要进行判断,以确定是否需要进行时间同步补偿:
1)考虑到GNSS信息或者PPS信号会出现无效的情况,实际中计算有效PPS信号接收时刻与有效GNSS速度和位置信息接收时刻二者的时间差,该时间差应不大于GNSS信号的更新时间,否则不进行时间同步补偿。
2)考虑到GNSS无效一段时间后重新有效,这段时间内SINS不满足短期精度高的性质,故不应补偿时间同步。一般情况下,接收PPS信号与GNSS速度和位置信息的时间差在一定范围内波动,根据实际运动情况,对SINS在这两个时刻的速度差值和位置差值设定上限,当差值均大于该设定上限时不进行时间同步补偿。
步骤四,若进行时间同步补偿,则对同步后的速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置;若未进行时间同步补偿,则对步骤二中的卫星速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种基于时间同步补偿的SINS_GNSS组合导航方法,其特征在于,所述方法步骤如下:
步骤一,在接收到有效秒脉冲信号的中断内,导航计算机读取惯性测量单元数据进行纯惯性解算得到惯导速度和位置信息,并缓存解算前的惯导速度和位置信息;确定所述秒脉冲信号接收时刻,根据解算得到的惯导速度和位置信息以及解算前的惯导速度和位置信息计算所述秒脉冲信号接收时刻的惯导速度和位置信息并缓存,同时缓存解算后的姿态转换矩阵和角速度;
步骤二,在接收到有效卫星速度和位置信息的中断内,通过惯导与卫星之间的杆臂以及步骤一缓存的角速度、姿态转换矩阵进行杆臂补偿,得到卫星速度和位置信息;
步骤三,若有效秒脉冲信号接收时刻与有效卫星速度和位置信息接收时刻的时间差不大于卫星信号的更新时间,且惯导在这两个时刻的速度差值和位置差值均不大于设定上限时,则利用惯导在这两个时刻的速度差值和位置差值与步骤二中的卫星速度和位置相加即可得到同步后的速度和位置信息;否则不进行时间同步补偿;
步骤四,若进行时间同步补偿,则对同步后的速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置;若未进行时间同步补偿,则对步骤二中的卫星速度和位置信息进行卡尔曼滤波输出惯导的姿态、速度和位置。
2.如权利要求1所述的基于时间同步补偿的SINS_GNSS组合导航方法,其特征在于,所述秒脉冲信号接收时刻采用数字信号处理定时器测量,即有效秒脉冲信号接收时刻与中断开始的间隔时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010766041.7A CN112050807B (zh) | 2020-08-03 | 2020-08-03 | 一种基于时间同步补偿的sins_gnss组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010766041.7A CN112050807B (zh) | 2020-08-03 | 2020-08-03 | 一种基于时间同步补偿的sins_gnss组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112050807A CN112050807A (zh) | 2020-12-08 |
CN112050807B true CN112050807B (zh) | 2023-08-18 |
Family
ID=73602532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010766041.7A Active CN112050807B (zh) | 2020-08-03 | 2020-08-03 | 一种基于时间同步补偿的sins_gnss组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112050807B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112325875A (zh) * | 2020-10-11 | 2021-02-05 | 中国运载火箭技术研究院 | 容错处理方法及装置、存储介质、电子装置 |
CN114295122B (zh) * | 2021-12-02 | 2024-06-11 | 河北汉光重工有限责任公司 | 用于嵌入式***的sins_gnss时间同步方法及*** |
CN115164873B (zh) * | 2022-09-07 | 2022-12-09 | 中国人民解放军国防科技大学 | 一种x射线脉冲星导航的脉冲星信号处理误差修正方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103743395A (zh) * | 2014-01-17 | 2014-04-23 | 哈尔滨工程大学 | 一种惯性重力匹配组合导航***中时间延迟的补偿方法 |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN106950586A (zh) * | 2017-01-22 | 2017-07-14 | 无锡卡尔曼导航技术有限公司 | 用于农机作业的gnss/ins/车辆组合导航方法 |
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
CN107643534A (zh) * | 2017-09-11 | 2018-01-30 | 东南大学 | 一种基于gnss/ins深组合导航的双速率卡尔曼滤波方法 |
CN110174899A (zh) * | 2019-04-12 | 2019-08-27 | 北京控制工程研究所 | 一种基于敏捷卫星的高精度成像姿态指向控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6697736B2 (en) * | 2002-02-06 | 2004-02-24 | American Gnc Corporation | Positioning and navigation method and system thereof |
US8013789B2 (en) * | 2004-10-06 | 2011-09-06 | Ohio University | Systems and methods for acquisition and tracking of low CNR GPS signals |
US7579984B2 (en) * | 2005-11-23 | 2009-08-25 | The Boeing Company | Ultra-tightly coupled GPS and inertial navigation system for agile platforms |
-
2020
- 2020-08-03 CN CN202010766041.7A patent/CN112050807B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103743395A (zh) * | 2014-01-17 | 2014-04-23 | 哈尔滨工程大学 | 一种惯性重力匹配组合导航***中时间延迟的补偿方法 |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN106950586A (zh) * | 2017-01-22 | 2017-07-14 | 无锡卡尔曼导航技术有限公司 | 用于农机作业的gnss/ins/车辆组合导航方法 |
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
CN107643534A (zh) * | 2017-09-11 | 2018-01-30 | 东南大学 | 一种基于gnss/ins深组合导航的双速率卡尔曼滤波方法 |
CN110174899A (zh) * | 2019-04-12 | 2019-08-27 | 北京控制工程研究所 | 一种基于敏捷卫星的高精度成像姿态指向控制方法 |
Non-Patent Citations (1)
Title |
---|
捷联惯导在线标定的时间延迟补偿方法影响分析;王志伟等;《火力与指挥控制》;第第39卷卷(第第9期期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112050807A (zh) | 2020-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112050807B (zh) | 一种基于时间同步补偿的sins_gnss组合导航方法 | |
CN108535755B (zh) | 基于mems的gnss/imu车载实时组合导航方法 | |
CN110031882B (zh) | 一种基于sins/dvl组合导航***的外量测信息补偿方法 | |
CN112378400A (zh) | 一种双天线gnss辅助的捷联惯导组合导航方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
US8412456B2 (en) | Loosely-coupled integration of global navigation satellite system and inertial navigation system: speed scale-factor and heading bias calibration | |
CN110631574B (zh) | 一种惯性/里程计/rtk多信息融合方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN108594283B (zh) | Gnss/mems惯性组合导航***的自由安装方法 | |
CN109471146B (zh) | 一种基于ls-svm的自适应容错gps/ins组合导航方法 | |
CN111156994A (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN111006675B (zh) | 基于高精度重力模型的车载激光惯导***自标定方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN104776847B (zh) | 一种适用于水下导航***单点估计陀螺漂移的方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN114894181A (zh) | 一种实时自主组合导航定位方法及装置 | |
US8566055B1 (en) | Gyro indexing compensation method and system | |
CN113551669A (zh) | 基于短基线的组合导航定位方法及装置 | |
CN116678406B (zh) | 组合导航姿态信息确定方法、装置、终端设备及存储介质 | |
CN110514201B (zh) | 一种惯性导航***及适用于高转速旋转体的导航方法 | |
CN114264304B (zh) | 复杂动态环境高精度水平姿态测量方法与*** | |
CN112229401B (zh) | 适用于ins-gps伪距融合的量测信息同步外推方法及*** | |
CN115542363A (zh) | 一种适用于垂直下视航空吊舱的姿态测量方法 | |
CN114279443B (zh) | 一种基于最大熵自适应抗差估计的usbl斜距修正方法 | |
CN112083465A (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 |