CN116734887A - 基于速度误差修正模型的极地双惯导协同标定方法 - Google Patents
基于速度误差修正模型的极地双惯导协同标定方法 Download PDFInfo
- Publication number
- CN116734887A CN116734887A CN202310230518.3A CN202310230518A CN116734887A CN 116734887 A CN116734887 A CN 116734887A CN 202310230518 A CN202310230518 A CN 202310230518A CN 116734887 A CN116734887 A CN 116734887A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- representing
- degrees
- error
- coordinate system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000012937 correction Methods 0.000 title claims abstract description 21
- 230000007246 mechanism Effects 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 48
- 239000013598 vector Substances 0.000 claims description 33
- 238000006243 chemical reaction Methods 0.000 claims description 18
- 238000009434 installation Methods 0.000 claims description 17
- 230000036544 posture Effects 0.000 claims description 9
- 230000017105 transposition Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000001568 sexual effect Effects 0.000 claims 1
- 239000000969 carrier Substances 0.000 abstract description 2
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 239000005441 aurora Substances 0.000 description 1
- 239000003245 coal Substances 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000003345 natural gas Substances 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 239000003208 petroleum Substances 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明属于导航领域,公开了基于速度误差修正模型的极地双惯导协同标定方法,适用于装备多套带有转位机构惯导系统的载体在极地的自主标定。本发明针对极地航行的舰船的惯导系统无外界参考信息时自标定能力受限的问题,以地球椭球模型下的横地理坐标系为导航坐标系,将两套惯导系统在横地理坐标系下的相对速度、相对位置为约束观测,建立了双惯导系统联合误差状态卡尔曼滤波器,在极地无外界基准信息的情况下,对待标定惯导系统的误差参数进行标定估计。本发明方法完全自主,以两套惯导系统的相对误差为约束观测,标定精度不受正常工作惯导系统绝对误差的影响;通过修正速度误差模型能提高动基座下的标定精度,具有重要工程意义。
Description
技术领域
本发明属于导航技术领域,涉及惯导系统的外场标定方法,特别涉及基于速度误差修正模型的极地双惯导协同标定方法,适用于两套及以上带有双轴或三轴转位机构的惯导系统间在极地的协同标定。
背景技术
极地具有重大的战略和经济价值,北极航道是连接东亚、欧洲和北美洲东岸的最短航道,蕴藏着石油、天然气、煤炭等各类资源。各类舰船的极地航行离不开高精度、高可靠性导航设备提供导航定位信息。由于经线收敛于地理极点、地磁线收敛于极点附近,传统磁罗盘定向的方式不适用于极区导航,此外,高纬度地区卫星高度角降低,卫星导航存在盲区,极光和磁暴的干扰会导致无线电导航失效等,低纬度地区常用的导航手段并不适用于极地范围内的导航定位。惯性导航是一种完全自主、抗干扰强的导航方式,是极地环境中最主要导航方式。然而惯性导航在极区也面临着计算溢出导致误差增大、缺少航向参考等问题,需要在进入极区后切换导航坐标系。
具备极地航行能力的舰船航行时长通常较长,对惯导系统的定位精度要求高。标定技术能够对惯导系统的误差项进行补偿,是提高惯导系统导航精度的关键技术。惯导系统在出厂前会在高精度转台上进行精确标定,但是由于环境等诸多因素的影响,一定时间后惯导系统的误差参数会发生变化,引起导航精度下降。随着旋转调制惯导系统、“三自”惯组技术的成熟,外场标定技术由于其免拆卸、成本低等优点,越来越成为标定技术研究的重点。在中低纬度下,传统的外场标定技术以外界准确参考信息作为观测,利用卡尔曼滤波实现系统级标定。然而在极区特殊的环境下,能够接收到的外界参考信息极其有限,外场标定技术的使用会受到限制。这对于需要定期标定或者故障后修复的惯导系统而言其导航精度会受到严重影响。具备极地航行能力的舰船出于可靠性的需要通常会搭载多套带有转位机构的惯导系统,利用两套惯导系统的冗余信息,以两套惯导系统间的相对速度、位置作为约束观测,构建联合状态卡尔曼滤波器能够使惯导系统的系统性误差得到标定估计。若在舰船运动过程中进行标定,传统的速度误差方程中的比力项需要微分得到,动态环境下误差较大,会影响标定的精度。
本发明针对目前存在的问题,提出基于速度误差修正模型的极地双惯导协同标定方法,适用于装备多套带有转位机构惯导系统的载体在极地环境下的标定。本发明以地球椭球模型下的横地理坐标系为导航坐标系,将两套惯导系统在横地理坐标系下的相对速度、相对位置作为约束观测,建立了地球椭球模型横地理坐标系下基于速度误差修正模型的双惯导系统联合状态卡尔曼滤波器。该方法不受载体运动状态的影响,在静基座、动基座下均能对待标定惯导系统的全误差参数进行在线标定,解决了极地无外界基准信息情况下惯导系统的外场标定难题;以两套惯导系统间的相对误差为观测量,标定精度不受惯导系统绝对误差的影响;通过速度误差修正模型消除了模型中的比力项,提高了在运动状态下的标定精度。
发明内容
本发明提出基于速度误差修正模型的极地双惯导协同标定方法,以地球椭球模型下的横地理坐标系为导航坐标系,实现了在极地环境无外界基准信息时,对具备自标定能力的惯导系统的陀螺标度因数、加速度计标度因数、安装误差角的标定。本标定方案不受载体运动状态的影响,在静基座、动基座条件下均能完成标定;通过速度误差修正模型提高了动基座下的标定精度;不受参考惯导系统绝对误差的影响。本发明标定精度能够满足导航级惯导系统的需求,具有重要工程实用价值。
为解决上述技术问题,本发明提出的解决方案为:
基于速度误差修正模型的极地双惯导协同标定方法,所述方法包括以下步骤:
(1)构建基于地球椭球模型下的横地球坐标系和横地理坐标系;
以北纬0°东经90°点为横地球坐标系下的北极点,定义为横北极点,北纬0°西经90°点为横地球坐标系下的南极点,定义为横南极点,0°经线和180°经线包围的椭圆面为横赤道面,取横北极、横南极和北极点组成的半个大椭圆为0°横经线,所在平面为横本初子午线,将地球坐标系与新定义的横地球坐标系之间的转换关系表示为:
式中,e系表示地球坐标系,e′系表示横地球坐标系,表示地球坐标系与横地球坐标系转换的方向余弦矩阵;
基于横经纬网定义横地理坐标系,横北向指向横北极,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,n系表示地理坐标系,t系表示横地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
确定方向余弦矩阵和速度矢量的转换关系:
式中,表示载体坐标系与横地理坐标系之间转换的方向余弦矩阵,/>表示载体坐标系与地理坐标系之间转换的方向余弦矩阵,vt表示横地理坐标系下的载体速度矢量,vn表示地理坐标系下的载体速度矢量;
将载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
(2)构建两套惯导系统的误差模型;
定义正常工作的双轴旋转调制惯导系统为惯导1,其体坐标系b1定义为“右-前-上”,待标定的惯导系统为惯导2,其体坐标系b2定义为“右-前-上”;
惯导1的标度因数误差及安装误差很小进而忽略,将惯导1的误差模型定义为:
其中,
式中,表示惯导1的陀螺组件误差,/>表示惯导1的加速度计组件误差,/>表示惯导1的x轴陀螺漂移,/>表示惯导1的y轴陀螺漂移,/>表示惯导1的z轴陀螺漂移,/>表示惯导1的x轴加速度计零偏,/>表示惯导1的y轴加速度计零偏,/>表示惯导1的z轴加速度计零偏,/>表示惯导1的陀螺漂移,/>表示惯导1的加速度计零偏,/>为惯导1的陀螺噪声,为惯导1加速度计噪声;
考虑标度因数误差、安装角误差及零偏误差,将惯导2的误差模型定义为:
其中,
式中,表示惯导2的陀螺组件误差,/>表示惯导2的加速度计组件误差,/>表示惯导2陀螺组件输出的理论角速度矢量,/>表示惯导2加速度计组件测得的理论比力矢量,/>表示惯导2的x轴陀螺漂移,/>表示惯导2的y轴陀螺漂移,/>表示惯导2的z轴陀螺漂移,/>表示惯导2的x轴加速度计零偏,/>表示惯导2的y轴加速度计零偏,/>表示惯导2的z轴加速度计零偏,/>表示惯导2的陀螺漂移,/>表示惯导2的加速度计零偏,/>为惯导2的陀螺噪声,/>为惯导2加速度计噪声;δκg和δμg表示陀螺的标度因数误差矩阵和安装误差矩阵,δκa和δμa表示加速度计的标度因数误差矩阵和安装误差矩阵;
确定δκg和δκa:
式中,δκgx、δκgy和δκgz分别表示x轴陀螺、y轴陀螺和z轴陀螺的标度因数误差,δκax、δκay和δκaz分别表示x轴加速度计、y轴加速度计和z轴加速度计的标度因数误差;
确定δμg和δμa:
式中,δμgyx、δμgzx和δμgzy表示陀螺组件的三个安装误差角,δμayx、δμazx、δμazy、δμaxy、δμaxz和δμayz表示加速度计组件的六个安装误差角;
(3)利用两套惯导系统输出的姿态、速度、位置相关信息,建立在横地理坐标系下的联合状态卡尔曼滤波器,具体步骤为:
(3.1)确定横地理坐标系下基于速度误差修正模型的系统联合误差方程:
其中,
式中,φ1 t表示惯导1在横地理坐标系下的姿态误差角,表示横地理坐标系下的惯导1的速度误差矢量,δr1 t表示惯导1在横地理坐标系下的位置误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,/>表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2在横地理坐标系下的位置误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,/>为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,/>为横地理坐标系相对于地球坐标系的旋转角速度,gt表示载体所在位置的重力矢量,vt表示载体在横地理坐标系下的速度,/>分别表示载体在横东向、横北向、天向的速度,h为载体所在位置的高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
F87=Frv F88=Frr
式中,0i×j表示i行j列的零矩阵,ωie表示地球自转角速度大小,gt分别载体位置处的重力加速度的值,C23表示矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>表示惯导2在横东向、横北向、天向的姿态误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,vt表示公共点的速度真值;惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导1输出的位置信息,/>表示惯导2输出的位置信息,/>表示b2坐标系相对于横地理坐标系的旋转角速度,/>表示两套惯导间的外杆臂,/>表示两套惯导间的外杆臂在惯导2体坐标系下的投影,rt表示公共点的位置在横地理坐标系下的真值;
由于两套系统反映的是同一载体的速度信息、位置信息,观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束,将观测量表示为:
式中,υv、υr为相应的速度观测噪声、位置观测噪声;
增加外界高度信息的观测
式中,为惯导1输出的高度值,υh为高度观测的噪声;
将观测方程表示为:
z(t)=H(t)x(t)+υ(t)
其中,
H1=[0 0 1]
υ(t)=[(υv)T (υr)T υh]T
式中,I3×3表示3行3列的单位矩阵;
(4)确定两套惯导系统的转位次序:
惯导1的转位次序为双轴16次序,具体转位流程如下:
次序1:z轴以9°/s正向旋转180°,转停100s;
次序2:y轴以9°/s反向旋转180°,转停100s;
次序3:z轴以9°/s正向旋转180°,转停100s;
次序4:y轴以9°/s反向旋转180°,转停100s;
次序5:y轴以9°/s反向旋转180°,转停100s;
次序6:z轴以9°/s正向旋转180°,转停100s;
次序7:y轴以9°/s反向旋转180°,转停100s;
次序8:z轴以9°/s正向旋转180°,转停100s;
次序9:z轴以9°/s反向旋转180°,转停100s;
次序10:y轴以9°/s正向旋转180°,转停100s;
次序11:z轴以9°/s反向旋转180°,转停100s;
次序12:y轴以9°/s正向旋转180°,转停100s;
次序13:y轴以9°/s正向旋转180°,转停100s;
次序14:z轴以9°/s反向旋转180°,转停100s;
次序15:y轴以9°/s正向旋转180°,转停100s;
次序16:z轴以9°/s反向旋转180°,转停100s;
惯导2的转位次序为18次序,具体转位流程如下:
次序1:y轴以9°/s正向旋转90°,转停180s;
次序2:y轴以9°/s正向旋转180°,转停180s;
次序3:y轴以9°/s正向旋转180°,转停180s;
次序4:z轴以9°/s正向旋转90°,转停180s;
次序5:z轴以9°/s正向旋转180°,转停180s;
次序6:z轴以9°/s正向旋转180°,转停180s;
次序7:x轴以9°/s正向旋转90°,转停180s;
次序8:x轴以9°/s正向旋转180°,转停180s;
次序9:x轴以9°/s正向旋转180°,转停180s;
次序10:x轴以9°/s正向旋转90°,转停180s;
次序11:x轴以9°/s正向旋转90°,转停180s;
次序12:x轴以9°/s正向旋转90°,转停180s;
次序13:z轴以9°/s正向旋转90°,转停180s;
次序14:z轴以9°/s正向旋转90°,转停180s;
次序15:z轴以9°/s正向旋转90°,转停180s;
次序16:y轴以9°/s正向旋转90°,转停180s;
次序17:y轴以9°/s正向旋转90°,转停180s;
次序18:y轴以9°/s正向旋转90°,转停180s;
基于联合转位方式,惯导1处于双轴旋转调制导航状态,惯导2处于标定状态,其陀螺标度因数误差、加速度计标度因数误差、安装误差均得到激励,根据步骤(3)所述方案,建立联合状态卡尔曼滤波器即实现惯导2的极区外场标定。
进一步的,本发明方法对载体的运动状态无要求,载体处于系泊状态或运动状态均能实现在线标定。
进一步的,本发明方法不仅仅适用于高纬度地区,在非横北极、横南极的中纬度地区同样适用。
进一步的,惯导1与惯导2处于零位时的相对姿态在安装完毕后标定得到,惯导2在标定初始时刻的姿态基于两套惯导的相对姿态通过与惯导1传递对准获得。
进一步的,步骤(4)所述的联合转位次序适用于两套及以上具有双轴转位机构的惯导系统间的在线标定,对于双轴和三轴惯导系统之间、多套三轴惯导系统间的在线标定也适用。
进一步的,步骤(4)所述的联合转位次序仅为基于两套具有双轴转位机构的惯导系统的优选方案,对于其他旋转调制次序与标定次序之间的联合转位方案,也属于本发明的范畴。
综上所述,本发明的优点及积极效果为:本发明建立了地球椭球模型横地理坐标系下基于速度误差修正模型的联合状态卡尔曼滤波器,解决了传统的以当地水平坐标系为导航坐标系的惯性导航系统在极区失效的问题,通过两套惯导系统协同转位,利用两套惯导系统的冗余信息实现了在极地环境下的标定,通过速度修正模型消除比力项,提高了动基座下的标定精度,该标定方法不受极地特殊地理位置和恶劣自然环境的影响,具有重要工程意义。
附图说明
图1是本发明实施例提供的流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
由于经线在极地快速收敛,以当地水平地理坐标系为导航坐标系的惯导系统会存在很大误差。由于磁暴、电离层的干扰等,在极区缺少可靠的外界参考信息,在极区的导航定位主要依赖于惯性导航系统。然而,当惯导系统在极地环境下需要定期标定或者故障后更换了部分组件需要重新标定,传统的外场标定技术不能满足这一需求,这会影响惯导系统的精度。此外,传统速度误差方程中的比力项无法直接测得,在动基座下比力计算不准会影响标定的精度。针对这些问题,本发明提出基于速度误差修正模型的极地双惯导协同标定方法,所述的标定方法如图1所示。具体实施方式如下:
(1)构建基于地球椭球模型下的横地球坐标系和横地理坐标系;
以北纬0°东经90°点为横地球坐标系下的北极点,定义为横北极点,北纬0°西经90°点为横地球坐标系下的南极点,定义为横南极点,0°经线和180°经线包围的椭圆面为横赤道面,取横北极、横南极和北极点组成的半个大椭圆为0°横经线,所在平面为横本初子午线,将地球坐标系与新定义的横地球坐标系之间的转换关系表示为:
式中,e系表示地球坐标系,e′系表示横地球坐标系,表示地球坐标系与横地球坐标系转换的方向余弦矩阵;
基于横经纬网定义横地理坐标系,横北向指向横北极,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,n系表示地理坐标系,t系表示横地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
确定方向余弦矩阵和速度矢量的转换关系:
式中,表示载体坐标系与横地理坐标系之间转换的方向余弦矩阵,/>表示载体坐标系与地理坐标系之间转换的方向余弦矩阵,vt表示横地理坐标系下的载体速度矢量,vn表示地理坐标系下的载体速度矢量;
将载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
(2)构建两套惯导系统的误差模型;
定义正常工作的双轴旋转调制惯导系统为惯导1,其体坐标系b1定义为“右-前-上”,待标定的惯导系统为惯导2,其体坐标系b2定义为“右-前-上”;
惯导1的标度因数误差及安装误差很小进而忽略,将惯导1的误差模型定义为:
其中,
式中,表示惯导1的陀螺组件误差,/>表示惯导1的加速度计组件误差,/>表示惯导1的x轴陀螺漂移,/>表示惯导1的y轴陀螺漂移,/>表示惯导1的z轴陀螺漂移,/>表示惯导1的x轴加速度计零偏,/>表示惯导1的y轴加速度计零偏,/>表示惯导1的z轴加速度计零偏,/>表示惯导1的陀螺漂移,/>表示惯导1的加速度计零偏,/>为惯导1的陀螺噪声,为惯导1加速度计噪声;
考虑标度因数误差、安装角误差及零偏误差,将惯导2的误差模型定义为:
其中,
式中,表示惯导2的陀螺组件误差,/>表示惯导2的加速度计组件误差,/>表示惯导2陀螺组件输出的理论角速度矢量,/>表示惯导2加速度计组件测得的理论比力矢量,/>表示惯导2的x轴陀螺漂移,/>表示惯导2的y轴陀螺漂移,/>表示惯导2的z轴陀螺漂移,/>表示惯导2的x轴加速度计零偏,/>表示惯导2的y轴加速度计零偏,/>表示惯导2的z轴加速度计零偏,/>表示惯导2的陀螺漂移,/>表示惯导2的加速度计零偏,/>为惯导2的陀螺噪声,/>为惯导2加速度计噪声;δκg和δμg表示陀螺的标度因数误差矩阵和安装误差矩阵,δκa和δμa表示加速度计的标度因数误差矩阵和安装误差矩阵;
确定δκg和δκa:
式中,δκgx、δκgy和δκgz分别表示x轴陀螺、y轴陀螺和z轴陀螺的标度因数误差,δκax、δκay和δκaz分别表示x轴加速度计、y轴加速度计和z轴加速度计的标度因数误差;
确定δμg和δμa:
式中,δμgyx、δμgzx和δμgzy表示陀螺组件的三个安装误差角,δμayx、δμazx、δμazy、δμaxy、δμaxz和δμayz表示加速度计组件的六个安装误差角;
(3)利用两套惯导系统输出的姿态、速度、位置相关信息,建立在横地理坐标系下的联合状态卡尔曼滤波器,具体步骤为:
(3.1)确定横地理坐标系下基于速度误差修正模型的系统联合误差方程:
其中,
/>
式中,φ1 t表示惯导1在横地理坐标系下的姿态误差角,表示横地理坐标系下的惯导1的速度误差矢量,φr1 t表示惯导1在横地理坐标系下的位置误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,/>表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2在横地理坐标系下的位置误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,/>为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,/>为横地理坐标系相对于地球坐标系的旋转角速度,gt表示载体所在位置的重力矢量,vt表示载体在横地理坐标系下的速度,/>分别表示载体在横东向、横北向、天向的速度,h为载体所在位置的高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
/>
/>
F87=Frv F88=Frr
式中,0i×j表示i行j列的零矩阵,ωie表示地球自转角速度大小,gt分别载体位置处的重力加速度的值,C23表示矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>表示惯导2在横东向、横北向、天向的姿态误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,vt表示公共点的速度真值;惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导1输出的位置信息,/>表示惯导2输出的位置信息,/>表示b2坐标系相对于横地理坐标系的旋转角速度,/>表示两套惯导间的外杆臂,/>表示两套惯导间的外杆臂在惯导2体坐标系下的投影,rt表示公共点的位置在横地理坐标系下的真值;
由于两套系统反映的是同一载体的速度信息、位置信息,观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束,将观测量表示为:
式中,υv、υr为相应的速度观测噪声、位置观测噪声;
增加外界高度信息的观测
式中,为惯导1输出的高度值,υh为高度观测的噪声;
将观测方程表示为:
z(t)=H(t)x(t)+υ(t)
其中,
/>
H1=[0 0 1]
υ(t)=[(υv)T (υr)T υh]T
式中,I3×3表示3行3列的单位矩阵;
(4)确定两套惯导系统的转位次序:
惯导1的转位次序为双轴16次序,具体转位流程如下:
次序1:z轴以9°/s正向旋转180°,转停100s;
次序2:y轴以9°/s反向旋转180°,转停100s;
次序3:z轴以9°/s正向旋转180°,转停100s;
次序4:y轴以9°/s反向旋转180°,转停100s;
次序5:y轴以9°/s反向旋转180°,转停100s;
次序6:z轴以9°/s正向旋转180°,转停100s;
次序7:y轴以9°/s反向旋转180°,转停100s;
次序8:z轴以9°/s正向旋转180°,转停100s;
次序9:z轴以9°/s反向旋转180°,转停100s;
次序10:y轴以9°/s正向旋转180°,转停100s;
次序11:z轴以9°/s反向旋转180°,转停100s;
次序12:y轴以9°/s正向旋转180°,转停100s;
次序13:y轴以9°/s正向旋转180°,转停100s;
次序14:z轴以9°/s反向旋转180°,转停100s;
次序15:y轴以9°/s正向旋转180°,转停100s;
次序16:z轴以9°/s反向旋转180°,转停100s;
惯导2的转位次序为18次序,具体转位流程如下:
次序1:y轴以9°/s正向旋转90°,转停180s;
次序2:y轴以9°/s正向旋转180°,转停180s;
次序3:y轴以9°/s正向旋转180°,转停180s;
次序4:z轴以9°/s正向旋转90°,转停180s;
次序5:z轴以9°/s正向旋转180°,转停180s;
次序6:z轴以9°/s正向旋转180°,转停180s;
次序7:x轴以9°/s正向旋转90°,转停180s;
次序8:x轴以9°/s正向旋转180°,转停180s;
次序9:x轴以9°/s正向旋转180°,转停180s;
次序10:x轴以9°/s正向旋转90°,转停180s;
次序11:x轴以9°/s正向旋转90°,转停180s;
次序12:x轴以9°/s正向旋转90°,转停180s;
次序13:z轴以9°/s正向旋转90°,转停180s;
次序14:z轴以9°/s正向旋转90°,转停180s;
次序15:z轴以9°/s正向旋转90°,转停180s;
次序16:y轴以9°/s正向旋转90°,转停180s;
次序17:y轴以9°/s正向旋转90°,转停180s;
次序18:y轴以9°/s正向旋转90°,转停180s;
基于联合转位方式,惯导1处于双轴旋转调制导航状态,惯导2处于标定状态,其陀螺标度因数误差、加速度计标度因数误差、安装误差均得到激励,根据步骤(3)所述方案,建立联合状态卡尔曼滤波器即实现惯导2的极区外场标定。
本发明方法对载体的运动状态无要求,载体处于系泊状态或运动状态均能实现在线标定。
本发明方法不仅仅适用于高纬度地区,在非横北极、横南极的中纬度地区同样适用。
惯导1与惯导2处于零位时的相对姿态在安装完毕后标定得到,惯导2在标定初始时刻的姿态基于两套惯导的相对姿态通过与惯导1传递对准获得。
所述步骤(4)中的联合转位次序适用于两套及以上具有双轴转位机构的惯导系统间的在线标定,对于双轴和三轴惯导系统之间、多套三轴惯导系统间的在线标定也适用。
所述步骤(4)中的联合转位次序仅为基于两套具有双轴转位机构的惯导系统的优选方案,对于其他旋转调制次序与标定次序之间的联合转位方案,也属于本发明的范畴。
以上所述仅是本发明的优选实施方式,并不用以限制本发明,凡属于本发明思路下的技术方案均属于本发明的保护范围。在不脱离本发明原理前提下的若干改进和润饰等,这些改进和润饰也应视为本发明的保护范围。
Claims (5)
1.基于速度误差修正模型的极地双惯导协同标定方法,其特征在于,所述方法包括以下步骤:
(1)构建基于地球椭球模型下的横地球坐标系和横地理坐标系;
以北纬0°东经90°点为横地球坐标系下的北极点,定义为横北极点,北纬0°西经90°点为横地球坐标系下的南极点,定义为横南极点,0°经线和180°经线包围的椭圆面为横赤道面,取横北极、横南极和北极点组成的半个大椭圆为0°横经线,所在平面为横本初子午线,将地球坐标系与新定义的横地球坐标系之间的转换关系表示为:
式中,e系表示地球坐标系,e′系表示横地球坐标系,表示地球坐标系与横地球坐标系转换的方向余弦矩阵;
基于横经纬网定义横地理坐标系,横北向指向横北极,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,n系表示地理坐标系,t系表示横地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
确定方向余弦矩阵和速度矢量的转换关系:
式中,表示载体坐标系与横地理坐标系之间转换的方向余弦矩阵,/>表示载体坐标系与地理坐标系之间转换的方向余弦矩阵,vt表示横地理坐标系下的载体速度矢量,vn表示地理坐标系下的载体速度矢量;
将载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
(2)构建两套惯导系统的误差模型;
定义正常工作的双轴旋转调制惯导系统为惯导1,其体坐标系b1定义为“右-前-上”,待标定的惯导系统为惯导2,其体坐标系b2定义为“右-前-上”;
惯导1的标度因数误差及安装误差很小进而忽略,将惯导1的误差模型定义为:
其中,
式中,表示惯导1的陀螺组件误差,/>表示惯导1的加速度计组件误差,/>表示惯导1的x轴陀螺漂移,/>表示惯导1的y轴陀螺漂移,/>表示惯导1的z轴陀螺漂移,/>表示惯导1的x轴加速度计零偏,/>表示惯导1的y轴加速度计零偏,/>表示惯导1的z轴加速度计零偏,/>表示惯导1的陀螺漂移,/>表示惯导1的加速度计零偏,/>为惯导1的陀螺噪声,/>为惯导1加速度计噪声;
考虑标度因数误差、安装角误差及零偏误差,将惯导2的误差模型定义为:
其中,
式中,表示惯导2的陀螺组件误差,/>表示惯导2的加速度计组件误差,/>表示惯导2陀螺组件输出的理论角速度矢量,/>表示惯导2加速度计组件测得的理论比力矢量,/>表示惯导2的x轴陀螺漂移,/>表示惯导2的y轴陀螺漂移,/>表示惯导2的z轴陀螺漂移,/>表示惯导2的x轴加速度计零偏,/>表示惯导2的y轴加速度计零偏,/>表示惯导2的z轴加速度计零偏,/>表示惯导2的陀螺漂移,/>表示惯导2的加速度计零偏,/>为惯导2的陀螺噪声,/>为惯导2加速度计噪声;δκg和δμg表示陀螺的标度因数误差矩阵和安装误差矩阵,δκa和δμa表示加速度计的标度因数误差矩阵和安装误差矩阵;
确定δκg和δκa:
式中,δκgx、δκgy和δκgz分别表示x轴陀螺、y轴陀螺和z轴陀螺的标度因数误差,δκax、δκay和δκaz分别表示x轴加速度计、y轴加速度计和z轴加速度计的标度因数误差;
确定δμg和δμa:
式中,δμgyx、δμgzx和δμgzy表示陀螺组件的三个安装误差角,δμayx、δμazx、δμazy、δμaxy、δμaxz和δμayz表示加速度计组件的六个安装误差角;
(3)利用两套惯导系统输出的姿态、速度、位置相关信息,建立在横地理坐标系下的联合状态卡尔曼滤波器,具体步骤为:
(3.1)确定横地理坐标系下基于速度误差修正模型的系统联合误差方程:
其中,
式中,φ1 t表示惯导1在横地理坐标系下的姿态误差角,表示横地理坐标系下的惯导1的速度误差矢量,δr1 t表示惯导1在横地理坐标系下的位置误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,φ2 t表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2在横地理坐标系下的位置误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,/>为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,/>为横地理坐标系相对于地球坐标系的旋转角速度,gt表示载体所在位置的重力矢量,vt表示载体在横地理坐标系下的速度,/>分别表示载体在横东向、横北向、天向的速度,h为载体所在位置的高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
式中,0i×j表示i行j列的零矩阵,ωie表示地球自转角速度大小,gt分别载体位置处的重力加速度的值,C23表示矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>表示惯导2在横东向、横北向、天向的姿态误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,/>表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,vt表示公共点的速度真值;惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导1输出的位置信息,/>表示惯导2输出的位置信息,/>表示b2坐标系相对于横地理坐标系的旋转角速度,/>表示两套惯导间的外杆臂,/>表示两套惯导间的外杆臂在惯导2体坐标系下的投影,rt表示公共点的位置在横地理坐标系下的真值;
由于两套系统反映的是同一载体的速度信息、位置信息,观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束,将观测量表示为:
式中,υv、υr为相应的速度观测噪声、位置观测噪声;
增加外界高度信息的观测
式中,为惯导1输出的高度值,υh为高度观测的噪声;
将观测方程表示为:
z(t)=H(t)x(t)+υ(t)
其中,
H1=[0 0 1]
υ(t)=[(υv)T (υr)T υh]T
式中,I3×3表示3行3列的单位矩阵;
(4)确定两套惯导系统的转位次序:
惯导1的转位次序为双轴16次序,具体转位流程如下:
次序1:z轴以9°/s正向旋转180°,转停100s;
次序2:y轴以9°/s反向旋转180°,转停100s;
次序3:z轴以9°/s正向旋转180°,转停100s;
次序4:y轴以9°/s反向旋转180°,转停100s;
次序5:y轴以9°/s反向旋转180°,转停100s;
次序6:z轴以9°/s正向旋转180°,转停100s;
次序7:y轴以9°/s反向旋转180°,转停100s;
次序8:z轴以9°/s正向旋转180°,转停100s;
次序9:z轴以9°/s反向旋转180°,转停100s;
次序10:y轴以9°/s正向旋转180°,转停100s;
次序11:z轴以9°/s反向旋转180°,转停100s;
次序12:y轴以9°/s正向旋转180°,转停100s;
次序13:y轴以9°/s正向旋转180°,转停100s;
次序14:z轴以9°/s反向旋转180°,转停100s;
次序15:y轴以9°/s正向旋转180°,转停100s;
次序16:z轴以9°/s反向旋转180°,转停100s;
惯导2的转位次序为18次序,具体转位流程如下:
次序1:y轴以9°/s正向旋转90°,转停180s;
次序2:y轴以9°/s正向旋转180°,转停180s;
次序3:y轴以9°/s正向旋转180°,转停180s;
次序4:z轴以9°/s正向旋转90°,转停180s;
次序5:z轴以9°/s正向旋转180°,转停180s;
次序6:z轴以9°/s正向旋转180°,转停180s;
次序7:x轴以9°/s正向旋转90°,转停180s;
次序8:x轴以9°/s正向旋转180°,转停180s;
次序9:x轴以9°/s正向旋转180°,转停180s;
次序10:x轴以9°/s正向旋转90°,转停180s;
次序11:x轴以9°/s正向旋转90°,转停180s;
次序12:x轴以9°/s正向旋转90°,转停180s;
次序13:z轴以9°/s正向旋转90°,转停180s;
次序14:z轴以9°/s正向旋转90°,转停180s;
次序15:z轴以9°/s正向旋转90°,转停180s;
次序16:y轴以9°/s正向旋转90°,转停180s;
次序17:y轴以9°/s正向旋转90°,转停180s;
次序18:y轴以9°/s正向旋转90°,转停180s;
基于联合转位方式,惯导1处于双轴旋转调制导航状态,惯导2处于标定状态,其陀螺标度因数误差、加速度计标度因数误差、安装误差均得到激励,根据步骤(3)所述方案,建立联合状态卡尔曼滤波器即实现惯导2的极区外场标定。
2.如权利要求1所述的基于速度误差修正模型的极地双惯导协同标定方法,其特征在于,所述方法对载体的运动状态无要求,载体处于系泊状态或运动状态均能实现在线标定。
3.如权利要求1所述的基于速度误差修正模型的极地双惯导协同标定方法,其特征在于,所述方法不仅仅适用于高纬度地区,在非横北极、横南极的中纬度地区同样适用。
4.如权利要求1所述的基于速度误差修正模型的极地双惯导协同标定方法,其特征在于,惯导1与惯导2处于零位时的相对姿态在安装完毕后标定得到,惯导2在标定初始时刻的姿态基于两套惯导的相对姿态通过与惯导1传递对准获得。
5.如权利要求1所述的基于速度误差修正模型的极地双惯导协同标定方法,其特征在于,步骤(4)所述的联合转位次序适用于两套及以上具有双轴转位机构的惯导系统间的在线标定,对于双轴和三轴惯导系统之间、多套三轴惯导系统间的在线标定也适用。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310230518.3A CN116734887B (zh) | 2023-03-11 | 2023-03-11 | 基于速度误差修正模型的极地双惯导协同标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310230518.3A CN116734887B (zh) | 2023-03-11 | 2023-03-11 | 基于速度误差修正模型的极地双惯导协同标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116734887A true CN116734887A (zh) | 2023-09-12 |
CN116734887B CN116734887B (zh) | 2024-01-30 |
Family
ID=87917594
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310230518.3A Active CN116734887B (zh) | 2023-03-11 | 2023-03-11 | 基于速度误差修正模型的极地双惯导协同标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116734887B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117470233A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下横坐标系组合导航方法 |
CN117470234A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
CN117516519A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
CN117537811A (zh) * | 2023-11-10 | 2024-02-09 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
CN117537811B (zh) * | 2023-11-10 | 2024-05-31 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090037107A1 (en) * | 2004-03-29 | 2009-02-05 | Huddle James R | Inertial navigation system error correction |
US20090089001A1 (en) * | 2007-08-14 | 2009-04-02 | American Gnc Corporation | Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS) |
CN103983277A (zh) * | 2014-05-16 | 2014-08-13 | 哈尔滨工程大学 | 一种适用于极区的惯导系统综合校正方法 |
US20180066961A1 (en) * | 2016-09-02 | 2018-03-08 | Northrop Grumman Systems Corporation | Self-calibration of an inertial system |
CN108759863A (zh) * | 2018-05-08 | 2018-11-06 | 北京航天时代激光导航技术有限责任公司 | 一种激光捷联惯组误差参数快速标定方法及系统 |
CN109029454A (zh) * | 2018-07-13 | 2018-12-18 | 哈尔滨工程大学 | 一种基于卡尔曼滤波的横坐标系捷联惯导系统阻尼算法 |
CN115585826A (zh) * | 2022-08-12 | 2023-01-10 | 中国人民解放军国防科技大学 | 多惯导旋转调制光纤陀螺标度因数误差自校正方法与装置 |
-
2023
- 2023-03-11 CN CN202310230518.3A patent/CN116734887B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090037107A1 (en) * | 2004-03-29 | 2009-02-05 | Huddle James R | Inertial navigation system error correction |
US20090089001A1 (en) * | 2007-08-14 | 2009-04-02 | American Gnc Corporation | Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS) |
CN103983277A (zh) * | 2014-05-16 | 2014-08-13 | 哈尔滨工程大学 | 一种适用于极区的惯导系统综合校正方法 |
US20180066961A1 (en) * | 2016-09-02 | 2018-03-08 | Northrop Grumman Systems Corporation | Self-calibration of an inertial system |
CN108759863A (zh) * | 2018-05-08 | 2018-11-06 | 北京航天时代激光导航技术有限责任公司 | 一种激光捷联惯组误差参数快速标定方法及系统 |
CN109029454A (zh) * | 2018-07-13 | 2018-12-18 | 哈尔滨工程大学 | 一种基于卡尔曼滤波的横坐标系捷联惯导系统阻尼算法 |
CN115585826A (zh) * | 2022-08-12 | 2023-01-10 | 中国人民解放军国防科技大学 | 多惯导旋转调制光纤陀螺标度因数误差自校正方法与装置 |
Non-Patent Citations (5)
Title |
---|
XIAO BAO-LIANG 等: "Simulation Research on Strapdown Inertial Measuring Unit Calibration", JOURNAL OF SYSTEM SIMULATION, vol. 23, no. 5, pages 921 - 4 * |
李倩: "横坐标系捷联惯导系统极区导航及其误差抑制技术研究", 中国博士学位论文全文数据库工程科技Ⅱ辑, no. 11, pages 036 - 27 * |
李杨 等: "伪惯导建模的极区双速度模式惯性系对准算法", 系统工程与电子技术, vol. 44, no. 5, pages 1677 - 1684 * |
王林 等: "双航海惯导联合旋转调制协同定位与误差参数估计", 中国惯性技术学报, vol. 25, no. 5, pages 599 - 605 * |
王林 等: "基于格网系的双航海惯导定位信息融合", 中国惯性技术学报, vol. 26, no. 02, pages 141 - 148 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117470233A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下横坐标系组合导航方法 |
CN117470234A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
CN117516519A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
CN117537811A (zh) * | 2023-11-10 | 2024-02-09 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
CN117516519B (zh) * | 2023-11-10 | 2024-04-09 | 中国人民解放军国防科技大学 | 一种跨极区最优阻尼切换方法 |
CN117470234B (zh) * | 2023-11-10 | 2024-04-26 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
CN117537811B (zh) * | 2023-11-10 | 2024-05-31 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
Also Published As
Publication number | Publication date |
---|---|
CN116734887B (zh) | 2024-01-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN116734887B (zh) | 基于速度误差修正模型的极地双惯导协同标定方法 | |
CN116481564B (zh) | 基于Psi角误差修正模型的极地双惯导协同标定方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN115200574B (zh) | 一种地球椭球模型下的极区横向组合导航方法 | |
CN106979781B (zh) | 基于分布式惯性网络的高精度传递对准方法 | |
CN110243362B (zh) | 一种中高空超声速靶标导航方法 | |
CN111947653A (zh) | 一种月面巡视探测器双模式惯性/视觉/天文导航方法 | |
CN108871326A (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN111121766A (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN104697520A (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN110514200B (zh) | 一种惯性导航系统及高转速旋转体姿态测量方法 | |
CN113203415B (zh) | 一种原子陀螺导航系统及其导航解算方法 | |
CN112747770B (zh) | 一种基于速度量测的载体机动中初始对准方法 | |
CN112710328A (zh) | 一种四轴冗余惯导系统的误差标定方法 | |
CN115574817B (zh) | 一种基于三轴旋转式惯导系统的导航方法及导航系统 | |
CN116222618B (zh) | 一种极地环境下的双惯导协同标定方法 | |
CN111380520B (zh) | 一种引入径向速度的sins/usbl松组合导航定位方法 | |
CN116242397B (zh) | 一种速度误差修正模型下的双惯导协同标定方法 | |
CN116519011B (zh) | 基于Psi角误差修正模型的长航时双惯导协同标定方法 | |
CN116222619B (zh) | 一种双惯导系统外场协同在线标定方法 | |
CN112304339A (zh) | 一种卫星移动通信天线的惯导校准方法 | |
CN115265597B (zh) | 一种双轴旋转惯导地球物理场相关陀螺零偏的补偿方法 | |
CN117470233A (zh) | 一种优化的地球椭球模型下横坐标系组合导航方法 | |
CN116878541A (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 |