CN107907898A - 基于格网框架的极区sins/gps组合导航算法 - Google Patents
基于格网框架的极区sins/gps组合导航算法 Download PDFInfo
- Publication number
- CN107907898A CN107907898A CN201711085303.8A CN201711085303A CN107907898A CN 107907898 A CN107907898 A CN 107907898A CN 201711085303 A CN201711085303 A CN 201711085303A CN 107907898 A CN107907898 A CN 107907898A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtr
- mtd
- sins
- 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
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 16
- 238000005259 measurement Methods 0.000 claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims description 8
- 230000004927 fusion Effects 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 description 19
- 238000000034 method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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
-
- 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
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/GPS组合导航算法,包括如下步骤,步骤1,对SINS系统进行格网导航设置;步骤2,对GPS系统和SINS系统进行组合设置;步骤3,得到极区SINS/GPS组合导航系统的状态方程;步骤4,得到极区SINS/GPS组合导航系统的量测方程;步骤5,将SINS系统校正输出的导航参数作为组合导航系统的输出。在格网坐标系中,通过采用极区格网惯性导航力学编排,在极区SINS/GPS组合导航过程中,顺利快速的完成极区导航任务,满足极区导航全自主、长航时和高精度导航的能力的要求。
Description
技术领域
本发明涉及极区导航系统的导航算法,具体为基于格网框架的极区SINS/GPS组合导航算法。
背景技术
现有的中低维度的SINS/GPS组合导航系统中,首先由捷联惯性导航系统(SINS)和全球卫星导航系统(GPS)对飞机的飞行参数分别进行测量;然后,将SINS和GPS各自输出的对应导航参数相减作为量测量,送入组合导航卡尔曼滤波器进行信息融合;接着,利用卡尔曼滤波估计值实时地对SINS进行误差校正;最终,将SINS校正输出的导航参数作为组合导航系统的输出。SINS/GPS组合导航的方案结构如图1所示。
中低纬度地区SINS/GPS组合导航方案已经相对成熟,采用指北方位力学编排基本可以满足中低纬度地区组合导航的需要。由于极区特殊的地理位置,惯性导航设备在极区无法输出传统意义下的航向和位置信息,但是惯性导航系统仍然可以完成位置方向余弦矩阵和姿态方向余弦矩阵的正常计算。由于地球经线在极区逐渐收敛为一点,所以惯性导航系统在极区不能通过常规的经纬度来表达其位置信息。因此,在高纬度地区由于经度收敛造成定位定向困难,需要重新考虑惯性力学编排克服经线收敛引起的问题。
发明内容
针对现有技术中存在的问题,本发明提供一种基于格网框架的极区SINS/GPS组合导航算法,能够较好的克服SINS和GPS各自的缺点,明显的提高工作性能,满足在极区的导航需求。
本发明是通过以下技术方案来实现:
基于格网框架的极区SINS/GPS组合导航算法,包括如下步骤,
步骤1,对SINS系统进行格网导航设置;建立格网坐标系,并在极地航图上将所有的经线平行于格林威治子午线进行绘制;
步骤2,对GPS系统和SINS系统进行组合设置;在格网坐标系的基础上,SINS系统采用指北方位惯导力学编排,并将格网北向作为GPS系统的航向参考;
步骤3,根据极区SINS/GPS组合导航系统的状态变量,SINS系统误差方程和极区SINS/GPS组合系统的状态向量XG,得到极区SINS/GPS组合导航系统的状态方程如下,
其中,FG(t)为系统状态矩阵;GG(t)为系统噪声驱动阵;系统噪声WG(t)=[wgx wgywgz wax way waz]T,wgx、wgy、wgz分别为沿载体x、y、z轴上陀螺仪的白噪声,wax、way、waz分别为沿载体x、y、z轴上加速度计的白噪声;
步骤4,根据极区SINS/GPS组合导航系统中,将SINS系统的输出位置信息和GPS系统的输出位置信息之差作为量测值ZIG,得到极区SINS/GPS组合导航系统的量测方程如下,
ZIG=HXG+VG;
其中,H为量测矩阵;VG为GPS的量测白噪声阵,其量测噪声方差强度阵为R;
步骤5,将由极区SINS/GPS组合导航系统的量测方程得到的量测量,送入卡尔曼滤波器中进行信息融合,利用融合得到的卡尔曼滤波估计值实时地对SINS系统进行误差校正;最终将SINS系统校正输出的导航参数作为组合导航系统的输出。
优选的,步骤1中,假设P点为飞行载体所在位置,以P点处平行于格林威治子午面的平面作为格网平面,以载体所在地的水平面作为切平面,格网平面与切平面的交线就定义为格网北向,格网天向同地理天向重合,格网东向在切平面内且与格网北向垂直构成右手直角坐标系,建立形成格网坐标系。
优选的,步骤3中,所述的极区SINS/GPS组合系统的状态向量XG如下所示,
其中包括的SINS/GPS组合导航系统的状态变量为:
捷联惯性导航系统数学平台姿态误差角分别为格网航向角、格网俯仰角和格网横滚角;
捷联惯性导航系统速度误差分别为格网东向速度误差、格网北向速度误差和格网天向速度误差;
位置误差δRe=[δx δy δz]T,分别为ECEF坐标系下的x向、y向和z向位置误差;
陀螺随机常值漂移ε=[εxεy vz]T,分别为x向、y向和z向陀螺随机常值漂移;
加速度计随机常值偏置分别为x向、y向和z向加速度计随机常值偏置。
优选的,步骤4中,在高纬度地区GPS系统的输出位置是ECEF坐标,同时将SINS系统采用ECFC坐标系表达位置信息。
进一步的,步骤4中,根据下式将SINS系统的速度输出转换到ECEF坐标下:
其中,为格网坐标系下SINS的速度输出; 为ECEF坐标系下SINS的速度值。
再进一步的,步骤4中,极区SINS/GPS组合导航系统的量测值ZIG为:
其中:为SINS的速度输出;为GPS的速度输出;为SINS的位置输出;为GPS的位置输出;δvxINS,δvyINS,δvzINS为SINS的速度误差;δvxGPS,δvyGPS,δvzGPS为GPS的速度误差;δxINS,δyINS,δzINS为SINS的位置误差;δxGPS,δyGPS,δzGPS为GPS的位置误差。
与现有技术相比,本发明具有以下有益的技术效果:
本发明在导航算法时,摒弃传统人为定义的经纬度概念,避免由于经线收敛引起的定位困难;利用格网导航的基本思想,在极地航图上将所有的经线平行于格林威治子午线绘制,这样载体所有的方位测量都是相对于格林威治子午线及其平行线定义的,即使在极区,经线也不会收敛于一点,这样可以避免极区相对当地经线定位困难的问题,并将极大的减少极区飞行过程中航向改变的次数;在格网坐标系中,通过采用极区格网惯性导航力学编排,在极区SINS/GPS组合导航过程中,顺利快速的完成极区导航任务,满足极区导航全自主、长航时和高精度导航的能力的要求。
进一步的,在量测值计算时,通过将SINS系统的输出位置与GPS系统输出位置在ECEF坐标中划归统一,保证了量测的精确确定。
附图说明
图1为现有技术的中低纬度SINS/GPS组合导航算法的流程框图。
图2为本发明实例中所述的极区仿真轨迹中纬度、经度和高度的位置变化示意图。
图3为在极区SINS/GPS组合导航系统的姿态误差估计值与中低纬度地区仿真参数相同情况下,姿态误差估计值中俯仰角误差、横滚角误差和航向角误差的仿真结果对比图。
图4为在极区SINS/GPS组合导航系统的姿态误差估计值与中低纬度地区仿真参数相同情况下,速度误差估计值中东向速度误差、北向速度误差和天向速度误差的仿真结果对比图。
图5为在极区SINS/GPS组合导航系统的姿态误差估计值与中低纬度地区仿真参数相同情况下,位置误差估计值中纬度误差、经度误差和高度误差的仿真结果对比图。
图6为在极区SINS/GPS组合导航系统的姿态误差估计值与中低纬度地区仿真参数相同情况下,x、y和z轴陀螺常值漂移估计值的仿真结果对比图。
图7为在极区SINS/GPS组合导航系统的姿态误差估计值与中低纬度地区仿真参数相同情况下,x、y和z轴加速度计常值估计值的仿真结果对比图。
具体实施方式
下面结合具体的实施例对本发明做进一步的详细说明,所述是对本发明的解释而不是限定。
本发明采用极区格网惯性导航力学编排,在极区SINS/GPS组合导航过程中,SINS采用格网力学编排方案。在格网坐标系框架下的SINS/GPS组合导航系统可以很好的完成极区导航任务,满足极区导航全自主、长航时和高精度导航的能力要求。
在惯性导航系统中,中低纬度地区采用指北方位惯导力学编排方案,航向以真北作为参考,与之对应的GPS系统也以真北作为航向参考;而在极区为克服经线收敛造成的定位定向难题,惯性导航系统采用格网力学编排方案,与之对应GPS也应以格网北向作为航向参考。
首先,确定极区SINS/GPS组合导航系统的状态方程。
选取SINS/GPS组合导航系统的状态变量为:捷联惯性导航系统数学平台姿态误差角分别为格网航向角、格网俯仰角和格网横滚角;捷联惯性导航系统速度误差分别为格网东向速度误差、格网北向速度误差和格网天向速度误差;位置误差δRe=[δx δy δz]T,分别为ECEF坐标系下的x向、y向和z向位置误差;陀螺随机常值漂移ε=[εx εy vz]T,分别为x向、y向和z向陀螺随机常值漂移;加速度计随机常值偏置分别为x向、y向和z向加速度计随机常值偏置。
因此,SINS/GPS组合导航系统状态向量为:
其展开式为:
其中:
C13=CweR+CwGR
C23=vG×(2CweR+CwGR)
根据SINS系统误差方程及极区SINS/GPS组合系统的状态向量XG,列写出SINS/GPS组合导航系统的状态方程为:
其中,FG(t)为系统状态矩阵;GG(t)为系统噪声驱动阵;系统噪声WG(t)=[wgx wgywgz wax way waz]T,这里wgx、wgy、wgz分别为沿载体x、y、z轴上陀螺仪的白噪声,wax、way、waz分别为沿载体x、y、z轴上加速度计的白噪声。
然后,确定极区SINS/GPS组合导航系统的量测方程。
在高纬度地区GPS的输出位置是ECEF坐标,SINS也可以采用ECFC坐标系表达位置信息,极区SINS/GPS组合导航系统可采用SINS输出的位置信息与GPS的对应输出信息之差作为量测值,因此需要将SINS的速度输出转换到ECEF坐标下:
则,极区SINS/GPS量测ZIG为:
结合前面所选取的系统状态向量XG,根据上述量测量ZIG可以列写出极区SINS/GPS组合导航系统的量测方程为
ZIG=HXG+VG
其中,为量测矩阵;VG为GPS的量测白噪声阵,其量测噪声方差强度阵为R。
最后,将由极区SINS/GPS组合导航系统的量测方程得到的量测量,送入卡尔曼滤波器中进行信息融合,利用融合得到的卡尔曼滤波估计值实时地对SINS系统进行误差校正;最终将SINS系统校正输出的导航参数作为组合导航系统的输出。
对本发明所述的算法进行仿真验证。
飞越极区的飞行过程中模拟了飞机的加速、爬升、转弯机动,极区轨迹中包含了载机飞越极点的轨迹。轨迹参数设置如下:
轨迹起始点:[83°N 108°E 5000]
轨迹终点:[83.05°N 76.33°W 6516m]
飞行速度:起始速度200m/s,最高速度270m/s。
飞行时间:7200s。
飞行距离:840mn。
本发明极区仿真轨迹中的位置变化如图2所示:
极区SINS/GPS组合导航系统的其他仿真参数与中低纬度地区仿真参数相同,仿真结果对比如图3-7所示。
由图3、图4和图5的仿真结果可知,基于格网框架的极区SINS/GPS组合导航系统中,SINS的导航参数误差获得了显著的收敛。在5s飞机水平加速后水平平台失准角迅速收敛,经过7200秒的组合导航仿真,姿态误差收敛稳定后航向角误差稳定在5′,俯仰角误差和横滚角误差小于0.5′;全程三个方向的速度误差小于0.1m/s;纬度误差和经度误差都小于5m。与中低纬度的SINS/GPS组合导航系统误差精度相当,可见,极区SINS/GPS组合导航系统可以很好的完成极区导航任务。
但是由图6和图7可知,极区飞行中陀螺常值漂移和加速度计偏置值的估计需要机动,在转弯机动后水平陀螺漂移估计值开始逐渐收敛到0.01°/h,而方位陀螺漂移一直未收敛,因此对于天向陀螺的补偿在极区无法进行,只能借助外部信息;有加速和转弯机动后,三个轴向的加速度计的偏置值逐渐收敛至40ug。
本发明从理论上完善极区格网惯性力学编排方案,并对SINS/GPS组合导航系统工作在中低纬度与极区的环境下进行仿真,为基于格网框架的极区惯性组合导航提供理论支撑。仿真结果表明:极区格网导航坐标系下的SINS/GPS组合导航系统能够较好的克服SINS和GPS各自的缺点,明显的提高工作性能,通过仿真结果比较,可以得到基于格网框架的极区SINS/GPS组合导航方案的导航精度同中低纬度地区组合导航方案一致,验证了极区SINS/GPS组合导航方案的有效性。
Claims (6)
1.基于格网框架的极区SINS/GPS组合导航算法,其特征在于,包括如下步骤,
步骤1,对SINS系统进行格网导航设置;建立格网坐标系,并在极地航图上将所有的经线平行于格林威治子午线进行绘制;
步骤2,对GPS系统和SINS系统进行组合设置;在格网坐标系的基础上,SINS系统采用指北方位惯导力学编排,并将格网北向作为GPS系统的航向参考;
步骤3,根据极区SINS/GPS组合导航系统的状态变量,SINS系统误差方程和极区SINS/GPS组合系统的状态向量XG,得到极区SINS/GPS组合导航系统的状态方程如下,
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>F</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>X</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>G</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>W</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
其中,FG(t)为系统状态矩阵;GG(t)为系统噪声驱动阵;系统噪声WG(t)=[wgx wgy wgzwax way waz]T,wgx、wgy、wgz分别为沿载体x、y、z轴上陀螺仪的白噪声,wax、way、waz分别为沿载体x、y、z轴上加速度计的白噪声;
步骤4,根据极区SINS/GPS组合导航系统中,将SINS系统的输出位置信息和GPS系统的输出位置信息之差作为量测值ZIG,得到极区SINS/GPS组合导航系统的量测方程如下,
ZIG=HXG+VG;
其中,H为量测矩阵;VG为GPS的量测白噪声阵,其量测噪声方差强度阵为R;
步骤5,将由极区SINS/GPS组合导航系统的量测方程得到的量测量,送入卡尔曼滤波器中进行信息融合,利用融合得到的卡尔曼滤波估计值实时地对SINS系统进行误差校正;最终将SINS系统校正输出的导航参数作为组合导航系统的输出。
2.根据权利要求1所述的基于格网框架的极区SINS/GPS组合导航算法,其特征在于,步骤1中,假设P点为飞行载体所在位置,以P点处平行于格林威治子午面的平面作为格网平面,以载体所在地的水平面作为切平面,格网平面与切平面的交线就定义为格网北向,格网天向同地理天向重合,格网东向在切平面内且与格网北向垂直构成右手直角坐标系,建立形成格网坐标系。
3.根据权利要求1所述的基于格网框架的极区SINS/GPS组合导航算法,其特征在于,步骤3中,所述的极区SINS/GPS组合系统的状态向量XG如下所示,
其中包括的SINS/GPS组合导航系统的状态变量为:
捷联惯性导航系统数学平台姿态误差角分别为格网航向角、格网俯仰角和格网横滚角;
捷联惯性导航系统速度误差分别为格网东向速度误差、格网北向速度误差和格网天向速度误差;
位置误差δRe=[δx δy δz]T,分别为ECEF坐标系下的x向、y向和z向位置误差;
陀螺随机常值漂移ε=[εx εy vz]T,分别为x向、y向和z向陀螺随机常值漂移;
加速度计随机常值偏置▽=[▽x ▽y ▽z]T,分别为x向、y向和z向加速度计随机常值偏置。
4.根据权利要求1所述的基于格网框架的极区SINS/GPS组合导航算法,其特征在于,步骤4中,在高纬度地区GPS系统的输出位置是ECEF坐标,同时将SINS系统采用ECFC坐标系表达位置信息。
5.根据权利要求4所述的基于格网框架的极区SINS/GPS组合导航算法,其特征在于,步骤4中,根据下式将SINS系统的速度输出转换到ECEF坐标下:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>x</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>y</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>z</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mi>G</mi>
<mi>e</mi>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>E</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>N</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>U</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,为格网坐标系下SINS的速度输出; 为ECEF坐标系下SINS的速度值。
6.根据权利要求5所述的基于格网框架的极区SINS/GPS组合导航算法,其特征在于,步骤4中,极区SINS/GPS组合导航系统的量测值ZIG为:
<mrow>
<msub>
<mi>Z</mi>
<mrow>
<mi>I</mi>
<mi>G</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>x</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>x</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>y</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>y</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>z</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>v</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>z</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>y</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>z</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>x</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>x</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>y</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>y</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>z</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>z</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>v</mi>
<mrow>
<mi>z</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>z</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;x</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;x</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;y</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;y</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;z</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>(</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>&delta;z</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>x</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>y</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>z</mi>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;v</mi>
<mrow>
<mi>z</mi>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;x</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;x</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;y</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;y</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;z</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&delta;z</mi>
<mrow>
<mi>G</mi>
<mi>P</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中:为SINS的速度输出;为GPS的速度输出;为SINS的位置输出;为GPS的位置输出;δvxINS,δvyINS,δvzINS为SINS的速度误差;δvxGPS,δvyGPS,δvzGPS为GPS的速度误差;δxINS,δyINS,δzINS为SINS的位置误差;δxGPS,δyGPS,δzGPS为GPS的位置误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711085303.8A CN107907898A (zh) | 2017-11-07 | 2017-11-07 | 基于格网框架的极区sins/gps组合导航算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711085303.8A CN107907898A (zh) | 2017-11-07 | 2017-11-07 | 基于格网框架的极区sins/gps组合导航算法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107907898A true CN107907898A (zh) | 2018-04-13 |
Family
ID=61842715
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711085303.8A Pending CN107907898A (zh) | 2017-11-07 | 2017-11-07 | 基于格网框架的极区sins/gps组合导航算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107907898A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109737958A (zh) * | 2019-03-08 | 2019-05-10 | 哈尔滨工程大学 | 一种声学测速辅助的极区格网惯性导航误差抑制方法 |
CN109737959A (zh) * | 2019-03-20 | 2019-05-10 | 哈尔滨工程大学 | 一种基于联邦滤波的极区多源信息融合导航方法 |
CN109781100A (zh) * | 2019-03-08 | 2019-05-21 | 哈尔滨工程大学 | 一种基于卡尔曼滤波估计的极区组合导航双通道误差校正方法 |
CN110196048A (zh) * | 2019-05-27 | 2019-09-03 | 哈尔滨工程大学 | 一种极区无经度更新的格网惯性导航方法 |
CN111174806A (zh) * | 2018-11-13 | 2020-05-19 | 千寻位置网络有限公司 | 一种gnss/ins融合定位结果异常来源检测方法及装置 |
CN113155125A (zh) * | 2021-05-09 | 2021-07-23 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss全球组合导航方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103528584A (zh) * | 2013-11-04 | 2014-01-22 | 东南大学 | 基于横向地理坐标系的极区惯性导航方法 |
-
2017
- 2017-11-07 CN CN201711085303.8A patent/CN107907898A/zh active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103528584A (zh) * | 2013-11-04 | 2014-01-22 | 东南大学 | 基于横向地理坐标系的极区惯性导航方法 |
Non-Patent Citations (1)
Title |
---|
赵成龙: "基于格网坐标系的极区惯性导航与组合导航算法研究", 《中国优秀硕士学位论文全文数据库(电子期刊) 信息科技辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111174806A (zh) * | 2018-11-13 | 2020-05-19 | 千寻位置网络有限公司 | 一种gnss/ins融合定位结果异常来源检测方法及装置 |
CN111174806B (zh) * | 2018-11-13 | 2022-02-01 | 千寻位置网络有限公司 | 一种gnss/ins融合定位结果异常来源检测方法及装置 |
CN109737958A (zh) * | 2019-03-08 | 2019-05-10 | 哈尔滨工程大学 | 一种声学测速辅助的极区格网惯性导航误差抑制方法 |
CN109781100A (zh) * | 2019-03-08 | 2019-05-21 | 哈尔滨工程大学 | 一种基于卡尔曼滤波估计的极区组合导航双通道误差校正方法 |
CN109737959A (zh) * | 2019-03-20 | 2019-05-10 | 哈尔滨工程大学 | 一种基于联邦滤波的极区多源信息融合导航方法 |
CN110196048A (zh) * | 2019-05-27 | 2019-09-03 | 哈尔滨工程大学 | 一种极区无经度更新的格网惯性导航方法 |
CN113155125A (zh) * | 2021-05-09 | 2021-07-23 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss全球组合导航方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110487301B (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
AU2020103939A4 (en) | Polar Integrated Navigation Algorithm of SINS / GPS Based on Grid Framework | |
CN107907898A (zh) | 基于格网框架的极区sins/gps组合导航算法 | |
CN109556632B (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN106123921B (zh) | 动态干扰条件下捷联惯导系统的纬度未知自对准方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
WO2020114301A1 (zh) | 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN107314718A (zh) | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN105928515B (zh) | 一种无人机导航系统 | |
CN101893445A (zh) | 摇摆状态下低精度捷联惯导系统快速初始对准方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN103743413A (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN103792561A (zh) | 一种基于gnss通道差分的紧组合降维滤波方法 | |
CN107024206A (zh) | 一种基于ggi/gps/ins的组合导航系统 | |
CN103148868A (zh) | 匀速直航下基于多普勒计程仪地理系测速误差估计的组合对准方法 | |
CN109489661A (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN105928519A (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
CN113108787A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180413 |