CN116222618B - 一种极地环境下的双惯导协同标定方法 - Google Patents

一种极地环境下的双惯导协同标定方法 Download PDF

Info

Publication number
CN116222618B
CN116222618B CN202310230520.0A CN202310230520A CN116222618B CN 116222618 B CN116222618 B CN 116222618B CN 202310230520 A CN202310230520 A CN 202310230520A CN 116222618 B CN116222618 B CN 116222618B
Authority
CN
China
Prior art keywords
inertial navigation
degrees
representing
error
stops
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.)
Active
Application number
CN202310230520.0A
Other languages
English (en)
Other versions
CN116222618A (zh
Inventor
王林
梁钟泓
廖志坤
郭鸿刚
王元涵
郝艳
陈宏翔
宋东阳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National University of Defense Technology
Original Assignee
National University of Defense Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by National University of Defense Technology filed Critical National University of Defense Technology
Priority to CN202310230520.0A priority Critical patent/CN116222618B/zh
Publication of CN116222618A publication Critical patent/CN116222618A/zh
Application granted granted Critical
Publication of CN116222618B publication Critical patent/CN116222618B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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

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′系表示横地球坐标系,表示地球坐标系与横地球坐标系之间的转换关系;
载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
基于横经纬网定义横地理坐标系,横北向指向横北极,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,t系表示横地理坐标系,n系表示地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
(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的速度误差矢量,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,/>表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,vt表示载体在横地理坐标系下的速度矢量,/>为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,为横地理坐标系相对于地球坐标系的旋转角速度,gt表示载体所在位置的重力矢量,分别表示载体在横东向、横北向、天向的速度,Lt、h为载体所在位置的横纬度和高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
式中,0i×j表示i行j列的零矩阵,λt表示载体所在位置的横经度,ωie表示地球自转角速度大小,分别表示比力在横东向、横北向、天向的投影,C23表示/>矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>表示惯导2在横东向、横北向、天向的姿态误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导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)Tr)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′系表示横地球坐标系,表示地球坐标系与横地球坐标系之间的转换关系;
载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
/>
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
基于横经纬网定义横地理坐标系,横北向指向横北极,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,t系表示横地理坐标系,n系表示地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
(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的速度误差矢量,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,/>表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,vt表示载体在横地理坐标系下的速度矢量,/>为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,为横地理坐标系相对于地球坐标系的旋转角速度,gt表示载体所在位置的重力矢量,分别表示载体在横东向、横北向、天向的速度,Lt、h为载体所在位置的横纬度和高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
/>
式中,0i×j表示i行j列的零矩阵,λt表示载体所在位置的横经度,ωie表示地球自转角速度大小,分别表示比力在横东向、横北向、天向的投影,C23表示/>矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>表示惯导2在横东向、横北向、天向的姿态误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导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)Tr)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′系表示横地球坐标系,表示地球坐标系与横地球坐标系之间的转换关系;
载体所在位置的法线与横赤道面的夹角定义为横纬度,与横本初子午面的夹角定义为横经度,将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为:
式中,Lt表示横纬度,λt表示横经度,L表示纬度,λ表示经度;
基于横经纬网定义横地理坐标系,横北向指向横北极点,所在位置的法线向上为天向,按照右手坐标系定义横东向,将横地理坐标系与地理坐标系之间的转换关系表示为:
式中,t系表示横地理坐标系,n系表示地理坐标系,β表示地理坐标系与横地理坐标系之间的旋转角度;
确定β与经纬度、横经纬度之间的转换关系:
(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在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导1的速度误差矢量,/>表示惯导1的横纬度误差,/>表示惯导1的横经度误差,δh1表示惯导1的高度误差,/>分别表示惯导1在横东向、横北向、天向的速度误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导1横纬度误差相关的地球自转角速度误差,/>表示与惯导1横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导1体坐标系至横地理坐标系的方向余弦矩阵,/>表示惯导2在横地理坐标系下的姿态误差角,/>表示横地理坐标系下的惯导2的速度误差矢量,/>表示惯导2的横纬度误差,/>表示惯导2的横经度误差,δh2表示惯导2的高度误差,/>分别表示惯导2在横东向、横北向、天向的速度误差,/>表示与惯导2横纬度误差、横地理坐标系下速度误差相关的横地理坐标系相对惯性坐标系的角速度误差,/>表示与惯导2横纬度误差相关的地球自转角速度误差,表示与惯导2横纬度误差、横地理坐标系下速度误差相关的转移角速度误差,/>表示惯导2体坐标系至横地理坐标系的方向余弦矩阵,vt表示载体在横地理坐标系下的速度矢量,为横地理坐标系相对于惯性坐标系的旋转角速度,/>为地球自转角速度向量,/>为横地理坐标系相对于地球坐标系的旋转角速度,ft表示比力在横地理坐标系的投影,分别表示载体在横东向、横北向、天向的速度,Lt、h为载体所在位置的横纬度和高度,Rx为载体所在位置的横东向的曲率半径,Ry为载体所在位置的横北向的曲率半径,/>为载体所在位置的扭曲率,RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径;
(3.2)确定联合状态方程:
其中,
式中,0i×j表示i行j列的零矩阵,λt表示载体所在位置的横经度,ωie表示地球自转角速度大小,分别表示比力在横东向、横北向、天向的投影,C23表示/>矩阵的第二、第三列,C3表示/>矩阵的第三列,/>表示惯导2的x轴陀螺输出值,/>表示惯导2的y轴陀螺输出值,/>表示惯导2的z轴陀螺输出值,/>表示惯导2的x轴加速度计输出值,/>表示惯导2的y轴加速度计输出值,/>表示惯导2的z轴加速度计输出值;
将状态向量x(t)表示为:
式中,表示惯导1在横东向、横北向、天向的姿态误差,/>表示惯导2在横东向、横北向、天向的姿态误差;
将噪声分布矩阵及噪声矩阵表示为:
(3.3)确定状态约束观测方程:
将惯导1、惯导2系统输出的速度、位置分别表示为:
式中,和/>分别表示惯导1和惯导2输出的横地理坐标系下的速度矢量,惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿,/>表示惯导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)Tr)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)中的联合转位次序适用于两套以上具有双轴转位机构的惯导系统间的在线标定,对于双轴和三轴惯导系统之间、多套三轴惯导系统间的在线标定也适用。
CN202310230520.0A 2023-03-11 2023-03-11 一种极地环境下的双惯导协同标定方法 Active CN116222618B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310230520.0A CN116222618B (zh) 2023-03-11 2023-03-11 一种极地环境下的双惯导协同标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310230520.0A CN116222618B (zh) 2023-03-11 2023-03-11 一种极地环境下的双惯导协同标定方法

Publications (2)

Publication Number Publication Date
CN116222618A CN116222618A (zh) 2023-06-06
CN116222618B true CN116222618B (zh) 2024-02-13

Family

ID=86587179

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310230520.0A Active CN116222618B (zh) 2023-03-11 2023-03-11 一种极地环境下的双惯导协同标定方法

Country Status (1)

Country Link
CN (1) CN116222618B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117537811B (zh) * 2023-11-10 2024-05-31 中国人民解放军国防科技大学 一种优化的地球椭球模型下跨极区导航切换方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6516021B1 (en) * 1999-09-14 2003-02-04 The Aerospace Corporation Global positioning systems and inertial measuring unit ultratight coupling method
CN103940446A (zh) * 2014-04-10 2014-07-23 哈尔滨工程大学 一种基于横坐标系的极区航行船舶捷联惯性导航系统重调方法
CN103983277A (zh) * 2014-05-16 2014-08-13 哈尔滨工程大学 一种适用于极区的惯导系统综合校正方法
CN107167134A (zh) * 2017-06-22 2017-09-15 中国人民解放军国防科学技术大学 冗余配置激光陀螺航海惯导协同定位方法
CN107543545A (zh) * 2017-10-30 2018-01-05 中国人民解放军国防科技大学 极区双航海惯性导航系统定位信息融合方法
CN109029454A (zh) * 2018-07-13 2018-12-18 哈尔滨工程大学 一种基于卡尔曼滤波的横坐标系捷联惯导系统阻尼算法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8005635B2 (en) * 2007-08-14 2011-08-23 Ching-Fang Lin Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6516021B1 (en) * 1999-09-14 2003-02-04 The Aerospace Corporation Global positioning systems and inertial measuring unit ultratight coupling method
CN103940446A (zh) * 2014-04-10 2014-07-23 哈尔滨工程大学 一种基于横坐标系的极区航行船舶捷联惯性导航系统重调方法
CN103983277A (zh) * 2014-05-16 2014-08-13 哈尔滨工程大学 一种适用于极区的惯导系统综合校正方法
CN107167134A (zh) * 2017-06-22 2017-09-15 中国人民解放军国防科学技术大学 冗余配置激光陀螺航海惯导协同定位方法
CN107543545A (zh) * 2017-10-30 2018-01-05 中国人民解放军国防科技大学 极区双航海惯性导航系统定位信息融合方法
CN109029454A (zh) * 2018-07-13 2018-12-18 哈尔滨工程大学 一种基于卡尔曼滤波的横坐标系捷联惯导系统阻尼算法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于格网系的双航海惯导定位信息融合;王林 等;《中国惯性技术学报》;第26卷(第2期);141-148页 *
航海多惯导协同定位与误差参数估计;王林;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》(第02期);53-82页 *

Also Published As

Publication number Publication date
CN116222618A (zh) 2023-06-06

Similar Documents

Publication Publication Date Title
CN116734887B (zh) 基于速度误差修正模型的极地双惯导协同标定方法
CN116481564B (zh) 基于Psi角误差修正模型的极地双惯导协同标定方法
CN109211269B (zh) 一种双轴旋转惯导系统姿态角误差标定方法
CN109471146B (zh) 一种基于ls-svm的自适应容错gps/ins组合导航方法
CN116222618B (zh) 一种极地环境下的双惯导协同标定方法
CN111947653A (zh) 一种月面巡视探测器双模式惯性/视觉/天文导航方法
CN110243362B (zh) 一种中高空超声速靶标导航方法
CN104697520A (zh) 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN111380518A (zh) 一种引入径向速度的sins/usbl紧组合导航定位方法
CN112710328A (zh) 一种四轴冗余惯导系统的误差标定方法
CN110514200B (zh) 一种惯性导航系统及高转速旋转体姿态测量方法
CN113203415B (zh) 一种原子陀螺导航系统及其导航解算方法
CN111141310B (zh) 一种垂直发射仿真转台激励补偿方法
CN111024128B (zh) 一种机载光电吊舱光轴稳定状态传递对准方法
CN115574817B (zh) 一种基于三轴旋转式惯导系统的导航方法及导航系统
CN115265599B (zh) 双轴旋转惯导地球物理场相关陀螺零偏的快速标定方法
CN114111805B (zh) 运载火箭多源多类测量数据位置基准高精度对齐方法
CN112304339B (zh) 一种卫星移动通信天线的惯导校准方法
CN111380520B (zh) 一种引入径向速度的sins/usbl松组合导航定位方法
CN116222619B (zh) 一种双惯导系统外场协同在线标定方法
CN116519011B (zh) 基于Psi角误差修正模型的长航时双惯导协同标定方法
CN116242397B (zh) 一种速度误差修正模型下的双惯导协同标定方法
CN115265597B (zh) 一种双轴旋转惯导地球物理场相关陀螺零偏的补偿方法
CN117470233B (zh) 一种优化的地球椭球模型下横坐标系组合导航方法
Zhang et al. A novel anti-swing initial alignment method based on polarization/geomagnetic fusion for ships working on unfamiliar waters

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