CN106403934B - 一种弹载地磁姿态测量处理方法 - Google Patents
一种弹载地磁姿态测量处理方法 Download PDFInfo
- Publication number
- CN106403934B CN106403934B CN201610718111.5A CN201610718111A CN106403934B CN 106403934 B CN106403934 B CN 106403934B CN 201610718111 A CN201610718111 A CN 201610718111A CN 106403934 B CN106403934 B CN 106403934B
- Authority
- CN
- China
- Prior art keywords
- angle
- sin
- magnetic
- roll attitude
- cos
- 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.)
- Expired - Fee Related
Links
- 230000005389 magnetism Effects 0.000 title claims abstract description 12
- 238000005259 measurement Methods 0.000 title claims abstract description 10
- 238000003672 processing method Methods 0.000 title claims description 3
- 238000004364 calculation method Methods 0.000 claims abstract description 7
- 238000012545 processing Methods 0.000 abstract description 6
- 238000000034 method Methods 0.000 abstract description 5
- 238000010304 firing Methods 0.000 abstract description 4
- 238000001514 detection method Methods 0.000 abstract description 3
- 238000012360 testing method Methods 0.000 abstract description 2
- 238000005096 rolling process Methods 0.000 description 4
- 230000000087 stabilizing effect Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/06—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving measuring of drift angle; involving correction for drift
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Measuring Magnetic Variables (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种弹载地磁姿态测量处理算法，该方法包括以下步骤：弹载双轴地磁传感器固定与弹体上，与弹轴方向垂直，敏感Y、Z方向的磁阻变化，以北东天导航坐标系为参考，xb′为xb在NOE平面上的投影，γ为弹体滚转姿态角，β为偏航角，θ为俯仰角。根据坐标变换，得到弹体Y、Z方向的地磁输出；根据磁偏航角ψ的取值范围，分析滚转姿态角γ的解算方法。磁探测基准理论计算值与射角变化检测值的对比曲线，从几种检测结果看，理论计算值与实际检测值基本一致，最大偏差范围：‑3.2°～+2.97°。
Description
技术领域
本发明属于地磁导航应用技术领域，具体地说，涉及一种弹载地磁姿态测量处理算法。
背景技术
地磁场是地球系统的基本物理场，是地球的固有资源，为航空、航天、航海提供了天然的参考系，可应用于航天器或舰船的定位定向及姿态控制。利用地球磁场空间分布的磁导航技术简便高效、性能可靠、抗干扰，一直是世界发达国家不可缺少的基本导航定位手段，如自动化程度很高的波音飞机都装载有磁导航定位系统。当前，地磁技术已广泛应用于地球科学、资源探测、航天航空、交通通讯、地震预测、空间天气、测绘等诸多领域，拥有巨大的应用潜力。
地球磁场同地球引力场一样，是一个地球物理场，它是由基本磁场与变化磁场两部分组成的。基本磁场来源于地球内部，研究它的变化及其起源，一直是地球动力学中的重要内容之一，而变化磁场则与电离层的变化和太阳活动等有关。地磁场是由不同来源的磁场叠加起来构成的，按其来源可把地磁场分为两大部分：一部分为稳定磁场，另一部分主要是起源于地球外部的快速变化磁场。快速变化磁场比稳定磁场弱的多，最大变化也只占总磁场的2％-4％。因此稳定磁场是地磁场的主要部分。地球主磁场的变化极为缓慢，这种变化称为地磁场的长周期变化。地球的变化磁场则是起源于外部并叠加在主磁场之上的各种短周期的地磁场变化。地球基本磁场变化十分缓慢，年变率在千分之一以下。外源场变化的时间尺寸比较小，变化比较复杂，平静时的外源场的强度不到内源场的千分之一，强扰动时的外源场也在内源场的百分之一以下。因此，在考虑地磁场本身对航天器的影响时，只需考虑内源场中的基本磁场。
炮弹的空中姿态测量，特别是高过载下姿态测量在国内仍是一大技术难题,很多方法尚处于探索中。
发明内容
本发明的目的在于克服炮弹的空中姿态测量技术存在的缺陷，提供一种弹载地磁姿态测量处理算法。
其具体技术方案为：
一种弹载地磁姿态测量处理算法，包括以下步骤：弹载双轴地磁传感器固定与弹体上，与弹轴方向垂直，敏感Y、Z方向的磁阻变化，
以北东天导航坐标系为参考，x′b为xb在NOE平面上的投影，γ为弹体滚转姿态角，β为偏航角，θ为俯仰角。根据坐标变换，得到弹体Y、Z方向的地磁输出：
式中ψ＝D+β为弹体的磁偏航角(磁射向)，φ＝θ+I为弹体的磁俯仰角。
根据发射阵地地和飞行过程中的经纬度和高度信息可以计算出任意飞行弹道点上的地磁偏角D和地磁倾角I；
根据飞行中卫星定位装置探测的速度信息：VN、VE、VH和弹道运动方程组可以初步计算出弹丸弹道倾角θc和速度航向角βc，根据炮弹姿态角转换关系：β＝βC+δ2和θ＝θC+δ1，δ1、δ2为炮弹攻角分量，可忽略不计。
从公式(1)可知，根据计算出炮弹飞行弹道上磁偏航角ψ和磁俯仰角φ要解出滚转姿态角γ，需要制导地磁场矢量的大小|M|。分析(1)可以看出，当MY＝0和MZ＝0时，解算出滚转姿态角γ不需要|M|。由于滚转姿态角γ∈[0°,360°]，所以无论磁俯仰角φ在哪个范围，在一个旋转周期内必有MY＝0和MZ＝0的点。根据磁偏航角ψ的取值范围，分析滚转姿态角γ的解算方法：
1)当磁偏航角ψ＝0°或磁偏航角ψ＝180°时：
当MY＝0时，如果sinφ≠0，则cosγ＝0,此时滚转姿态角γ＝90°或γ＝-90°。
当MZ＝0时，如果sinφ≠0，则sinγ＝0,此时滚转姿态角γ＝0°或γ＝180°。
对于远程打击的滑翔增程炮弹，全飞行过程中磁俯仰角φ只可能在弹道顶点某点上 sinφ＝0，滑翔增程和精度控制是过弹道顶点后才开始控制的。
2)当磁偏航角ψ≠0°或磁偏航角ψ≠180°时：
当地磁传感器的输出MY＝0时，可得到下式：
|M|sinγsinψcosφ+|M|cosγsinφ＝0
|M|≠0，可得:
当地磁传感器的输出MZ＝0时，可得到下式：
|M|sinγsinφ-|M|cosγsinψcosφ＝0
|M|≠0，可得:
根据计算出炮弹飞行弹道上任意点的磁偏航角ψ和磁俯仰角φ，由(3)、(4)可以解算出MY＝0和MZ＝0极值点＝相对应的出滚转姿态角γE0和γH0。从计算公式看，γE0和γH0相差90°。
若以弹体上地磁传感器的输出MZ＝0与舵控正方向标定滚转角，则MZ＝0时滚转姿态角γ(γH0)随磁偏航角ψ和磁俯仰角φ的变化关系可得：
γH0＝arctan(sinψ.tanφ) (5)
由(5)式可实时计算出炮弹飞行过程中MZ＝0时炮弹的滚转姿态角，根据计算的转速，可积分计算出任意点出的滚转姿态角γ：
与现有技术相比，本发明的有益效果：
本发明提供一种弹载地磁姿态测量处理算法在验证过程中，磁探测基准理论计算值与射角变化检测值的对比曲线，从几种检测结果看，理论计算值与实际检测值基本一致，最大偏差范围：-3.2°～+2.97°。
附图说明
图1是磁传感器安装示意图。
具体实施方式
下面结合附图和具体实施方案对本发明的技术方案作进一步详细地说明。
一种弹载地磁姿态测量处理算法，包括以下步骤：弹载双轴地磁传感器固定与弹体上，与弹轴方向垂直，敏感Y、Z方向的磁阻变化，具体安装急与弹体坐标关系如图1所示。
以北东天导航坐标系为参考，x′b为xb在NOE平面上的投影，γ为弹体滚转姿态角，β为偏航角(射向)，θ为俯仰角(射角)。根据坐标变换，得到弹体Y、Z方向的地磁输出：
式中ψ＝D+β为弹体的磁偏航角(磁射向)，φ＝θ+I为弹体的磁俯仰角(磁射角)。
根据发射阵地地和飞行过程中的经纬度和高度信息可以计算出任意飞行弹道点上的地磁偏角D和地磁倾角I；
根据飞行中卫星定位装置探测的速度信息：VN、VE、VH和弹道运动方程组可以初步计算出弹丸弹道倾角θc和速度航向角βc，根据炮弹姿态角转换关系：β＝βC+δ2和θ＝θC+δ1，δ1、δ2为炮弹攻角分量，可忽略不计。
从公式(1)可知，根据计算出炮弹飞行弹道上磁偏航角ψ和磁俯仰角φ要解出滚转姿态角γ，需要制导地磁场矢量的大小|M|。分析(1)可以看出，当MY＝0和MZ＝0时，解算出滚转姿态角γ不需要|M|。由于滚转姿态角γ∈[0°,360°]，所以无论磁俯仰角φ在哪个范围，在一个旋转周期内必有MY＝0和MZ＝0的点。根据磁偏航角ψ的取值范围，分析滚转姿态角γ的解算方法：
1)当磁偏航角ψ＝0°或磁偏航角ψ＝180°时：
当MY＝0时，如果sinφ≠0，则cosγ＝0,此时滚转姿态角γ＝90°或γ＝-90°。
当MZ＝0时，如果sinφ≠0，则sinγ＝0,此时滚转姿态角γ＝0°或γ＝180°。
对于远程打击的滑翔增程炮弹，全飞行过程中磁俯仰角φ只可能在弹道顶点某点上sinφ＝0，滑翔增程和精度控制是过弹道顶点后才开始控制的。
2)当磁偏航角ψ≠0°或磁偏航角ψ≠180°时：
当地磁传感器的输出MY＝0时，可得到下式：
|M|sinγsinψcosφ+|M|cosγsinφ＝0
|M|≠0，可得:
当地磁传感器的输出MZ＝0时，可得到下式：
|M|sinγsinφ-|M|cosγsinψcosφ＝0
|M|≠0，可得:
根据计算出炮弹飞行弹道上任意点的磁偏航角ψ和磁俯仰角φ，由(3)、(4)可以解算出MY＝0和MZ＝0极值点＝相对应的出滚转姿态角γE0和γH0。从计算公式看，γE0和γH0相差90°。
若以弹体上地磁传感器的输出MZ＝0与舵控正方向(铅直向上)标定滚转角，则MZ＝0 时滚转姿态角γ(γH0)随磁偏航角ψ和磁俯仰角φ的变化关系可得：
γH0＝arctan(sinψ.tanφ) (5)
由(5)式可实时计算出炮弹飞行过程中MZ＝0时炮弹的滚转姿态角，根据计算的转速，可积分计算出任意点出的滚转姿态角γ：
以上所述，仅为本发明较佳的具体实施方式，本发明的保护范围不限于此，任何熟悉本技术领域的技术人员在本发明披露的技术范围内，可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。
Claims (1)
1.一种弹载地磁姿态测量处理方法，其特征在于，包括以下步骤：
1)当磁偏航角ψ＝0°或磁偏航角ψ＝180°时：
当MY＝0时，如果sinφ≠0，则cosγ＝0,此时滚转姿态角γ＝90°或γ＝-90°；
当MZ＝0时，如果sinφ≠0，则sinγ＝0,此时滚转姿态角γ＝0°或γ＝180°；
对于远程打击的滑翔增程炮弹，全飞行过程中磁俯仰角φ只可能在弹道顶点某点上sinφ＝0，滑翔增程和精度控制是过弹道顶点后才开始控制的；
2)当磁偏航角ψ≠0°或磁偏航角ψ≠180°时：
当地磁传感器的输出MY＝0时，得到下式：
|M|sinγsinψcosφ+|M|cosγsinφ＝0
|M|≠0，得:
当地磁传感器的输出MZ＝0时，得到下式：
|M|sinγsinφ-|M|cosγsinψcosφ＝0
|M|≠0，得:
根据计算出炮弹飞行弹道上任意点的磁偏航角ψ和磁俯仰角φ，由(3)、(4)解算出MY＝0和MZ＝0极值点相对应的出滚转姿态角γE0和γH0；从计算公式看，γE0和γH0相差 90°；
若以弹体上地磁传感器的输出MZ＝0与舵控正方向标定滚转角，则MZ＝0时滚转姿态角γH0随磁偏航角ψ和磁俯仰角φ的变化关系得：
γH0＝arctan(sinψ.tanφ) (5)
由(5)式实时计算出炮弹飞行过程中MZ＝0时炮弹的滚转姿态角，根据计算的转速，积分计算出任意点出的滚转姿态角γ：
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610718111.5A CN106403934B (zh) | 2016-08-24 | 2016-08-24 | 一种弹载地磁姿态测量处理方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610718111.5A CN106403934B (zh) | 2016-08-24 | 2016-08-24 | 一种弹载地磁姿态测量处理方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN106403934A CN106403934A (zh) | 2017-02-15 |
| CN106403934B true CN106403934B (zh) | 2019-04-09 |
Family
ID=58004304
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610718111.5A Expired - Fee Related CN106403934B (zh) | 2016-08-24 | 2016-08-24 | 一种弹载地磁姿态测量处理方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106403934B (zh) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
| CN109373998B (zh) * | 2018-10-11 | 2020-07-17 | 重庆天箭惯性科技股份有限公司 | 基于多传感器数据的旋转体姿态测量方法 |
| CN110672060B (zh) * | 2019-08-23 | 2022-09-16 | 中国人民解放军63729部队 | 一种基于外测速度的箭上姿态角情况判决方法 |
| CN113587746B (zh) * | 2021-10-08 | 2021-12-21 | 北京信息科技大学 | 基于地磁信息测量弹体的大跨度转速的方法、装置及系统 |
| CN114252067A (zh) * | 2021-12-25 | 2022-03-29 | 江苏九天航空航天科技有限公司 | 一种制导炮弹空中姿态预测方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001033253A (ja) * | 1999-07-19 | 2001-02-09 | Tokin Corp | 姿勢角検出装置 |
| CN102607562A (zh) * | 2012-04-12 | 2012-07-25 | 南京航空航天大学 | 基于载体飞行模态判别的微惯性参数自适应姿态确定方法 |
| CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
| CN103487052A (zh) * | 2013-09-17 | 2014-01-01 | 哈尔滨工程大学 | 一种基于磁传感器组合的飞行器姿态测量方法 |
| CN103940425A (zh) * | 2014-04-22 | 2014-07-23 | 北京信息科技大学 | 一种磁-惯性组合捷联测量方法 |
-
2016
- 2016-08-24 CN CN201610718111.5A patent/CN106403934B/zh not_active Expired - Fee Related
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001033253A (ja) * | 1999-07-19 | 2001-02-09 | Tokin Corp | 姿勢角検出装置 |
| CN102607562A (zh) * | 2012-04-12 | 2012-07-25 | 南京航空航天大学 | 基于载体飞行模态判别的微惯性参数自适应姿态确定方法 |
| CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
| CN103487052A (zh) * | 2013-09-17 | 2014-01-01 | 哈尔滨工程大学 | 一种基于磁传感器组合的飞行器姿态测量方法 |
| CN103940425A (zh) * | 2014-04-22 | 2014-07-23 | 北京信息科技大学 | 一种磁-惯性组合捷联测量方法 |
Non-Patent Citations (3)
| Title |
|---|
| 基于磁传感器组合的旋转弹体姿态测试方法研究;李玎;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20110115(第1期);32-35 |
| 抗干扰弹载地磁测姿系统设计;姚雨林等;《兵器装备工程学报》;20160430;第37卷(第4期);101-105 |
| 旋转弹体背景磁场模型和地磁姿态测试方法研究;向超;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20140215(第2期);22-24 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN106403934A (zh) | 2017-02-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106403934B (zh) | 一种弹载地磁姿态测量处理方法 | |
| Wang et al. | A GNSS/INS integrated navigation algorithm based on Kalman filter | |
| CN102607639A (zh) | 基于bp神经网络的大攻角飞行状态下大气数据测量方法 | |
| CN105242682B (zh) | 靶机目标特性测量系统 | |
| CN106802143B (zh) | 一种基于惯性仪器和迭代滤波算法的船体形变角测量方法 | |
| Wang et al. | Integrated navigation method of a marine strapdown inertial navigation system using a star sensor | |
| Wang et al. | Modified compensation algorithm of lever-arm effect and flexural deformation for polar shipborne transfer alignment based on improved adaptive Kalman filter | |
| CN110017808A (zh) | 利用地磁信息和加速计解算飞行器姿态的方法 | |
| Kim et al. | Underwater glider navigation error compensation using sea current data | |
| Cheng et al. | On lever-arm effect compensation for polar Transfer Alignment | |
| CN106403935B (zh) | 一种弹载磁组合姿态测量装置的应用 | |
| CN109000682A (zh) | 基于直线航迹的空中粗对准的方法 | |
| Jia-Tong et al. | On simultaneous AUV localization with single acoustic beacon using angles measurements | |
| CN110017809B (zh) | 利用地磁信息和光流传感器解算飞行器姿态的方法 | |
| CN110017831A (zh) | 利用地磁信息和声呐传感器解算飞行器姿态的方法 | |
| RU2331892C2 (ru) | Способ определения компонента скорости летательного аппарата | |
| CN110986926A (zh) | 一种基于地磁要素的飞行弹体旋转姿态测量方法 | |
| Feng et al. | Analysis of Near Space Hypersonic Glide Vehicle Trajectory Characteristics and Defense Difficulties | |
| Meng et al. | A UAV Aided Method for Ship Attitude Estimation | |
| Chen et al. | Study on a new algorithm for tracking ballistic missile in free flight phase | |
| Chi et al. | Research on AUV Integrated Navigation Method Based on Improved Particle Filter Algorithm | |
| Xu et al. | Spinning missile attitude estimation method based on the solar vector and MEMS | |
| Qu et al. | An algorithm of online wind field estimation for small fixed-wing UAVs | |
| Chuanjun et al. | Magnetometer-Based Attitude Determination for Spinning Flight Vehicles | |
| Cao et al. | A Biaxial Infrared and Geomagnetic Composite Attitude Measurement Method of Rotating Projectile |
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 | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190409 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |