CN104459747A - 一种gnss/ins组合导航方法及*** - Google Patents
一种gnss/ins组合导航方法及*** Download PDFInfo
- Publication number
- CN104459747A CN104459747A CN201410806448.2A CN201410806448A CN104459747A CN 104459747 A CN104459747 A CN 104459747A CN 201410806448 A CN201410806448 A CN 201410806448A CN 104459747 A CN104459747 A CN 104459747A
- Authority
- CN
- China
- Prior art keywords
- moment
- value
- ins
- gnss receiver
- gnss
- 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.)
- Pending
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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种GNSS/INS组合导航方法,包括:利用GNSS接收机接收tk时刻导航卫星的导航电文;计算GNSS接收机tk时刻的伪距值和多普勒频移值的测量残余;将tk时刻伪距值和多普勒频移值的测量残余输入卡尔曼滤波器,获得tk时刻GNSS接收机状态修正值ΔXk;计算tk时刻GNSS接收机的最优状态估计值Xk;计算tk时刻INS传感器的状态估计值获得tk时刻INS传感器的状态残余值将tk时刻INS传感器的状态残余值输入卡尔曼滤波器,得到tk时刻INS传感器的状态修正值ΔYk;计算tk时刻INS传感器的最优状态估计值Yk;输出tk时刻目标的状态估计值。
Description
技术领域
本发明涉及卫星导航和惯性导航领域,尤其涉及一种GNSS/INS组合导航方法及***。
背景技术
组合导航技术是指使用两种或两种以上的不同导航***(或设备)对同一目标进行测量,利用不同导航设备性能上的互补特性,从这些测量值的比较值中提取各***的误差并进行校正,以提高整个导航***性能的方法和手段。因此组合导航具有更高的导航性能。
全球卫星导航***(GNSS:Global Navigation Satellite System)具有全天候、不受外界环境干扰的优点,长期定位精度较高,但是短期内定位精度低。惯性导航***(INS:Inertial Navigation System)是一种自主式导航***,可以连续提供多种导航信息,短时间内定位精度较高,然而定位误差随时间积累,长时间定位精度较差。因此将GNSS和INS组合起来构成组合导航***GNSS/INS能够取各子***之长,是一种理想的组合导航***。
目前卡尔曼滤波是实现组合导航的主要方法。它在两个导航***输出信息的基础上,通过滤波算法去估计***的各种误差,再利用误差状态的估值去校正***,达到组合导航的目的。
根据GNSS和INS结合层面的不同分为松组合、紧组合和深耦合。松组合是一种低水平的组合,GNSS和INS仍独立工作,用GNSS辅助INS。紧组合是指GNSS和INS在伪距、载波相位和多普勒频移等测距领域内进行的组合。深耦合是将INS的惯导传感器测量值反馈给GNSS卫星接收机的信号跟踪环路,从而帮助接收机更好地跟踪卫星信号的载波相位(或频率)和码相位的定位方式。
松组合的GNSS/INS***具有结构简单,定位精度不高的特点。
发明内容
本发明的目的在于在相同定位精度的前提下,提出了一种松组合的GNSS/INS导航定位***,此***具有低成本的特点,能够满足对性能指标要求不高的用户需求。
为了实现上述目的,本发明提供了一种GNSS/INS组合导航方法,包括:
步骤1)利用GNSS接收机接收tk时刻导航卫星的导航电文;
步骤2)计算GNSS接收机tk时刻的伪距值和多普勒频移值的测量残余;
步骤3)将tk时刻伪距值和多普勒频移值的测量残余输入卡尔曼滤波器,获得tk时刻GNSS接收机状态修正值ΔXk;
步骤4)计算tk时刻GNSS接收机的最优状态估计值Xk;
步骤5)计算tk时刻INS传感器的状态估计值
步骤6)获得tk时刻INS传感器的状态残余值
步骤7)将tk时刻INS传感器的状态残余值输入卡尔曼滤波器,得到tk时刻INS传感器的状态修正值ΔYk;
步骤8)计算tk时刻INS传感器的最优状态估计值Yk:
步骤9)输出tk时刻目标的状态估计值;
所述tk时刻目标的状态估计值为tk时刻INS传感器的最优状态估计值Yk。
上述技术方案中,所述步骤2)进一步包括:
步骤201)在tk时刻,利用tk-1时刻GNSS接收机的最优状态估计值Xk-1预测tk时刻GNSS接收机的状态预测值
其中,Xk-1=[x1k-1,y1k-1,z1k-1,vx1k-1,vy1k-1,vz1k-1]T表示GNSS接收机tk-1时刻
位置和速度;wk-1为过程噪声;A为状态转移矩阵:
其中,Ts=tk-tk-1,I3×3为3×3阶的单位矩阵;
步骤202)根据导航电文计算tk时刻卫星位置和速度;
步骤203)根据tk时刻GNSS接收机的状态预测值和tk时刻卫星位置和速度,计算GNSS接收机与各颗卫星之间的伪距预测值和预测多普勒频移预测值;
步骤204)将GNSS接收机tk时刻接收的伪距值和多普勒频移值与伪距预测值和多普勒频移预测值做差形成测量残余。
上述技术方案中,所述步骤4)进一步包括:
此外,本发明还提供了一种GNSS/INS组合导航的***,包括:
GNSS接收模块:用于利用GNSS接收机接收tk时刻导航卫星发送的导航电文;
GNSS处理模块:用于计算tk时刻GNSS接收机的伪距值和多普勒频移值的测量残余;
卡尔曼滤波器模块:通过时分复用完成两个功能,一个功能是计算tk时刻GNSS接收机状态估计修正值;另一个功能是计算INS传感器的状态修正值;本模块在硬件上用一个卡尔曼滤波器实现;
GNSS计算模块;用于计算tk时刻GNSS接收机的最优状态估计值;
INS计算模块:用于利用INS传感器计算tk时刻INS传感器的状态估计值;本模块在硬件上采用捷联式INS惯导传感器;
INS处理模块;用于获得INS传感器的状态残余值;
INS优化模块:用于计算INS传感器的最优状态估计值;
输出模块:用于输出tk时刻目标的状态估计值。
本发明的优点在于:
1、本发明的***采用的卡尔曼滤波模块,其滤波器的增益矩阵与观测值无关,从而减少了实时在线计算量,降低了GNSS/INS组合导航***的硬件资源配置,降低了***的成本;
2、本发明的***将两个子***的定位结果差异反馈给INS子***,实时地对INS传感器进行偏差校正,提高了INS定位的精度。因此在满足定位精度需求的前提下,INS接收模块可以采用成本更低的INS传感器;
3、本发明的***采用了时分复用技术两次使用一个卡尔曼滤波模块,分别实现两个功能:计算GNSS接收机的状态修正值、计算INS传感器的状态修正值,这样可以减少硬件资源配置,降低了成本。
附图说明
图1为本发明的GNSS/INS组合导航方法的流程图。
具体实施方式
以下结合附图与具体实施例对本发明做进一步详细说明。
在本文中,GNSS接收机的状态值,INS传感器的状态值都是目标的状态值;状态值为一个向量,包括目标三个方向的位置和速度,用[x,y,z,vx,vy,vz]T表示。
如图1所示,本发明提供了一种GNSS/INS组合导航方法,所述方法包括:
步骤1)利用GNSS接收机接收tk时刻导航卫星的导航电文;
步骤2)计算GNSS接收机tk时刻的伪距值和多普勒频移值的测量残余;包括:
步骤201)在tk时刻,利用tk-1时刻GNSS接收机的最优状态估计值Xk-1预测tk时刻GNSS接收机的状态预测值
其中,Xk-1=[x1k-1,y1k-1,z1k-1,vx1k-1,vy1k-1,vz1k-1]T表示GNSS接收机tk-1时刻位置和速度,wk-1为过程噪声,A为状态转移矩阵:
其中,Ts=tk-tk-1,I3×3为3×3阶的单位矩阵;
步骤202)根据导航电文计算tk时刻卫星位置和速度;
步骤203)根据tk时刻GNSS接收机的状态预测值和tk时刻卫星位置和速度,计算GNSS接收机与各颗卫星之间的伪距预测值和预测多普勒频移预测值;
步骤204)将GNSS接收机tk时刻接收的伪距值和多普勒频移值与伪距预测值和多普勒频移预测值做差形成测量残余;
步骤3)将tk时刻伪距值和多普勒频移值的测量残余输入卡尔曼滤波器,获得tk时刻GNSS接收机状态修正值ΔXk;
步骤4)计算tk时刻GNSS接收机的最优状态估计值Xk;
步骤5)计算tk时刻INS传感器的状态估计值;
tk时刻INS传感器的状态估计值表示为
步骤6)获得tk时刻INS传感器的状态残余值
步骤7)将tk时刻INS传感器的状态残余值输入卡尔曼滤波器,得到tk时刻INS传感器的状态修正值ΔYk;
步骤8)计算tk时刻INS传感器的最优状态估计值Yk:
步骤9)输出tk时刻目标的状态估计值;
所述tk时刻目标的状态估计值为tk时刻INS传感器的最优状态估计值Yk。
此外,本发明还提供了一种GNSS/INS组合导航的***,包括:
GNSS接收模块:用于利用GNSS接收机接收tk时刻导航卫星发送的导航电文;
GNSS处理模块:用于计算tk时刻GNSS接收机的伪距值和多普勒频移值的测量残余;
卡尔曼滤波器模块:通过时分复用完成两个功能,一个功能是计算tk时刻GNSS接收机状态估计修正值;另一个功能是计算INS传感器的状态修正值;本模块在硬件上可用一个卡尔曼滤波器实现;
GNSS计算模块;用于计算tk时刻GNSS接收机的最优状态估计值Xk;
INS计算模块:用于利用INS传感器计算tk时刻INS传感器的状态估计值;本模块在硬件上可采用捷联式INS惯导传感器;
INS处理模块;将tk时刻INS传感器的状态估计值与tk时刻GNSS接收机的最优状态估计值做差,获得INS传感器的状态残余值;
INS输出模块:用于计算INS传感器的最优状态估计值。
Claims (4)
1.一种GNSS/INS组合导航方法,包括:
步骤1)利用GNSS接收机接收tk时刻导航卫星的导航电文;
步骤2)计算GNSS接收机tk时刻的伪距值和多普勒频移值的测量残余;
步骤3)将tk时刻伪距值和多普勒频移值的测量残余输入卡尔曼滤波器,获得tk时刻GNSS接收机状态修正值ΔXk;
步骤4)计算tk时刻GNSS接收机的最优状态估计值Xk;
步骤5)计算tk时刻INS传感器的状态估计值
步骤6)获得tk时刻INS传感器的状态残余值
步骤7)将tk时刻INS传感器的状态残余值输入卡尔曼滤波器,得到tk时刻INS传感器的状态修正值ΔYk;
步骤8)计算tk时刻INS传感器的最优状态估计值Yk:
步骤9)输出tk时刻目标的状态估计值;
所述tk时刻目标的状态估计值为tk时刻INS传感器的最优状态估计值Yk。
2.根据权利要求1所述的GNSS/INS组合导航方法,其特征在于,所述步骤2)进一步包括:
步骤201)在tk时刻,利用tk-1时刻GNSS接收机的最优状态估计值Xk-1预测tk时刻GNSS接收机的状态预测值
其中,Xk-1=[x1k-1,y1k-1,z1k-1,vx1k-1,vy1k-1,vz1k-1]T表示GNSS接收机tk-1时刻位置和速度;wk-1为过程噪声;A为状态转移矩阵:
其中,Ts=tk-tk-1,I3×3为3×3阶的单位矩阵;
步骤202)根据导航电文计算tk时刻卫星位置和速度;
步骤203)根据tk时刻GNSS接收机的状态预测值和tk时刻卫星位置和速度,计算GNSS接收机与各颗卫星之间的伪距预测值和预测多普勒频移预测值;
步骤204)将GNSS接收机tk时刻接收的伪距值和多普勒频移值与伪距预测值和多普勒频移预测值做差形成测量残余。
3.根据权利要求2所述的GNSS/INS组合导航方法,其特征在于,所述步骤4)进一步包括:
4.一种GNSS/INS组合导航的***,其特征在于,所述***包括:
GNSS接收模块:用于利用GNSS接收机接收tk时刻导航卫星发送的导航电文;
GNSS处理模块:用于计算tk时刻GNSS接收机的伪距值和多普勒频移值的测量残余;
卡尔曼滤波器模块:通过时分复用完成两个功能,一个功能是计算tk时刻GNSS接收机状态估计修正值;另一个功能是计算INS传感器的状态修正值;本模块在硬件上用一个卡尔曼滤波器实现;
GNSS计算模块;用于计算tk时刻GNSS接收机的最优状态估计值;
INS计算模块:用于利用INS传感器计算tk时刻INS传感器的状态估计值;本模块在硬件上采用捷联式INS惯导传感器;
INS处理模块;用于获得INS传感器的状态残余值;
INS优化模块:用于计算INS传感器的最优状态估计值;
输出模块:用于输出tk时刻目标的状态估计值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410806448.2A CN104459747A (zh) | 2014-12-19 | 2014-12-19 | 一种gnss/ins组合导航方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410806448.2A CN104459747A (zh) | 2014-12-19 | 2014-12-19 | 一种gnss/ins组合导航方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104459747A true CN104459747A (zh) | 2015-03-25 |
Family
ID=52906095
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410806448.2A Pending CN104459747A (zh) | 2014-12-19 | 2014-12-19 | 一种gnss/ins组合导航方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104459747A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182375A (zh) * | 2015-09-29 | 2015-12-23 | 中国电子科技集团公司第五十四研究所 | 基于惯导***辅助的伪卫星***接收机载波跟踪方法 |
CN105806339A (zh) * | 2016-05-14 | 2016-07-27 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN111007553A (zh) * | 2019-11-20 | 2020-04-14 | 广东博智林机器人有限公司 | 被测对象的导航方法、装置、计算机设备和存储介质 |
CN112105959A (zh) * | 2018-05-16 | 2020-12-18 | 高通股份有限公司 | 基于多普勒的卫星定位***测量中的误差缓解 |
CN113848579A (zh) * | 2021-11-29 | 2021-12-28 | 北京北斗华大科技有限公司 | Ins辅助gnss定位的粗差剔除方法及*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100211315A1 (en) * | 2007-03-22 | 2010-08-19 | Furuno Electric Company Limited | Gps composite navigation apparatus |
CN103278837A (zh) * | 2013-05-17 | 2013-09-04 | 南京理工大学 | 基于自适应滤波的sins/gnss多级容错组合导航方法 |
-
2014
- 2014-12-19 CN CN201410806448.2A patent/CN104459747A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100211315A1 (en) * | 2007-03-22 | 2010-08-19 | Furuno Electric Company Limited | Gps composite navigation apparatus |
CN103278837A (zh) * | 2013-05-17 | 2013-09-04 | 南京理工大学 | 基于自适应滤波的sins/gnss多级容错组合导航方法 |
Non-Patent Citations (4)
Title |
---|
卞鸿巍等: "组合导航***新息自适应卡尔曼滤波算法", 《上海交通大学学报》 * |
吴富梅等: "基于载波相位平滑伪距技术的GPS/INS组合导航", 《大地测量与地球动力学》 * |
廖卓: "Kalman滤波在高动态GNSS接收机中的研究与设计", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
王新龙: "《惯性导航基础》", 28 February 2013 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182375A (zh) * | 2015-09-29 | 2015-12-23 | 中国电子科技集团公司第五十四研究所 | 基于惯导***辅助的伪卫星***接收机载波跟踪方法 |
CN105806339A (zh) * | 2016-05-14 | 2016-07-27 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN105806339B (zh) * | 2016-05-14 | 2018-09-25 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN112105959A (zh) * | 2018-05-16 | 2020-12-18 | 高通股份有限公司 | 基于多普勒的卫星定位***测量中的误差缓解 |
CN112105959B (zh) * | 2018-05-16 | 2024-04-02 | 高通股份有限公司 | 基于多普勒的卫星定位***测量中的误差缓解 |
CN111007553A (zh) * | 2019-11-20 | 2020-04-14 | 广东博智林机器人有限公司 | 被测对象的导航方法、装置、计算机设备和存储介质 |
CN111007553B (zh) * | 2019-11-20 | 2022-01-04 | 广东博智林机器人有限公司 | 被测对象的导航方法、装置、计算机设备和存储介质 |
CN113848579A (zh) * | 2021-11-29 | 2021-12-28 | 北京北斗华大科技有限公司 | Ins辅助gnss定位的粗差剔除方法及*** |
CN113848579B (zh) * | 2021-11-29 | 2022-03-08 | 北京北斗华大科技有限公司 | Ins辅助gnss定位的粗差剔除方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20200158883A1 (en) | Systems and methods for reduced-outlier satellite positioning | |
US8525727B2 (en) | Position and velocity uncertainty metrics in GNSS receivers | |
Rovira-Más et al. | The role of GNSS in the navigation strategies of cost-effective agricultural robots | |
US9651647B2 (en) | Navigation track correction | |
CN104459747A (zh) | 一种gnss/ins组合导航方法及*** | |
US20180113219A1 (en) | Method and system for ascertaining a position of a mobile apparatus | |
CN109313272B (zh) | 使用速度积分的改进gnss接收器 | |
CN110376621A (zh) | 一种基于北斗三号B2b信号的卫星定位方法及装置 | |
CN107710017A (zh) | 用于在实时运动模式和相对定位模式之间切换的卫星导航接收器及方法 | |
JP2018136298A (ja) | 搬送波伝播距離のアンビギュイティ推定用分散カルマン・フィルタ・アーキテクチャ | |
CN102508277A (zh) | 精密单点定位与惯性测量紧组合导航***及数据处理方法 | |
WO2022156480A1 (zh) | 钟差预报方法和装置 | |
CN114791613A (zh) | 星历预报方法和装置 | |
US9513374B2 (en) | Measurement error covariance in GNSS receiver circuitry, pseudoranges, reference position | |
EP3805801A1 (en) | Identifying gnss navigation data as potentially manipulated or as trustworthy at least partially based on an estimated deviation of a second estimate of a satellite state from a first estimate of the satellite state | |
JP2011013189A (ja) | 測位装置及びプログラム | |
CN108344415A (zh) | 一种组合导航信息融合方法 | |
CN102819029A (zh) | 一种超紧组合卫星导航接收机 | |
US9405014B2 (en) | Method of controlling electronic apparatus and electronic apparatus | |
KR20120080776A (ko) | 추정 위치의 신뢰도 제공 방법 및 이를 구현하는 이동 단말기 | |
JP2009222438A (ja) | 移動体用測位装置 | |
CN101865992B (zh) | 一种利用多普勒频移平滑伪距的方法 | |
Han et al. | Precise positioning with machine learning based Kalman filter using GNSS/IMU measurements from android smartphone | |
JP2013113789A (ja) | 速度推定装置及びプログラム | |
WO2018052738A1 (en) | Detection of outlier range measurements using spatial displacement data |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150325 |
|
WD01 | Invention patent application deemed withdrawn after publication |