CN107543545A - 极区双航海惯性导航系统定位信息融合方法 - Google Patents
极区双航海惯性导航系统定位信息融合方法 Download PDFInfo
- Publication number
- CN107543545A CN107543545A CN201711033300.XA CN201711033300A CN107543545A CN 107543545 A CN107543545 A CN 107543545A CN 201711033300 A CN201711033300 A CN 201711033300A CN 107543545 A CN107543545 A CN 107543545A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mtd
- msub
- msubsup
- mtr
- 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.)
- Granted
Links
Landscapes
- Navigation (AREA)
- Pharmaceuticals Containing Other Organic And Inorganic Compounds (AREA)
Abstract
本发明针对极区内双航海惯性导航系统缺少信息融合,主惯导故障情况下损失定位精度的问题,公开了极区双航海惯性导航系统定位信息融合方法。对双航海惯性导航系统的误差方程在极区内格网坐标系下进行了重新编排,建立了双航海惯性导航系统在极区内的联合误差状态方程和观测方程,对单轴旋转调制激光陀螺航海惯性导航系统的陀螺漂移、加速度计零偏进行估计,并根据极区内单轴旋转调制激光陀螺航海惯性导航系统的定位误差预测模型对其确定性定位误差进行预测补偿,使得作为主惯导的双轴旋转调制激光陀螺航海惯性导航系统故障情况下的定位精度依然可以保证,在保证高可靠性的条件下,进一步提升巡航舰船在极区内的导航定位能力。
Description
技术领域
本发明涉及一种极区航海惯性导航系统定位信息融合方法,特别是一种极区双航海惯性导航系统定位信息融合方法,属于惯性导航领域。
背景技术
极区蕴含了极其丰富的油气资源,同时也处于重要的战略位置。随着极区重要性的日益凸显,以美国、俄罗斯为代表的各个大国加快了对南北极的考察研究。公开报道表明,美国、俄罗斯两国舰船多次在极区进行巡航。对我国而言,加强舰船在极区的巡航将增加我国在该地区的话语权。对于在极区巡航的现代舰船导航系统而言,必须具备高可靠性、高精度、长航时导航的能力。受极区气候、磁场等外部环境的影响,卫星导航、天文导航的使用受到了不同程度的限制,这种情况下,惯性导航系统的定位精度、可靠性成为了决定舰船极区导航能力的重要因素。但是由于极区处于地球的两端,经线迅速收敛,导致相对经线建立航向参考越来越困难,传统的在地理坐标系编排的航海惯性导航系统在极区将无法工作,需要在其它的可用坐标系下重新进行编排。
激光陀螺旋转调制航海惯性导航系统由于其特有的优势已成为很多现代舰船的标准装备,目前装备的旋转调制航海惯性导航系统分为单轴旋转调制激光陀螺航海惯性导航系统和双轴旋转调制激光陀螺航海惯性导航系统。单轴旋转调制激光陀螺航海惯性导航系统只有方位轴旋转机构,可以调制水平方向惯性器件确定性误差的影响,但却不能调制方位轴惯性器件确定性误差的影响;双轴旋转调制激光陀螺航海惯性导航系统存在方位轴旋转机构和横滚轴旋转机构,可以调制所有方向惯性器件确定性误差的影响,因此其定位精度相较于单轴而言更高,但由于其多出的横滚轴旋转机构及其它配套电子设备,造价相对更高,可靠性也低于单轴旋转调制激光陀螺航海惯性导航系统。为满足极区巡航舰船对惯性导航系统高可靠性的要求,同时综合考虑到系统的定位精度、成本等因素,单轴旋转调制激光陀螺航海惯性导航系统和双轴旋转调制激光陀螺航海惯性导航系统备份配置是一种理想方案,并且已被多类舰船采用。此种情况下,以定位精度相对更高的双轴旋转调制激光陀螺航海惯性导航系统作为主惯导系统,正常情况下由其提供导航定位结果;一旦双轴旋转调制激光陀螺航海惯性导航系统故障,由可靠性更高、作为热备份系统的单轴旋转调制激光陀螺航海惯性导航系统继续提供导航定位信息,但此时不可避免的要损失一定的定位精度。目前的配置情况下,两套系统间缺少信息融合,只能保证主惯导设备正常情况下的定位精度,主惯导设备故障情况下热备份系统的定位精度将会损失。
因此,要实现极区双航海惯性导航系统定位信息融合重点需要解决:1.旋转调制激光陀螺航海惯性导航系统误差方程在极区内可用坐标系下的重新编排2.极区内双航海惯性导航系统定位信息融合,实现单轴旋转调制激光陀螺航海惯性导航系统定位精度的提升,即使作为主惯导的双轴旋转调制激光陀螺航海惯性导航系统发生故障,单轴旋转调制激光陀螺航海惯性导航系统的定位精度依然可以保证,并与主惯导设备正常情况下的定位精度相当,在保证高可靠性的条件下,进一步提升巡航舰船在极区内的导航定位能力3.解决舰船由非极区向极区航行时双航海惯性导航系统的联合误差状态及其协方差在不同导航坐标系下的转换问题,以证联合状态卡尔曼滤波器平稳运行。
发明内容
本发明针对极区内双航海惯性导航系统缺少信息融合,主惯导故障情况下损失定位精度的问题,提出了一种极区双航海惯性导航系统定位信息融合方法。该方法分别对单轴旋转调制激光陀螺航海惯性导航系统、双轴旋转调制激光陀螺航海惯性导航系统的误差方程在极区内格网坐标系下进行了重新编排,进一步建立了双航海惯性导航系统在极区内的联合误差状态方程和观测方程,对单轴旋转调制激光陀螺航海惯性导航系统的方位陀螺漂移进行估计,并根据极区内单轴旋转调制激光陀螺航海惯性导航系统的定位误差预测模型对其方位陀螺漂移造成的确定性定位误差进行预测补偿,即使双轴旋转调制激光陀螺航海惯性导航系统发生故障,单轴旋转调制激光陀螺航海惯性导航系统的定位精度依然可以保证,在保证高可靠性的条件下,进一步提升巡航舰船在极区内的导航定位能力。
为实现本发明所采取的技术解决方案是:
极区双航海惯性导航系统定位信息融合方法,其步骤为:
步骤1:极区内确定格网坐标系G为导航坐标系,其定义为:以舰船所在地平行于格林威治子午面的平面为格网面,其与当地水平面的交线定义为格网北向,格网北向与当地地理系n的北向的夹角为格网角σ,格网天向与当地地理系n的天向重合,格网东向与格网北向、格网天向构成右手正交坐标系,当地地理系n为“东向-北向-天向”定义;
步骤2:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,单轴旋转调制激光陀螺航海惯性导航系统编号为1,通过以下步骤实现:
2.1)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程为
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为格网系相对惯性坐标系的角速度,为格网系下表示的地球自转角速度,分别为在格网东向、格网北向、格网天向的分量,为格网系相对地球的转移角速度,分别为在格网东向、格网北向、格网天向的分量,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角相关的地球自转角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为单轴旋转调制激光陀螺航海惯性导航系统1的载体系b1到格网系G的方向余弦矩阵,为单轴旋转调制激光陀螺航海惯性导航系统1的陀螺输出角速度误差,ε1=[εx1 εy1 εz1]T为该系统中的陀螺漂移,εx1、εy1、εz1为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
2.2)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程为
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为比力,分别为比力在格网东向、格网北向、格网天向的分量,为格网坐标系G下的舰船速度,分别为舰船速度格网东向、格网北向、格网天向的分量,为单轴旋转调制激光陀螺航海惯性导航系统1的比力误差,为该系统中的加速度计零偏,为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
2.3)确定格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,同时建立其微分方程,通过以下步骤实现:
2.3.1)将格网系下单轴旋转调制激光陀螺航海惯性导航系统1输出的舰船位置矩阵用真实的舰船位置矩阵表示为
其中,I3为三阶单位矩阵,为格网系G下的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,为当地地理系n与格网系G间的方向余弦矩阵,为地心地固坐标系e与当地地理系n间的方向余弦矩阵, cij表示舰船位置矩阵的第i行j列元素,其中,i=1,2,3,j=1,2,3;L、λ分别为舰船真实的纬度、经度,δσ1为单轴旋转调制激光陀螺航海惯性导航系统1的格网角误差,为当地地理系n下的位置误差角,δL1、δλ1分别为单轴旋转调制激光陀螺航海惯性导航系统1的纬度输出误差、经度输出误差;
2.3.2)根据(3)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角为
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
2.3.3)根据(4)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角各分量间的关系
即单轴旋转调制激光陀螺航海惯性导航系统1位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
2.3.4)根据(3)式确定对其两侧微分获得位置误差角的微分方程为
步骤3:在格网坐标系G下建立双轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,双轴旋转调制激光陀螺航海惯性导航系统编号为2,通过以下步骤实现:
3.1)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程为
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角相关的地球自转角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为双轴旋转调制激光陀螺航海惯性导航系统2的载体系b2到格网系G的方向余弦矩阵,为双轴旋转调制激光陀螺航海惯性导航系统2的陀螺输出角速度误差,ε2=[εx2 εy2 εz2]T为该系统中的陀螺漂移,εx2、εy2、εz2为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
3.2)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程为
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为双轴旋转调制激光陀螺航海惯性导航系统2的比力误差,为该系统中的加速度计零偏,为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
3.3)确定格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,同时建立其微分方程,通过以下步骤实现:
3.3.1)将格网系下双轴旋转调制激光陀螺航海惯性导航系统2输出的舰船位置矩阵用真实的舰船位置矩阵表示为
其中,为格网系G下的双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,δσ2为双轴旋转调制激光陀螺航海惯性导航系统2的格网角误差,为当地地理系n下的位置误差角,δL2、δλ2分别为双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差、经度输出误差;
3.3.2)根据(9)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角为
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
3.3.3)根据(10)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角各分量间的关系
即双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
3.3.4)根据(9)式确定对其两侧微分获得位置误差角的微分方程为
步骤4:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的联合误差状态方程,通过以下步骤实现:
4.1)构建格网坐标系下的联合误差状态,联合误差状态为:单轴旋转调制激光陀螺航海惯性导航系统1姿态误差与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值单轴旋转调制激光陀螺航海惯性导航系统1位置误差角与双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的差值的格网东向分量和格网北向分量,增广单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏以及双轴旋转调制激光陀螺航海惯性导航系统2的陀螺漂移ε2、加速度计零偏作为联合误差状态,不考虑高度通道相关的误差状态;联合误差状态矢量xG(t)为
4.2)分别将步骤2.1)中单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程式(1)减去步骤3.1)中双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程式(7)、步骤2.2)中单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程式(2)减去步骤3.2)中双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程式(8)、步骤2.3)中单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角微分方程式(6)减去步骤3.3)中双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角微分方程式(12),构建格网坐标系下的联合误差状态方程为
其中,为地球自转角速度误差的差值,为格网系相对地球的转移角速度误差的差值,为格网系相对惯性坐标系的角速度误差的差值;
4.3)将步骤4.2)中的联合误差状态方程表示为矩阵形式
其中,系统状态矩阵F(t)、系统噪声矩阵G(t)及系统噪声w(t)分别为:
κG是符号的替换简写,h为舰船的高度,Re为地球的长半轴,f为地球的椭球扁率,1/RxG、1/RyG为地球在格网系下相应坐标轴方向的曲率,1/τfG为舰船所在位置的扭曲率,分别为的前两行前两列构成的子矩阵,0i×j代表i行j列的零矩阵;
步骤5:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2间的观测方程,通过以下步骤实现
5.1)确定观测量z(t)为扣除两套系统间的杆臂效应之后的格网东向速度误差差值、格网北向速度误差差值,以及位置误差角差值,如下:
其中,分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网东向速度, 分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网北向速度;分别为中相应的矩阵元素;
5.2)确定观测方程为
z(t)=HxG(t)+υ(t) (27)
其中,观测矩阵为I2为二阶单位矩阵,υ(t)为观测噪声;
步骤6:在格网坐标系G下分别对单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的姿态、速度、位置矩阵进行更新,按照步骤4、步骤5中所述联合误差状态方程、观测方程进行卡尔曼滤波,对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏进行估计;
步骤7:根据步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏对它们造成的确定性的长期定位误差进行预测补偿,补偿方式为输出校正,预测补偿步骤为:
7.1)根据步骤2.1)、2.2)、2.3)所建立的单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差、速度误差、位置误差角微分方程,确定其误差状态为
误差状态方程同步骤2.1)、2.2)、2.3)所述,同时将步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏作为外界输入矢量
7.2)离散化步骤7.1)中的误差状态方程,得到单轴旋转调制激光陀螺航海惯性导航系统1的定位误差预测模型
其中,为误差状态的离散化估计量,Φ1(k+1,k)为系统状态矩阵A1的离散矩阵,Γ1(k+1,k)为外界输入矩阵B1的离散矩阵,Δt为离散间隔,为外界输入量u(t)的离散量,k、k+1为离散化时刻,初始时刻
7.3)根据定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差通过卡尔曼滤波进行预测补偿,补偿方式为输出校正,补偿过确定性定位误差后,单轴旋转调制激光陀螺航海惯性导航系统1的位置输出矩阵为
其中,为通过定位误差预测模型估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,分别是的格网东向分量和格网北向分量,为位置矩阵修正值;
步骤8:舰船一旦进入极区,导航坐标系由当地地理坐标系n切换为格网坐标系G,相应的联合误差状态及其协方差也从当地地理坐标系n转换到格网坐标系G下,通过以下步骤实现
8.1)格网坐标系G下表示的联合误差状态xG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态xn(t)得到,转换方式为xG(t)=Txn(t),其中,
式中,当地地理系n下表示的单轴旋转调制激光陀螺航海惯性导航系统1姿态误差φ1 n与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值的地理东向、地理北向、地理天向分量分别为单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值的地理东向、地理北向分量分别为δL12、δλ12分别为单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差差值和经度输出误差差值;
8.2)格网坐标系G下表示的联合误差状态的协方差PG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态的协方差Pn(t)得到,转换方式为
式中,为格网坐标系G下联合误差状态xG(t)的估计值,为当地地理系n下联合误差状态xn(t)的估计值,E{}表示期望运算符,Pn(t)由当地地理系下的联合误差状态卡尔曼滤波器计算得到;
8.3)转换完成后,按步骤6所述通过卡尔曼滤波器对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏进行估计,并按步骤7所述的定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差进行预测补偿;一旦作为主惯导的双轴旋转调制激光陀螺航海惯性导航系统2故障,可靠性更高且经过确定性定位误差补偿的单轴旋转调制激光陀螺航海惯性导航系统1继续输出定位信息。
通过以上步骤实现了极区双航海惯性导航系统定位信息融合方法。
与现有技术相比,本发明的有益效果是:
1)格网坐标系的使用解决了传统当地地理坐标系极区无法适用的问题,使得巡航舰船具备了极区导航能力;
2)实现了极区内双航海惯性导航系统定位信息的充分利用,能够对热备份的单轴旋转调制激光陀螺航海惯性导航系统的确定性定位误差进行补偿,既能保证主惯导系统正常情况下的定位精度,也能保证主惯导系统故障情况下的定位精度,改善了巡航舰船在极区的导航定位精度;
3)舰船由非极区向极区航行过程中,本发明实现了双航海惯性导航系统联合误差状态及其协方差由当地地理系向格网坐标系的转换,使得联合状态卡尔曼滤波器可以平稳运行。
附图说明
图1为本发明方法的示意图;
图2为单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移估计误差示意图;
图3为单轴旋转调制激光陀螺航海惯性导航系统1的加速度计零偏估计误差示意图;
图4为单轴旋转调制激光陀螺航海惯性导航系统1的定位误差对比示意图。
具体实施方式
下面对本发明中的方法作进一步详细说明。
如图1所示,为本发明方法的示意图,通过单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2之间的信息融合,构建卡尔曼滤波器,对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移和加速度计零偏进行估计,并根据单轴旋转调制激光陀螺航海惯性导航系统1的定位误差预测模型对其方位陀螺漂移造成的确定性定位误差进行预测补偿。正常情况下以定位精度相对更高的双轴旋转调制激光陀螺航海惯性导航系统2作为主惯导系统,由其提供导航定位结果;一旦双轴旋转调制激光陀螺航海惯性导航系统2故障,由可靠性更高、作为热备份系统的单轴旋转调制激光陀螺航海惯性导航系统1继续提供误差补偿后的导航定位信息,在保证可靠性的条件下又能保证定位精度。
本发明方法的详细步骤为:
极区双航海惯性导航系统定位信息融合方法,其步骤为:
步骤1:极区内确定格网坐标系G为导航坐标系,其定义为:以舰船所在地平行于格林威治子午面的平面为格网面,其与当地水平面的交线定义为格网北向,格网北向与当地地理系n的北向的夹角为格网角σ,格网天向与当地地理系n的天向重合,格网东向与格网北向、格网天向构成右手正交坐标系,当地地理系n为“东向-北向-天向”定义;
步骤2:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,单轴旋转调制激光陀螺航海惯性导航系统编号为1,通过以下步骤实现:
2.1)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程为
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为格网系相对惯性坐标系的角速度,为格网系下表示的地球自转角速度,分别为在格网东向、格网北向、格网天向的分量,为格网系相对地球的转移角速度,分别为在格网东向、格网北向、格网天向的分量,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角相关的地球自转角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为单轴旋转调制激光陀螺航海惯性导航系统1的载体系b1到格网系G的方向余弦矩阵,为单轴旋转调制激光陀螺航海惯性导航系统1的陀螺输出角速度误差,ε1=[εx1 εy1 εz1]T为该系统中的陀螺漂移,εx1、εy1、εz1为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
2.2)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程为
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为比力,分别为比力在格网东向、格网北向、格网天向的分量,为格网坐标系G下舰船速度,分别为舰船速度格网东向、格网北向、格网天向的分量,为单轴旋转调制激光陀螺航海惯性导航系统1的比力误差,为该系统中的加速度计零偏,为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
2.3)确定格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,同时建立其微分方程,通过以下步骤实现:
2.3.1)将格网系下单轴旋转调制激光陀螺航海惯性导航系统1输出的舰船位置矩阵用真实的舰船位置矩阵表示为
其中,I3为三阶单位矩阵,为格网系G下的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,为当地地理系n与格网系G间的方向余弦矩阵,为地心地固坐标系e与当地地理系n间的方向余弦矩阵, cij表示舰船位置矩阵的第i行j列元素,其中,i=1,2,3,j=1,2,3;L、λ分别为舰船真实的纬度、经度,δσ1为单轴旋转调制激光陀螺航海惯性导航系统1的格网角误差,为当地地理系n下的位置误差角,δL1、δλ1分别为单轴旋转调制激光陀螺航海惯性导航系统1的纬度输出误差、经度输出误差;
2.3.2)根据(39)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角为
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
2.3.3)根据(40)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角各分量间的关系
即单轴旋转调制激光陀螺航海惯性导航系统1位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
2.3.4)根据(39)式确定对其两侧微分获得位置误差角的微分方程为
步骤3:在格网坐标系G下建立双轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,双轴旋转调制激光陀螺航海惯性导航系统编号为2,通过以下步骤实现:
3.1)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程为
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角相关的地球自转角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为双轴旋转调制激光陀螺航海惯性导航系统2的载体系b2到格网系G的方向余弦矩阵,为双轴旋转调制激光陀螺航海惯性导航系统2的陀螺输出角速度误差,ε2=[εx2 εy2 εz2]T为该系统中的陀螺漂移,εx2、εy2、εz2为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
3.2)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程为
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为双轴旋转调制激光陀螺航海惯性导航系统2的比力误差,为该系统中的加速度计零偏,为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
3.3)确定格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,同时建立其微分方程,通过以下步骤实现:
3.3.1)将格网系下双轴旋转调制激光陀螺航海惯性导航系统2输出的舰船位置矩阵用真实的舰船位置矩阵表示为
其中,为格网系G下的双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,δσ2为双轴旋转调制激光陀螺航海惯性导航系统2的格网角误差,为当地地理系n下的位置误差角,δL2、δλ2分别为双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差、经度输出误差;
3.3.2)根据(45)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角为
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
3.3.3)根据(46)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角各分量间的关系
即双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
3.3.4)根据(45)式确定对其两侧微分获得位置误差角的微分方程为
步骤4:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的联合误差状态方程,通过以下步骤实现:
4.1)构建格网坐标系下的联合误差状态,联合误差状态为:单轴旋转调制激光陀螺航海惯性导航系统1姿态误差与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值单轴旋转调制激光陀螺航海惯性导航系统1位置误差角与双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的差值的格网东向分量和格网北向分量,增广单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏以及双轴旋转调制激光陀螺航海惯性导航系统2的陀螺漂移ε2、加速度计零偏作为联合误差状态,不考虑高度通道相关的误差状态;联合误差状态矢量x(t)为
4.2)分别将步骤2.1)中单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程式(37)减去步骤3.1)中双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程式(43)、步骤2.2)中单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程式(38)减去步骤3.2)中双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程式(44)、步骤2.3)中单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角微分方程式(42)减去步骤3.3)中双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角微分方程式(48),构建格网坐标系下的联合误差状态方程为
其中,为地球自转角速度误差的差值,为格网系相对地球的转移角速度误差的差值,为格网系相对惯性坐标系的角速度误差的差值;
4.3)将步骤4.2)中的联合误差状态方程表示为矩阵形式
其中,系统状态矩阵F(t)、系统噪声矩阵G(t)及系统噪声w(t)分别为:
κG是符号的替换简写,h为舰船的高度,Re为地球的长半轴,f为地球的椭球扁率,1/RxG、1/RyG为地球在格网系下相应坐标轴方向的曲率,1/τfG为舰船所在位置的扭曲率,分别为的前两行前两列构成的子矩阵,0i×j代表i行j列的零矩阵;
步骤5:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2间的观测方程,通过以下步骤实现
5.1)确定观测量z(t)为扣除两套系统间的杆臂效应之后的格网东向速度误差差值、格网北向速度误差差值,以及位置误差角差值,如下:
其中,分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网东向速度, 分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网北向速度;分别为中相应的矩阵元素;
5.2)确定观测方程为
z(t)=HxG(t)+υ(t) (63)
其中,观测矩阵为I2为二阶单位矩阵,υ(t)为观测噪声;
步骤6:在格网坐标系G下分别对单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的姿态、速度、位置矩阵进行更新,按照步骤4、步骤5中所述联合误差状态方程、观测方程进行卡尔曼滤波,对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏进行估计;
步骤7:根据步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏对它们造成的确定性的长期定位误差进行预测补偿,补偿方式为输出校正,预测补偿步骤为:
7.1)根据步骤2.1)、2.2)、2.3)所建立的单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差、速度误差、位置误差角微分方程,确定其误差状态为
误差状态方程同步骤2.1)、2.2)、2.3)所述,同时将步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏作为外界输入矢量
7.2)离散化步骤7.1)中的误差状态方程,得到单轴旋转调制激光陀螺航海惯性导航系统1的定位误差预测模型
其中,为误差状态x1(t)的离散化估计量,Φ1(k+1,k)为系统状态矩阵A1的离散矩阵,Γ1(k+1,k)为外界输入矩阵B1的离散矩阵,Δt为离散间隔,为外界输入量u(t)的离散量,k、k+1为离散化时刻,初始时刻
7.3)根据定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差通过卡尔曼滤波进行预测补偿,补偿方式为输出校正,补偿过确定性定位误差后,单轴旋转调制激光陀螺航海惯性导航系统1的位置输出矩阵为
其中,为通过定位误差预测模型估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,分别是的格网东向分量和格网北向分量,为位置矩阵修正值;
步骤8:舰船一旦进入极区,导航坐标系由当地地理坐标系n切换为格网坐标系G,相应的联合误差状态及其协方差也从当地地理坐标系n转换到格网坐标系G下,通过以下步骤实现
8.1)格网坐标系G下表示的联合误差状态xG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态xn(t)得到,转换方式为xG(t)=Txn(t),其中,
式中,当地地理系n下表示的单轴旋转调制激光陀螺航海惯性导航系统1姿态误差与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值的地理东向、地理北向、地理天向分量分别为单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值的地理东向、地理北向分量分别为δL12、δλ12分别为单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差差值和经度输出误差差值;
8.2)格网坐标系G下表示的联合误差状态的协方差PG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态的协方差Pn(t)得到,转换方式为
式中,为格网坐标系G下联合误差状态xG(t)的估计值,为当地地理系n下联合误差状态xn(t)的估计值,E{}表示期望运算符,Pn(t)由当地地理系下的联合误差状态卡尔曼滤波器计算得到;
其中,当地地理系下的联合误差状态卡尔曼滤波器的状态方程为
式中,系统状态矩阵S(t)、系统噪声矩阵Gn(t)为:
分别为当地地理系下舰船的东向速度、北向速度,ωie为地球自转角速度,RE、RN分别为卯酉圈、子午圈曲率半径,分别为地理东向、地理北向、地理天向的比力值,为单轴旋转调制激光陀螺航海惯性导航系统1的载体系b1到当地地理系n的方向余弦矩阵,为双轴旋转调制激光陀螺航海惯性导航系统2的载体系b2到当地地理系n的方向余弦矩阵,分别为的前两行前两列构成的子矩阵;
当地地理系下的联合误差状态卡尔曼滤波器的观测方程分别为
zn(t)=Hxn(t)+μ(t) (80)
式中,观测量 表示当地地理系下单轴旋转调制激光陀螺航海惯性导航系统1的东向输出速度与双轴旋转调制激光陀螺航海惯性导航系统2的东向输出速度的差值,表示当地地理系下单轴旋转调制激光陀螺航海惯性导航系统1的北向输出速度与双轴旋转调制激光陀螺航海惯性导航系统2的北向输出速度的差值,表示单轴旋转调制激光陀螺航海惯性导航系统1的输出纬度与双轴旋转调制激光陀螺航海惯性导航系统2的输出纬度的差值,表示单轴旋转调制激光陀螺航海惯性导航系统1的输出经度与双轴旋转调制激光陀螺航海惯性导航系统2的输出经度的差值,μ(t)为观测噪声;
8.3)转换完成后,按步骤6所述通过卡尔曼滤波器对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏进行估计,并按步骤7所述的定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差进行预测补偿;一旦作为主惯导的双轴旋转调制激光陀螺航海惯性导航系统2故障,可靠性更高且经过确定性定位误差补偿的单轴旋转调制激光陀螺航海惯性导航系统1继续输出定位信息。
按照以上步骤在中低纬度地区利用1套单轴旋转调制激光陀螺航海惯性导航系统和1套双轴旋转调制激光陀螺航海惯性导航系统进行了实验验证,验证本发明方法的效果。
首先,两套系统在当地地理坐标系下进行联合误差状态卡尔曼滤波,并在第12h时切换到格网坐标系下继续进行联合误差状态卡尔曼滤波,同时假定双轴旋转调制激光陀螺航海惯性导航系统在第24h时发生故障,之后由补偿过定位误差的单轴旋转调制激光陀螺航海惯性导航系统提供定位结果输出。
图2是单轴旋转调制激光陀螺航海惯性导航系统在144h导航时间内的纬度误差、经度误差及它们的预测值,从图中可以看出,定位误差预测良好。图3是单轴旋转调制激光陀螺航海惯性导航系统的径向定位误差补偿前后的对比示意图,补偿过误差后,单轴旋转调制激光陀螺航海惯性导航系统的定位精度提升明显。图4给出了无故障情况下双轴旋转调制激光陀螺航海惯性导航系统的径向定位误差与补偿后的单轴旋转调制激光陀螺航海惯性导航系统径向定位误差对比,可以发现两者精度相当,因此即使双轴旋转调制激光陀螺航海惯性导航系统发生故障,补偿误差后的单轴旋转调制激光陀螺航海惯性导航系统依然可以保证定位精度。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应当视为落入本发明的保护范围。
Claims (1)
1.极区双航海惯性导航系统定位信息融合方法,其特征在于包括以下步骤:
步骤1:极区内确定格网坐标系G为导航坐标系,其定义为:以舰船所在地平行于格林威治子午面的平面为格网面,其与当地水平面的交线定义为格网北向,格网北向与当地地理系n的北向的夹角为格网角σ,格网天向与当地地理系n的天向重合,格网东向与格网北向、格网天向构成右手正交坐标系,当地地理系n为“东向-北向-天向”定义;
步骤2:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,单轴旋转调制激光陀螺航海惯性导航系统编号为1,通过以下步骤实现:
2.1)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程为
<mrow>
<msubsup>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<mo>&lsqb;</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>iG</mi>
<mn>1</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ib</mi>
<mn>1</mn>
</msub>
</mrow>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为格网系相对惯性坐标系的角速度,为格网系下表示的地球自转角速度,分别为在格网东向、格网北向、格网天向的分量,为格网系相对地球的转移角速度,分别为在格网东向、格网北向、格网天向的分量,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角相关的地球自转角速度误差,为与单轴旋转调制激光陀螺航海惯性导航系统1的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为单轴旋转调制激光陀螺航海惯性导航系统1的载体系b1到格网系G的方向余弦矩阵,为单轴旋转调制激光陀螺航海惯性导航系统1的陀螺输出角速度误差,ε1=[εx1 εy1 εz1]T为该系统中的陀螺漂移,εx1、εy1、εz1为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
2.2)建立格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程为
<mrow>
<mi>&delta;</mi>
<msubsup>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>&lsqb;</mo>
<msup>
<mi>f</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msup>
<mi>v</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ie</mi>
<mn>1</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>1</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<msubsup>
<mi>&delta;v</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;f</mi>
<mn>1</mn>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为单轴旋转调制激光陀螺航海惯性导航系统1的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为比力,分别为比力在格网东向、格网北向、格网天向的分量,为格网坐标系G下的舰船速度,分别为舰船速度格网东向、格网北向、格网天向的分量,为单轴旋转调制激光陀螺航海惯性导航系统1的比力误差,▽1=[▽x1 ▽y1 ▽z1]T为该系统中的加速度计零偏,▽x1、▽y1、▽z1为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
2.3)确定格网坐标系G下单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,同时建立其微分方程,通过以下步骤实现:
2.3.1)将格网系下单轴旋转调制激光陀螺航海惯性导航系统1输出的舰船位置矩阵用真实的舰船位置矩阵表示为
<mrow>
<msubsup>
<mover>
<mi>C</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>C</mi>
<mi>e</mi>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&delta;&sigma;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&delta;&sigma;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>)</mo>
</mrow>
<msubsup>
<mi>C</mi>
<mi>n</mi>
<mi>G</mi>
</msubsup>
<mo>&lsqb;</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mn>1</mn>
<mi>n</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>C</mi>
<mi>e</mi>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,I3为三阶单位矩阵,为格网系G下的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,为当地地理系n与格网系G间的方向余弦矩阵,为地心地固坐标系e与当地地理系n间的方向余弦矩阵, cij表示舰船位置矩阵的第i行j列元素,其中,i=1,2,3,j=1,2,3;L、λ分别为舰船真实的纬度、经度,δσ1为单轴旋转调制激光陀螺航海惯性导航系统1的格网角误差,为当地地理系n下的位置误差角,δL1、δλ1分别为单轴旋转调制激光陀螺航海惯性导航系统1的纬度输出误差、经度输出误差;
2.3.2)根据(3)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角为
<mrow>
<msubsup>
<mi>&theta;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>U</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&sigma;</mi>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;L</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;&lambda;</mi>
<mn>1</mn>
</msub>
<mi>cos</mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
2.3.3)根据(4)式确定单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角各分量间的关系
<mrow>
<msubsup>
<mi>&theta;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>U</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>23</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
即单轴旋转调制激光陀螺航海惯性导航系统1位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
2.3.4)根据(3)式确定对其两侧微分获得位置误差角的微分方程为
<mrow>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<msubsup>
<mi>&theta;</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>1</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤3:在格网坐标系G下建立双轴旋转调制激光陀螺航海惯性导航系统的姿态误差微分方程、速度误差微分方程、位置误差角微分方程,双轴旋转调制激光陀螺航海惯性导航系统编号为2,通过以下步骤实现:
3.1)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程为
<mrow>
<msubsup>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<mo>&lsqb;</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>iG</mi>
<mn>2</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ib</mi>
<mn>2</mn>
</msub>
</mrow>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差,分别为姿态误差在格网东向、格网北向、格网天向的分量,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对惯性坐标系的角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角相关的地球自转角速度误差,为与双轴旋转调制激光陀螺航海惯性导航系统2的速度误差、位置误差角相关的格网系相对地球的转移角速度误差,为双轴旋转调制激光陀螺航海惯性导航系统2的载体系b2到格网系G的方向余弦矩阵,为双轴旋转调制激光陀螺航海惯性导航系统2的陀螺输出角速度误差,ε2=[εx2 εy2 εz2]T为该系统中的陀螺漂移,εx2、εy2、εz2为陀螺漂移在相应坐标轴的分量,为该系统中的陀螺噪声,为陀螺噪声在相应坐标轴的分量;
3.2)建立格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程为
<mrow>
<mi>&delta;</mi>
<msubsup>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>&lsqb;</mo>
<msup>
<mi>f</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msup>
<mi>v</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ie</mi>
<mn>2</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>2</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<msubsup>
<mi>&delta;v</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;f</mi>
<mn>2</mn>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为双轴旋转调制激光陀螺航海惯性导航系统2的速度误差,分别为速度误差在格网东向、格网北向、格网天向的分量,为双轴旋转调制激光陀螺航海惯性导航系统2的比力误差,▽2=[▽x2 ▽y2▽z2]T为该系统中的加速度计零偏,▽x2、▽y2、▽z2为加速度计零偏在相应坐标轴的分量,为加速度计噪声,为加速度计噪声在相应坐标轴的分量;
3.3)确定格网坐标系G下双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,同时建立其微分方程,通过以下步骤实现:
3.3.1)将格网系下双轴旋转调制激光陀螺航海惯性导航系统2输出的舰船位置矩阵用真实的舰船位置矩阵表示为
<mrow>
<msubsup>
<mover>
<mi>C</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>2</mn>
</msub>
</msubsup>
<mo>=</mo>
<mo>&lsqb;</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>C</mi>
<mi>e</mi>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&delta;&sigma;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&delta;&sigma;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>)</mo>
</mrow>
<msubsup>
<mi>C</mi>
<mi>n</mi>
<mi>G</mi>
</msubsup>
<mo>&lsqb;</mo>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mn>2</mn>
<mi>n</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>C</mi>
<mi>e</mi>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为格网系G下的双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角,δσ2为双轴旋转调制激光陀螺航海惯性导航系统2的格网角误差,为当地地理系n下的位置误差角,δL2、δλ2分别为双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差、经度输出误差;
3.3.2)根据(9)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角为
<mrow>
<msubsup>
<mi>&theta;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>U</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&sigma;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mi>&sigma;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>&delta;</mi>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;&lambda;</mi>
<mn>2</mn>
</msub>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为位置误差角在格网东向、格网北向、格网天向的分量;
3.3.3)根据(10)式确定双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角各分量间的关系
<mrow>
<msubsup>
<mi>&theta;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>U</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cot</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>23</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
即双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的格网天向分量与其格网东向分量线性相关,其格网东向、格网北向分量即可完全确定相应的位置误差角
3.3.4)根据(9)式确定对其两侧微分获得位置误差角的微分方程为
<mrow>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<msubsup>
<mi>&theta;</mi>
<mn>2</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>2</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤4:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的联合误差状态方程,通过以下步骤实现:
4.1)构建格网坐标系下的联合误差状态,联合误差状态为:单轴旋转调制激光陀螺航海惯性导航系统1姿态误差φ1 G与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值单轴旋转调制激光陀螺航海惯性导航系统1位置误差角与双轴旋转调制激光陀螺航海惯性导航系统2位置误差角的差值的格网东向分量和格网北向分量,增广单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏▽1以及双轴旋转调制激光陀螺航海惯性导航系统2的陀螺漂移ε2、加速度计零偏▽2作为联合误差状态,不考虑高度通道相关的误差状态;联合误差状态矢量xG(t)为
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mi>G</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>&lsqb;</mo>
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>U</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>U</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>z</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>x</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>z</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>x</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
<msup>
<mo>&rsqb;</mo>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
4.2)分别将步骤2.1)中单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差微分方程式(1)减去步骤3.1)中双轴旋转调制激光陀螺航海惯性导航系统2的姿态误差微分方程式(7)、步骤2.2)中单轴旋转调制激光陀螺航海惯性导航系统1的速度误差微分方程式(2)减去步骤3.2)中双轴旋转调制激光陀螺航海惯性导航系统2的速度误差微分方程式(8)、步骤2.3)中单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角微分方程式(6)减去步骤3.3)中双轴旋转调制激光陀螺航海惯性导航系统2的位置误差角微分方程式(12),构建格网坐标系下的联合误差状态方程为
<mrow>
<msubsup>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<mo>&lsqb;</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>iG</mi>
<mn>12</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;&omega;</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ib</mi>
<mn>2</mn>
</msub>
</mrow>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&delta;</mi>
<msubsup>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>&lsqb;</mo>
<msup>
<mi>f</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mi>&phi;</mi>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msup>
<mi>v</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>ie</mi>
<mn>12</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>12</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<msubsup>
<mi>&delta;v</mi>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;f</mi>
<mn>1</mn>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<msubsup>
<mi>&delta;f</mi>
<mn>2</mn>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<msubsup>
<mi>&theta;</mi>
<mn>12</mn>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&delta;&omega;</mi>
<mrow>
<msub>
<mi>eG</mi>
<mn>12</mn>
</msub>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为地球自转角速度误差的差值,为格网系相对地球的转移角速度误差的差值,为格网系相对惯性坐标系的角速度误差的差值;
4.3)将步骤4.2)中的联合误差状态方程表示为矩阵形式
<mrow>
<msup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>G</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>x</mi>
<mi>G</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>G</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>w</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,系统状态矩阵F(t)、系统噪声矩阵G(t)及系统噪声w(t)分别为:
<mrow>
<msub>
<mi>F</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mo>&lsqb;</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>G</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>N</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>N</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>E</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>E</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>N</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>N</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>E</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>E</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>F</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mfrac>
<mn>1</mn>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>F</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>23</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mfrac>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
<mrow>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>c</mi>
<mn>32</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mn>3</mn>
<mo>/</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</mfrac>
<mo>-</mo>
<mfrac>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>c</mi>
<mn>32</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mn>3</mn>
<mo>/</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>22</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>c</mi>
<mn>12</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>F</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>F</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>f</mi>
<mi>U</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<msubsup>
<mi>f</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>f</mi>
<mi>U</mi>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>f</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>F</mi>
<mn>6</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mfrac>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>F</mi>
<mn>7</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&lsqb;</mo>
<mn>2</mn>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>23</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mfrac>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
<mrow>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>c</mi>
<mn>32</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mn>3</mn>
<mo>/</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</mfrac>
<mo>-</mo>
<mfrac>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>c</mi>
<mn>32</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mn>3</mn>
<mo>/</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>22</mn>
</msub>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>c</mi>
<mn>12</mn>
</msub>
<msubsup>
<mi>v</mi>
<mi>N</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>c</mi>
<mn>22</mn>
</msub>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>12</mn>
</msub>
<msubsup>
<mi>v</mi>
<mi>E</mi>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>F</mi>
<mn>8</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>C</mi>
<mo>&OverBar;</mo>
</mover>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mover>
<mi>C</mi>
<mo>&OverBar;</mo>
</mover>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msubsup>
<mover>
<mi>C</mi>
<mo>&OverBar;</mo>
</mover>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>MC</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
<msup>
<mi>M</mi>
<mi>T</mi>
</msup>
<mo>,</mo>
<msubsup>
<mover>
<mi>C</mi>
<mo>&OverBar;</mo>
</mover>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>MC</mi>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mi>G</mi>
</msubsup>
<msup>
<mi>M</mi>
<mi>T</mi>
</msup>
<mo>,</mo>
<mi>M</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>23</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>F</mi>
<mn>9</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mfrac>
<mn>1</mn>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>F</mi>
<mn>10</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>33</mn>
</msub>
</mfrac>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>N</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>33</mn>
</msub>
</mfrac>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>E</mi>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>e</mi>
<mi>G</mi>
<mi>U</mi>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>24</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&kappa;</mi>
<mi>G</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>L</mi>
<mi> </mi>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mi>&lambda;</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>32</mn>
</msub>
<msqrt>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>c</mi>
<mn>32</mn>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>x</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mi>e</mi>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>fc</mi>
<mn>13</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mfrac>
<mi>h</mi>
<msubsup>
<mi>R</mi>
<mi>e</mi>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>&lsqb;</mo>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mi>f</mi>
<mo>-</mo>
<mn>2</mn>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<msubsup>
<mi>c</mi>
<mn>13</mn>
<mn>2</mn>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mrow>
<mi>y</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>R</mi>
<mi>e</mi>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>fc</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mfrac>
<mi>h</mi>
<msubsup>
<mi>R</mi>
<mi>e</mi>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>&lsqb;</mo>
<msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mi>f</mi>
<mo>-</mo>
<mn>2</mn>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<msubsup>
<mi>c</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>f</mi>
<mi>G</mi>
</mrow>
</msub>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>fc</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>23</mn>
</msub>
</mrow>
<msub>
<mi>R</mi>
<mi>e</mi>
</msub>
</mfrac>
<mo>&lsqb;</mo>
<mn>1</mn>
<mo>-</mo>
<mn>2</mn>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mi>f</mi>
<mo>-</mo>
<mn>2</mn>
<msubsup>
<mi>fc</mi>
<mn>33</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mfrac>
<mi>h</mi>
<msub>
<mi>R</mi>
<mi>e</mi>
</msub>
</mfrac>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>25</mi>
<mo>)</mo>
</mrow>
</mrow>
κG是符号的替换简写,h为舰船的高度,Re为地球的长半轴,f为地球的椭球扁率,1/RxG、1/RyG为地球在格网系下相应坐标轴方向的曲率,1/τfG为舰船所在位置的扭曲率,分别为的前两行前两列构成的子矩阵,0i×j代表i行j列的零矩阵;
步骤5:在格网坐标系G下建立单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2间的观测方程,通过以下步骤实现
5.1)确定观测量z(t)为扣除两套系统间的杆臂效应之后的格网东向速度误差差值、格网北向速度误差差值,以及位置误差角差值,如下:
<mrow>
<mi>z</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>26</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网东向速度, 分别为单轴旋转调制激光陀螺航海惯性导航系统1、双轴旋转调制激光陀螺航海惯性导航系统2各自输出的格网北向速度;分别为中相应的矩阵元素;
5.2)确定观测方程为
z(t)=HxG(t)+υ(t) (27)
其中,观测矩阵为I2为二阶单位矩阵,υ(t)为观测噪声;
步骤6:在格网坐标系G下分别对单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的姿态、速度、位置矩阵进行更新,按照步骤4、步骤5中所述联合误差状态方程、观测方程进行卡尔曼滤波,对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏▽1进行估计;
步骤7:根据步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏▽1,对它们造成的确定性的长期定位误差进行预测补偿,补偿方式为输出校正,预测补偿步骤为:
7.1)根据步骤2.1)、2.2)、2.3)所建立的单轴旋转调制激光陀螺航海惯性导航系统1的姿态误差、速度误差、位置误差角微分方程,确定其误差状态为
<mrow>
<msubsup>
<mi>x</mi>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>U</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>28</mn>
<mo>)</mo>
</mrow>
</mrow>
误差状态方程同步骤2.1)、2.2)、2.3)所述,同时将步骤6中估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏▽1作为外界输入矢量u(t)=[εx1 εy1 εz1 ▽x1 ▽y1]T;
7.2)离散化步骤7.1)中的误差状态方程,得到单轴旋转调制激光陀螺航海惯性导航系统1的定位误差预测模型
<mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>&Phi;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>&Gamma;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>u</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>29</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Phi;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>e</mi>
<mrow>
<msub>
<mi>A</mi>
<mn>1</mn>
</msub>
<mi>&Delta;</mi>
<mi>t</mi>
</mrow>
</msup>
<mo>,</mo>
<msub>
<mi>&Gamma;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>&Phi;</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>,</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mrow>
<mi>&Delta;</mi>
<mi>t</mi>
</mrow>
</msubsup>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>1</mn>
</msub>
<mi>&tau;</mi>
</mrow>
</msup>
<msub>
<mi>d&tau;B</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>30</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>A</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>F</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>2</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>3</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>F</mi>
<mn>5</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>6</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>7</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>9</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>F</mi>
<mn>10</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mi>C</mi>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
</mrow>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msubsup>
<mover>
<mi>C</mi>
<mo>&OverBar;</mo>
</mover>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>31</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为误差状态的离散化估计量,Φ1(k+1,k)为系统状态矩阵A1的离散矩阵,Γ1(k+1,k)为外界输入矩阵B1的离散矩阵,Δt为离散间隔,为外界输入量u(t)的离散量,k、k+1为离散化时刻,初始时刻
7.3)根据定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差通过卡尔曼滤波进行预测补偿,补偿方式为输出校正,补偿过确定性定位误差后,单轴旋转调制激光陀螺航海惯性导航系统1的位置输出矩阵为
<mrow>
<msubsup>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mi>e</mi>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mover>
<mi>C</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>-</mo>
<mi>&delta;</mi>
<msubsup>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>,</mo>
<mi>&delta;</mi>
<msubsup>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<mo>&lsqb;</mo>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msubsup>
<mover>
<mi>C</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<msub>
<mi>G</mi>
<mn>1</mn>
</msub>
</msubsup>
<mo>,</mo>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
<mi>G</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<msub>
<mi>c</mi>
<mn>13</mn>
</msub>
<msub>
<mi>c</mi>
<mn>33</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>G</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>32</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为通过定位误差预测模型估计得到的单轴旋转调制激光陀螺航海惯性导航系统1的位置误差角,分别是的格网东向分量和格网北向分量,为位置矩阵修正值;
步骤8:舰船一旦进入极区,导航坐标系由当地地理坐标系n切换为格网坐标系G,相应的联合误差状态及其协方差也从当地地理坐标系n转换到格网坐标系G下,通过以下步骤实现
8.1)格网坐标系G下表示的联合误差状态xG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态xn(t)得到,转换方式为xG(t)=Txn(t),其中,
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mi>n</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>&lsqb;</mo>
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>U</mi>
<mn>1</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&phi;</mi>
<mrow>
<mi>U</mi>
<mn>2</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>1</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>E</mi>
<mn>2</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>1</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&delta;v</mi>
<mrow>
<mi>N</mi>
<mn>2</mn>
</mrow>
<mi>n</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;L</mi>
<mn>12</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&delta;&lambda;</mi>
<mn>12</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>z</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>x</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mrow>
<mi>z</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>x</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<msub>
<mo>&dtri;</mo>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
<msup>
<mo>&rsqb;</mo>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>33</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>T</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>C</mi>
<mi>n</mi>
<mi>G</mi>
</msubsup>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<msubsup>
<mi>MC</mi>
<mi>n</mi>
<mi>G</mi>
</msubsup>
<msup>
<mi>M</mi>
<mi>T</mi>
</msup>
</mrow>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>2</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>T</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mn>2</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>2</mn>
<mo>&times;</mo>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>I</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>34</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>T</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&sigma;</mi>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>L</mi>
<mi> </mi>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mi>&lambda;</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>T</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>&lsqb;</mo>
<msup>
<mi>v</mi>
<mi>G</mi>
</msup>
<mo>&times;</mo>
<mo>&rsqb;</mo>
<msub>
<mi>T</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>T</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&sigma;</mi>
</mrow>
</mtd>
<mtd>
<mfrac>
<mrow>
<mi>cos</mi>
<mi>&sigma;</mi>
</mrow>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>35</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,当地地理系n下表示的单轴旋转调制激光陀螺航海惯性导航系统1姿态误差与双轴旋转调制激光陀螺航海惯性导航系统2姿态误差的差值的地理东向、地理北向、地理天向分量分别为单轴旋转调制激光陀螺航海惯性导航系统1速度误差与双轴旋转调制激光陀螺航海惯性导航系统2速度误差的差值的地理东向、地理北向分量分别为δL12、δλ12分别为单轴旋转调制激光陀螺航海惯性导航系统1与双轴旋转调制激光陀螺航海惯性导航系统2的纬度输出误差差值和经度输出误差差值;
8.2)格网坐标系G下表示的联合误差状态的协方差PG(t)通过转换矩阵T从当地地理系n下表示的联合误差状态的协方差Pn(t)得到,转换方式为
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>P</mi>
<mi>G</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>E</mi>
<mo>{</mo>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>G</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>x</mi>
<mi>G</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>G</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>x</mi>
<mi>G</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mi>E</mi>
<mo>{</mo>
<mrow>
<mo>(</mo>
<mi>T</mi>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>Tx</mi>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<mi>T</mi>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>Tx</mi>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mi>T</mi>
<mi>E</mi>
<mo>{</mo>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>x</mi>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>x</mi>
<mo>~</mo>
</mover>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>-</mo>
<msup>
<mi>x</mi>
<mi>n</mi>
</msup>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>}</mo>
<msup>
<mi>T</mi>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msup>
<mi>TP</mi>
<mi>n</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>T</mi>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>36</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,为格网坐标系G下联合误差状态xG(t)的估计值,为当地地理系n下联合误差状态xn(t)的估计值,E{}表示期望运算符,Pn(t)由当地地理系下的联合误差状态卡尔曼滤波器计算得到;
8.3)转换完成后,按步骤6所述通过卡尔曼滤波器对单轴旋转调制激光陀螺航海惯性导航系统1的陀螺漂移ε1、加速度计零偏▽1进行估计,并按步骤7所述的定位误差预测模型对单轴旋转调制激光陀螺航海惯性导航系统1的确定性的长期定位误差进行预测补偿;一旦作为主惯导的双轴旋转调制激光陀螺航海惯性导航系统2故障,可靠性更高且经过确定性定位误差补偿的单轴旋转调制激光陀螺航海惯性导航系统1继续输出定位信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711033300.XA CN107543545B (zh) | 2017-10-30 | 2017-10-30 | 极区双航海惯性导航系统定位信息融合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711033300.XA CN107543545B (zh) | 2017-10-30 | 2017-10-30 | 极区双航海惯性导航系统定位信息融合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107543545A true CN107543545A (zh) | 2018-01-05 |
CN107543545B CN107543545B (zh) | 2019-07-19 |
Family
ID=60967262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711033300.XA Active CN107543545B (zh) | 2017-10-30 | 2017-10-30 | 极区双航海惯性导航系统定位信息融合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107543545B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110196066A (zh) * | 2019-05-10 | 2019-09-03 | 西北工业大学 | 基于格网姿态速度信息不变的虚拟极区方法 |
CN110501028A (zh) * | 2019-09-16 | 2019-11-26 | 哈尔滨工程大学 | 一种用于双轴旋转mems-sins的十六位置旋转调制方法 |
CN111060140A (zh) * | 2019-12-31 | 2020-04-24 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
CN111879321A (zh) * | 2020-08-01 | 2020-11-03 | 中国人民解放军国防科技大学 | 一种基于机抖激光陀螺的惯性/天文组合导航系统 |
CN111928848A (zh) * | 2020-09-24 | 2020-11-13 | 中国人民解放军国防科技大学 | 一种基于虚拟圆球法向量模型的极区惯性导航方法 |
CN112304310A (zh) * | 2019-07-23 | 2021-02-02 | 南京航空航天大学 | 一种基于陀螺仪信息的惯性导航方法 |
CN113108782A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种海空旋转调制惯导/天文组合导航方法 |
CN113108787A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种长航时惯导/卫星全球组合导航方法 |
CN113108788A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种长航时惯导/天文全球组合导航方法 |
CN113108789A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss组合导航方法 |
CN113108783A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种无人潜航器惯性/多普勒组合导航方法 |
CN113108786A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 |
CN113155125A (zh) * | 2021-05-09 | 2021-07-23 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss全球组合导航方法 |
CN113432624A (zh) * | 2021-06-24 | 2021-09-24 | 中国人民解放军国防科技大学 | 一种激光陀螺旋转调制惯导系统的长周期导航测试方法 |
CN116222618A (zh) * | 2023-03-11 | 2023-06-06 | 中国人民解放军国防科技大学 | 一种极地环境下的双惯导协同标定方法 |
CN116519011A (zh) * | 2023-03-11 | 2023-08-01 | 中国人民解放军国防科技大学 | 基于Psi角误差修正模型的长航时双惯导协同标定方法 |
CN117516519A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060271298A1 (en) * | 2005-03-10 | 2006-11-30 | Macintosh Scott | Method for correcting a 3D location measured by a tracking system assuming a vertical offset |
CN101561280A (zh) * | 2009-05-19 | 2009-10-21 | 北京理工大学 | 一种捷联磁惯性组合系统 |
CN102928860A (zh) * | 2012-10-18 | 2013-02-13 | 无锡清华信息科学与技术国家实验室物联网技术中心 | 基于局部定位信息提高gps定位精度的方法 |
US8437979B2 (en) * | 2007-01-20 | 2013-05-07 | Kcf Technologies, Inc. | Smart tether system for underwater navigation and cable shape measurement |
CN104897178A (zh) * | 2015-07-06 | 2015-09-09 | 中国人民解放军国防科学技术大学 | 一种双惯导联合旋转调制导航与在线相对性能评估方法 |
CN106249260A (zh) * | 2016-09-28 | 2016-12-21 | 中国船舶重工集团公司第七0七研究所 | 一种卫星光纤罗经系统及其组合导航方法 |
CN107167134A (zh) * | 2017-06-22 | 2017-09-15 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
-
2017
- 2017-10-30 CN CN201711033300.XA patent/CN107543545B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060271298A1 (en) * | 2005-03-10 | 2006-11-30 | Macintosh Scott | Method for correcting a 3D location measured by a tracking system assuming a vertical offset |
US8437979B2 (en) * | 2007-01-20 | 2013-05-07 | Kcf Technologies, Inc. | Smart tether system for underwater navigation and cable shape measurement |
CN101561280A (zh) * | 2009-05-19 | 2009-10-21 | 北京理工大学 | 一种捷联磁惯性组合系统 |
CN102928860A (zh) * | 2012-10-18 | 2013-02-13 | 无锡清华信息科学与技术国家实验室物联网技术中心 | 基于局部定位信息提高gps定位精度的方法 |
CN104897178A (zh) * | 2015-07-06 | 2015-09-09 | 中国人民解放军国防科学技术大学 | 一种双惯导联合旋转调制导航与在线相对性能评估方法 |
CN106249260A (zh) * | 2016-09-28 | 2016-12-21 | 中国船舶重工集团公司第七0七研究所 | 一种卫星光纤罗经系统及其组合导航方法 |
CN107167134A (zh) * | 2017-06-22 | 2017-09-15 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
Non-Patent Citations (8)
Title |
---|
DING, XF (DING XIANFEI)等: ""Study on Regulating Law of Two-stage Turbo charger System of Piston Aircraft Engine"", 《2ND INTERNATIONAL SYMPOSIUM ON AIRCRAFT AIRWORTHINESS (ISAA)》 * |
JUN MO等: ""Application of KALMAN Filter in UM220 as a Dual system Satellite Positioning and Navigation Unit"", 《第三届中国卫星导航学术年会电子文集——S07北斗/GNSS用户终端技术》 * |
MAU-TSUEN YANG等: ""A Multimodal Fusion System for People Detection and Tracking"", 《INTERNATIONAL JOURNAL OF IMAGING SYSTEMS AND TECHNOLOGY》 * |
刘为任等: ""一种双惯导组合导航方法"", 《中国惯性技术学报》 * |
吴文启等: ""激光陀螺捷联惯导系统参数稳定性与外场自标定"", 《中国惯性技术学报》 * |
张鹭等: ""初始方位信 息辅助 下潜航器快速传递对准算法"", 《导航与控制》 * |
杨元喜等: ""北斗在极区导航定位性能分析"", 《武汉大学学报·信息科学版》 * |
鄂栋臣等: ""北极考察与GPS定位研究初探"", 《极地研究》 * |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110196066A (zh) * | 2019-05-10 | 2019-09-03 | 西北工业大学 | 基于格网姿态速度信息不变的虚拟极区方法 |
CN110196066B (zh) * | 2019-05-10 | 2022-07-15 | 西北工业大学 | 基于格网姿态速度信息不变的虚拟极区方法 |
CN112304310A (zh) * | 2019-07-23 | 2021-02-02 | 南京航空航天大学 | 一种基于陀螺仪信息的惯性导航方法 |
CN110501028A (zh) * | 2019-09-16 | 2019-11-26 | 哈尔滨工程大学 | 一种用于双轴旋转mems-sins的十六位置旋转调制方法 |
CN111060140A (zh) * | 2019-12-31 | 2020-04-24 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
CN111879321A (zh) * | 2020-08-01 | 2020-11-03 | 中国人民解放军国防科技大学 | 一种基于机抖激光陀螺的惯性/天文组合导航系统 |
CN111928848A (zh) * | 2020-09-24 | 2020-11-13 | 中国人民解放军国防科技大学 | 一种基于虚拟圆球法向量模型的极区惯性导航方法 |
CN113155125A (zh) * | 2021-05-09 | 2021-07-23 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss全球组合导航方法 |
CN113108783B (zh) * | 2021-05-09 | 2022-06-14 | 中国人民解放军国防科技大学 | 一种无人潜航器惯性/多普勒组合导航方法 |
CN113108789A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss组合导航方法 |
CN113108783A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种无人潜航器惯性/多普勒组合导航方法 |
CN113108786A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 |
CN113108787A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种长航时惯导/卫星全球组合导航方法 |
CN113108782A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种海空旋转调制惯导/天文组合导航方法 |
CN113108788A (zh) * | 2021-05-09 | 2021-07-13 | 中国人民解放军国防科技大学 | 一种长航时惯导/天文全球组合导航方法 |
CN113108782B (zh) * | 2021-05-09 | 2022-06-14 | 中国人民解放军国防科技大学 | 一种海空旋转调制惯导/天文组合导航方法 |
CN113432624B (zh) * | 2021-06-24 | 2022-05-13 | 中国人民解放军国防科技大学 | 一种激光陀螺旋转调制惯导系统的长周期导航测试方法 |
CN113432624A (zh) * | 2021-06-24 | 2021-09-24 | 中国人民解放军国防科技大学 | 一种激光陀螺旋转调制惯导系统的长周期导航测试方法 |
CN116222618A (zh) * | 2023-03-11 | 2023-06-06 | 中国人民解放军国防科技大学 | 一种极地环境下的双惯导协同标定方法 |
CN116519011A (zh) * | 2023-03-11 | 2023-08-01 | 中国人民解放军国防科技大学 | 基于Psi角误差修正模型的长航时双惯导协同标定方法 |
CN116222618B (zh) * | 2023-03-11 | 2024-02-13 | 中国人民解放军国防科技大学 | 一种极地环境下的双惯导协同标定方法 |
CN116519011B (zh) * | 2023-03-11 | 2024-03-01 | 中国人民解放军国防科技大学 | 基于Psi角误差修正模型的长航时双惯导协同标定方法 |
CN117516519A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
CN117516519B (zh) * | 2023-11-10 | 2024-04-09 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107543545B (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107543545B (zh) | 极区双航海惯性导航系统定位信息融合方法 | |
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN107167134B (zh) | 冗余配置激光陀螺航海惯导协同定位方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN106871928A (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN101793523B (zh) | 一种组合导航和光电探测一体化系统 | |
CN104897178B (zh) | 一种双惯导联合旋转调制导航与在线相对性能评估方法 | |
CN103900608B (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN108957496A (zh) | Uav抗gnss失效定位定向接收机及其应用方法 | |
CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
CN101344391A (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN105043415A (zh) | 基于四元数模型的惯性系自对准方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN105300404B (zh) | 一种舰船基准惯性导航系统标校方法 | |
CN104215242A (zh) | 一种基于横向游移坐标系的极区惯性导航方法 | |
CN109059964A (zh) | 一种基于重力峰的惯性导航与重力测量双校准方法 | |
CN102628691A (zh) | 一种完全自主的相对惯性导航方法 | |
CN110457813A (zh) | 基于横向地理坐标系的虚拟极区方法 | |
CN104697520A (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN108007477A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |