一种基于姿态耦合的捷联惯导/星敏感器组合导航方法技术

本发明专利技术涉及一种组合导航领域，特别是一种基于姿态耦合的捷联惯导/星敏感器组合导航方法。本发明专利技术包括：采集捷联惯导系统输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵；星敏感器直接输出相对于惯性空间的姿态矩阵，得到载体坐标系相对地球坐标系的转换矩阵；利用转换矩阵得到星敏感器捷联矩阵；捷联惯导系统提供捷联矩阵；星敏感器捷联矩阵和捷联惯导捷联矩阵相乘；由捷联惯导捷联矩阵得到姿态角；由星敏感器捷联矩阵得到姿态角；星敏感器和捷联惯导解算两组姿态作差；耦合计算，得到各导航系统失准角；校正捷联惯导姿态信息；校正捷联惯导位置信息；校正捷联惯导速度信息。本发明专利技术不受惯性组件测量误差影响，计算量小，可靠性较强。

【技术实现步骤摘要】
一种基于姿态耦合的捷联惯导/星敏感器组合导航方法
本专利技术涉及一种组合导航领域，特别是一种基于姿态耦合的捷联惯导/星敏感器组合导航方法。
技术介绍
捷联惯导系统(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)采集捷联惯导系统输出带有位置误差的地球坐标系相对地理坐标系的转换矩阵其中，e表示地球坐标系，原点位于地球质心，z轴指向地球自转方向，x指向春分点方向，y轴与其它两轴构成右手螺旋定则；n′表示捷联惯导系统计算导航坐标系；表示地球坐标系相对捷联惯导系统计算地理坐标系的转换矩阵；sin为三角函数中的正弦函数，cos为三角函数中的余弦函数；λs＝λ+δλs为捷联惯导系统解算经度，λ为载体所在位置地理经度，δλs为捷联惯导系统解算经度误差；为捷联惯导系统解算纬度，为载体所在位置地理纬度，为捷联惯导系统解算纬度误差；(2)星敏感器直接输出相对于惯性空间的姿态矩阵得到载体坐标系相对地球坐标系的转换矩阵Cbe=CieCbi=cbe11cbe12cbe13cbe21cbe22cbe23cbe31cbe32cbe33,]]>其中，b表示载体坐标系，原点位于载体质心，z轴垂直于载体甲板平面，y轴指向载体艏向；x轴与其余两轴构成右手螺旋定则；表示载体系到地球系的转换矩阵；表示载体系到惯性系的转换矩阵，由星敏感器提供，cbeij(i,j＝1,2,3)表示中第i行第j列矩阵元素；表示惯性系到地球系的转换矩阵，与地球转速和导航时间有关，借助外部时间信息可得到该矩阵：Cie=cos(k+ωie·t)sin(k+ωie·t)0-sin(k+ωie·t)cos(k+ωie·t)0001,]]>其中，ωie为地球自转角速度，t是世界标准时间系统提供的具体时间，k是初始位置经度与春分点之间的夹角；(3)利用转换矩阵和得到星敏感器捷联矩阵CbnC′=cbnC′11cbnC′12cbnC′13cbnC′21cbnC′22cbnC′23cbnC′31cbnC′32cbnC′33,]]>其中，表示中第i行第j列矩阵元素；(4)捷联惯导系统提供捷联矩阵CbnS′=cbnS′11cbnS′12cbnS′13cbnS′21cbnS′22cbnS′23cbnS′31cbnS′32cbnS′33,]]>其中，表示中第i行第j列矩阵元素；(5)星敏感器捷联矩阵和捷联惯导捷联矩阵相乘：CbnC′(CbnS′)T=c11c12c13c21c22c23c31c32c33,]]>其中，角标T表示矩阵转置；cij(i,j＝1,2,3)表示乘积中第i行第j列矩阵元素，a1=c23a2=c13a3=c12;]]>(6)由捷联惯导捷联矩阵得到姿态角，即θSx=sin-1(cbnS′32)θSy=tan-1(-cbnS′31/cbnS′33)θSz=tan-1(-cbnS′12/cbnS′22),]]>其中，θSx，θSy，θSz分别为捷联惯导解算载体纵摇角、横摇角、航向角；(7)由星敏感器捷联矩阵得到姿态角，即θCx=sin-1(cbnC′32)θCy=tan-1(-cbnC′31/cbnC′33)θCz=tan-1(-cbnC′12/cbnC′22),]]>其中，θCx，θCy，θCz分别为星敏感器捷联矩阵解算载体纵摇角、横摇角、航向角；(8)星敏感器和捷联惯导解算两组姿态作差，得到a4=θSx-θCxa5=θSy-θCya6=θSz-θCz;]]>(9)耦合计算，得到各导航系统失准角：其中，φSx，φSy，φSz为捷联惯导数学平台失准角；φCx，φCy，φCz为星敏感器数学平台失准角；m(S)ij(i,j＝1,2)为与捷联惯导捷联矩阵元素相关的变量；m(C)ij(i,j＝1,2)为与星敏感器捷联矩阵元素相关的变量：m(S)11=-cbnS′221-cbnS′322,m(S)12=cbnS′121-cbnS′322,m(S)21=cbnS′21cbnS′33-cbnS′23cbnS′31cbnS′332+cbnS′312,]]>m(S)22=cbnS′13cb...

【技术特征摘要】
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)由捷联惯导捷联矩阵得到姿态角，即

【专利技术属性】
技术研发人员：王秋滢，朱明红，刁鸣，李一兵，高伟，于飞，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江;23