CN103940425A - 一种磁-惯性组合捷联测量方法 - Google Patents
一种磁-惯性组合捷联测量方法 Download PDFInfo
- Publication number
- CN103940425A CN103940425A CN201410162204.5A CN201410162204A CN103940425A CN 103940425 A CN103940425 A CN 103940425A CN 201410162204 A CN201410162204 A CN 201410162204A CN 103940425 A CN103940425 A CN 103940425A
- Authority
- CN
- China
- Prior art keywords
- angle
- moment
- pitch
- magnetic
- carrier
- 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
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/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
- G01C21/165—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 combined with non-inertial navigation instruments
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
一种磁-惯性组合捷联测量方法,其包括在导航坐标系下建立载体基于地磁测量的滚转角解算方程和基于惯性测量的角运动方程;将上一时刻的俯仰角和偏航角近似为当时刻的俯仰角和偏航角;将当时刻的弹体坐标系y轴、z轴地磁测量值、俯仰角和偏航角作为基于地磁测量的滚转角解算方程的输入,解算当时刻的滚转角;将当时刻陀螺对弹体坐标系y轴、z轴角速度的测量信息,及俯仰角和滚转角作为角运动方程的输入,解算下一时刻的俯仰角速率和偏航角速率,然后通过对当时刻的俯仰角速率和偏航角速率积分,计算出载体下一时刻的俯仰角和偏航角;将下一时刻作为当时刻,重复上述过程,完成载体姿态的实时解算。该方法较好地解决了具有高角速度特征的载体的姿态解算问题。
Description
技术领域
本发明属于姿态测量领域,尤其涉及一种磁-惯性组合捷联测量方法。
背景技术
目前,国内外为满足低成本要求,大部分姿态测量器件采用MEMS陀螺作为载体。然而,对具有高角速度特征的载体测量,由于MEMS陀螺量程的限制,致使高角速度条件下精准测量载体姿态成为一道难题。尽管标定MEMS陀螺的比例因数能够使其满足大量程的测量范围,但由于存在变转速的实际情况,MEMS陀螺的测量精度仍然不值得信赖。在已公开发表的文献中,主要通过对标定技术研究,提高MEMS陀螺的测量精度,导致MEMS陀螺的应用条件受限。
发明内容
为了解决高角速度特征载体的姿态解算问题,本发明提供了一种磁-惯性组合捷联测量方法。
该磁-惯性组合捷联测量方法包括:
(1)在导航坐标系下建立载体基于地磁测量的滚转角解算方程和基于惯性测量的角运动方程;
(2)将上一时刻的俯仰角和偏航角近似为当时刻的俯仰角和偏航角;
(3)将当时刻的弹体坐标系y轴、z轴地磁测量值、俯仰角、偏航角作为基于地磁测量的滚转角解算方程的输入,解算当时刻的滚转角;
(4)将当时刻陀螺对弹体坐标系y轴、z轴角速度的测量信息,以及俯仰角、滚转角作为角运动方程的输入,解算下一时刻的俯仰角速率和偏航角速率,然后通过对当时刻的俯仰角速率和偏航角速率积分,计算出载体下一时刻的俯仰角和偏航角;
(5)将下一时刻作为当时刻,重复(1)-(4)过程,完成载体姿态的实时解算。
进一步的,设t-1时刻载体的俯仰角为θ(t-1),偏航角为ψ(t-1);t时刻弹体坐标系下y轴地磁传感器的测量值为m by (t),z轴地磁传感器的测量值为m bz (t),当地地磁矢量的磁偏角为D,当地地磁矢量的磁倾角为I;将t-1时刻的俯仰角和偏航角近似为t时刻的俯仰角和偏航角,即θ(t)=θ(t-1),ψ(t)=ψ(t-1);将俯仰角θ(t)和偏航角ψ(t)作为t时刻滚转角γ解算的输入,利用基于地磁测量的滚转角解算方程解算γ(t)。所述滚转角解算方程为:
。
进一步的,所述角运动方程为:
将固连于弹体坐标系的y轴陀螺测量值ω by (t)、z轴陀螺测量值ω bz (t)、γ(t)及θ(t)带入到角动量方程,计算得到的俯仰角和偏航角速率,通过积分可计算出载体下一时刻的俯仰角θ(t+1)和偏航角ψ(t+1)。
本发明的有益效果为:
本发明可广泛应用于具有高角速度特征的载体姿态解算领域,为惯性导航关键问题的解决提供理论基础。
附图说明
图1为本发明磁-惯性组合捷联测量方法的流程图。
具体实施方式
如图1所示,设t-1时刻载体的俯仰角为θ(t-1),偏航角为ψ(t-1)。t时刻弹体坐标系下y轴地磁传感器的测量值为m by (t),z轴地磁传感器的测量值为m bz (t),当地地磁矢量的磁偏角为D,当地地磁矢量的磁倾角为I。将t-1时刻的俯仰角和偏航角近似为t时刻的俯仰角和偏航角,即θ(t)=θ(t-1),ψ(t)=ψ(t-1)。将俯仰角θ(t)和偏航角ψ(t)作为t时刻滚转角γ解算的输入,利用基于地磁测量的滚转角解算方程解算γ(t),公式如下所示:
在导航坐标系下建立载体的角运动方程,如下所示:
将固连于弹体坐标系的y轴陀螺测量值ω by (t)、z轴陀螺测量值ω bz (t)、γ(t)及θ(t)带入到角动量方程,计算得到的俯仰角和偏航角速率,通过积分可计算出载体下一时刻的俯仰角θ(t+1)和偏航角ψ(t+1)。
将下一时刻作为当时刻,重复上述过程,完成载体姿态的实时解算。
最后应说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,均应涵盖在本发明的权利要求范围当中。
Claims (4)
1.一种磁-惯性组合捷联测量方法,其特征在于,该方法包括如下步骤:
(1)在导航坐标系下建立载体基于地磁测量的滚转角解算方程和基于惯性测量的角运动方程;
(2)将上一时刻的俯仰角和偏航角近似为当时刻的俯仰角和偏航角;
(3)将当时刻的弹体坐标系y轴、z轴地磁测量值、俯仰角、偏航角作为基于地磁测量的滚转角解算方程的输入,解算当时刻的滚转角;
(4)将当时刻陀螺对弹体坐标系y轴、z轴角速度的测量信息,以及俯仰角、滚转角作为角运动方程的输入,解算下一时刻的俯仰角速率和偏航角速率,然后通过对当时刻的俯仰角速率和偏航角速率积分,计算出载体下一时刻的俯仰角和偏航角;
(5)将下一时刻作为当时刻,重复(1)-(4)过程,完成载体姿态的实时解算。
2.如权利1所述的一种磁-惯性组合捷联测量方法,其特征在于:
设t-1时刻载体的俯仰角为θ(t-1),偏航角为ψ(t-1);t时刻弹体坐标系下y轴地磁传感器的测量值为 m by (t),z轴地磁传感器的测量值为m bz (t),当地地磁矢量的磁偏角为D,当地地磁矢量的磁倾角为I;将t-1时刻的俯仰角和偏航角近似为t时刻的俯仰角和偏航角,即θ(t)=θ(t-1),ψ(t)=ψ(t-1);将俯仰角θ(t)和偏航角ψ(t)作为t时刻滚转角γ解算的输入,利用基于地磁测量的滚转角解算方程解算γ(t)。
3.如权利1或2所述的一种磁-惯性组合捷联测量方法,其特征在于:
所述滚转角解算方程为:
。
4.如权利1所述的一种磁-惯性组合捷联测量方法,其特征在于:
所述角运动方程为:
将固连于弹体坐标系的y轴陀螺测量值ω by (t)、z轴陀螺测量值ω bz (t)、γ(t)及θ(t)带入到角动量方程,计算得到的俯仰角和偏航角速率,通过积分可计算出载体下一时刻的俯仰角θ(t+1)和偏航角ψ(t+1)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410162204.5A CN103940425B (zh) | 2014-04-22 | 2014-04-22 | 一种磁‑惯性组合捷联测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410162204.5A CN103940425B (zh) | 2014-04-22 | 2014-04-22 | 一种磁‑惯性组合捷联测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103940425A true CN103940425A (zh) | 2014-07-23 |
CN103940425B CN103940425B (zh) | 2017-03-01 |
Family
ID=51188194
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410162204.5A Active CN103940425B (zh) | 2014-04-22 | 2014-04-22 | 一种磁‑惯性组合捷联测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103940425B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104764451A (zh) * | 2015-04-23 | 2015-07-08 | 北京理工大学 | 一种基于惯性和地磁传感器的目标姿态跟踪方法 |
CN105403218A (zh) * | 2015-12-08 | 2016-03-16 | 北京健德乾坤导航系统科技有限责任公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105547293A (zh) * | 2016-01-07 | 2016-05-04 | 北京电子工程总体研究所 | 一种垂直状态惯性导航的初始基准的建立方法 |
CN105841698A (zh) * | 2016-03-28 | 2016-08-10 | 中国船舶重工集团公司第七研究所 | 一种无需调零的auv舵角精确实时测量系统 |
CN106092098A (zh) * | 2016-08-25 | 2016-11-09 | 湖北三江航天红峰控制有限公司 | 一种基于陀螺和倾角仪的载体航姿测量方法 |
CN106403934A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法 |
CN106403935A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载磁组合姿态测量装置的应用 |
CN107063254A (zh) * | 2016-12-27 | 2017-08-18 | 南京理工大学 | 一种陀螺地磁组合的姿态解算方法 |
CN107314718A (zh) * | 2017-05-31 | 2017-11-03 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
CN109373998A (zh) * | 2018-10-11 | 2019-02-22 | 重庆天箭惯性科技股份有限公司 | 基于多传感器数据的旋转体姿态测量方法 |
CN110514200A (zh) * | 2019-08-13 | 2019-11-29 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及高转速旋转体姿态测量方法 |
CN111337019A (zh) * | 2020-03-25 | 2020-06-26 | 中国人民解放军军事科学院国防科技创新研究院 | 一种用于组合导航的量子传感装置 |
CN113701752A (zh) * | 2021-08-27 | 2021-11-26 | 浙江大学 | 一种旋转弹用全捷联姿态测量装置及方法 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62232008A (ja) * | 1986-04-01 | 1987-10-12 | Nippon Koki Kk | トンネル掘削機の位置及び姿勢の検出方法並びに検出装置 |
JPH06323865A (ja) * | 1992-07-01 | 1994-11-25 | Westinghouse Electric Corp <We> | 磁気マーカーを用いる潜水艇の位置決定装置 |
CN1644456A (zh) * | 2005-01-21 | 2005-07-27 | 清华大学 | 用于微小卫星的微型组合姿态测量系统 |
CN1898576A (zh) * | 2003-12-24 | 2007-01-17 | 秦内蒂克有限公司 | 组合的磁场梯度和磁场强度传感器 |
CN101554926A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 航天器的姿态控制系统及方法 |
CN201955092U (zh) * | 2011-03-15 | 2011-08-31 | 滨州学院 | 一种基于地磁辅助的平台式惯性导航装置 |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
KR20120078659A (ko) * | 2010-12-30 | 2012-07-10 | 엘아이지넥스원 주식회사 | 지자기맵 정보를 이용하여 수중 운동체의 위치를 결정하기 위한 장치 및 그 방법 |
CN102778232A (zh) * | 2012-07-10 | 2012-11-14 | 清华大学 | 微惯性测量装置 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN103218906A (zh) * | 2013-04-23 | 2013-07-24 | 中国科学院深圳先进技术研究院 | 跌倒数据采集分析平台 |
CN103630139A (zh) * | 2013-12-17 | 2014-03-12 | 哈尔滨工程大学 | 一种基于地磁梯度张量测量的水下载体全姿态确定方法 |
-
2014
- 2014-04-22 CN CN201410162204.5A patent/CN103940425B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62232008A (ja) * | 1986-04-01 | 1987-10-12 | Nippon Koki Kk | トンネル掘削機の位置及び姿勢の検出方法並びに検出装置 |
JPH06323865A (ja) * | 1992-07-01 | 1994-11-25 | Westinghouse Electric Corp <We> | 磁気マーカーを用いる潜水艇の位置決定装置 |
CN1898576A (zh) * | 2003-12-24 | 2007-01-17 | 秦内蒂克有限公司 | 组合的磁场梯度和磁场强度传感器 |
CN1644456A (zh) * | 2005-01-21 | 2005-07-27 | 清华大学 | 用于微小卫星的微型组合姿态测量系统 |
CN101554926A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 航天器的姿态控制系统及方法 |
KR20120078659A (ko) * | 2010-12-30 | 2012-07-10 | 엘아이지넥스원 주식회사 | 지자기맵 정보를 이용하여 수중 운동체의 위치를 결정하기 위한 장치 및 그 방법 |
CN201955092U (zh) * | 2011-03-15 | 2011-08-31 | 滨州学院 | 一种基于地磁辅助的平台式惯性导航装置 |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
CN102778232A (zh) * | 2012-07-10 | 2012-11-14 | 清华大学 | 微惯性测量装置 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN103218906A (zh) * | 2013-04-23 | 2013-07-24 | 中国科学院深圳先进技术研究院 | 跌倒数据采集分析平台 |
CN103630139A (zh) * | 2013-12-17 | 2014-03-12 | 哈尔滨工程大学 | 一种基于地磁梯度张量测量的水下载体全姿态确定方法 |
Non-Patent Citations (3)
Title |
---|
史金光等: "《制导炮弹飞行姿态角的一种组合测量方法》", 《弹道学报》, vol. 23, no. 3, 30 September 2011 (2011-09-30), pages 37 - 42 * |
李兴城等: "《基于磁阻传感器的旋转弹姿态测量算法研究》", 《计算机仿真》, vol. 29, no. 5, 31 May 2012 (2012-05-31) * |
马国梁等: "《磁阻传感器测量旋转弹滚转姿态的原理分析》", 《弹道学报》, vol. 24, no. 1, 28 March 2012 (2012-03-28), pages 32 - 36 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104764451A (zh) * | 2015-04-23 | 2015-07-08 | 北京理工大学 | 一种基于惯性和地磁传感器的目标姿态跟踪方法 |
CN105403218A (zh) * | 2015-12-08 | 2016-03-16 | 北京健德乾坤导航系统科技有限责任公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105403218B (zh) * | 2015-12-08 | 2018-12-21 | 北京天龙智控科技有限公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105547293A (zh) * | 2016-01-07 | 2016-05-04 | 北京电子工程总体研究所 | 一种垂直状态惯性导航的初始基准的建立方法 |
CN105841698B (zh) * | 2016-03-28 | 2018-10-26 | 中国船舶重工集团公司第七一〇研究所 | 一种无需调零的auv舵角精确实时测量系统 |
CN105841698A (zh) * | 2016-03-28 | 2016-08-10 | 中国船舶重工集团公司第七研究所 | 一种无需调零的auv舵角精确实时测量系统 |
CN106403934A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法 |
CN106403935A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载磁组合姿态测量装置的应用 |
CN106403935B (zh) * | 2016-08-24 | 2019-03-29 | 易文俊 | 一种弹载磁组合姿态测量装置的应用 |
CN106403934B (zh) * | 2016-08-24 | 2019-04-09 | 易文俊 | 一种弹载地磁姿态测量处理方法 |
CN106092098A (zh) * | 2016-08-25 | 2016-11-09 | 湖北三江航天红峰控制有限公司 | 一种基于陀螺和倾角仪的载体航姿测量方法 |
CN107063254B (zh) * | 2016-12-27 | 2023-08-25 | 南京理工大学 | 一种陀螺地磁组合的姿态解算方法 |
CN107063254A (zh) * | 2016-12-27 | 2017-08-18 | 南京理工大学 | 一种陀螺地磁组合的姿态解算方法 |
CN107314718A (zh) * | 2017-05-31 | 2017-11-03 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107314718B (zh) * | 2017-05-31 | 2018-11-13 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
CN109373998A (zh) * | 2018-10-11 | 2019-02-22 | 重庆天箭惯性科技股份有限公司 | 基于多传感器数据的旋转体姿态测量方法 |
CN110514200B (zh) * | 2019-08-13 | 2023-03-14 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及高转速旋转体姿态测量方法 |
CN110514200A (zh) * | 2019-08-13 | 2019-11-29 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及高转速旋转体姿态测量方法 |
CN111337019A (zh) * | 2020-03-25 | 2020-06-26 | 中国人民解放军军事科学院国防科技创新研究院 | 一种用于组合导航的量子传感装置 |
CN113701752A (zh) * | 2021-08-27 | 2021-11-26 | 浙江大学 | 一种旋转弹用全捷联姿态测量装置及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103940425B (zh) | 2017-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103940425A (zh) | 一种磁-惯性组合捷联测量方法 | |
CN106643737B (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN106979780B (zh) | 一种无人车实时姿态测量方法 | |
CN105180937B (zh) | 一种mems‑imu初始对准方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
CN103852081B (zh) | 用于大气数据/捷联惯导组合导航系统的真空速解算方法 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN107063254B (zh) | 一种陀螺地磁组合的姿态解算方法 | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN105300381A (zh) | 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法 | |
CN105157705A (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN104864874B (zh) | 一种低成本单陀螺航位推算导航方法及系统 | |
CN108225370A (zh) | 一种运动姿态传感器的数据融合与解算方法 | |
CN103940442A (zh) | 一种采用加速收敛算法的定位方法及装置 | |
CN109764870B (zh) | 基于变换估计量建模方案的载体初始航向估算方法 | |
Liu et al. | A complementary filter based on multi-sample rotation vector for attitude estimation | |
CN103499348A (zh) | Ahrs高精度姿态数据计算方法 | |
CN106248082B (zh) | 一种飞行器自主导航系统及导航方法 | |
CN102937450A (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN105241319B (zh) | 一种高速自旋制导炮弹空中实时对准方法 | |
WO2018214226A1 (zh) | 一种无人车实时姿态测量方法 | |
CN108871319B (zh) | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 | |
CN104236533A (zh) | 一种陀螺仪数据融合方法 | |
CN110095118A (zh) | 一种车身姿态角的实时测量方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |