CN106707322B - 基于rtk/sins的高动态定位定姿系统及方法 - Google Patents

基于rtk/sins的高动态定位定姿系统及方法 Download PDF

Info

Publication number
CN106707322B
CN106707322B CN201611254796.9A CN201611254796A CN106707322B CN 106707322 B CN106707322 B CN 106707322B CN 201611254796 A CN201611254796 A CN 201611254796A CN 106707322 B CN106707322 B CN 106707322B
Authority
CN
China
Prior art keywords
mrow
msub
gnss
sins
rtk
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
CN201611254796.9A
Other languages
English (en)
Other versions
CN106707322A (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.)
LEADOR SPATIAL INFORMATION TECHNOLOGY Co Ltd
Original Assignee
LEADOR SPATIAL INFORMATION TECHNOLOGY Co Ltd
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 LEADOR SPATIAL INFORMATION TECHNOLOGY Co Ltd filed Critical LEADOR SPATIAL INFORMATION TECHNOLOGY Co Ltd
Priority to CN201611254796.9A priority Critical patent/CN106707322B/zh
Publication of CN106707322A publication Critical patent/CN106707322A/zh
Application granted granted Critical
Publication of CN106707322B publication Critical patent/CN106707322B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • 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

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)

Abstract

本发明公开了一种基于RTK/SINS的高动态定位定姿系统及方法，设置GNSS模块、SINS模块和RTK通信模块，在系统上电启动后，进行GNSS模块初始化，GNSS模块辅助SINS完成初始化；GNSS模块计算基站视线方向的数据链传输多普勒频移，并送入RTK通信模块进行跟踪辅助；RTK通信模块接收基站播发的差分数据，传递给GNSS模块；GNSS获取卡尔曼滤波的观测量，SINS模块获取卡尔曼滤波的预测量；将SINS的预测量与GNSS的观测量进行卡尔曼滤波，输出组合导航结果；计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，持续迭代直至导航结束。

Description

基于RTK/SINS的高动态定位定姿系统及方法
技术领域
本发明涉及导航领域，特别是涉及一种适用于高动态场景下的高精度定位定姿导航系统及方法。
背景技术
导航技术多年来一直受到各个国家的重视且发展迅速，并取得了一定的成果，但在加速度达到20g～100g的高动态下的导航一直是一大难题。除了民用领域的具体市场价值，现代战争中，技术对抗巳经成为了关键，导弹、战斗机等高动态载体对现代导航技术的可靠性、抗干扰能力等都提出了新的要求。
对于高动态条件中的载体，如何更好地解决其导航定位一直是一大难题，因其对现代国防军事等的重要作用而一直被众多专家学者所关注。高动态环境下载体的精确导航，首先对于GNSS(Global Navigation Satellite System,全球卫星导航系统)而言，卫星和运动载体间的相对运动会引发多普勒频移与多普勒频移率，直接导致跟踪环路失锁。而增大带宽跟踪高动态信号的做法则会引入更大的噪声。对于惯性导航，高动态环境对其初始对准等技术提出了更高的要求，且定位误差会变大。鉴于单纯对SINS(StrapdownInertial Navigation System,捷联惯性导航系统)的提升一般主要依靠提升硬件，其性价比不高及提升有限等原因，目前针对高动态导航，主要研究的方向在于高动态组合导航技术。GNSS/SINS超紧耦合正是一种新型的组合导航技术，能够全面提升导航系统的各项性能，尤其在高动态等恶劣条件下表现尤为明显。
当前对于深耦合或超紧耦合导航技术的研究已取得一些进展，《一种GNSS/INS深耦合系统环路辅助切换方法》(申请号：201510697375.2)提出了一种INS出现故障时，对深耦合系统的环路辅助状态进行切换的方法，避免了INS故障造成的系统精度发散，提升了系统的鲁棒性。《基于UKF滤波的BDS与GIS深耦合定位方法和系统》(申请号：201310733134.X)提出了一种基于UKF(Unscented Kalman Filter，无迹卡尔曼滤波)的定位方法，采用地理信息系统技术，对定位系统的修正来源于精确的GIS模型，解决了定位误差随时间推移而增大的技术问题。这些技术解决了组合导航系统的鲁棒性和精度问题，但其应用场景并未在高动态之下，GNSS定位方式也基本采用单点定位的方式，而组合导航若有高精度的需求，RTK(Real Time Kinematic，载波相位差分技术)技术是非常有必要的。但是在高动态环境下，RTK通信数据链通常也存在巨大的多普勒频移，难以维持数据链的正常通信，因此现有技术通常难以兼顾高精度和高动态的需求。
发明内容
为了解决上述的技术问题，本发明提供一种基于RTK/SINS的高动态定位定姿技术方案。
本发明所采用的技术方案提供一种基于RTK/SINS的高动态定位定姿系统，包括GNSS模块、SINS模块和RTK通信模块，GNSS模块和SINS模块之间建立了通信连接，GNSS模块和RTK通信模块之间建立了通信连接；系统执行以下步骤，
步骤一，系统上电启动；
步骤二，GNSS模块初始化，期间GNSS跟踪环路使用初始带宽进行卫星信号跟踪，初始带宽包括载波环带宽T1和码环带宽T2；
步骤三，GNSS模块完成初始化后，获得载体位置速度信息，并将相关信息传递给SINS模块，辅助SINS完成初始化；
步骤四，由GNSS模块提供载体位置速度，计算基站视线方向的数据链传输多普勒频移，并送入RTK通信模块进行跟踪辅助；
步骤五，RTK通信模块接收基站播发的差分数据，传递给GNSS模块，GNSS模块进行实时RTK解算，将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量；
步骤六，GNSS模块通过卫星星历计算，向SINS模块提供当前卫星位置/速度，同时SINS模块根据自身递推的位置和速度，计算得到卫星伪距和多普勒频移，作为卡尔曼滤波的预测量；
步骤七，将SINS的预测量与GNSS的观测量送入卡尔曼滤波器，进行卡尔曼滤波；
步骤八，利用卡尔曼滤波结果对GNSS误差与SINS误差进行校正，输出组合导航结果，并修正SINS的加速度计与陀螺仪；
步骤九，利用校正后的SINS位置速度，以及GNSS提供的卫星位置速度，计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，GNSS接收机开始使用工作带宽进行卫星信号跟踪，工作带宽包括载波环带宽t1和码环带宽t2，t1小于T1，t2小于T2；
步骤十，重复步骤四至九，直至导航结束。
而且，步骤四中，基站视线方向的数据链传输多普勒频移fRTK计算方法为，
其中，Pxgnss、Pygnss、Pzgnss为地球坐标系下的GNSS坐标，Vxgnss、Vygnss、Vzgnss为GNSS速度，Pxbase、Pybase、Pzbase为基站坐标，λRTK为RTK通信数据链载波波长。
而且，步骤六中，
卫星伪距预测量计算公式为，
卫星载波多普勒频移预测量计算公式为，
其中，Pxins、Pyins、Pzins为地球坐标系下的SINS坐标，Vxins、Vyins、Vzins为SINS速度，Pxsat、Pysat、Pzsat为卫星坐标，Vxsat、Vysat、Vzsat为卫星速度，λsat为卫星载波波长。
而且，步骤九中，采用卫星载波多普勒频移预测量计算公式计算出新的被校正后的载波多普勒频移。
而且，t1为T1的1/100～1/10，t2为T2的1/100～1/10。
本发明还相应提供一种基于RTK/SINS的高动态定位定姿方法，设置GNSS模块、SINS模块和RTK通信模块，GNSS模块和SINS模块之间建立通信连接，GNSS模块和RTK通信模块之间建立通信连接；执行以下步骤，
步骤一，系统上电启动；
步骤二，GNSS模块初始化，期间GNSS跟踪环路使用初始带宽进行卫星信号跟踪，初始带宽包括载波环带宽T1和码环带宽T2；
步骤三，GNSS模块完成初始化后，获得载体位置速度信息，并将相关信息传递给SINS模块，辅助SINS完成初始化；
步骤四，由GNSS模块提供载体位置速度，计算基站视线方向的数据链传输多普勒频移，并送入RTK通信模块进行跟踪辅助；
步骤五，RTK通信模块接收基站播发的差分数据，传递给GNSS模块，GNSS模块进行实时RTK解算，将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量；
步骤六，GNSS模块通过卫星星历计算，向SINS模块提供当前卫星位置/速度，同时SINS模块根据自身递推的位置和速度，计算得到卫星伪距和多普勒频移，作为卡尔曼滤波的预测量；
步骤七，将SINS的预测量与GNSS的观测量送入卡尔曼滤波器，进行卡尔曼滤波；
步骤八，利用卡尔曼滤波结果对GNSS误差与SINS误差进行校正，输出组合导航结果，并修正SINS的加速度计与陀螺仪；
步骤九，利用校正后的SINS位置速度，以及GNSS提供的卫星位置速度，计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，GNSS接收机开始使用工作带宽进行卫星信号跟踪，工作带宽包括载波环带宽t1和码环带宽t2，t1小于T1，t2小于T2；
步骤十，重复步骤四至九，直至导航结束。
而且，步骤四中，基站视线方向的数据链传输多普勒频移fRTK计算方法为，
其中，Pxgnss、Pygnss、Pzgnss为地球坐标系下的GNSS坐标，Vxgnss、Vygnss、Vzgnss为GNSS速度，Pxbase、Pybase、Pzbase为基站坐标，λRTK为RTK通信数据链载波波长。
而且，步骤六中，
卫星伪距预测量计算公式为，
卫星载波多普勒频移预测量计算公式为，
其中，Pxins、Pyins、Pzins为地球坐标系下的SINS坐标，Vxins、Vyins、Vzins为SINS速度，Pxsat、Pysat、Pzsat为卫星坐标，Vxsat、Vysat、Vzsat为卫星速度，λsat为卫星载波波长。
而且，步骤九中，采用卫星载波多普勒频移预测量计算公式计算出新的被校正后的载波多普勒频移。
而且，t1为T1的1/100～1/10，t2为T2的1/100～1/10。
本发明相较于现有的组合导航技术，引入了RTK技术，一方面通过基站视线方向的载波多普勒频移辅助，获得高精度的GNSS RTK数据；一方面通过卫星视线方向的载波多普勒频移辅助，减小GNSS跟踪环路带宽提升了跟踪精度，两种辅助方式均有效提升了高动态下的定位定姿精度。
因此，本发明相较于现有技术具有以下优点：
(1)加入了RTK通信多普勒辅助
在几十至数百g的加速度应力下，现有的大部分无线通信模块都会失锁，因此现有高动态下的组合导航系统多为单点定位，而本系统由GNSS为RTK通信模块提供数据链的多普勒频移辅助，可在高动态应力下仍能稳定接收基站差分信息，从而获得高精度的载波相位信息，为高精度的组合解算提供数据基础。
(2)加入了卫星载波多普勒辅助
SINS提供的卫星多普勒频移辅助GNSS跟踪环路，可以减小环路跟踪载体高动态所需的大带宽，保证以小带宽捕获并锁定GNSS卫星信号，从而减小由载体动态所引起的跟踪误差，带宽的缩小还可以进一步减小弱噪声引起的跟踪误差，提高GNSS的跟踪精度。
通常情况下未进行多普勒辅助的定位定姿系统难以在高于20g的高动态环境下正常工作，而且因为未进行RTK解算，单点定位精度通常也在10m～30m左右。而在上述两种技术的辅助下，本发明中的定位定姿系统能够同时兼顾高动态与高精度的需求，可在20g～100g的加速度场景下正常工作，且定位精度可达分米级，具有重要的市场价值。
附图说明
图1为本发明实施例的系统构架图；
图2为本发明实施例的流程图。
具体实施方式
以下结合附图和实施例对本发明技术方案进行具体描述。
本发明提出了一种基于RTK/SINS的高动态定位定姿系统，其结构如图1所示，主要包括：GNSS模块1、SINS模块2和RTK通信模块3。GNSS模块和SINS模块之间建立了通信连接，GNSS模块和RTK通信模块之间建立了通信连接。其中GNSS模块进行卫星导航解算，并向SINS模块提供初始化数据与卫星星历数据，向RKT通信模块提供数据链多普勒辅助；SINS模块进行惯性导航解算，并向GNSS模块的跟踪环路提供多普勒辅助；RTK通信模块进行与基站的数据链通信，并向GNSS模块提供差分数据供RTK解算。
本发明通过在GNSS/SINS超紧耦合系统中加入RTK通信模块并加以多普勒辅助，在高动态条件下维持稳定的RTK数据链通信，并将组合方式升级为RTK/SINS超紧耦合，同时兼顾了高动态和高精度的需求。本发明将GNSS/SINS的导航结果与已知坐标基站进行视线向量计算，估算出通信模块的多普勒频移，并送入通信模块的跟踪环路进行辅助，保证RTK通信模块在高动态下稳定跟踪，为GNSS/SINS组合结算提供高精度的数据基础。同时，GNSS板卡将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量，将SINS计算出的卫星伪距与伪距率作为卡尔曼滤波的预估量，进行卡尔曼滤波，利用滤波结果对SINS与GNSS进行误差校正，输出校正后的定位定姿结果，并将校正后的卫星载波多普勒频移量送入GNSS跟踪环路进行辅助，GNSS转而使用更小的带宽进行跟踪以获得更精确的跟踪结果。
本发明实施例的工作流程如图2所示，实施例中GNSS模块简称GNSS，SINS模块简称SINS，其主要步骤包括：
步骤一：系统上电启动。
步骤二：GNSS初始化，期间GNSS跟踪环路使用初始的大带宽进行卫星信号跟踪，其中载波环带宽T1范围约50～1000Hz，码环带宽T2范围约0.5～10Hz；实施例中期间GNSS载波环带宽为250Hz，码环带宽范围为5Hz。
步骤三：GNSS完成初始化后，获得载体位置速度信息，并将位置速度航向时间等信息传递给SINS，辅助SINS完成初始化。具体SINS初始化为现有技术，本发明不予赘述。
步骤四：由GNSS提供载体位置速度，计算基站视线方向的数据链传输多普勒频移，并将其送入RTK通信模块进行跟踪辅助，保障通信模块在高动态下不会失锁。
实施例中，由GNSS提供载体位置坐标为[Pxgnss,Pygnss,Pzgnss]，速度为[Vxgnss,Vygnss,Vzgnss]，已知基站坐标为[Pxbase,Pybase,Pzbase]，已知RTK通信数据链载波波长为λRTK，计算基站视线方向的数据链传输多普勒频移，并将其送入RTK通信模块的跟踪环路进行辅助；
基站视线方向的数据链传输多普勒频移fRTK计算方法为：
其中：Pxgnss、Pygnss、Pzgnss为地球坐标系下的GNSS坐标，Vxgnss、Vygnss、Vzgnss为GNSS速度，Pxbase、Pybase、Pzbase为基站坐标，λRTK为RTK通信数据链载波波长。
具体实施时，辅助方法为在RTK通信模块的跟踪环路中，在锁相环(或锁频环)的环路滤波器之后、晶体振荡器频率字变更前，将环路滤波器结果加入上述多普勒频移数值，即完成辅助跟踪。
步骤五：RTK通信模块接收基站播发的差分数据，传递给GNSS，后者进行实时RTK解算，得到精确的卫星载波相位/多普勒频移，即将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量。
步骤六：GNSS通过卫星星历计算，向SINS提供当前卫星位置/速度，同时SINS根据自身递推的位置/速度，计算得到卫星伪距/多普勒频移，即将SINS计算出的卫星伪距与伪距率作为卡尔曼滤波的预测量。
实施例中，GNSS通过卫星星历计算，向SINS提供当前卫星位置坐标为[Pxsat,Pysat,Pzsat]，速度为[Vxsat,Vysat,Vzsat]，同时SINS由惯性递推得到其位置坐标为[Pxins,Pyins,Pzins]，速度为[Vxins,Vyins,Vzins]，再由已知的卫星载波波长λsat计算得到卫星伪距/多普勒频移，即预测量；
卫星伪距预测量计算公式为：
卫星载波多普勒频移预测量计算公式为：
其中：Pxins、Pyins、Pzins为地球坐标系下的SINS坐标，Vxins、Vyins、Vzins为SINS速度，Pxsat、Pysat、Pzsat为卫星坐标，Vxsat、Vysat、Vzsat为卫星速度，λsat为卫星载波波长。
步骤七：将SINS的预测量与GNSS的观测量送入卡尔曼滤波器，进行卡尔曼滤波，卡尔曼滤波结果为GNSS与SINS的误差状态向量，具体包含SINS的位置误差、速度误差与姿态角误差、加速度计误差、陀螺仪误差以及GNSS的时钟误差。卡尔曼滤波器为现有技术，本发明不予赘述。
步骤八：利用卡尔曼滤波结果对GNSS误差与SINS误差进行校正，校正方法为将步骤七输出的误差状态向量中分量同GNSS与SINS的对应状态值进行相加，输出组合导航结果，包含SINS位置、速度与姿态角与GNSS时钟，并修正SINS的加速度计与陀螺仪。
步骤九：利用校正后的SINS位置/速度，以及GNSS提供的卫星位置速度，参考步骤六的方法(即采用步骤六的卫星载波多普勒频移预测量计算公式)，计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，GNSS接收机开始使用小的工作带宽进行卫星信号跟踪，工作带宽包括载波环带宽t1和码环带宽t2，t1小于T1，t2小于T2。建议载波环带宽t1范围约0.5～10Hz，码环带宽t2范围约0.01～0.1Hz。优选地，t1为T1的1/100～1/10，t2为T2的1/100～1/10，例如t1为T1的1/50，t2为T2的1/50。实施例中载波环带宽降至2.5Hz，码环带宽降至0.05Hz，进一步提升跟踪精度。
载波多普勒频移辅助GNSS跟踪环路的方法为：在载波跟踪环的环路滤波器之后、数控振荡器频率字更新之前，将载波环滤波器结果加上载波多普勒频移值；同时，在码跟踪环的环路滤波器之后、数控振荡器频率字更新之前，将载波多普勒频移值除以1540后加入码环滤波器结果。完成多普勒辅助后，通过调整跟踪环路的滤波器参数，可将载波环与码环的带宽降低为原带宽的1/10～1/100，并在后续导航中不再调整。
步骤十：返回步骤四，重复步骤四至九，直至导航结束。重复时保持使用工作带宽，无需调整带宽。
具体实施时，以上流程可采用计算机软件技术实现自动运行。本发明所提供系统及相应方法都应在保护范围内。
应当理解的是，上述针对较佳实施例的描述较为详细，并不能因此而认为是对本发明专利保护范围的限制，本领域的普通技术人员在本发明的启示下，在不脱离本发明权利要求所保护的范围情况下，还可以做出替换或变形，均落入本发明的保护范围之内，本发明的请求保护范围应以所附权利要求为准。

Claims (10)

1.一种基于RTK/SINS的高动态定位定姿系统，其特征在于：包括GNSS模块、SINS模块和RTK通信模块，GNSS模块和SINS模块之间建立了通信连接，GNSS模块和RTK通信模块之间建立了通信连接；系统执行以下步骤，
步骤一，系统上电启动；
步骤二，GNSS模块初始化，期间GNSS跟踪环路使用初始带宽进行卫星信号跟踪，初始带宽包括载波环带宽T1和码环带宽T2；
步骤三，GNSS模块完成初始化后，获得载体位置速度信息，并将相关信息传递给SINS模块，辅助SINS完成初始化；
步骤四，由GNSS模块提供载体位置速度，计算基站视线方向的数据链传输多普勒频移，并送入RTK通信模块进行跟踪辅助；
步骤五，RTK通信模块接收基站播发的差分数据，传递给GNSS模块，GNSS模块进行实时RTK解算，将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量；
步骤六，GNSS模块通过卫星星历计算，向SINS模块提供当前卫星位置/速度，同时SINS模块根据自身递推的位置和速度，计算得到卫星伪距和多普勒频移，作为卡尔曼滤波的预测量；
步骤七，将SINS的预测量与GNSS的观测量送入卡尔曼滤波器，进行卡尔曼滤波；
步骤八，利用卡尔曼滤波结果对GNSS误差与SINS误差进行校正，输出组合导航结果，并修正SINS的加速度计与陀螺仪；
步骤九，利用校正后的SINS位置速度，以及GNSS提供的卫星位置速度，计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，GNSS接收机开始使用工作带宽进行卫星信号跟踪，工作带宽包括载波环带宽t1和码环带宽t2，t1小于T1，t2小于T2；
步骤十，重复步骤四至九，直至导航结束。
2.根据权利要求1所述基于RTK/SINS的高动态定位定姿系统，其特征在于：步骤四中，基站视线方向的数据链传输多普勒频移fRTK计算方法为，
<mrow> <msub> <mi>f</mi> <mrow> <mi>R</mi> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>Px</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>Vx</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>Py</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>Vy</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>Pz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>Vz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>R</mi> <mi>T</mi> <mi>K</mi> </mrow> </msub> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Px</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Py</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Pz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> </mfrac> </mrow>
其中，Pxgnss、Pygnss、Pzgnss为地球坐标系下的GNSS坐标，Vxgnss、Vygnss、Vzgnss为GNSS速度，Pxbase、Pybase、Pzbase为基站坐标，λRTK为RTK通信数据链载波波长。
3.根据权利要求1所述基于RTK/SINS的高动态定位定姿系统，其特征在于：步骤六中，卫星伪距预测量计算公式为，
<mrow> <msub> <mi>S</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Ry</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow>
卫星载波多普勒频移预测量计算公式为，
<mrow> <msub> <mi>f</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>Vx</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vx</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>Py</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>Vy</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vy</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>Vz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Py</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> </mfrac> </mrow>
其中，Pxins、Pyins、Pzins为地球坐标系下的SINS坐标，Vxins、Vyins、Vzins为SINS速度，Pxsat、Pysat、Pzsat为卫星坐标，Vxsat、Vysat、Vzsat为卫星速度，λsat为卫星载波波长。
4.根据权利要求3所述基于RTK/SINS的高动态定位定姿系统，其特征在于：步骤九中，采用卫星载波多普勒频移预测量计算公式计算出新的被校正后的载波多普勒频移。
5.根据权利要求1或2或3所述基于RTK/SINS的高动态定位定姿系统，其特征在于：t1为T1的1/10，t2为T2的1/10。
6.一种基于RTK/SINS的高动态定位定姿方法，其特征在于：设置GNSS模块、SINS模块和RTK通信模块，GNSS模块和SINS模块之间建立通信连接，GNSS模块和RTK通信模块之间建立通信连接；执行以下步骤，
步骤一，系统上电启动；
步骤二，GNSS模块初始化，期间GNSS跟踪环路使用初始带宽进行卫星信号跟踪，初始带宽包括载波环带宽T1和码环带宽T2；
步骤三，GNSS模块完成初始化后，获得载体位置速度信息，并将相关信息传递给SINS模块，辅助SINS完成初始化；
步骤四，由GNSS模块提供载体位置速度，计算基站视线方向的数据链传输多普勒频移，并送入RTK通信模块进行跟踪辅助；
步骤五，RTK通信模块接收基站播发的差分数据，传递给GNSS模块，GNSS模块进行实时RTK解算，将RTK解算后的卫星载波相位与多普勒频移作为卡尔曼滤波的观测量；
步骤六，GNSS模块通过卫星星历计算，向SINS模块提供当前卫星位置/速度，同时SINS模块根据自身递推的位置和速度，计算得到卫星伪距和多普勒频移，作为卡尔曼滤波的预测量；
步骤七，将SINS的预测量与GNSS的观测量送入卡尔曼滤波器，进行卡尔曼滤波；
步骤八，利用卡尔曼滤波结果对GNSS误差与SINS误差进行校正，输出组合导航结果，并修正SINS的加速度计与陀螺仪；
步骤九，利用校正后的SINS位置速度，以及GNSS提供的卫星位置速度，计算出新的被校正后的载波多普勒频移，并送入GNSS跟踪环路进行辅助，GNSS接收机开始使用工作带宽进行卫星信号跟踪，工作带宽包括载波环带宽t1和码环带宽t2，t1小于T1，t2小于T2；
步骤十，重复步骤四至九，直至导航结束。
7.根据权利要求6所述基于RTK/SINS的高动态定位定姿方法，其特征在于：步骤四中，基站视线方向的数据链传输多普勒频移fRTK计算方法为，
<mrow> <msub> <mi>f</mi> <mrow> <mi>R</mi> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>Px</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> <msub> <mi>Vx</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>+</mo> <mo>(</mo> <msub> <mi>Py</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> <msub> <mi>Vy</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>+</mo> <mo>(</mo> <msub> <mi>Pz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> <msub> <mi>Vz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>R</mi> <mi>T</mi> <mi>K</mi> </mrow> </msub> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>Px</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Py</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Pz</mi> <mrow> <mi>g</mi> <mi>n</mi> <mi>s</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>b</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> </mfrac> </mrow>
其中，Pxgnss、Pygnss、Pzgnss为地球坐标系下的GNSS坐标，Vxgnss、Vygnss、Vzgnss为GNSS速度，Pxbase、Pybase、Pzbase为基站坐标，λRTK为RTK通信数据链载波波长。
8.根据权利要求6所述基于RTK/SINS的高动态定位定姿方法，其特征在于：步骤六中，卫星伪距预测量计算公式为，
<mrow> <msub> <mi>S</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Py</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow>
卫星载波多普勒频移预测量计算公式为，
<mrow> <msub> <mi>f</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> <mo>(</mo> <msub> <mi>Vx</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vx</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msub> <mi>Py</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> <mo>(</mo> <msub> <mi>Vy</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vy</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> <mo>(</mo> <msub> <mi>Vz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Vz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mrow> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>Px</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Px</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Py</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Py</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Pz</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>s</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Pz</mi> <mrow> <mi>s</mi> <mi>a</mi> <mi>t</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> </mfrac> </mrow> 2
其中，Pxins、Pyins、Pzins为地球坐标系下的SINS坐标，Vxins、Vyins、Vzins为SINS速度，Pxsat、Pysat、Pzsat为卫星坐标，Vxsat、Vysat、Vzsat为卫星速度，λsat为卫星载波波长。
9.根据权利要求8所述基于RTK/SINS的高动态定位定姿方法，其特征在于：步骤九中，采用卫星载波多普勒频移预测量计算公式计算出新的被校正后的载波多普勒频移。
10.根据权利要求6或7或8所述基于RTK/SINS的高动态定位定姿方法，其特征在于：t1为T1的1/100～1/10，t2为T2的1/100～1/10。
CN201611254796.9A 2016-12-30 2016-12-30 基于rtk/sins的高动态定位定姿系统及方法 Active CN106707322B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611254796.9A CN106707322B (zh) 2016-12-30 2016-12-30 基于rtk/sins的高动态定位定姿系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611254796.9A CN106707322B (zh) 2016-12-30 2016-12-30 基于rtk/sins的高动态定位定姿系统及方法

Publications (2)

Publication Number Publication Date
CN106707322A CN106707322A (zh) 2017-05-24
CN106707322B true CN106707322B (zh) 2017-11-28

Family

ID=58904868

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611254796.9A Active CN106707322B (zh) 2016-12-30 2016-12-30 基于rtk/sins的高动态定位定姿系统及方法

Country Status (1)

Country Link
CN (1) CN106707322B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107179084B (zh) * 2017-06-27 2020-08-11 上海航天控制技术研究所 Gnss兼容机伪距与加表组合导航及漂移估计方法
CN107462904A (zh) * 2017-07-28 2017-12-12 东南大学 Gnss和ins融合的高精度gnss终端动态定位检测车及检测方法
CN107817509A (zh) * 2017-09-07 2018-03-20 上海电力学院 基于rtk北斗和激光雷达的巡检机器人导航系统及方法
CN107678046A (zh) * 2017-11-14 2018-02-09 北京东方联星科技有限公司 一种便携式高精度全球卫星导航系统接收机
CN109683185A (zh) * 2019-02-01 2019-04-26 广东海洋大学 基于rtk的导航小车
CN111190208A (zh) * 2020-01-14 2020-05-22 成都纵横融合科技有限公司 一种基于rtk的gnss/ins紧组合导航解算方法
CN114115297B (zh) * 2022-01-24 2022-05-10 成都航天通信设备有限责任公司 基于视线导引法的auv跟踪控制方法及装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7646336B2 (en) * 2006-03-24 2010-01-12 Containertrac, Inc. Automated asset positioning for location and inventory tracking using multiple positioning techniques
US7855678B2 (en) * 2007-05-16 2010-12-21 Trimble Navigation Limited Post-mission high accuracy position and orientation system
CN101666650B (zh) * 2009-09-30 2011-04-06 北京航空航天大学 一种sins/gps超紧致组合导航系统及实现方法
CN102033235B (zh) * 2010-10-15 2012-11-28 东南大学 基于gps/sins城镇地籍图根点快速测量及事后数据处理方法
CN102830408B (zh) * 2012-09-11 2014-05-14 中国人民解放军国防科学技术大学 一种惯性信息辅助的卫星接收机基带信号处理方法
CN103941271B (zh) * 2014-03-11 2016-12-07 哈尔滨工程大学 一种时间-空间差分的gps/sins超紧组合导航方法
CN103995272B (zh) * 2014-06-11 2017-02-15 东南大学 一种惯性辅助gps接收机实现方法

Also Published As

Publication number Publication date
CN106707322A (zh) 2017-05-24

Similar Documents

Publication Publication Date Title
CN106707322B (zh) 基于rtk/sins的高动态定位定姿系统及方法
CN104297773B (zh) 一种高精度北斗三频sins深组合导航系统
CN102819029B (zh) 一种超紧组合卫星导航接收机
CN102636798B (zh) 基于环路状态自检测的sins/gps深组合导航方法
US7994973B2 (en) Moving body positioning device
Godha et al. Integration of DGPS with a low cost MEMS-based inertial measurement unit (IMU) for land vehicle navigation application
CN108535755A (zh) 基于mems的gnss/imu车载实时组合导航方法
CN104931995A (zh) 一种基于矢量跟踪的gnss/sins深组合导航方法
CN109407126A (zh) 一种多模接收机联合定位解算的方法
CN108226985A (zh) 基于精密单点定位的列车组合导航方法
CN108594272A (zh) 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法
CN103487820A (zh) 一种车载捷联/卫星紧组合无缝导航方法
CN103995272A (zh) 一种新型惯性辅助gps接收机实现方法
CN103968836A (zh) 一种基于时序伪距差分推算移动目标位置的方法及装置
CN109375248A (zh) 一种卡尔曼多模融合定位算法模型及其串行更新的方法
CN108897027B (zh) 基于北斗Ka星间链路信号的地面用户导航定位方法
Zou et al. A MEMS-assisted GNSS signal uninterrupted tracking method based on adaptive motion constraints
JP5163511B2 (ja) Ｇｎｓｓ受信装置及び測位方法
CN101581775B (zh) 基于四维ukf的高动态gnss载波的开环补偿跟踪方法
CN106125117A (zh) 一种惯性/卫星超紧组合本地信号控制量生成方法
CN101770018B (zh) 当前位置坐标的计算方法
Kim et al. A deeply coupled GPS/INS integrated Kalman filter design using a linearized correlator output
Yuan et al. Unscented Kalman filtering for ultra-tightly coupled GPS/INS integration
JP2009098099A (ja) 移動体用測位装置
Li et al. Performance analysis of the ultra-Tight GPS/INS integration based on an improved Kalman filter design for tracking loops

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant