CN112833918B - 一种基于函数迭代的高旋体微惯导空中对准方法及装置 - Google Patents
一种基于函数迭代的高旋体微惯导空中对准方法及装置 Download PDFInfo
- Publication number
- CN112833918B CN112833918B CN202110172143.0A CN202110172143A CN112833918B CN 112833918 B CN112833918 B CN 112833918B CN 202110172143 A CN202110172143 A CN 202110172143A CN 112833918 B CN112833918 B CN 112833918B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- micro inertial
- rotation
- attitude matrix
- angular rate
- 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
Links
Images
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本公开的基于函数迭代的高旋体微惯导空中对准方法及装置,根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。能够通过改善高旋体微惯导姿态解算过程中的积分精度,提高高旋体微惯导空中对准精度。
Description
技术领域
本公开属于高动态环境下高旋体空中对准技术领域,特别是涉及到一种基于函数迭代的高旋体微惯导空中对准方法。
背景技术
高旋体空中对准是指在高旋体飞行中确定SINS(Strap-down inertialnavigation system,捷联惯性导航系统)初始姿态的过程。对准精度对保证SINS的性能至关重要。空中对准的核心是在高旋体飞行过程中确定弹体坐标系和导航坐标系之间的初始姿态矩阵。由于捷联在高旋体上SINS的输出不再是载体运动时标准重力和地球自转速率在载体坐标系内的投影,传统的解析粗对准方法不适用于动态粗对准。
针对高精度SINS,目前提出了基于优化的对准方法(optimization-basedAlignment,OBA)。OBA方法是基于姿态矩阵分解技术导出的,该技术将所需姿态矩阵分解为两个时变姿态矩阵和一个定常姿态矩阵。利用姿态更新直接计算时变姿态矩阵,并利用Davenport的q-方法,在构造矢量观测的基础上得到定常姿态矩阵。OBA方法的核心是如何构造向量观测值,且其性能在很大程度上依赖于构造的向量观测值。到目前为止,基于矢量观测的不同构造过程,已经提出了许多衍生OBA方法。此外,OBA方法的精度还依赖于SINS的姿态解算方法,当前高旋体姿态计算方法通常是采用尽可能精确地积分姿态微分方程的圆锥校正算法。Jordan和Bortz在20世纪70年代建立了基于简化旋转矢量微分方程的增量姿态更新算法结构。究其本质,向量观测值的构造过程和SINS的姿态解算过程为积分过程,因此,有效改善SINS的姿态解算过程中的积分精度可提高对准精度。因此,针对上述问题,本文提出一种基于函数迭代的高旋体微惯导空中对准方法,提高空中对准精度。
发明内容
有鉴于此,本公开提出了一种基于函数迭代的高旋体微惯导空中对准方法,能够通过改善高旋体微惯导姿态解算过程中的积分精度,提高高旋体微惯导空中对准精度。
根据本公开的一方面,提出了一种基于函数迭代的高旋体微惯导空中对准方法,所述方法包括:
根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;
构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;
根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;
采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
在一种可能的实现方式中,所述采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,包括:
将所述高旋体微惯导的时变信号映射到所述Legendre多项式区间内,利用所述时变信号对所述模型系数、三轴角速率和旋转矢量进行函数拟合。
在一种可能的实现方式中,所述旋转矢量的精度依赖于所述三轴角速率的积分精度。
在一种可能的实现方式中,所述Legendre多项式区间为[-1,1]。
根据本公开的另一方面,提出了一种基于函数迭代的高旋体微惯导空中对准装置,所述装置包括:
拆分模块,用于根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;
构建模块,用于构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;
时变姿态矩阵解算模块,用于根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;
函数拟合模块,用于采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
本公开的基于函数迭代的高旋体微惯导空中对准方法,根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。能够通过改善高旋体微惯导姿态解算过程中的积分精度,提高高旋体微惯导空中对准精度。
根据下面参考附图对示例性实施例的详细说明,本公开的其它特征及方面将变得清楚。
附图说明
包含在说明书中并且构成说明书的一部分的附图与说明书一起示出了本公开的示例性实施例、特征和方面,并且用于解释本公开的原理。
图1示出了根据本公开一实施例的基于函数迭代的高旋体微惯导函数迭代的空中对准方法的流程图;
图2示出了根据本公开一实施例的基于函数迭代的高旋体微惯导空中对准方法的流程图;
图3示出了根据本公开一实施例的时变信号到Legendre多项式区间的映射关系图;
图4示出了根据本公开一实施例的基于函数迭代的高旋体微惯导空中对准装置框图。
具体实施方式
以下将参考附图详细说明本公开的各种示例性实施例、特征和方面。附图中相同的附图标记表示功能相同或相似的元件。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。
在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。
另外,为了更好的说明本公开,在下文的具体实施方式中给出了众多的具体细节。本领域技术人员应当理解,没有某些具体细节,本公开同样可以实施。在一些实例中,对于本领域技术人员熟知的方法、手段、元件和电路未作详细描述,以便于凸显本公开的主旨。
图1示出了根据本公开一实施例的基于异构机器人的自主跟踪系统原理图。如图1所示,该方法可以包括:
步骤S1:根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵。
图2示出了根据本公开一实施例的基于函数迭代的高旋体微惯导空中对准方法的流程图。
其中,n(t)为t时刻的微惯导坐标系,b(t)为t时刻的弹体坐标系,n(0)为0时刻的微惯导坐标系,b(0)为0时刻的弹体坐标系。
步骤S2:构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数。
将式(2)转换为Wahba问题进行求解,简化式(3)为:
步骤S3:根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量。
其中,i=1,2...,ns,ns为子样数,T=tk-tk-1为姿态更新周期。
不同子样数下的旋转矢量表达式为:
对旋转矢量计算方法做进一步优化,即对式(6)左右两边同时在时间区间[tk-1,tk]内积分,可得:
采用多子样优化旋转矢量,近似等效为:
步骤S4:采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
在一示例中,将所述高旋体微惯导的时变信号映射到所述Legendre多项式区间内,利用所述时变信号对所述模型系数、三轴角速率和旋转矢量进行函数拟合;且Legendre多项式区间为[-1,1]。
Legendre多项式在区间[-1,1]之间的递推式为:
对Legendre多项式进行积分:
图3示出了根据本公开一实施例的时变信号到Legendre多项式区间的映射关系图。
对于多子样算法,陀螺仪测量高旋体微惯导的三轴角增量提取迭代表达式为:
本公开的基于函数迭代的高旋体微惯导空中对准方法,根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。能够通过改善高旋体微惯导姿态解算过程中的积分精度,提高高旋体微惯导空中对准精度。
图4示出了根据本公开一实施例的基于函数迭代的高旋体微惯导空中对准装置。
根据本公开的另一方面,提出了一种高旋体微惯导函数迭代的空中对准装置,如图4所示,该装置40可以包括:
拆分模块41,用于根据链式法则,将所述高旋体微惯导的姿态矩阵拆分为时变姿态矩阵和定常姿态矩阵;
构建模块42,用于构建所述定常姿态矩阵模型,将所述定常姿态矩阵模型转换为Wahba问题进行求解,得到所述定常姿态矩阵模型的模型系数;
时变姿态矩阵解算模块43,用于根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;
函数拟合模块44,用于采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,迭代计算所述模型系数、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
在一种可能的实现方式中,采用Legendre多项式对所述模型系数、三轴角速率和旋转矢量进行函数拟合,包括:
将高旋体微惯导的时变信号映射到所述Legendre多项式区间内,利用所述时变信号对所述模型系数、三轴角速率和旋转矢量进行函数拟合。
在一种可能的实现方式中,旋转矢量的精度依赖于所述三轴角速率的积分精度。
在一种可能的实现方式中,Legendre多项式区间为[-1,1]。
上述装置能够通过改善高旋体微惯导姿态解算过程中的积分精度,提高高旋体微惯导空中对准精度。
以上已经描述了本公开的各实施例,上述说明是示例性的,并非穷尽性的,并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场中的技术改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。
Claims (8)
1.一种基于函数迭代的高旋体微惯导空中对准方法,其特征在于,所述方法包括:
构建所述定常姿态矩阵模型式中, 其中Re为地球平均半径,ωie为地球自转角速率,[Lλh]T为微惯导位置的纬度、经度和高度,为微惯导的速度,代表东、北和天向速度,fb为加速度计测量的三轴比力,gn为当地重力加速度;将所述定常姿态矩阵模型转换为Wahba问题进行求解,令得到所述定常姿态矩阵模型的模型系数和
根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;
采用Legendre多项式对fb′、fn′、三轴角速率和旋转矢量进行函数拟合,迭代计算fb′、fn′、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
2.根据权利要求1所述的高旋体微惯导空中对准方法,其特征在于,所述采用Legendre多项式对fb′、fn′、三轴角速率和旋转矢量进行函数拟合,包括:
将所述高旋体微惯导的时变信号映射到所述Legendre多项式区间内,利用所述时变信号对fb′、fn′、三轴角速率和旋转矢量进行函数拟合。
3.根据权利要求1所述的高旋体微惯导空中对准方法,其特征在于,所述旋转矢量的精度依赖于所述三轴角速率的积分精度。
4.根据权利要求1所述的高旋体微惯导空中对准方法,其特征在于,所述Legendre多项式区间为[-1,1]。
5.一种基于函数迭代的高旋体微惯导空中对准装置,其特征在于,所述装置包括:
构建模块,用于构建所述定常姿态矩阵模型式中,其中Re为地球平均半径,ωie为地球自转角速率,[L λ h]T为微惯导位置的纬度、经度和高度,为微惯导的速度,代表东、北和天向速度,fb为加速度计测量的三轴比力,gn为当地重力加速度;将所述定常姿态矩阵模型转换为Wahba问题进行求解,令得到所述定常姿态矩阵模型的模型系数和
时变姿态矩阵解算模块,用于根据旋转矢量法对所述时变姿态矩阵进行求解,得到所述高旋体微惯导的三轴角速率和旋转矢量;
函数拟合模块,用于采用Legendre多项式对fb′、fn′、三轴角速率和旋转矢量进行函数拟合,迭代计算fb′、fn′、三轴角速率和旋转矢量的值,实现所述高旋体微惯导空中对准。
6.根据权利要求5所述的高旋体微惯导空中对准装置,其特征在于,所述采用Legendre多项式对fb′、fn′、三轴角速率和旋转矢量进行函数拟合,包括:
将所述高旋体微惯导的时变信号映射到所述Legendre多项式区间内,利用所述时变信号对fb′、fn′、三轴角速率和旋转矢量进行函数拟合。
7.根据权利要求5所述的高旋体微惯导空中对准装置,其特征在于,所述旋转矢量的精度依赖于所述三轴角速率的积分精度。
8.根据权利要求5所述的高旋体微惯导空中对准装置,其特征在于,所述Legendre多项式区间为[-1,1]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110172143.0A CN112833918B (zh) | 2021-02-08 | 2021-02-08 | 一种基于函数迭代的高旋体微惯导空中对准方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110172143.0A CN112833918B (zh) | 2021-02-08 | 2021-02-08 | 一种基于函数迭代的高旋体微惯导空中对准方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112833918A CN112833918A (zh) | 2021-05-25 |
CN112833918B true CN112833918B (zh) | 2022-12-13 |
Family
ID=75932805
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110172143.0A Active CN112833918B (zh) | 2021-02-08 | 2021-02-08 | 一种基于函数迭代的高旋体微惯导空中对准方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112833918B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114963873B (zh) * | 2022-04-25 | 2023-07-14 | 北京自动化控制设备研究所 | 一种基于加速度信息的旋转弹快速对准方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5338464B2 (ja) * | 2009-05-08 | 2013-11-13 | 株式会社Ihi | 慣性航法装置、飛翔体及び航法データ算出方法 |
CN103557871B (zh) * | 2013-10-22 | 2016-06-15 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN107741228A (zh) * | 2017-05-24 | 2018-02-27 | 北京大学 | 一种基于重心拉格朗日插值法的捷联惯导姿态解算方法 |
CN109596144B (zh) * | 2018-12-10 | 2020-07-24 | 苏州大学 | Gnss位置辅助sins行进间初始对准方法 |
CN109724597B (zh) * | 2018-12-19 | 2021-04-02 | 上海交通大学 | 一种基于函数迭代积分的惯性导航解算方法及系统 |
CN112229421B (zh) * | 2020-09-16 | 2023-08-11 | 北京工业大学 | 基于李群最优估计的捷联惯性导航晃动基座粗对准方法 |
-
2021
- 2021-02-08 CN CN202110172143.0A patent/CN112833918B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112833918A (zh) | 2021-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106990426B (zh) | 一种导航方法和导航装置 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN112629538B (zh) | 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法 | |
KR101988786B1 (ko) | 관성 항법 장치의 초기 정렬 방법 | |
EP2557394B1 (en) | System for processing pulse signals within an inertial navigation system | |
CN109682377B (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
CN106989761B (zh) | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 | |
CN112504275B (zh) | 一种基于级联卡尔曼滤波算法的水面舰船水平姿态测量方法 | |
CN107063254B (zh) | 一种陀螺地磁组合的姿态解算方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN111351508A (zh) | 一种mems惯性测量单元系统级批量标定方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN116007620A (zh) | 一种组合导航滤波方法、系统、电子设备及存储介质 | |
CN112562077A (zh) | 一种融合pdr和先验地图的行人室内定位方法 | |
CN111121820B (zh) | 基于卡尔曼滤波的mems惯性传感器阵列融合方法 | |
CN109931952A (zh) | 未知纬度条件下捷联惯导直接解析式粗对准方法 | |
CN112833918B (zh) | 一种基于函数迭代的高旋体微惯导空中对准方法及装置 | |
CN108416387B (zh) | 基于gps与气压计融合数据的高度滤波方法 | |
CN108871319B (zh) | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 | |
CN112284388B (zh) | 一种无人机多源信息融合导航方法 | |
CN117053802A (zh) | 一种基于旋转mems imu的车载导航系统定位误差减小的方法 | |
CN110514201A (zh) | 一种惯性导航系统及适用于高转速旋转体的导航方法 | |
CN116519015A (zh) | 一种基于相对距离约束的分布式协同导航方法及系统 | |
CN112683265B (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 | |
CN110733671B (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 |