CN106643797B - 一种炮击后陀螺零偏修正方法 - Google Patents
一种炮击后陀螺零偏修正方法 Download PDFInfo
- Publication number
- CN106643797B CN106643797B CN201611177705.6A CN201611177705A CN106643797B CN 106643797 B CN106643797 B CN 106643797B CN 201611177705 A CN201611177705 A CN 201611177705A CN 106643797 B CN106643797 B CN 106643797B
- Authority
- CN
- China
- Prior art keywords
- zero
- mems gyroscope
- bit
- indicate
- axis
- 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
- 238000002715 modification method Methods 0.000 title claims abstract description 10
- 238000000034 method Methods 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000005358 geomagnetic field Effects 0.000 claims description 8
- 230000000631 nonopiate Effects 0.000 claims 1
- 230000000149 penetrating effect Effects 0.000 claims 1
- 238000005259 measurement Methods 0.000 abstract description 9
- 230000000694 effects Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000005516 engineering process Methods 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
-
- 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/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
本发明涉及弹载MEMS陀螺仪,具体是一种炮击后陀螺零偏修正方法。本发明解决了弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题。一种炮击后陀螺零偏修正方法,该方法是采用如下步骤实现的:步骤S1:定义弹体出炮口20m处的时刻为零位修正时刻;步骤S2:对弹载惯导系统进行初始对准;步骤S3:根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;步骤S4:根据计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;步骤S5:根据ψ1、θ1、γ1、θ2、γ2,计算出MEMS陀螺仪在弹体发射前后的零位变化;步骤S6:计算出MEMS陀螺仪的准确实时输出。本发明适用于弹体的姿态测量。
Description
技术领域
本发明涉及弹载MEMS陀螺仪,具体是一种炮击后陀螺零偏修正方法。
背景技术
随着MEMS技术的发展,MEMS陀螺仪以其体积小、重量轻、功耗低、可靠性高等传统陀螺仪无法比拟的优点广泛应用于武器装备系统。弹载惯导系统中的MEMS陀螺仪(简称弹载MEMS陀螺仪)作为系统的核心元件,其精度和性能在弹体的姿态测量中起着至关重要的作用。在实际应用中,当弹体发射时,弹载MEMS陀螺仪会受到较大的过载作用,由此导致弹载MEMS陀螺仪发生零偏(即弹载MEMS陀螺仪的零位发生显著偏移),从而导致弹体的姿态测量结果出现巨大误差。基于此,有必要发明一种对弹载MEMS陀螺仪的零偏进行在线修正的方法,以解决弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题。
发明内容
本发明为了解决弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题,提供了一种炮击后陀螺零偏修正方法。
本发明是采用如下技术方案实现的:
一种炮击后陀螺零偏修正方法,该方法是采用如下步骤实现的:
步骤S1:定义弹体的发射坐标系为导航坐标系,简称n系;定义弹体坐标系为载体坐标系,简称b系;惯性坐标系简称i系;定义弹体出炮口20m处的时刻为零位修正时刻;定义弹体从发射点到出炮口20m处的飞行时间为t;
步骤S2:在弹体发射前,对弹载惯导系统进行初始对准;
步骤S3:在弹体发射后,根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;
步骤S4:利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量,由此得出b系下的地磁场强度矢量Hb′并进行补偿;具体补偿公式如下:
Hb=(Hb′-offset)(CfsCNO)-1 (1);
式(1)中:Hb表示补偿后b系下的地磁场强度矢量;offset表示高精度三轴磁力仪的零点漂移矩阵;Cfs表示高精度三轴磁力仪的标度因数矩阵;CNO表示高精度三轴磁力仪的非正交矩阵;
根据计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;具体计算公式如下:
式(2)中:分别表示Hb在b系三轴上的分量;
步骤S5:根据ψ1、θ1、γ1、θ2、γ2,计算出MEMS陀螺仪在弹体发射前后的零位变化;具体计算公式如下:
式(3)中:Δωx0表示MEMS陀螺仪在弹体发射前后的零位变化在x轴上的分量;Δωy0表示MEMS陀螺仪在弹体发射前后的零位变化在y轴上的分量;Δωz0表示MEMS陀螺仪在弹体发射前后的零位变化在z轴上的分量;
步骤S6:根据MEMS陀螺仪在弹体发射前后的零位变化,计算出MEMS陀螺仪的准确实时输出;具体计算公式如下:
式(4)中:ωx′表示MEMS陀螺仪的准确实时输出在x轴上的分量;ωy′表示MEMS陀螺仪的准确实时输出在y轴上的分量;ωz′表示MEMS陀螺仪的准确实时输出在z轴上的分量。
本发明所述的一种炮击后陀螺零偏修正方法通过有效利用弹体在空中的运动特性及三维磁测信息(即高精度三轴磁力仪获取的信息),实现了对弹载MEMS陀螺仪的零偏进行在线修正,由此大幅提高了弹体的姿态测量精度。
本发明有效解决了弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题,适用于弹体的姿态测量。
附图说明
图1是本发明中弹体的发射时刻和零位修正时刻的示意图。
具体实施方式
一种炮击后陀螺零偏修正方法,该方法是采用如下步骤实现的:
步骤S1:定义弹体的发射坐标系为导航坐标系,简称n系;定义弹体坐标系为载体坐标系,简称b系;惯性坐标系简称i系;定义弹体出炮口20m处的时刻为零位修正时刻;定义弹体从发射点到出炮口20m处的飞行时间为t;
步骤S2:在弹体发射前,对弹载惯导系统进行初始对准;
步骤S3:在弹体发射后,根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;
步骤S4:利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量,由此得出b系下的地磁场强度矢量Hb′并进行补偿;具体补偿公式如下:
Hb=(Hb′-offset)(CfsCNO)-1 (1);
式(1)中:Hb表示补偿后b系下的地磁场强度矢量;offset表示高精度三轴磁力仪的零点漂移矩阵;Cfs表示高精度三轴磁力仪的标度因数矩阵;CNO表示高精度三轴磁力仪的非正交矩阵;
根据Hb,计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;具体计算公式如下:
式(2)中:分别表示Hb在b系三轴上的分量;
步骤S5:根据ψ1、θ1、γ1、θ2、γ2,计算出MEMS陀螺仪在弹体发射前后的零位变化;具体计算公式如下:
式(3)中:Δωx0表示MEMS陀螺仪在弹体发射前后的零位变化在x轴上的分量;Δωy0表示MEMS陀螺仪在弹体发射前后的零位变化在y轴上的分量;Δωz0表示MEMS陀螺仪在弹体发射前后的零位变化在z轴上的分量;
步骤S6:根据MEMS陀螺仪在弹体发射前后的零位变化,计算出MEMS陀螺仪的准确实时输出;具体计算公式如下:
式(4)中:ωx′表示MEMS陀螺仪的准确实时输出在x轴上的分量;ωy′表示MEMS陀螺仪的准确实时输出在y轴上的分量;ωz′表示MEMS陀螺仪的准确实时输出在z轴上的分量。
Claims (1)
1.一种炮击后陀螺零偏修正方法,其特征在于:该方法是采用如下步骤实现的:
步骤S1:定义弹体的发射坐标系为导航坐标系,简称n系;定义弹体坐标系为载体坐标系,简称b系;惯性坐标系简称i系;定义弹体出炮口20m处的时刻为零位修正时刻;定义弹体从发射点到出炮口20m处的飞行时间为t;
步骤S2:在弹体发射前,对弹载惯导系统进行初始对准;
步骤S3:在弹体发射后,根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;
步骤S4:利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量,由此得出b系下的地磁场强度矢量Hb′并进行补偿;具体补偿公式如下:
Hb=(Hb′-offset)(CfsCNO)-1 (1);
式(1)中:Hb表示补偿后b系下的地磁场强度矢量;offset表示高精度三轴磁力仪的零点漂移矩阵;Cfs表示高精度三轴磁力仪的标度因数矩阵;CNO表示高精度三轴磁力仪的非正交矩阵;
根据Hb,计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;具体计算公式如下:
式(2)中:分别表示Hb在b系三轴上的分量;
步骤S5:根据ψ1、θ1、γ1、θ2、γ2,计算出MEMS陀螺仪在弹体发射前后的零位变化;具体计算公式如下:
式(3)中:Δωx0表示MEMS陀螺仪在弹体发射前后的零位变化在x轴上的分量;Δωy0表示MEMS陀螺仪在弹体发射前后的零位变化在y轴上的分量;Δωz0表示MEMS陀螺仪在弹体发射前后的零位变化在z轴上的分量;
步骤S6:根据MEMS陀螺仪在弹体发射前后的零位变化,计算出MEMS陀螺仪的准确实时输出;具体计算公式如下:
式(4)中:ωx′表示MEMS陀螺仪的准确实时输出在x轴上的分量;ωy′表示MEMS陀螺仪的准确实时输出在y轴上的分量;ωz′表示MEMS陀螺仪的准确实时输出在z轴上的分量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611177705.6A CN106643797B (zh) | 2016-12-19 | 2016-12-19 | 一种炮击后陀螺零偏修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611177705.6A CN106643797B (zh) | 2016-12-19 | 2016-12-19 | 一种炮击后陀螺零偏修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106643797A CN106643797A (zh) | 2017-05-10 |
CN106643797B true CN106643797B (zh) | 2019-01-04 |
Family
ID=58833346
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611177705.6A Expired - Fee Related CN106643797B (zh) | 2016-12-19 | 2016-12-19 | 一种炮击后陀螺零偏修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643797B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110530400B (zh) * | 2019-10-29 | 2020-03-20 | 成都纵横自动化技术股份有限公司 | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102313543A (zh) * | 2011-07-11 | 2012-01-11 | 上海大学 | 基于巨磁阻传感器的地磁方位角测量系统、测量方法及正交补偿方法 |
CN105659791B (zh) * | 2009-03-19 | 2013-01-16 | 北京理工大学 | 高速旋转制导炮弹滚转信息的处理方法 |
CN103075930A (zh) * | 2012-12-25 | 2013-05-01 | 中北大学 | 适用于高速旋转弹体炮口初始姿态的测量方法 |
CN105675015A (zh) * | 2016-01-08 | 2016-06-15 | 中国电子科技集团公司第二十六研究所 | 一种微机械陀螺仪零偏自动消除方法 |
-
2016
- 2016-12-19 CN CN201611177705.6A patent/CN106643797B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105659791B (zh) * | 2009-03-19 | 2013-01-16 | 北京理工大学 | 高速旋转制导炮弹滚转信息的处理方法 |
CN102313543A (zh) * | 2011-07-11 | 2012-01-11 | 上海大学 | 基于巨磁阻传感器的地磁方位角测量系统、测量方法及正交补偿方法 |
CN103075930A (zh) * | 2012-12-25 | 2013-05-01 | 中北大学 | 适用于高速旋转弹体炮口初始姿态的测量方法 |
CN105675015A (zh) * | 2016-01-08 | 2016-06-15 | 中国电子科技集团公司第二十六研究所 | 一种微机械陀螺仪零偏自动消除方法 |
Non-Patent Citations (2)
Title |
---|
制导炮弹飞行姿态的陀螺/磁阻传感器组合测量方法研究;韩艳;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20100815;全文 |
高速旋转弹载体干扰磁场补偿算法;龙达峰等;《弹箭与制导学报》;20160430;第36卷(第2期);全文 |
Also Published As
Publication number | Publication date |
---|---|
CN106643797A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107314718B (zh) | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 | |
CN109596018B (zh) | 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法 | |
CN109373833B (zh) | 适用于旋转弹初始姿态和速度联合测量方法 | |
CN105157705B (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN105115508B (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN109373832B (zh) | 基于磁测滚转的旋转弹炮口初始参数测量方法 | |
KR101560580B1 (ko) | 포탄용 항법장치 및 그것의 제어방법 | |
CN107478110B (zh) | 一种基于状态观测器的旋转弹姿态角计算方法 | |
CN107883940A (zh) | 一种制导炮弹用高动态姿态测量方法 | |
Sokolovic et al. | Integration of INS, GPS, magnetometer and barometer for improving accuracy navigation of the vehicle | |
CN105486307A (zh) | 针对机动目标的视线角速率估计方法 | |
CN110017808B (zh) | 利用地磁信息和加速计解算飞行器姿态的方法 | |
CN106643797B (zh) | 一种炮击后陀螺零偏修正方法 | |
Cui et al. | A unified nonsingular rapid transfer alignment solution for tactical weapon based on matrix Kalman filter | |
Zhang et al. | Research on auto compensation technique of strap-down inertial navigation systems | |
Adam et al. | In-flight roll angle estimation for a guided high spin projectile | |
Hong et al. | Compensation of parasitic effect in homing loop with strapdown seeker via PID control | |
CN114964224A (zh) | 一种微惯导系统误差自主抑制方法 | |
Kim et al. | Stability analysis of strapdown seeker scale factor error and LOS rate | |
RU2615032C1 (ru) | Бесплатформенная инерциальная курсовертикаль на чувствительных элементах высокой точности | |
Zhang et al. | Deep data fusion method for missile-borne inertial/celestial system | |
CN112179378B (zh) | 一种偏振光导航辅助的传递对准系统 | |
Huang et al. | The design of attitude heading reference system based on MEMS sensing technology | |
Fairfax et al. | Cost-efficient state estimation for precision projectiles |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190104 |