CN106643797A - 一种炮击后陀螺零偏修正方法 - Google Patents
一种炮击后陀螺零偏修正方法 Download PDFInfo
- Publication number
- CN106643797A CN106643797A CN201611177705.6A CN201611177705A CN106643797A CN 106643797 A CN106643797 A CN 106643797A CN 201611177705 A CN201611177705 A CN 201611177705A CN 106643797 A CN106643797 A CN 106643797A
- Authority
- CN
- China
- Prior art keywords
- zero
- omega
- mems gyroscope
- missile
- component
- 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
- 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表示高精度三轴磁力仪的非正交矩阵;
根据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轴上的分量。
本发明所述的一种炮击后陀螺零偏修正方法通过有效利用弹体在空中的运动特性及三维磁测信息(即高精度三轴磁力仪获取的信息),实现了对弹载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 true CN106643797A (zh) | 2017-05-10 |
CN106643797B CN106643797B (zh) | 2019-01-04 |
Family
ID=58833346
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611177705.6A Active CN106643797B (zh) | 2016-12-19 | 2016-12-19 | 一种炮击后陀螺零偏修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643797B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110530400A (zh) * | 2019-10-29 | 2019-12-03 | 成都纵横自动化技术股份有限公司 | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102313543A (zh) * | 2011-07-11 | 2012-01-11 | 上海大学 | 基于巨磁阻传感器的地磁方位角测量系统、测量方法及正交补偿方法 |
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 active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
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 |
---|
韩艳: "制导炮弹飞行姿态的陀螺/磁阻传感器组合测量方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
龙达峰等: "高速旋转弹载体干扰磁场补偿算法", 《弹箭与制导学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110530400A (zh) * | 2019-10-29 | 2019-12-03 | 成都纵横自动化技术股份有限公司 | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 |
CN110530400B (zh) * | 2019-10-29 | 2020-03-20 | 成都纵横自动化技术股份有限公司 | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 |
Also Published As
Publication number | Publication date |
---|---|
CN106643797B (zh) | 2019-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN105115508B (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN105486307B (zh) | 针对机动目标的视线角速率估计方法 | |
CN104567930A (zh) | 一种能够估计和补偿机翼挠曲变形的传递对准方法 | |
CN103279642B (zh) | 无地面控制点的目标定位精度分析方法 | |
CN105157705A (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN107478110B (zh) | 一种基于状态观测器的旋转弹姿态角计算方法 | |
CN105021092A (zh) | 一种捷联寻的导引头的制导信息提取方法 | |
CN104316079B (zh) | 一种基于火箭橇试验的惯性测量系统落点精度估计方法 | |
CN103499348A (zh) | Ahrs高精度姿态数据计算方法 | |
CN111504256A (zh) | 一种基于最小二乘法的滚转角实时估计方法 | |
CN108827288A (zh) | 一种基于对偶四元数的降维捷联惯性导航系统初始对准方法及系统 | |
CN105241319B (zh) | 一种高速自旋制导炮弹空中实时对准方法 | |
Avrutov et al. | Gyrocompassing mode of the attitude and heading reference system | |
Reddy et al. | Advanced navigation system for aircraft applications | |
CN104931048A (zh) | 一种基于mimu的肩扛制导火箭弹的导航方法 | |
CN106643797A (zh) | 一种炮击后陀螺零偏修正方法 | |
Bin et al. | Attitude dynamics aiding for line-of-sight angular rate reconstruction of strap-down seeker | |
Zhang et al. | Research on auto compensation technique of strap-down inertial navigation systems | |
CN105352528B (zh) | 一种应用于弹道导弹的惯导误差在线补偿方法 | |
CN104297525A (zh) | 基于火箭橇试验的惯性测量系统加速度计标定方法 | |
CN109737960A (zh) | 基于速度加角速度匹配的船体变形测量方法 | |
CN113218423A (zh) | 发射时无基准姿态信息的空中粗对准方法 | |
Zhu et al. | Attitude measurement method of geomagnetic/gyro combination based on difference-quotient | |
Gao et al. | Research on initial precision alignment method of strapdown inertial navigation system |
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 |