CN116481564A - 基于Psi角误差修正模型的极地双惯导协同标定方法 - Google Patents
基于Psi角误差修正模型的极地双惯导协同标定方法 Download PDFInfo
- Publication number
- CN116481564A CN116481564A CN202310230514.5A CN202310230514A CN116481564A CN 116481564 A CN116481564 A CN 116481564A CN 202310230514 A CN202310230514 A CN 202310230514A CN 116481564 A CN116481564 A CN 116481564A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- representing
- degrees
- coordinate system
- error
- 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 53
- 238000012937 correction Methods 0.000 title claims abstract description 24
- 239000011159 matrix material Substances 0.000 claims description 45
- 239000013598 vector Substances 0.000 claims description 24
- 238000009434 installation Methods 0.000 claims description 16
- 238000006243 chemical reaction Methods 0.000 claims description 15
- 230000008569 process Effects 0.000 claims description 13
- 230000005484 gravity Effects 0.000 claims description 9
- 230000036544 posture Effects 0.000 claims description 9
- 238000012546 transfer Methods 0.000 claims description 9
- 230000007246 mechanism Effects 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 6
- 230000017105 transposition Effects 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 239000000969 carrier Substances 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000004083 survival effect Effects 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
本发明属于导航技术领域，公开了基于Psi角误差修正模型的极地双惯导协同标定方法，适用于极地环境无外界参考信息时双惯导系统的协同标定。本发明在椭球模型横地球坐标系的基础上，将两套惯导系统在横平台坐标系下的相对速度、横计算坐标系下的相对位置作为约束观测，建立了Psi角误差修正模型下的双惯导系统联合状态卡尔曼滤波器，对待标定惯导系统的误差参数进行标定估计。本发明方法标定精度不受正常工作惯导系统绝对误差的影响，在运动状态下也能进行标定；通过对速度误差模型的修正，避免动态情况下比力不准影响标定精度；Psi角误差模型定义在计算坐标系，与位置误差解耦，更适合极地航行的长航时舰船惯导系统的标定。
Description
技术领域
本发明属于导航技术领域，涉及惯导系统的外场标定方法，特别涉及基于Psi角误差修正模型的极地双惯导协同标定方法，适用于两套及以上带有双轴或三轴转位机构的惯导系统间在极地的协同标定。
背景技术
极地地区自然资源丰富，战略地位重要，具有很高的科学研究和战略价值，北极问题已超出北极区域的范畴，攸关人类生存和发展的共同命运。为确保舰船等载体平台在极地的安全航行，载体精确的定位导航技术是需要解决的关键问题之一。由于经线收敛于地理极点、地磁线收敛于极点附近，此外，极地环境复杂，磁暴、太阳风暴频发，这导致很多低纬度地区常用的导航手段并不适用于极地范围内的导航定位。惯性导航能够为载体连续提供姿态、速度、位置信息，是极地环境中最主要导航方式。然而惯性导航在极区也面临着计算溢出导致误差增大、缺少航向参考等问题，需要在进入极区后切换导航坐标系。
由于惯导系统自身特性以及外界环境的影响，惯导系统在一段时间后其误差参数会发生变化，这会严重影响惯导系统的定位精度。此外，在极地环境中，恶劣的环境会导致惯导系统的元器件发生故障的可能性增大。这些情况下需要对惯导系统重新进行标定以保证惯导系统的定位精度。在中低纬度下载体一般具备外界准确参考信息作为观测，利用卡尔曼滤波即可对惯导系统实现系统级标定。然而在极区特殊的环境下，能够接收到的外界参考信息极其有限，外场标定技术的使用会受到限制。这对于需要定期标定或者故障后修复的惯导系统而言其导航精度会受到严重影响。具备极地航行能力的舰船航时长，对系统可靠性的要求高，通常会搭载多套带有转位机构的惯导系统。利用两套惯导系统的冗余信息，以两套惯导系统间的相对速度、位置作为约束观测，构建联合状态卡尔曼滤波器能够使惯导系统的系统性误差得到标定估计。传统的Phi角误差模型定义在真实坐标系，然而真实坐标系是未知的，通常将计算坐标系近似为真实坐标系使用，存在近似误差，而Psi角误差模型定义在计算坐标系，与位置误差解耦，更适合极区长航时航行的舰船。此外，若在舰船运动过程中进行标定，传统的速度误差方程中的比力项需微分获得，在动态环境下误差较大，也会影响标定的精度。
本发明针对目前存在的问题，提出基于Psi角误差修正模型的极地双惯导协同标定方法，适用于装备多套带有转位机构惯导系统的载体在极地环境下的标定。本发明以两套惯导系统在横平台坐标系下的相对速度、横计算坐标系下的相对位置作为约束观测，建立了地球椭球模型横地球坐标系下基于Psi角误差修正模型的双惯导系统联合状态卡尔曼滤波器对待标定惯导系统的误差进行估计。该方法不受载体运动状态的影响，在静基座、动基座下均能对待标定惯导系统的全误差参数进行在线标定，解决了极地无外界基准信息情况下惯导系统的外场标定难题；以两套惯导系统间的相对误差为观测量，标定精度不受惯导系统绝对误差的影响；通过误差修正模型消除了模型中的比力项，提高了在运动状态下的标定精度；Psi角误差模型定义在计算坐标系，与位置误差解耦，更适合极地航行的长航时舰船惯导系统的标定。
发明内容
本发明提出基于Psi角误差修正模型的极地双惯导协同标定方法，实现了在极地环境无外界基准信息时，对具备自标定能力的惯导系统的陀螺标度因数、加速度计标度因数、安装误差角的标定，Psi角误差模型更适合极地航行的长航时舰船的惯导系统，对速度误差模型进行修正提高了运动状态下的标定精度，本发明的标定精度能够满足导航级惯导系统的需求，具有重要工程实用价值。
为解决上述技术问题，本发明提出的解决方案为：
基于Psi角误差修正模型的极地双惯导协同标定方法，所述方法包括以下步骤：
(1)构建基于地球椭球模型下的横地球坐标系和横计算坐标系；
以北纬0°东经90°点为横地球坐标系下的北极点，定义为横北极点，北纬0°西经90°点为横地球坐标系下的南极点，定义为横南极点，0°经线和180°经线包围的椭圆面为横赤道面，取横北极、横南极和北极点组成的半个大椭圆为0°横经线，所在平面为横本初子午线，将地球坐标系与新定义的横地球坐标系之间的转换关系表示为：
式中，e系表示地球坐标系，e′系表示横地球坐标系，表示地球坐标系与横地球坐标系转换的方向余弦矩阵；
基于横经纬网定义横计算坐标系，横北向指向横北极，所在位置的法线向上为天向，按照右手坐标系定义横东向，将横计算坐标系与计算坐标系之间的转换关系表示为：
式中，c系表示计算坐标系，c′系表示横计算坐标系，β表示计算坐标系与横计算坐标系之间的旋转角度；
确定β与经纬度、横经纬度之间的转换关系：
将横计算坐标系与横平台坐标系之间的转换关系表示为：
式中，p′系表示横平台坐标系，I表示单位矩阵，[ψ×]表示横计算坐标系下漂移误差角的反对称矩阵；
将载体所在位置的法线与横赤道面的夹角定义为横纬度，与横本初子午面的夹角定义为横经度，将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为：
式中，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表示横计算坐标系下惯导1的漂移误差角，表示横平台坐标系下误差修正后惯导1的速度误差矢量，表示横计算坐标系下惯导1的位置误差，表示横计算坐标系下惯导1的地球自转角速度，表示横计算坐标系下惯导1的转移角速度，表示惯导1体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导1的重力矢量，ψ2表示横计算坐标系下惯导2的漂移误差角，表示横平台坐标系下误差修正后惯导2的速度误差矢量，表示横计算坐标系下惯导2的位置误差，表示惯导2横计算坐标系下的地球自转角速度，表示横计算坐标系下惯导2的转移角速度，表示惯导2体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导2的重力矢量，vp′表示载体在横平台坐标系下的速度，h表示载体所在位置的高度，Rx为载体所在位置的横东向的曲率半径，Ry为载体所在位置的横北向的曲率半径，为载体所在位置的扭曲率，RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径；
(3.2)确定联合状态方程：
其中，
式中，0i×j表示i行j列的零矩阵，和为惯导1输出的横纬度和横经度，和为惯导2输出的横纬度和横经度，分别表示横平台坐标系下载体在横东向、横北向、天向的速度，ωie表示地球自转角速度大小，表示惯导1输出位置处的重力加速度的值，表示惯导2输出位置处的重力加速度的值，C23表示矩阵的第二、第三列，C3表示矩阵的第三列，表示惯导2的x轴陀螺输出值，表示惯导2的y轴陀螺输出值，表示惯导2的z轴陀螺输出值，表示惯导2的x轴加速度计输出值，表示惯导2的y轴加速度计输出值，表示惯导2的z轴加速度计输出值；
将状态向量x(t)表示为：
式中，ψE1、ψN1、ψU1分别表示惯导1在横东向、横北向、天向的漂移误差角， 分别表示在横平台坐标系下惯导1在横东向、横北向、天向的速度误差，表示惯导1在横东向的位置误差，表示惯导1在横北向的位置误差，表示惯导1的天向误差，ψE2、ψN2、ψU2表示惯导2在横东向、横北向、天向的漂移误差角，分别表示横平台坐标系下惯导2在横东向、横北向、天向的速度误差，表示惯导2的在横东向的位置误差，表示惯导2的在横北向的位置误差，表示惯导2在天向的位置误差；
将噪声分布矩阵及噪声矩阵表示为：
(3.3)确定状态约束观测方程：
将惯导1、惯导2系统输出的速度、位置分别表示为：
式中，和分别表示惯导1和惯导2输出的横平台坐标系下的速度矢量，惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿，表示惯导1输出的横计算坐标系下的位置信息，表示惯导2输出的横计算坐标系下的位置信息，表示惯导2体坐标系相对于横平台坐标系的旋转角速度，表示两套惯导间的外杆臂，表示两套惯导间的外杆臂在惯导2体坐标系下的投影，rc′表示公共点的位置在横计算坐标系下的真值；
由于两套系统反映的是同一载体的速度信息、位置信息，观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束，将观测量表示为：
式中，υv、υr为相应的速度观测噪声、位置观测噪声；
增加外界高度信息的观测
式中，表示惯导1输出的高度信息，δh1表示惯导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)所述的联合转位次序仅为基于两套具有双轴转位机构的惯导系统的优选方案，对于其他旋转调制次序与标定次序之间的联合转位方案，也属于本发明的范畴。
综上所述，本发明的优点及积极效果为：本发明建立了地球椭球模型横地球坐标系下基于Psi角误差修正模型的联合状态卡尔曼滤波器，解决了传统的以当地水平坐标系为导航坐标系的惯性导航系统在极区失效的问题，通过两套惯导系统协同转位，利用两套惯导系统的冗余信息实现了在极地环境下的标定，Psi角误差模型定义在计算坐标系，与位置误差解耦，更适合极地航行的长航时舰船惯导系统的标定，通过对速度误差的修正，消除比力项，提高了动基座下的标定精度，该标定方法不受极地特殊地理位置和恶劣自然环境的影响，具有重要工程意义。
附图说明
图1是本发明实施例提供的流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
由于经线在极地快速收敛，以当地水平地理坐标系为导航坐标系的惯导系统会存在很大误差。由于磁暴、电离层的干扰等，在极区缺少可靠的外界参考信息，在极区的导航定位主要依赖于惯性导航系统。当惯导系统在极地环境下需要定期标定或者故障后更换了部分组件需要重新标定，传统的外场标定技术不能满足这一需求，这会影响惯导系统的精度。此外，传统的Phi角误差模型定义在真实坐标系，然而真实坐标系是未知的，通常将计算坐标系近似为真实坐标系使用，存在近似误差，传统速度误差方程中的比力项也无法直接测得，在动基座下比力计算存在误差，这些因素会影响标定的精度。针对这些问题，本发明提出基于Psi角误差修正模型的极地双惯导协同标定方法，所述的标定方法如图1所示。具体实施方式如下：
(1)构建基于地球椭球模型下的横地球坐标系和横计算坐标系；
以北纬0°东经90°点为横地球坐标系下的北极点，定义为横北极点，北纬0°西经90°点为横地球坐标系下的南极点，定义为横南极点，0°经线和180°经线包围的椭圆面为横赤道面，取横北极、横南极和北极点组成的半个大椭圆为0°横经线，所在平面为横本初子午线，将地球坐标系与新定义的横地球坐标系之间的转换关系表示为：
式中，e系表示地球坐标系，e′系表示横地球坐标系，表示地球坐标系与横地球坐标系转换的方向余弦矩阵；
基于横经纬网定义横计算坐标系，横北向指向横北极，所在位置的法线向上为天向，按照右手坐标系定义横东向，将横计算坐标系与计算坐标系之间的转换关系表示为：
式中，c系表示计算坐标系，c′系表示横计算坐标系，β表示计算坐标系与横计算坐标系之间的旋转角度；
确定β与经纬度、横经纬度之间的转换关系：
将横计算坐标系与横平台坐标系之间的转换关系表示为：
式中，p′系表示横平台坐标系，I表示单位矩阵，[ψ×]表示横计算坐标系下漂移误差角的反对称矩阵；
将载体所在位置的法线与横赤道面的夹角定义为横纬度，与横本初子午面的夹角定义为横经度，将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为：
式中，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表示横计算坐标系下惯导1的漂移误差角，表示横平台坐标系下误差修正后惯导1的速度误差矢量，表示横计算坐标系下惯导1的位置误差，表示横计算坐标系下惯导1的地球自转角速度，表示横计算坐标系下惯导1的转移角速度，表示惯导1体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导1的重力矢量，ψ2表示横计算坐标系下惯导2的漂移误差角，表示横平台坐标系下误差修正后惯导2的速度误差矢量，表示横计算坐标系下惯导2的位置误差，表示惯导2横计算坐标系下的地球自转角速度，表示横计算坐标系下惯导2的转移角速度，表示惯导2体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导2的重力矢量，vp′表示载体在横平台坐标系下的速度，h表示载体所在位置的高度，Rx为载体所在位置的横东向的曲率半径，Ry为载体所在位置的横北向的曲率半径，为载体所在位置的扭曲率，RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径；
(3.2)确定联合状态方程：
其中，
式中，0i×j表示i行j列的零矩阵，和为惯导1输出的横纬度和横经度，和为惯导2输出的横纬度和横经度，分别表示横平台坐标系下载体在横东向、横北向、天向的速度，ωie表示地球自转角速度大小，表示惯导1输出位置处的重力加速度的值，表示惯导2输出位置处的重力加速度的值，C23表示矩阵的第二、第三列，C3表示矩阵的第三列，表示惯导2的x轴陀螺输出值，表示惯导2的y轴陀螺输出值，表示惯导2的z轴陀螺输出值，表示惯导2的x轴加速度计输出值，表示惯导2的y轴加速度计输出值，表示惯导2的z轴加速度计输出值；
将状态向量x(t)表示为：
式中，ψE1、ψN1、ψU1分别表示惯导1在横东向、横北向、天向的漂移误差角， 分别表示在横平台坐标系下惯导1在横东向、横北向、天向的速度误差，表示惯导1在横东向的位置误差，表示惯导1在横北向的位置误差，表示惯导1的天向误差，ψE2、ψN2、ψU2表示惯导2在横东向、横北向、天向的漂移误差角，分别表示横平台坐标系下惯导2在横东向、横北向、天向的速度误差，表示惯导2的在横东向的位置误差，表示惯导2的在横北向的位置误差，表示惯导2在天向的位置误差；
将噪声分布矩阵及噪声矩阵表示为：
(3.3)确定状态约束观测方程：
将惯导1、惯导2系统输出的速度、位置分别表示为：
式中，和分别表示惯导1和惯导2输出的横平台坐标系下的速度矢量，惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿，表示惯导1输出的横计算坐标系下的位置信息，表示惯导2输出的横计算坐标系下的位置信息，表示惯导2体坐标系相对于横平台坐标系的旋转角速度，表示两套惯导间的外杆臂，表示两套惯导间的外杆臂在惯导2体坐标系下的投影，rc′表示公共点的位置在横计算坐标系下的真值；
由于两套系统反映的是同一载体的速度信息、位置信息，观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束，将观测量表示为：
式中，υv、υr为相应的速度观测噪声、位置观测噪声；
增加外界高度信息的观测
式中，表示惯导1输出的高度信息，δh1表示惯导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.基于Psi角误差修正模型的极地双惯导协同标定方法，其特征在于，所述方法包括以下步骤：
(1)构建基于地球椭球模型下的横地球坐标系和横计算坐标系；
以北纬0°东经90°点为横地球坐标系下的北极点，定义为横北极点，北纬0°西经90°点为横地球坐标系下的南极点，定义为横南极点，0°经线和180°经线包围的椭圆面为横赤道面，取横北极、横南极和北极点组成的半个大椭圆为0°横经线，所在平面为横本初子午线，将地球坐标系与新定义的横地球坐标系之间的转换关系表示为：
式中，e系表示地球坐标系，e′系表示横地球坐标系，表示地球坐标系与横地球坐标系转换的方向余弦矩阵；
基于横经纬网定义横计算坐标系，横北向指向横北极，所在位置的法线向上为天向，按照右手坐标系定义横东向，将横计算坐标系与计算坐标系之间的转换关系表示为：
式中，c系表示计算坐标系，c′系表示横计算坐标系，β表示计算坐标系与横计算坐标系之间的旋转角度；
确定β与经纬度、横经纬度之间的转换关系：
将横计算坐标系与横平台坐标系之间的转换关系表示为：
式中，p′系表示横平台坐标系，I表示单位矩阵，[ψ×]表示横计算坐标系下漂移误差角的反对称矩阵；
将载体所在位置的法线与横赤道面的夹角定义为横纬度，与横本初子午面的夹角定义为横经度，将地球坐标系下定义的经纬度与横经纬度之间的转换关系表示为：
式中，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表示横计算坐标系下惯导1的漂移误差角，表示横平台坐标系下误差修正后惯导1的速度误差矢量，δr1 c′表示横计算坐标系下惯导1的位置误差，表示横计算坐标系下惯导1的地球自转角速度，表示横计算坐标系下惯导1的转移角速度，表示惯导1体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导1的重力矢量，ψ2表示横计算坐标系下惯导2的漂移误差角，表示横平台坐标系下误差修正后惯导2的速度误差矢量，表示横计算坐标系下惯导2的位置误差，表示惯导2横计算坐标系下的地球自转角速度，表示横计算坐标系下惯导2的转移角速度，表示惯导2体坐标系至横平台坐标系的方向余弦矩阵，表示在横计算坐标系下惯导2的重力矢量，vp′表示载体在横平台坐标系下的速度，h表示载体所在位置的高度，Rx为载体所在位置的横东向的曲率半径，Ry为载体所在位置的横北向的曲率半径，为载体所在位置的扭曲率，RE和RN分别为载体所在位置的卯酉圈半径和子午圈半径；
(3.2)确定联合状态方程：
其中，
式中，0i×j表示i行j列的零矩阵，和为惯导1输出的横纬度和横经度，和为惯导2输出的横纬度和横经度，分别表示横平台坐标系下载体在横东向、横北向、天向的速度，ωie表示地球自转角速度大小，表示惯导1输出位置处的重力加速度的值，表示惯导2输出位置处的重力加速度的值，C23表示矩阵的第二、第三列，C3表示矩阵的第三列，表示惯导2的x轴陀螺输出值，表示惯导2的y轴陀螺输出值，表示惯导2的z轴陀螺输出值，表示惯导2的x轴加速度计输出值，表示惯导2的y轴加速度计输出值，表示惯导2的z轴加速度计输出值；
将状态向量x(t)表示为：
式中，ψE1、ψN1、ψU1分别表示惯导1在横东向、横北向、天向的漂移误差角， 分别表示在横平台坐标系下惯导1在横东向、横北向、天向的速度误差，表示惯导1在横东向的位置误差，表示惯导1在横北向的位置误差，表示惯导1的天向误差，ψE2、ψN2、ψU2表示惯导2在横东向、横北向、天向的漂移误差角，分别表示横平台坐标系下惯导2在横东向、横北向、天向的速度误差，表示惯导2的在横东向的位置误差，表示惯导2的在横北向的位置误差，表示惯导2在天向的位置误差；
将噪声分布矩阵及噪声矩阵表示为：
(3.3)确定状态约束观测方程：
将惯导1、惯导2系统输出的速度、位置分别表示为：
式中，和分别表示惯导1和惯导2输出的横平台坐标系下的速度矢量，惯导1与惯导2之间的外杆臂参数在系统安装完毕后通过标定补偿，表示惯导1输出的横计算坐标系下的位置信息，表示惯导2输出的横计算坐标系下的位置信息，表示惯导2体坐标系相对于横平台坐标系的旋转角速度，表示两套惯导间的外杆臂，表示两套惯导间的外杆臂在惯导2体坐标系下的投影，rc′表示公共点的位置在横计算坐标系下的真值；
由于两套系统反映的是同一载体的速度信息、位置信息，观测量实质上构成了惯导1、惯导2各自速度误差、位置误差的约束，将观测量表示为：
式中，υv、υr为相应的速度观测噪声、位置观测噪声；
增加外界高度信息的观测
式中，表示惯导1输出的高度信息，δh1表示惯导1的高度误差，υh为高度观测的噪声；
将观测方程表示为：
z(f)＝H(f)x(f)+υ(f)
其中，
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所述的基于Psi角误差修正模型的极地双惯导协同标定方法，其特征在于，所述方法对载体的运动状态无要求，载体处于系泊状态或运动状态均能实现在线标定。
3.如权利要求1所述的基于Psi角误差修正模型的极地双惯导协同标定方法，其特征在于，所述方法不仅仅适用于高纬度地区，在非横北极、横南极的中纬度地区同样适用。
4.如权利要求1所述的基于Psi角误差修正模型的极地双惯导协同标定方法，其特征在于，惯导1与惯导2处于零位时的相对姿态在安装完毕后标定得到，惯导2在标定初始时刻的姿态基于两套惯导的相对姿态通过与惯导1传递对准获得。
5.如权利要求1所述的基于Psi角误差修正模型的极地双惯导协同标定方法，其特征在于，所述步骤(4)中的联合转位次序适用于两套及以上具有双轴转位机构的惯导系统间的在线标定，对于双轴和三轴惯导系统之间、多套三轴惯导系统间的在线标定也适用。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310230514.5A CN116481564B (zh) | 2023-03-11 | 2023-03-11 | 基于Psi角误差修正模型的极地双惯导协同标定方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310230514.5A CN116481564B (zh) | 2023-03-11 | 2023-03-11 | 基于Psi角误差修正模型的极地双惯导协同标定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116481564A true CN116481564A (zh) | 2023-07-25 |
| CN116481564B CN116481564B (zh) | 2024-02-23 |
Family
ID=87210907
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202310230514.5A Active CN116481564B (zh) | 2023-03-11 | 2023-03-11 | 基于Psi角误差修正模型的极地双惯导协同标定方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116481564B (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117470235A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
| CN117470234A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
| CN117537811A (zh) * | 2023-11-10 | 2024-02-09 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
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 |
| CN103852086A (zh) * | 2014-03-26 | 2014-06-11 | 北京航空航天大学 | 一种基于卡尔曼滤波的光纤捷联惯导系统现场标定方法 |
| CN106767900A (zh) * | 2016-11-23 | 2017-05-31 | 东南大学 | 一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法 |
| CN107167134A (zh) * | 2017-06-22 | 2017-09-15 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
| CN115031731A (zh) * | 2022-06-21 | 2022-09-09 | 武汉第二船舶设计研究所 | 一种基于相对安装位置关系的多惯导协同导航方法及装置 |
| CN115200574A (zh) * | 2022-07-03 | 2022-10-18 | 中国人民解放军国防科技大学 | 一种地球椭球模型下的极区横向组合导航方法 |
| CN115265590A (zh) * | 2022-07-15 | 2022-11-01 | 北京航空航天大学 | 一种双轴旋转惯导动态误差抑制方法 |
-
2023
- 2023-03-11 CN CN202310230514.5A patent/CN116481564B/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 |
| CN103852086A (zh) * | 2014-03-26 | 2014-06-11 | 北京航空航天大学 | 一种基于卡尔曼滤波的光纤捷联惯导系统现场标定方法 |
| CN106767900A (zh) * | 2016-11-23 | 2017-05-31 | 东南大学 | 一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法 |
| CN107167134A (zh) * | 2017-06-22 | 2017-09-15 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
| CN115031731A (zh) * | 2022-06-21 | 2022-09-09 | 武汉第二船舶设计研究所 | 一种基于相对安装位置关系的多惯导协同导航方法及装置 |
| CN115200574A (zh) * | 2022-07-03 | 2022-10-18 | 中国人民解放军国防科技大学 | 一种地球椭球模型下的极区横向组合导航方法 |
| CN115265590A (zh) * | 2022-07-15 | 2022-11-01 | 北京航空航天大学 | 一种双轴旋转惯导动态误差抑制方法 |
Non-Patent Citations (2)
| Title |
|---|
| SHUANG DU ET AL.: "MEMS IMU Error Mitigation Using Rotation Modulation Technique", 《SENSORS》 * |
| 王林: "航海多惯导协同定位与误差参数估计", 《CNKI博士学位论文全文库》, no. 2020 * |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117470235A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
| CN117470234A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
| CN117537811A (zh) * | 2023-11-10 | 2024-02-09 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
| CN117470235B (zh) * | 2023-11-10 | 2024-04-26 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
| CN117470234B (zh) * | 2023-11-10 | 2024-04-26 | 中国人民解放军国防科技大学 | 基于Psi角误差模型的舰船跨极区滤波切换方法 |
| CN117537811B (zh) * | 2023-11-10 | 2024-05-31 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下跨极区导航切换方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116481564B (zh) | 2024-02-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN116481564B (zh) | 基于Psi角误差修正模型的极地双惯导协同标定方法 | |
| CN116734887B (zh) | 基于速度误差修正模型的极地双惯导协同标定方法 | |
| CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
| CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 | |
| CN107167134B (zh) | 冗余配置激光陀螺航海惯导协同定位方法 | |
| CN108871326B (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
| CN104698485A (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
| CN109916395A (zh) | 一种姿态自主冗余组合导航算法 | |
| CN102168978B (zh) | 一种船用惯性导航系统摇摆基座开环对准方法 | |
| CN113203415B (zh) | 一种原子陀螺导航系统及其导航解算方法 | |
| CN116222618B (zh) | 一种极地环境下的双惯导协同标定方法 | |
| CN112710328A (zh) | 一种四轴冗余惯导系统的误差标定方法 | |
| CN116448145A (zh) | 一种基于偏振矢量空间差分的航姿确定方法 | |
| CN110514200B (zh) | 一种惯性导航系统及高转速旋转体姿态测量方法 | |
| CN115878939A (zh) | 基于飞行器舵面偏转的高精度动态测量方法 | |
| CN109631870B (zh) | 基于光学自准直的星载光学陀螺组件姿态引出方法 | |
| CN116242397B (zh) | 一种速度误差修正模型下的双惯导协同标定方法 | |
| CN116222619B (zh) | 一种双惯导系统外场协同在线标定方法 | |
| CN115265599B (zh) | 双轴旋转惯导地球物理场相关陀螺零偏的快速标定方法 | |
| CN114111805B (zh) | 运载火箭多源多类测量数据位置基准高精度对齐方法 | |
| CN116519011B (zh) | 基于Psi角误差修正模型的长航时双惯导协同标定方法 | |
| CN112304339A (zh) | 一种卫星移动通信天线的惯导校准方法 | |
| CN117470233B (zh) | 一种优化的地球椭球模型下横坐标系组合导航方法 | |
| CN115265597B (zh) | 一种双轴旋转惯导地球物理场相关陀螺零偏的补偿方法 | |
| CN117073618A (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 |