CN106643726B - 一种统一惯性导航解算方法 - Google Patents
一种统一惯性导航解算方法 Download PDFInfo
- Publication number
- CN106643726B CN106643726B CN201611051763.4A CN201611051763A CN106643726B CN 106643726 B CN106643726 B CN 106643726B CN 201611051763 A CN201611051763 A CN 201611051763A CN 106643726 B CN106643726 B CN 106643726B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- carrier
- vector
- earth
- navigation
- 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
- 238000000034 method Methods 0.000 title claims abstract description 27
- 239000013598 vector Substances 0.000 claims abstract description 69
- 238000004364 calculation method Methods 0.000 claims abstract description 23
- 239000011159 matrix material Substances 0.000 claims abstract description 20
- 238000006243 chemical reaction Methods 0.000 claims abstract description 10
- 238000005259 measurement Methods 0.000 claims abstract description 5
- 230000009466 transformation Effects 0.000 claims description 9
- 239000007787 solid Substances 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000013508 migration Methods 0.000 description 5
- 230000005012 migration Effects 0.000 description 5
- 238000004088 simulation Methods 0.000 description 2
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及惯性导航技术领域,特别涉及一种统一惯性导航解算方法。
背景技术
惯性坐标系(i)相对惯性空间始终不变;地固坐标系(e)的原点在地心,Ze轴指向极轴,Xe轴指向格林威治经线,Ye轴根据右手定则确定;地理坐标系(L)的三个坐标轴分别指向大地东、北、天三个方向;游移方位坐标系(W)由地理坐标系(L)绕其天向轴ZL逆时针旋转一个游移角得到。导航坐标系(n)根据用户监测需要进行选取,可以选定为惯性坐标系、地固坐标系、地理坐标系、游移方位坐标系。
惯性导航系统分为捷联式惯性导航系统和平台式惯性导航系统。在捷联式惯性导航系统中,惯性仪表直接固联安装在载体上,测量得到载体相对于惯性坐标系的运动参数,然后通过姿态矩阵将这些运动参数从载体本体坐标系转换到导航坐标系。在平台式惯性导航系统中,通过框架结构建立一个稳定在导航坐标系的物理平台,该物理平台相对于导航坐标系建立了台体坐标系,测量仪表固联安装在物理平台上,并在台体坐标系上测量载体的运动参数。其中:在捷联式惯性导航系统中,固联坐标系(b)为载体本体坐标系;在平台式惯性导航系统中,固联坐标系(b)为台体坐标系。
传统解算方法未将平台式惯性导航系统和捷联式惯性导航系统的导航方程进行有效统一;也未将各类导航坐标系(n)的导航方程进行有效统一,导航解算方法比较繁杂。
发明内容
本发明的目的在于克服现有技术的不足,提供了一种统一惯性导航解算方法,该方法针对捷联式惯性导航系统和平台式惯性导航系统,给出了统一了导航方程,相对于传统解算方法既降低了计算量,又具有更广的适应性。
本发明的上述目的通过以下方案实现:
一种统一惯性导航解算方法包括以下步骤:
(1)、根据如下迭代公式更新计算地固坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的地固坐标系到导航坐标系的转换矩阵,且地固坐标系到导航坐标系的转换矩阵初始值为设定值Δt为相邻时刻间的时间间隔;为由构成的反对称矩阵,即 为任意的三维列矢量,为外部系统提供的导航坐标系相对于地固坐标系的角速度矢量;
(2)、根据如下迭代公式更新计算固联坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的固联坐标系到导航坐标系的转换矩阵,固联坐标系到导航坐标系的转换矩阵初始值为设定值 为前一时刻k-1的导航坐标系到地固坐标系的转换矩阵,即 为由构成的反对称矩阵,即 为任意的三维列矢量,为设定的地球相对于惯性空间的角速度矢量;为由构成的反对称矩阵,即 为任意的三维列矢量,为固联坐标系相对惯性空间的角速度矢量;
(3)、根据如下迭代公式更新计算载体在地固坐标系下的速度矢量:
(4)、根据载体在地固坐标系下的速度矢量,更新计算载体在地固坐标系下的位置矢量;并根据所述速度矢量更新载体在地理坐标系下的位置坐标;
(5)、重复步骤(1)~(4),在设定的惯性测量时段内,迭代计算得到每个时刻的载体在地固坐标系下的速度矢量、载体在地固坐标系下的位置矢量,以及载体在地理坐标系下的位置坐标。
上述的统一惯性导航解算方法,在步骤(2)中:在捷联式惯性系统中,角速度矢量为惯性系统中陀螺仪输出的载体相对于惯性空间的角速度;在平台式惯性系统中,角速度矢量为台体相对惯性空间的角速度,由台体稳定控制回路给出。
上述的统一惯性导航解算方法,在步骤(4)中,根据载体在地固坐标系下的速度矢量,更新计算载体在地固坐标系下的位置矢量,具体计算公式如下:
上述的统一惯性导航解算方法,如果已知载体在地理坐标系下的初始位置坐标,则载体在地固坐标系下的初始位置矢量其中,λ0、h0为载体在地理坐标系下的初始位置坐标中的纬度、经度和高度;N0为初始卯酉圈曲率半径;e为地球第一偏心率。
上述的统一惯性导航解算方法,在步骤(4)中,根据载体在地固坐标系下的速度矢量,更新计算载体在地理坐标系下的位置坐标,具体计算公式如下:
X(k)=X(k-1)+U(k-1)Ve(k)Δt;
本发明与现有技术相比,具有以下优点:
(1)、本发明给出了同时适用于捷联式惯性导航系统和平台式惯性导航系统的统一惯性导航解算方法,相对传统解算方法具有更好的适应性;
(2)、本发明给出了广泛适用于包括惯性坐标系(i)、地固坐标系(e)、地理坐标系(L)和游移方位坐标系(W)在内的各类导航坐标系(n)的统一惯性导航解算方法,解算过程统一,简单易实现。
附图说明
图1为本发明的统一惯性导航解算方法处理流程图。
具体实施方式
下面结合附图和具体实例对本发明作进一步详细的描述:
本发明的实现原理是:采用加速度计的固联坐标系(b)统一表示捷联式惯性导航系统中的载体坐标系和平台式惯性导航系统中的台体坐标系;在计算过程中,对于捷联式惯性导航系统,角速度矢量为惯性系统中陀螺仪输出的载体相对于惯性空间的角速度;在平台式惯性系统中,角速度矢量为台体相对惯性空间的角速度,由台体稳定控制回路给出。根据以上两点将两类惯性导航系统的导航方程进行统一。在地球范围内研究载体相对地球的运动,无论采用何种导航坐标系(n),其速度和位置输出都是与载体相对地球的速度和位置相关。因此,以坐标变换矩阵更新为基础,实时解算地速最后利用地速更新地固矢量和地理位置Xe,并以循环方式进行导航解算。
如图1所示,本发明的统一惯性导航解算方法的具体实现步骤如下:
(1)、根据如下迭代公式更新计算地固坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的地固坐标系到导航坐标系的转换矩阵,且地固坐标系到导航坐标系的转换矩阵初始值为设定值即初始值为已知量;Δt为相邻时刻间的时间间隔;为由构成的反对称矩阵,即 为任意的三维列矢量,为外部系统提供的导航坐标系相对于地固坐标系的角速度矢量;
(2)、根据如下迭代公式更新计算固联坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的固联坐标系到导航坐标系的转换矩阵,固联坐标系到导航坐标系的转换矩阵初始值为设定值即初始值为已知量;为前一时刻k-1的导航坐标系到地固坐标系的转换矩阵,即 为由构成的反对称矩阵,即 为任意的三维列矢量,为设定的地球相对于惯性空间的角速度矢量;为由构成的反对称矩阵,即 为任意的三维列矢量,为固联坐标系相对惯性空间的角速度矢量;
(3)、根据如下迭代公式更新计算载体在地固坐标系下的速度矢量:
(4)、根据载体在地固坐标系下的速度矢量,更新计算载体在地固坐标系下的位置矢量;并根据所述速度矢量更新载体在地理坐标系下的位置坐标;其中:
根据载体在地固坐标系下的速度矢量更新计算载体在地固坐标系下的位置矢量,具体计算公式如下:
其中,分别为当前时刻k和前一时刻k-1的载体在地固坐标系下的位置矢量,所述位置矢量的初始值为设定值即初始值为已知量。如果已知载体在地理坐标系下的初始位置坐标,则载体在地固坐标系下的初始位置矢量其中,λ0、h0为载体在地理坐标系下的初始位置坐标中的纬度、经度和高度;N0为初始卯酉圈曲率半径;e为地球第一偏心率。
另外,根据载体在地固坐标系下的速度矢量,更新计算载体在地理坐标系下的位置坐标,具体计算公式如下:
X(k)=X(k-1)+U(k-1)Ve(k)Δt;
(5)、重复步骤(1)~(4),在设定的惯性测量时段内,迭代计算得到每个时刻的载体在地固坐标系下的速度矢量、载体在地固坐标系下的位置矢量,以及载体在地理坐标系下的位置坐标。
综上所述,本发明的统一惯性导航解算方法的导航方程如下:
示例1:如果选取导航坐标系(n)为惯性坐标系(i),则导航方程为:
示例2:如果选取导航坐标系(n)为地固坐标系(e),则导航方程为:
示例3:如果选取导航坐标系(n)为地理坐标系(L),则得到基于地理坐标系(L)的导航方程为
示例4:如果选取导航坐标系(n)为游移方位坐标系(W),则得到基于游移方位坐标系(W)的导航方程为
实施例:
在本实施例中,对本发明的统一惯性导航解算方法进行仿真验证。
在仿真计算中,依次设定导航坐标系为地固坐标系(e)、地理坐标系(L)、游移方位坐标系(W)。其中,采用传统解算方法对以上三种导航坐标系的计算结果为1~3,而本发明的统一惯性导航解算方法的计算结果为4~6。表1给出了在t=10000秒时,1~6的定位结果,并给出此时的卫星导航系统的定位结果。根据结果比较可以看出,本发明的定位解算结果与传统解算结果的定位精度相近,从而验证了本发明统一惯性导航解算方法的有效性。
表1定位结果比较
以上所述,仅为本发明一个具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (3)
1.一种统一惯性导航解算方法,其特征在于包括以下步骤:
(1)、根据如下迭代公式更新计算地固坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的地固坐标系到导航坐标系的转换矩阵,且地固坐标系到导航坐标系的转换矩阵初始值为设定值Δt为相邻时刻间的时间间隔;为由构成的反对称矩阵,即 为任意的三维列矢量,为外部系统提供的导航坐标系相对于地固坐标系的角速度矢量;
(2)、根据如下迭代公式更新计算固联坐标系到导航坐标系的转换矩阵:
其中:分别为当前时刻k和前一时刻k-1的固联坐标系到导航坐标系的转换矩阵,固联坐标系到导航坐标系的转换矩阵初始值为设定值 为前一时刻k-1的导航坐标系到地固坐标系的转换矩阵,即 为由构成的反对称矩阵,即 为任意的三维列矢量,为设定的地球相对于惯性空间的角速度矢量;为由构成的反对称矩阵,即 为任意的三维列矢量,为固联坐标系相对惯性空间的角速度矢量;
(3)、根据如下迭代公式更新计算载体在地固坐标系下的速度矢量:
(4)、根据载体在地固坐标系下的速度矢量,更新计算载体在地固坐标系下的位置矢量,具体计算公式如下:
并根据载体在地固坐标系下的速度矢量,更新计算载体在地理坐标系下的位置坐标,具体计算公式如下:
(5)、重复步骤(1)~(4),在设定的惯性测量时段内,迭代计算得到每个时刻的载体在地固坐标系下的速度矢量、载体在地固坐标系下的位置矢量,以及载体在地理坐标系下的位置坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611051763.4A CN106643726B (zh) | 2016-11-23 | 2016-11-23 | 一种统一惯性导航解算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611051763.4A CN106643726B (zh) | 2016-11-23 | 2016-11-23 | 一种统一惯性导航解算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106643726A CN106643726A (zh) | 2017-05-10 |
CN106643726B true CN106643726B (zh) | 2020-04-10 |
Family
ID=58812463
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611051763.4A Active CN106643726B (zh) | 2016-11-23 | 2016-11-23 | 一种统一惯性导航解算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643726B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112882118B (zh) * | 2020-12-30 | 2022-12-06 | 中国人民解放军海军工程大学 | 地固坐标系下动基座重力矢量估计方法、系统及存储介质 |
CN113032513B (zh) * | 2021-05-21 | 2021-08-24 | 北京数字政通科技股份有限公司 | 一种针对空间地理数据的切片方法及渲染方法 |
CN116481535B (zh) * | 2023-02-02 | 2024-06-25 | 中国科学院力学研究所 | 一种利用惯导数据修正飞行弹道数据的计算方法 |
CN118225086B (zh) * | 2024-05-23 | 2024-08-02 | 武汉汉宁轨道交通技术有限公司 | 一种惯性系下位姿精密积分解算方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101660914A (zh) * | 2009-08-19 | 2010-03-03 | 南京航空航天大学 | 耦合惯性位置误差的机载星光和惯性组合的自主导航方法 |
EP2112472A3 (en) * | 2008-04-22 | 2012-03-28 | ITT Manufacturing Enterprises, Inc. | Navigation system and method of obtaining accurate navigational information in signal challenging environments |
CN102426017A (zh) * | 2011-11-03 | 2012-04-25 | 北京航空航天大学 | 一种基于星敏感器确定载体相对于地理坐标系姿态的方法 |
CN103940428A (zh) * | 2014-03-21 | 2014-07-23 | 哈尔滨工程大学 | 一种惯性导航系统横速度的实时测量方法 |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
-
2016
- 2016-11-23 CN CN201611051763.4A patent/CN106643726B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2112472A3 (en) * | 2008-04-22 | 2012-03-28 | ITT Manufacturing Enterprises, Inc. | Navigation system and method of obtaining accurate navigational information in signal challenging environments |
CN101660914A (zh) * | 2009-08-19 | 2010-03-03 | 南京航空航天大学 | 耦合惯性位置误差的机载星光和惯性组合的自主导航方法 |
CN102426017A (zh) * | 2011-11-03 | 2012-04-25 | 北京航空航天大学 | 一种基于星敏感器确定载体相对于地理坐标系姿态的方法 |
CN103940428A (zh) * | 2014-03-21 | 2014-07-23 | 哈尔滨工程大学 | 一种惯性导航系统横速度的实时测量方法 |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
Non-Patent Citations (4)
Title |
---|
Navigation in non-inertial terrestrial frames using the attitude matrices;Teodor Lucian Grigorie,et.al;《Proceedings ELMAR 2006》;20070512;全文 * |
弹载惯性/天文姿态组合导航方法研究;朱剑斌 等;《电光与控制》;20160531;第23卷(第05期);全文 * |
惯性导航系统极区导航参数解算方法;刘文超 等;《上海交通大学学报》;20140430;第48卷(第04期);全文 * |
捷联惯导系统中一种高精度姿态更新算法的推证;康帅 等;《中国空间科学技术》;20041031;第24卷(第05期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106643726A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110487301B (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航系统初始对准方法 | |
CN104635251B (zh) | 一种ins/gps组合定位定姿新方法 | |
CN106871928B (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
Yao et al. | Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
CN105509769B (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN106989761B (zh) | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 | |
Rad et al. | Optimal attitude and position determination by integration of INS, star tracker, and horizon sensor | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN111928848B (zh) | 一种基于虚拟圆球法向量模型的极区惯性导航方法 | |
CN108426575A (zh) | 用地球椭球模型改进的捷联惯导极地横向导航方法 | |
CN110285815A (zh) | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 | |
CN103759729A (zh) | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 | |
CN110207694A (zh) | 一种基于相对位置信息的极区格网惯导/超短基线组合导航方法 | |
CN112229421A (zh) | 基于李群最优估计的捷联惯性导航晃动基座粗对准方法 | |
CN106441297B (zh) | 惯导系统的重力误差矢量获取方法和装置 | |
CN109084756B (zh) | 一种重力视运动参数辨识与加速度计零偏分离方法 | |
CN111060140B (zh) | 一种地球椭球模型下的极区惯性导航误差获得方法 | |
CN110873577B (zh) | 一种水下快速动基座对准方法及装置 | |
CN105180928B (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 |