CN104501809B - 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 - Google Patents
一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 Download PDFInfo
- Publication number
- CN104501809B CN104501809B CN201410734807.8A CN201410734807A CN104501809B CN 104501809 B CN104501809 B CN 104501809B CN 201410734807 A CN201410734807 A CN 201410734807A CN 104501809 B CN104501809 B CN 104501809B
- Authority
- CN
- China
- Prior art keywords
- prime
- strapdown
- matrix
- inertial navigation
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 230000008878 coupling Effects 0.000 title claims abstract description 16
- 238000010168 coupling process Methods 0.000 title claims abstract description 16
- 238000005859 coupling reaction Methods 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims abstract description 102
- 238000004364 calculation method Methods 0.000 claims abstract description 20
- 238000006243 chemical reaction Methods 0.000 claims abstract description 11
- 230000009466 transformation Effects 0.000 claims description 24
- 230000017105 transposition Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract description 5
- 238000004088 simulation Methods 0.000 description 7
- 238000012937 correction Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 230000036544 posture Effects 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 239000000835 fiber Substances 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 235000002722 Dioscorea batatas Nutrition 0.000 description 1
- 235000003416 Dioscorea oppositifolia Nutrition 0.000 description 1
- 240000001811 Dioscorea oppositifolia Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 229940050561 matrix product Drugs 0.000 description 1
- 238000005070 sampling Methods 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/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种组合导航领域,特别是一种基于姿态耦合的捷联惯导/星敏感器组合导航方法。本发明包括:采集捷联惯导***输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵;星敏感器直接输出相对于惯性空间的姿态矩阵,得到载体坐标系相对地球坐标系的转换矩阵;利用转换矩阵得到星敏感器捷联矩阵;捷联惯导***提供捷联矩阵;星敏感器捷联矩阵和捷联惯导捷联矩阵相乘;由捷联惯导捷联矩阵得到姿态角;由星敏感器捷联矩阵得到姿态角;星敏感器和捷联惯导解算两组姿态作差;耦合计算,得到各导航***失准角;校正捷联惯导姿态信息;校正捷联惯导位置信息;校正捷联惯导速度信息。本发明不受惯性组件测量误差影响,计算量小,可靠性较强。
Description
技术领域
本发明涉及一种组合导航领域,特别是一种基于姿态耦合的捷联惯导/星敏感器组合导航方法。
背景技术
捷联惯导***(SINS)是一种能够实时输出载体速度、姿态、位置信息的全自主导航***,由于SINS导航过程不需要对外发射任何无线电信号,又不受外界环境条件等影响,因此受到各领域的青睐,广泛应用于航空、航天、航海等领域。SINS主要是利用陀螺仪和加速度计实时测量载体运动的角速度和线速度信息,经导航解算后得到导航信息。然而,惯性组件测量误差、初始对准误差等因素导致***解算导航误差随导航时间增长而逐渐发散,影响***导航精度,严重制约了捷联惯导***的长时间导航能力。
为解决上述问题,常采用其它导航设备与惯性导航***进行信息融合,组成以惯性导航***为主体的组合导航***。目前,SINS和全球定位***(GPS)的组合技术相对成熟,但是由于美国国家政策限制各国对GPS的使用,使得战时需求受限。虽然我国已自主研发了北斗导航***,但基于惯性/北斗的组合导航仍然存在导航过程中需要收发无线电信号的问题,导致该类组合技术应用受限。因此,对自主性强的天文导航技术,尤其是与天文导航有关的组合导航技术研究成为现代军事导航领域的主要趋势和热点。星敏感器作为目前精度最高的姿态敏感仪器,测量精度可达到角秒级,具有自主性强、无姿态积累误差、视场不受限制、抗干扰性强,隐蔽性好等优点。本发明提出星敏感器和捷联惯导的组合导航方案,使导航***的精度和实时性得到大幅度提高。
目前,基于捷联惯导/星敏感器的相对成熟的组合方法是,星敏感器利用捷联惯导提供的水平姿态信息解算出载体相对地理系的位置与航向,然后对惯导的输出进行校正。这种组合方法能很好地抑制惯导误差随时间的发散,但其导航精度却受到惯导提供的水平姿态精度的制约,也就是说,这种组合方法的导航精度要受到捷联惯导导航误差的影响,限制了该组合方法的应用范围。除此之外,星敏感器直接测量输出相对于惯性系的姿态,当***导航系选取当地地理系时,该信息无法直接使用。
《测绘科学技术学报》2009年26卷第2期由杨生等人撰写的《基于惯导/天文高精度定姿方法》,利用惯性导航***与天文导航***进行组合定姿,采用卡尔曼滤波技术设计了惯导/天文组合定姿算法,但是该文献主要针对飞行器提出了定姿方法,并没有定位方法,不满足低速航行的舰船的导航需求;公告号为103076015的中国发明专利在2013年5月1日公开的《一种基于全面最优校正的SINS/CNS组合导航***及其导航方法》,该发明解决了天文导航***高精度自主地平的问题,充分利用天文导航***的位置和姿态信息,对SINS误差进行全面最优校正,但是该发明利用星光折射间接敏感地平的解析天文定位方法得到位置信息和地平信息,再利用惯性姿态信息得到载体的姿态信息,计算过程复杂繁琐,适用范围小;《测绘工程》2013年22卷第4期由黄志远等人撰写的《CNS/SINS组合导航***仿真分析》,以弹道导弹为研究对象建立了CNS/SINS组合导航的数学模型,并设计滤波算法验证组合导航***的可靠性,但是该文献并没有对CNS/SINS组合导航***的组合方式进行阐述。以上文献都提出了天文和捷联惯导组合的导航方案,但却都没有给出以当地地理坐标系为导航坐标系时,星敏感器直接输出相对惯性系信息与捷联惯导***提供相对地理系导航信息的组合方案。
发明内容
本发明针对现有技术的不足,提出了一种提高组合导航***定姿、定速、定位精度的基于姿态耦合的星敏感器/捷联惯导组合导航方法。
一种基于姿态耦合的捷联惯导/星敏感器组合导航方法,包括:
(1)采集捷联惯导***输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵
其中,e表示地球坐标系,原点位于地球质心,z轴指向地球自转方向,x指向春分点方向,y轴与其它两轴构成右手螺旋定则;n′表示捷联惯导***计算导航坐标系;表示地球坐标系相对捷联惯导***计算地理坐标系的转换矩阵;sin为三角函数中的正弦函数,cos为三角函数中的余弦函数;λs=λ+δλs为捷联惯导***解算经度,λ为载体所在位置地理经度,δλs为捷联惯导***解算经度误差;为捷联惯导***解算纬度,为载体所在位置地理纬度,为捷联惯导***解算纬度误差;
(2)星敏感器直接输出相对于惯性空间的姿态矩阵得到载体坐标系相对地球坐标系的转换矩阵
其中,b表示载体坐标系,原点位于载体质心,z轴垂直于载体甲板平面,y轴指向载体艏向;x轴与其余两轴构成右手螺旋定则;表示载体系到地球系的转换矩阵;表示载体系到惯性系的转换矩阵,由星敏感器提供,cbeij(i,j=1,2,3)表示中第i行第j列矩阵元素;表示惯性系到地球系的转换矩阵,与地球转速和导航时间有关,借助外部时间信息可得到该矩阵:
其中,ωie为地球自转角速度,t是世界标准时间***提供的具体时间,k是初始位置经度与春分点之间的夹角。
(3)利用转换矩阵和得到星敏感器捷联矩阵
其中,(i,j=1,2,3)表示中第i行第j列矩阵元素;
(4)捷联惯导***提供捷联矩阵
其中,(i,j=1,2,3)表示中第i行第j列矩阵元素;
(5)星敏感器捷联矩阵和捷联惯导捷联矩阵相乘:
其中,角标T表示矩阵转置;cij(i,j=1,2,3)表示乘积中第i行第j列矩阵元素,
(6)由捷联惯导捷联矩阵得到姿态角,即
其中,θSx,θSy,θSz分别为捷联惯导解算载体纵摇角、横摇角、航向角;
(7)由星敏感器捷联矩阵得到姿态角,即
其中,θCx,θCy,θCz分别为星敏感器捷联矩阵解算载体纵摇角、横摇角、航向角;
(8)星敏感器和捷联惯导解算两组姿态作差,得到
(9)耦合计算,得到各导航***失准角:
其中,φSx,φSy,φSz为捷联惯导数学平台失准角;φCx,φCy,φCz为星敏感器数学平台失准角;m(S)ij(i,j=1,2)为与捷联惯导捷联矩阵元素相关的变量;m(C)ij(i,j=1,2)为与星敏感器捷联矩阵元素相关的变量:
(10)校正捷联惯导姿态信息:
其中,
更新载体姿态信息,
其中,cbnij(i,j=1,2,3)为第i行第j列矩阵元素;θ,φ,ψ表示组合导航解算载体纵摇角、横摇角和航向角;
(11)校正捷联惯导位置信息:
其中,λ分别表示组合导航解算载体纬度和经度信息;
(12)校正捷联惯导速度信息:
其中,R表示地球半径;分别表示φCx、φCy的微分形式;vxS、vyS分别表示捷联惯导解算东向、北向速度信息;vx、vy分别表示组合导航计算载体东向、北向速度信息。
本发明与现有技术相比的优点在于:本发明提出了一种基于姿态耦合的星敏感器/捷联惯导组合导航方法。该方法利用星敏感器测量的惯性姿态信息与捷联惯导测量输出的位置信息耦合计算,估算出捷联惯导导航解算位置误差、速度误差和姿态误差,将估算结果补偿后,可以抑制捷联惯导导航误差,提高***导航精度。本发明的优点在于:(1)不受惯性组件测量误差影响;(2)计算量小,简单易实现;(3)不依靠人为推导实现,可靠性较强。
附图说明
图1为本发明的组合导航方法流程图;
图2为利用本发明进行的仿真试验,将组合导航估算结果补偿前后的姿态误差比较曲线;
图3为利用本发明进行的仿真试验,将组合导航估算结果补偿前后的速度误差比较曲线;
图4为利用本发明进行的仿真试验,将组合导航估算结果补偿前后的位置误差比较曲线。
具体实施方式
下面结合附图对本发明的具体进行详细描述。
本发明方法依据星敏感器直接测量输出的惯性系姿态,在惯导位置信息辅助下进行星敏感器定姿,并得到星敏感器捷联矩阵,通过将星敏感器捷联矩阵与捷联惯导捷联矩阵相乘,再利用乘积矩阵元素与星敏感器和惯导姿态差值进一步耦合,得到捷联惯导导航误差估算值,从而校正捷联惯导导航输出,达到目的。
一种基于姿态耦合的捷联惯导/星敏感器组合导航方法,包括以下步骤:
步骤1:采集SINS输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵其中,e表示地球坐标系;n′表示捷联惯导(SINS)计算导航坐标系;表示地球坐标系相对SINS计算地理坐标系的转换矩阵;
步骤2:星敏感器直接输出相对于惯性空间的姿态矩阵根据转换矩阵间的数学关系,能够得到载体坐标系相对地球坐标系的转换矩阵其中,b表示载体坐标系;表示在载体系到地球系的转换矩阵;表示载体系到惯性系的转换矩阵,由星敏感器提供;表示惯性系到地球系的转换矩阵,与地球转速和导航时间有关,借助外部时间信息可得到该矩阵;
步骤3:利用步骤1和步骤2得到的转换矩阵相乘得到星敏感器捷联矩阵其中,n′C表示星敏感器计算导航系;
步骤4:采集SINS捷联矩阵
步骤5:星敏感器捷联矩阵和捷联惯导捷联矩阵相乘得到新矩阵;
步骤6:由捷联惯导捷联矩阵得到姿态角θSx,θSy,θSz;
步骤7:由星敏感器捷联矩阵得到姿态角θCx,θCy,θCz;
步骤8:利用步骤6和步骤7得到的两组姿态作差;
步骤9:利用上述计算结果耦合计算,得到各导航***失准角;
步骤10:校正捷联惯导姿态信息;
步骤11:校正捷联惯导位置信息;
步骤12:校正捷联惯导速度信息。
步骤9中所述耦合计算,具体过程为:
利用步骤5和步骤8矩阵乘积和姿态之差两组数学关系,得到组合导航***的失准角,如下:
其中,φSx,φSy,φSz为捷联惯导数学平台失准角;φCx,φCy,φCz为星敏感器数学平台失准角;m(S)ij(i,j=1,2)为与捷联惯导捷联矩阵元素相关的变量;m(C)ij(i,j=1,2)为与星敏感器捷联矩阵元素相关的变量,具体如下:
其中,(i,j=1,2,3)表示步骤4中的第i行第j列矩阵元素;(i,j=1,2,3)表示步骤3中的第i行第j列矩阵元素;
其中,cij(i,j=1,2,3)表示步骤5中矩阵乘积的第i行第j列矩阵元素。
如图1所示,本发明提供一种针对星敏感器/捷联惯导的组合导航方法,具体包括如下步骤:
步骤1:采集SINS输出带有其导航解算位置误差的地球坐标系到地理坐标系的转换矩阵如下:
其中,e表示地球坐标系,原点位于地球质心,z轴指向地球自转方向,x指向春分点方向,y轴与其它两轴构成右手螺旋定则;n′表示SINS计算导航坐标系;表示地球坐标系相对SINS计算地理坐标系的转换矩阵;sin为三角函数中的正弦函数,cos为三角函数中的余弦函数;λ为载体所在位置地理经度,δλs为SINS解算经度误差,λs=λ+δλs为SINS解算经度;为载体所在位置地理纬度,为SINS解算纬度误差,为SINS解算纬度。
步骤2:星敏感器直接输出相对于惯性空间的姿态矩阵根据转换矩阵间的数学关系,能够得到载体坐标系相对于地球坐标系的转换矩阵转换过程如下
其中,b表示载体坐标系,原点位于载体质心,z轴垂直于载体甲板平面,y轴指向载体艏向;x轴与其余两轴构成右手螺旋定则;表示载体系到地球系的转换矩阵;表示载体系到惯性系的转换矩阵,由星敏感器提供,cbeij(i,j=1,2,3)表示中第i行第j列矩阵元素;表示惯性系到地球系的转换矩阵,与地球转速和导航时间有关,借助外部时间信息可得到该矩阵,形式如下:
其中,ωie为地球自转角速度,t是世界标准时间***提供的具体时间,k是初始位置(经度)与春分点之间的夹角。
步骤3:利用步骤1和步骤2得到的转换矩阵和相乘,得到星敏感器捷联矩阵计算过程如下,
即
其中,(i,j=1,2,3)表示中第i行第j列矩阵元素。
步骤4:采集SINS导航解算得到的捷联矩阵并定义形式如下:
其中,(i,j=1,2,3)表示中第i行第j列矩阵元素。
步骤5:将步骤3得到的星敏感器捷联矩阵和步骤4采集的捷联惯导捷联矩阵相乘,得到新矩阵,形式如下:
其中,角标T表示矩阵转置;cij(i,j=1,2,3)表示矩阵乘积中第i行第j列矩阵元素,并定义:
步骤6:利用步骤4采集的捷联惯导捷联矩阵解算载体姿态信息,即
其中,θSx,θSy,θSz分别为捷联惯导解算载体纵摇角、横摇角、航向角。
步骤7:利用步骤3计算得到的星敏感器捷联矩阵解算载体姿态角,即
其中,θCx,θCy,θCz分别为星敏感器解算载体纵摇角、横摇角、航向角。
步骤8:利用步骤6和步骤7计算得到的两组姿态作差,得到:
其中,a4、a5、a6为两组姿态差值定义变量。
步骤9:利用步骤5和步骤8矩阵乘积和姿态之差两组数学关系,得到组合导航***的失准角,如下:
其中,φSx,φSy,φSz为捷联惯导数学平台失准角;φCx,φCy,φCz为星敏感器数学平台失准角;m(S)ij(i,j=1,2)为与捷联惯导捷联矩阵元素相关的变量;m(C)ij(i,j=1,2)为与星敏感器捷联矩阵元素相关的变量,具体如下:
步骤10:利用步骤9得到的捷联惯导数学平台失准角估算结果,对捷联惯导姿态信息进行校正,校正过程利用如下数学转换关系
其中,
更新载体姿态信息,
其中,cbnij(i,j=1,2,3)为第i行第j列矩阵元素;θ,φ,ψ表示组合导航解算载体纵摇角、横摇角和航向角。
步骤11:利用步骤9得到的星敏感器数学平台失准角估算结果,校正捷联惯导位置信息,校正过程如下:
其中,λ分别表示组合导航解算载体纬度和经度信息。
步骤12:利用步骤9得到的星敏感器数学平台失准角估算结果,校正捷联惯导速度信息,校正过程如下:
其中,R表示地球半径;分别表示φCx、φCy的微分形式;vxS、vyS分别表示捷联惯导解算东向、北向速度信息;vx、vy分别表示组合导航计算载体东向、北向速度信息。
对本发明的有益效果进行验证如下:
在Matlab仿真条件下,对该方法进行仿真实验:
赤道半径:R=6378393.0m;
由万有引力可得的地球表面重力加速度:g=9.78049m/s2;
地球自转角速度:Ω=7.2921158×10-5rad/s;
常数:π=3.1415926535;
载体初始位置45.7796°N、126.6709°E,初始姿态0°、0°、45°;
载体以5m/s的速度做任意形式运动;
光纤陀螺常值漂移:0.01°/h;
光纤陀螺白噪声误差:0.005°/h;
光纤陀螺刻度因数误差:10ppm;
加速度计零偏:10-4g;
加速度计白噪声误差:5×10-5g;
加速度计刻度因数误差:10ppm;
星敏感器输出信息中包含均值为0、幅值为1×10-5的白噪声;
仿真时间2小时,采样频率0.1Hz。
利用所述发明,得到基于星敏感器/捷联惯导组合导航结果与捷联惯导单独导航结果比较曲线如图2-图4。其中,图2为姿态误差比较曲线,图3为速度误差比较曲线,图4为位置误差比较曲线。
根据图2-图4结果可以看出,利用本发明提出的基于姿态耦合的星敏感器/捷联惯导组合导航方法可以较好的估计各导航误差,估计结果补偿后能够有效地提高***导航精度。
Claims (1)
1.一种基于姿态耦合的捷联惯导/星敏感器组合导航方法,其特征在于:
(1)采集捷联惯导***输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵
其中,e表示地球坐标系,原点位于地球质心,z轴指向地球自转方向,x指向春分点方向,y轴与其它两轴构成右手螺旋定则;n′表示捷联惯导***计算导航坐标系;表示地球坐标系相对捷联惯导***计算导航坐标系的转换矩阵;sin为三角函数中的正弦函数,cos为三角函数中的余弦函数;λs=λ+δλs为捷联惯导***解算经度,λ为载体所在位置地理经度,δλs为捷联惯导***解算经度误差;为捷联惯导***解算纬度,为载体所在位置地理纬度,为捷联惯导***解算纬度误差;
(2)星敏感器直接输出相对于惯性空间的姿态矩阵得到载体坐标系相对地球坐标系的转换矩阵
其中,b表示载体坐标系,原点位于载体质心,z轴垂直于载体甲板平面,y轴指向载体艏向;x轴与其余两轴构成右手螺旋定则;表示载体系到地球系的转换矩阵;表示载体系到惯性系的转换矩阵,由星敏感器提供,cbeij(i,j=1,2,3)表示中第i行第j列矩阵元素;表示惯性系到地球系的转换矩阵,与地球转速和导航时间有关,借助外部时间信息可得到该矩阵:
其中,ωie为地球自转角速度,t是世界标准时间***提供的具体时间,k是初始位置经度与春分点之间的夹角;
(3)利用转换矩阵和得到星敏感器捷联矩阵
其中,表示中第i行第j列矩阵元素;
(4)捷联惯导***提供捷联矩阵
其中,表示中第i行第j列矩阵元素;
(5)星敏感器捷联矩阵和捷联惯导捷联矩阵相乘:
其中,角标T表示矩阵转置;cij(i,j=1,2,3)表示乘积中第i行第j列矩阵元素,
(6)由捷联惯导捷联矩阵得到姿态角,即
其中,θSx,θSy,θSz分别为捷联惯导解算载体纵摇角、横摇角、航向角;
(7)由星敏感器捷联矩阵得到姿态角,即
其中,θCx,θCy,θCz分别为星敏感器捷联矩阵解算载体纵摇角、横摇角、航向角;
(8)星敏感器和捷联惯导解算两组姿态作差,得到
(9)耦合计算,得到各导航***失准角:
其中,φSx,φSy,φSz为捷联惯导数学平台失准角;φCx,φCy,φCz为星敏感器数学平台失准角;m(S)ij(i,j=1,2)为与捷联惯导捷联矩阵元素相关的变量;m(C)ij(i,j=1,2)为与星敏感器捷联矩阵元素相关的变量:
(10)校正捷联惯导姿态信息:
其中,
更新载体姿态信息,
其中,cbnij(i,j=1,2,3)为第i行第j列矩阵元素;θ,φ,ψ表示组合导航解算载体纵摇角、横摇角和航向角;
(11)校正捷联惯导位置信息:
其中,λ分别表示组合导航解算载体纬度和经度信息;
(12)校正捷联惯导速度信息:
其中,R表示地球半径;分别表示φCx、φCy的微分形式;vxS、vyS分别表示捷联惯导解算东向、北向速度信息;vx、vy分别表示组合导航计算载体东向、北向速度信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410734807.8A CN104501809B (zh) | 2014-12-04 | 2014-12-04 | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410734807.8A CN104501809B (zh) | 2014-12-04 | 2014-12-04 | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104501809A CN104501809A (zh) | 2015-04-08 |
CN104501809B true CN104501809B (zh) | 2017-05-24 |
Family
ID=52943235
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410734807.8A Expired - Fee Related CN104501809B (zh) | 2014-12-04 | 2014-12-04 | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104501809B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116430B (zh) * | 2015-08-21 | 2017-06-27 | 北京航天万达高科技有限公司 | 用于动中通的伪航向的基于卡尔曼滤波的海泊态搜星方法 |
CN108871326B (zh) * | 2018-07-09 | 2019-05-21 | 北京航空航天大学 | 一种单轴旋转调制惯性-天文深组合导航方法 |
CN110044319A (zh) * | 2019-04-30 | 2019-07-23 | 北京航天发射技术研究所 | 一种捷联惯导***减振器变形的测量方法和测量装置 |
CN111637885B (zh) * | 2020-05-12 | 2021-10-01 | 北京控制工程研究所 | 一种船载白昼星敏感器定位算法 |
CN115077521B (zh) * | 2022-08-22 | 2022-11-01 | 中国船舶重工集团公司第七0七研究所 | 一种基于虚拟框架载体坐标系惯性导航***姿态解耦方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102393204A (zh) * | 2011-10-21 | 2012-03-28 | 哈尔滨工程大学 | 一种基于sins/cns的组合导航信息融合方法 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN103604428A (zh) * | 2013-11-22 | 2014-02-26 | 哈尔滨工程大学 | 基于高精度水平基准的星敏感器定位方法 |
CN103674021A (zh) * | 2013-11-25 | 2014-03-26 | 哈尔滨工业大学 | 基于捷联惯导与星敏感器的组合导航***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7451022B1 (en) * | 2006-12-28 | 2008-11-11 | Lockheed Martin Corporation | Calibration of ship attitude reference |
-
2014
- 2014-12-04 CN CN201410734807.8A patent/CN104501809B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102393204A (zh) * | 2011-10-21 | 2012-03-28 | 哈尔滨工程大学 | 一种基于sins/cns的组合导航信息融合方法 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN103604428A (zh) * | 2013-11-22 | 2014-02-26 | 哈尔滨工程大学 | 基于高精度水平基准的星敏感器定位方法 |
CN103674021A (zh) * | 2013-11-25 | 2014-03-26 | 哈尔滨工业大学 | 基于捷联惯导与星敏感器的组合导航***及方法 |
Non-Patent Citations (4)
Title |
---|
Correction Technique for Velocity and Position Error of Inertial Navigation System by Celestial Observations;Farid Gul 等;《IEEE-2005 International Conference on Emerging Technologies》;20050917;第7-12页 * |
Predictive Iterated Kalman Filter for INS/GPS Integration and Its Application to SAR Motion Compensation;Jiancheng Fang 等;《IEEE Transactions on Instrumentation and Measurement》;20100430;第59卷(第4期);第909-915页 * |
捷联惯导/星敏感器组合导航技术研究;王鹏 等;《航天控制》;20051031;第23卷(第5期);第31-36页 * |
捷联惯导/星敏感器组合***的在轨自标定方法研究;杨波 等;《航天控制》;20100228;第28卷(第1期);第12-16页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104501809A (zh) | 2015-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN104165640B (zh) | 基于星敏感器的近空间弹载捷联惯导***传递对准方法 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN104880191B (zh) | 一种基于太阳矢量的偏振辅助导航方法 | |
CN101413800B (zh) | 导航/稳瞄一体化***的导航、稳瞄方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导***初始航向的姿态获取方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN106932804A (zh) | 天文辅助的惯性/北斗紧组合导航***及其导航方法 | |
CN103217159B (zh) | 一种sins/gps/偏振光组合导航***建模及动基座初始对准方法 | |
CN104501809B (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN104880192B (zh) | 一种基于偏振罗盘的载体航向角计算方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导***定位精度的方法 | |
CN109974697A (zh) | 一种基于惯性***的高精度测绘方法 | |
CN104697520B (zh) | 一体化无陀螺捷联惯导***与gps***组合导航方法 | |
CN103076026B (zh) | 一种捷联惯导***中确定多普勒计程仪测速误差的方法 | |
CN101915579A (zh) | 一种基于ckf的sins大失准角初始对准新方法 | |
CN110887472B (zh) | 一种偏振-地磁信息深度融合全自主姿态解算方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN113503892B (zh) | 一种基于里程计和回溯导航的惯导***动基座初始对准方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170524 |