CN104181574B - 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法 - Google Patents

一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法 Download PDF

Info

Publication number
CN104181574B
CN104181574B CN201310200322.6A CN201310200322A CN104181574B CN 104181574 B CN104181574 B CN 104181574B CN 201310200322 A CN201310200322 A CN 201310200322A CN 104181574 B CN104181574 B CN 104181574B
Authority
CN
China
Prior art keywords
module
sins
navigation
integrated navigation
parameter
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
CN201310200322.6A
Other languages
English (en)
Other versions
CN104181574A (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.)
CHENGDU GUOXING COMMUNICATION Co Ltd
Original Assignee
CHENGDU GUOXING COMMUNICATION 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 CHENGDU GUOXING COMMUNICATION Co Ltd filed Critical CHENGDU GUOXING COMMUNICATION Co Ltd
Priority to CN201310200322.6A priority Critical patent/CN104181574B/zh
Publication of CN104181574A publication Critical patent/CN104181574A/zh
Application granted granted Critical
Publication of CN104181574B publication Critical patent/CN104181574B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/48Determining 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/49Determining 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种捷联惯导系统/全球导航卫星系统组合导航滤波系统,由一次装订模块、地球参数解算模块、初始对准模块、捷联惯导解算模块、改进滤波算法参数计算模块、正常模式组合导航滤波模块、故障模式组合导航滤波模块和反馈校正输出模块组成;改进滤波算法参数计算模块根据SINS和GNSS提供的数据,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据结果及状态标志传递至正常模式或故障模式组合导航滤波模块中进行改进滤波计算。本发明将组合导航滤波算法模块化,显著提高了组合导航的精度,加快了组合导航滤波算法的收敛速度,且可有效抑制卡尔曼滤波的发散。

Description

一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及 方法
技术领域
本发明涉及组合导航信息融合技术,特别是涉及一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法。
背景技术
捷联惯导系统(SINS)能够完全自主并实时地提供载体的姿态、速度和位置信息,广泛应用于航空、航天和航海等军用及民用领域。但其突出的缺点是导航误差会随时间积累,不能独立完成长时间的导航任务。全球导航卫星系统(GNSS)具备长时间高精度导航的能力,但其缺点是卫星信号容易受干扰,无法提供连续的导航信息。
SINS/GNSS组合导航系统将GNSS与SINS结合起来进行导航,充分利用了各自的优点,并弥补了各自的缺点,可以得到一个既能全天候自主导航又能保证长时间导航精度的系统。Kalman滤波技术是目前实现SINS/GNSS组合导航信息融合的有效方法,通过滤波技术实现对姿态、速度和位置误差以及惯性器件误差的最优估计,进而实现误差的反馈校正。这样,在GNSS信号良好时能够输出高精度的导航信息,同时维持SINS系统的稳定;在GNSS失锁时,进入纯惯导模式,继续提供缓慢发散的导航信息。
然而,基于Kalman滤波的SINS/GNSS组合导航系统在GNSS信号失锁重捕后,由纯惯导模式切换进入组合模式,依靠GNSS信息将纯惯导缓慢发散的导航信息收敛到正确值。该收敛过程的持续时间受纯惯导模式运行时间的影响,纯惯导模式运行时间越长,收敛过程越缓慢,有时甚至伴随着震荡过程,大大降低了组合导航的精度和快速性。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于改进卡尔曼滤波算法的模块化实现捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法,将组合导航滤波算法模块化,显著提高组合导航精度,同时大大加快组合导航滤波算法的收敛速度,并有效抑制卡尔曼滤波的发散。
本发明的目的是通过以下技术方案来实现的:一种捷联惯导系统/全球导航卫星系统组合导航滤波系统,它由一次装订模块、地球参数解算模块、初始对准模块、捷联惯导解算模块、改进滤波算法参数计算模块、正常模式组合导航滤波模块、故障模式组合导航滤波模块和反馈校正输出模块组成;
所述一次装订模块用于根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
所述地球参数解算模块用于根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数;
所述初始对准模块用于根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
所述捷联惯导解算模块用于根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算;
所述改进滤波算法参数计算模块用于根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
所述正常模式组合导航滤波模块包括状态预测子模块、协方差预测子模块、增益计算子模块、状态估计子模块和协方差估计子模块组成;
所述故障模式组合导航滤波模块用于根据系统提供的错误状态标志,通过改进卡尔曼滤波计算的状态预测功能,通过后端处理方式排除前端出现的错误;
所述反馈校正输出模块用于根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出。
进一步地,所述的地球参数包括地球自转角速度投影分量、导航坐标系相对地球的旋转角速度和载体所在位置的重力加速度信息。
进一步地,所述的捷联惯导解算模块进行导航解算过程中,采用旋转矢量四元数算法解算载体的姿态角,采用双子样速度算法解算载体的速度,采用速度积分算法解算载体的当前位置。
一种捷联惯导系统/全球导航卫星系统组合导航滤波方法,它包括以下步骤:
S1:一次装订模块根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
S2:地球参数解算模块根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数;
S3:初始对准模块根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
S4:捷联惯导解算模块根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算;
S5:改进滤波算法参数计算模块根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
S6:反馈校正输出模块根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出。
本发明的有益效果是:
1)将组合导航滤波算法模块化,并在单片DSP上设计实现,根据不同的状态标志执行不同的模块,消除了组合导航滤波算法所受卫星状态的限制,显著提高了组合导航的精度,同时大大加快了组合导航滤波算法的收敛速度,还能有效地抑制卡尔曼滤波的发散;
2)故障模式组合导航滤波模块根据系统提供的错误状态标志,利用改进卡尔曼滤波的状态预测功能,通过后端处理方式排除前端出现的错误,提高了组合导航系统的故障诊断和容错能力。
附图说明
图1为本发明组合导航滤波方法流程图。
具体实施方式
下面结合附图进一步详细描述本发明的技术方案,但本发明的保护范围不局限于以下所述。
一种捷联惯导系统/全球导航卫星系统组合导航滤波系统,它由一次装订模块、地球参数解算模块、初始对准模块、捷联惯导解算模块、改进滤波算法参数计算模块、正常模式组合导航滤波模块、故障模式组合导航滤波模块和反馈校正输出模块组成;
所述一次装订模块用于根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
所述地球参数解算模块用于根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数,地球参数包括地球自转角速度投影分量、导航坐标系相对地球的旋转角速度和载体所在位置的重力加速度等信息;
所述初始对准模块用于根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
所述捷联惯导解算模块用于根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算;其中,采用旋转矢量四元数算法解算载体的姿态角,采用双子样速度算法解算载体的速度,采用速度积分算法解算载体的当前位置;
所述改进滤波算法参数计算模块用于根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
所述正常模式组合导航滤波模块包括状态预测子模块、协方差预测子模块、增益计算子模块、状态估计子模块和协方差估计子模块组成;
所述故障模式组合导航滤波模块用于根据系统提供的错误状态标志,通过改进卡尔曼滤波计算的状态预测功能,通过后端处理方式排除前端出现的错误,由此提高组合导航系统的故障诊断和容错能力;
所述反馈校正输出模块用于根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出,由此提高组合导航系统的精度,大大加快卡尔曼滤波的收敛速度,并有效地抑制卡尔曼滤波的发散。
一种捷联惯导系统/全球导航卫星系统组合导航滤波方法,它包括以下步骤:
S1:一次装订模块根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
S2:地球参数解算模块根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数;
S3:初始对准模块根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
S4:捷联惯导解算模块根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算;
S5:改进滤波算法参数计算模块根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
S6:反馈校正输出模块根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出。
如图1所示,以北斗/捷联惯导系统组合导航滤波方法为例,其步骤为:
SS1:BD/INS组合导航开始;
SS2:初始对准:初始对准模块根据一次装订模块和北斗全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息;
SS3:捷联惯导解算模块根据地球参数解算模块计算得到的地球相关参数进行组合导航滤波参数计算;
SS4:判断BD是否有效:无效则结合经验数据进行改进的组合导航滤波处理;有效则结合量测数据进行组合导航滤波处理;
SS5:校正输出。
组合导航系统的状态方程:
滤波器取导航系统各状态的误差量作为滤波器的状态变量,包括:平台误差角 导航系统的速度误差δVE、δVN、δVU,位置误差δL、δλ、δH,陀螺的随机常值漂移εbE、εbN、εbU,陀螺的相关漂移εrE、εrN、εrU及加速度计零偏▽E、▽N、▽U
姿态误差角方程:
当考虑飞行器高度和地球为圆球体时,姿态误差角方程为:
式中:RM和RN分别表示地球参考椭球子午圈和卯酉圈上各点的曲率半径,表达式如下:
RM=Re(1-2f+3fsin2L);
RN=Re(1+fsin2L);
Re=6378137m;
f=1/298.257。
速度误差方程:
当考虑飞行高度为h和地球为圆球体时,速度误差方程为:
位置误差方程为:
δ L · δ λ · δ h · δv N / ( R N + h ) δv E / ( R N + h ) sec L + v E / ( R N + h ) δ L sec L tan L δv U .
惯性仪表误差:
为了简单起见,惯性仪表误差只考虑随机误差。
1)陀螺随机漂移误差模型
根据捷联惯导随机误差分析的结果可知:陀螺随机漂移的误差模型一般取为随机常数、一阶马尔科夫过程和白噪声的组合,即:ε=εbrg。式中,εb为随机常值漂移,εr为一阶马尔柯夫过程,ωg为白噪声。
假定三个轴向的陀螺漂移误差模型相同,则表达式为:
ϵ · b = 0
ϵ · r = ϵ r / T g + ω r ;
其中,Tg为相关时间。
2)加速度计误差模型
加速度计的误差模型考虑为一阶马尔科夫过程,且假定三个轴的加速度计的误差模型相同,均为零偏和随机噪声,可表示为:
▿ = - ▿ / T a + ω a , · 其中,Ta为相关时间。
SINS误差状态方程:
将平台误差角方程、速度误差方程、位置误差方程和惯性仪表方程综合在一起,得出SINS误差状态方程的一般表达式为:
X · I ( t ) = F I ( t ) X I ( t ) + G I ( t ) W I ( t ) ;
式中:
F I = F N F S 0 F M ;
FN为对应于SINS系统9个误差参数(3个姿态误差、3个速度误差、3个位置误差)的系统动态矩阵。
FS在捷联惯导中为:
F S = C b t C b t 0 3 × 3 0 3 × 3 0 3 × 3 C b t 0 3 × 3 0 3 × 3 0 3 × 3 ;
FM表达式为:
F M = - diag [ 0,0,0 , T gx - 1 , T gy - 1 , T gz - 1 , T ax - 1 , T ay - 1 , T az - 1 ] ;
WI表达式为:
WI=[ωgxgygzbxbybzaxayaz]T
GI在捷联惯导系统中的表达式为:
G I = C b t 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 .
GPS/SINS组合系统状态方程:
在组合导航过程中,对于分布式组合方式,有两个卡尔曼滤波器分别处理INS和GPS数据。两个滤波器的误差状态方程单独建立,选取相应参数进行滤波。而对于全组合式方法,只有一个卡尔曼滤波器。组合系统的误差状态方程中,除了有INS的18个误差状态变量,是否还需要增加与GPS相关的误差状态变量,由观测修正信息的选择而决定。如果选择位置、速度为观测信息,则不需要在组合系统中增加GPS的状态变量。当采用GPS基本观测量作为量测修正信息时,一般是利用状态扩充法将GPS接收机的钟差及钟漂扩充到组合导航系统的状态向量中去,使符合卡尔曼滤波器的要求。
在本方案中,仅选择INS和GPS的位置、速度观测信息来组成量测方程,且讨论全组合的组合方式。因此,GPS/INS组合导航系统的误差状态变量,仍取INS的误差状态变量,无需GPS的误差状态变量,表达式如下:
X · ( t ) = F ( t ) X ( t ) + G ( t ) W ( t ) ;
式中:
组合系统的量测方程:
在位置、速度组合模式中,其量测值有两组:一组为位置量测差值,另一组为速度量测差值。所谓位置量测差值是由惯导系统给出的经度、纬度、高度信息和GPS接收机给出的相应的信息求差,作为一组量测值;所谓速度量测差值是由惯导系统给出的速度信息和GPS接收机给出的速度信息求差,作为一组量测值。
惯导系统的位置量测信息可表示为地理系下的真值与相应误差之和:
L I λ I h I = L t + δL λ t + δλ h t + δh ;
GPS接收机给出的位置信息可表示为地理系下的真值与相应误差之差,由下式表示:
L G λ G h G = L t - N N / R M λ t - N E / R N cos L h t + Nh ;
式中,Ltt,ht表示真实位置;NE,NN,Nh为接收机沿东、北、天方向的位置误差。则位置量测误差矢量为:
Z p ( t ) = ( L I - L G ) R M ( λ I - λ G ) R N cos L h I - h G
= R M δL + N N R N δ L cos L + N E δh + N U
= H p ( t ) X ( t ) + V p ( t ) .
类似位置误差矢量,定义速度量测误差矢量为:
Z v ( t ) = v IN - v GN v IE - v GE v IU - v GU
= δv N + M N δv E + M E δv U + M U
= H v ( t ) X ( t ) + V v ( t ) .
将位置量测矢量和速度量测矢量合并到一起,得到GPS/INS位置、速度组合系统量测方程,如下所示:
Z ( t ) = Z p ( t ) Z v ( t ) = H p ( t ) H v ( t ) X ( t ) + V p ( t ) V v ( t )
= H ( t ) X ( t ) + V ( t ) .

Claims (3)

1.一种捷联惯导系统/全球导航卫星系统组合导航滤波系统,其特征在于:它由一次装订模块、地球参数解算模块、初始对准模块、捷联惯导解算模块、改进滤波算法参数计算模块、正常模式组合导航滤波模块、故障模式组合导航滤波模块和反馈校正输出模块组成;
所述一次装订模块用于根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
所述地球参数解算模块用于根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数;
所述初始对准模块用于根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
所述捷联惯导解算模块用于根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算,所述的捷联惯导解算模块进行导航解算过程中,采用旋转矢量四元数算法解算载体的姿态角,采用双子样速度算法解算载体的速度,采用速度积分算法解算载体的当前位置;
所述改进滤波算法参数计算模块用于根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
所述正常模式组合导航滤波模块包括状态预测子模块、协方差预测子模块、增益计算子模块、状态估计子模块和协方差估计子模块组成;
所述故障模式组合导航滤波模块用于根据系统提供的错误状态标志,通过改进卡尔曼滤波计算的状态预测功能,通过后端处理方式排除前端出现的错误;
所述反馈校正输出模块用于根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出。
2.根据权利要求1所述的一种捷联惯导系统/全球导航卫星系统组合导航滤波系统,其特征在于:所述的地球参数包括地球自转角速度投影分量、导航坐标系相对地球的旋转角速度和载体所在位置的重力加速度信息。
3.一种捷联惯导系统/全球导航卫星系统组合导航滤波方法,其特征在于:它包括以下步骤:
S1:一次装订模块根据本地的先验温度补偿参数、陀螺仪和加速度计的系统误差预标定结果,将其作为初始对准模块以及捷联惯导解算模块的固有参数进行装订;
S2:地球参数解算模块根据GNSS全球导航卫星系统及SINS捷联惯导系统解算的位置、速度信息计算地球参数;
S3:初始对准模块根据一次装订模块和GNSS全球导航卫星系统提供的位置、速度、姿态信息解算得到SINS捷联惯导系统的初始时间、位置、速度和姿态角信息,并作为捷联惯导解算模块的初始值;
S4:捷联惯导解算模块根据捷联惯导设备提供的角速度和比力信息,并利用一次装订模块和初始对准模块提供的参数进行导航解算;
S5:改进滤波算法参数计算模块根据SINS捷联惯导系统和GNSS全球导航卫星系统提供的数据信息,对改进卡尔曼滤波算法所需的状态转移矩阵、系统驱动噪声协方差矩阵、量测噪声协方差矩阵进行计算,并根据参数计算结果及状态标志选择性地传递至正常模式组合导航滤波模块或故障模式组合导航滤波模块中进行改进卡尔曼滤波计算;
S6:反馈校正输出模块根据正常模式组合导航滤波模块或故障模式组合导航滤波模块估计得到的姿态误差、速度误差和位置误差分别对捷联惯导解算模块解算的姿态角、速度以及位置进行一次修正,并将修正后的结果作为组合导航系统的输出。
CN201310200322.6A 2013-05-25 2013-05-25 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法 Active CN104181574B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310200322.6A CN104181574B (zh) 2013-05-25 2013-05-25 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310200322.6A CN104181574B (zh) 2013-05-25 2013-05-25 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法

Publications (2)

Publication Number Publication Date
CN104181574A CN104181574A (zh) 2014-12-03
CN104181574B true CN104181574B (zh) 2016-08-10

Family

ID=51962762

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310200322.6A Active CN104181574B (zh) 2013-05-25 2013-05-25 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法

Country Status (1)

Country Link
CN (1) CN104181574B (zh)

Families Citing this family (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104697520B (zh) * 2015-02-05 2017-10-31 南京航空航天大学 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN105093249A (zh) * 2015-08-12 2015-11-25 浙大正呈科技有限公司 一种惯导导航装置
CN105629282B (zh) * 2015-12-22 2018-08-24 中国兵器工业集团第二○二研究所 自行防空武器的组合导航方法
CN105973271B (zh) * 2016-07-25 2019-10-11 北京航空航天大学 一种混合式惯导系统自标定方法
CN107525507B (zh) * 2016-10-18 2019-03-08 腾讯科技(深圳)有限公司 偏航的判定方法和装置
CN106767787A (zh) * 2016-12-29 2017-05-31 北京时代民芯科技有限公司 一种紧耦合gnss/ins组合导航装置
CN106767797B (zh) * 2017-03-23 2020-03-17 南京航空航天大学 一种基于对偶四元数的惯性/gps组合导航方法
CN107037469A (zh) * 2017-04-11 2017-08-11 北京七维航测科技股份有限公司 基于安装参数自校准的双天线组合惯导装置
WO2019023913A1 (en) * 2017-07-31 2019-02-07 Beijing Didi Infinity Technology And Development Co., Ltd. SYSTEM AND METHOD FOR DETERMINING VEHICLE ORIENTATION
CN107894774A (zh) * 2017-12-15 2018-04-10 北斗时空物联网(北京)股份有限公司 一种机器人管理系统及其控制方法
CN108318033A (zh) * 2017-12-28 2018-07-24 和芯星通(上海)科技有限公司 行人导航方法和系统、电子设备及存储介质
CN108387918A (zh) * 2018-01-18 2018-08-10 和芯星通(上海)科技有限公司 一种行人导航方法和云系统服务器、存储介质、电子设备
CN108802805B (zh) * 2018-06-07 2019-10-11 武汉大学 六自由度宽频带一体化地震监测系统
CN109163735B (zh) * 2018-09-29 2020-10-09 苏州大学 一种晃动基座正向-正向回溯初始对准方法
CN109596144B (zh) * 2018-12-10 2020-07-24 苏州大学 Gnss位置辅助sins行进间初始对准方法
CN109910882A (zh) * 2019-03-14 2019-06-21 钧捷智能(深圳)有限公司 一种基于捷联惯导的车道偏移预警辅助系统及其辅助方法
CN110296701B (zh) * 2019-07-09 2022-12-13 哈尔滨工程大学 惯性与卫星组合导航系统渐变型故障回溯容错方法
CN110780326A (zh) * 2019-09-26 2020-02-11 上海瀚所信息技术有限公司 一种车载组合导航系统和定位方法
CN111999747B (zh) * 2020-08-28 2023-06-20 大连海事大学 一种惯导-卫星组合导航系统的鲁棒故障检测方法
CN112083465A (zh) * 2020-09-18 2020-12-15 德明通讯(上海)有限责任公司 位置信息获取系统及方法
CN112462405B (zh) * 2020-10-20 2024-05-14 和芯星通科技(北京)有限公司 一种导航系统初始化方法和导航系统
CN112484731B (zh) * 2020-11-27 2023-05-09 北京航天长征飞行器研究所 一种高精度实时飞行导航计算方法
CN112857400B (zh) * 2021-01-22 2022-12-27 上海航天控制技术研究所 一种基于十表冗余捷联惯组的运载火箭初始对准方法
CN112596089B (zh) * 2021-03-02 2021-05-18 腾讯科技(深圳)有限公司 融合定位方法、装置、电子设备及存储介质
CN114485650B (zh) * 2022-02-15 2023-09-19 上海海事大学 一种mems-ins辅助gnss矢量环路跟踪方法、装置、存储介质及设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2005088337A1 (fr) * 2004-02-13 2005-09-22 Thales Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
CN102175095A (zh) * 2011-03-02 2011-09-07 浙江大学 一种捷联惯性导航传递对准算法并行实现方法
CN102176041A (zh) * 2011-01-17 2011-09-07 浙江大学 一种基于gnss/sins组合的车辆导航监控系统
CN102636798A (zh) * 2012-04-12 2012-08-15 南京航空航天大学 基于环路状态自检测的sins/gps深组合导航方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2005088337A1 (fr) * 2004-02-13 2005-09-22 Thales Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
CN102176041A (zh) * 2011-01-17 2011-09-07 浙江大学 一种基于gnss/sins组合的车辆导航监控系统
CN102175095A (zh) * 2011-03-02 2011-09-07 浙江大学 一种捷联惯性导航传递对准算法并行实现方法
CN102636798A (zh) * 2012-04-12 2012-08-15 南京航空航天大学 基于环路状态自检测的sins/gps深组合导航方法

Also Published As

Publication number Publication date
CN104181574A (zh) 2014-12-03

Similar Documents

Publication Publication Date Title
CN104181574B (zh) 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法
CN104181572B (zh) 一种弹载惯性/卫星紧组合导航方法
CN104344837B (zh) 一种基于速度观测的冗余惯导系统加速度计系统级标定方法
CN105371844B (zh) 一种基于惯性/天文互助的惯性导航系统初始化方法
CN106932804A (zh) 天文辅助的惯性/北斗紧组合导航系统及其导航方法
EP1582840A1 (en) Inertial navigation system error correction
CN105091907B (zh) Sins/dvl组合中dvl方位安装误差估计方法
CN106482746B (zh) 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法
CN103792561B (zh) 一种基于gnss通道差分的紧组合降维滤波方法
CN101413800A (zh) 导航/稳瞄一体化系统的导航、稳瞄方法
Zhao GPS/IMU integrated system for land vehicle navigation based on MEMS
CN103630136A (zh) 冗余传感器配置下基于三级滤波的导航参数最优融合方法
CN105571578A (zh) 一种利用伪观测取代精密转台的原地旋转调制寻北方法
CN103941274A (zh) 一种导航方法及导航终端
CN105352527A (zh) 一种基于双轴转位机构光纤陀螺标定方法
CN103542853A (zh) 一种估计加速度计漂移的绝对导航滤波方法
Hazry et al. Study of inertial measurement unit sensor
RU2277696C2 (ru) Интегрированная инерциально-спутниковая навигационная система
CN103616026A (zh) 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法
CN105180928B (zh) 一种基于惯性系重力特性的船载星敏感器定位方法
CN108279025B (zh) 一种基于重力信息的光纤陀螺罗经快速精对准方法
Strus et al. Development of a high accuracy pointing system for maneuvering platforms
Saini et al. Implementation of Multi-Sensor GPS/IMU Integration Using Kalman Filter for Autonomous Vehicle
Sahu et al. Centralized kalman filter for fusion of multiple on-board auxiliary sensors with ins for underwater navigation
Kaniewski Closed-loop INS/TACAN/ALT positioning system

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant