CN114383603B - 一种基于旋转调制法的制导炮弹空中姿态辨识方法 - Google Patents
一种基于旋转调制法的制导炮弹空中姿态辨识方法 Download PDFInfo
- Publication number
- CN114383603B CN114383603B CN202210285182.6A CN202210285182A CN114383603B CN 114383603 B CN114383603 B CN 114383603B CN 202210285182 A CN202210285182 A CN 202210285182A CN 114383603 B CN114383603 B CN 114383603B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- projectile
- rotation
- moment
- missile
- 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
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/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
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B35/00—Testing or checking of ammunition
- F42B35/02—Gauging, sorting, trimming or shortening cartridges or missiles
-
- 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
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- General Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Gyroscopes (AREA)
Abstract
本发明属于导弹姿态检测领域,具体公开了一种基于旋转调制法的制导炮弹空中姿态辨识方法,导弹升空后弹体消旋并保持滚转角稳定状态至第一时刻,记录弹体稳定后至第一时刻之间陀螺仪数据;使导弹绕x轴旋转180°并保持滚转角稳定状态至第二时刻,记录弹体稳定后至第二时刻时间的陀螺仪数据;在记录下的陀螺仪数据分别求均值,并消除两次数据中的陀螺仪常值漂移,将消除常值漂移后的陀螺仪真值带入滚转角计算公式,完成姿态辨识,通过上述方式,从误差调制的角度来进行滚转角辨识。通过转动可以将器件偏差相对于旋转轴对称分布,以此实现器件偏差的正负抵消,等价于提高了陀螺的精度,因此可以基于速度矢量进行姿态辨识。
Description
技术领域
本发明涉及制导炮弹空中对准领域,具体涉及一种基于旋转调制法的制导炮弹空中姿态辨识方法。
背景技术
制导炮弹从平台发射过程中,承受高过载、高转速等恶劣条件。制导炮弹发射时通常采用弹体高速旋转方案,进入有控段后才使弹体倾斜稳定或低速旋转,惯性导航系统要在发射后在空中重新进行对准。在粗对准时,位置、速度和俯仰角、偏航角等的初值可以直接从装定的弹道数据或卫星接收机测量数据中获得。但较为特殊的是,由于发射过程中弹体旋转,不易获得滚转角初始值。因此,研究制导炮弹在空中进行对准时,进行弹体初始滚转角辨识是该领域的技术难点。
一些制导炮弹上采用地磁测量元件来获得滚转角,但这样需要在弹上增加地磁测量元件;一些制导炮弹上直接利用陀螺的测量数据来估计滚转角,但陀螺精度低的情况下滚转角估计精度不高。在低精度陀螺和不增加额外测量元件的情况下,为了满足制导炮弹空中对准的高精度要求,需要在求解原理上做出创新,本发明提出的一种基于旋转调制法的制导炮弹空中姿态辨识方法,是从误差调制的角度来进行滚转角辨识。通过转动可以将器件偏差相对于旋转轴对称分布,以此实现器件偏差的正负抵消,等价于提高了陀螺的精度,因此可以基于速度矢量进行姿态辨识。
发明内容
针对现有技术中的上述不足,本发明提供了一种基于旋转调制法的制导炮弹空中姿态辨识方法。
为了达到上述发明目的,本发明采用的技术方案为:
一种基于旋转调制法的制导炮弹空中姿态辨识方法,包括如下步骤:
S1、导弹升空后弹体消旋并保持滚转角稳定状态至第一时刻,记录弹体稳定后至第一时刻之间陀螺仪数据;
S2、使导弹绕x轴旋转180°并保持滚转角稳定状态至第二时刻,记录弹体稳定后至第二时刻的陀螺仪数据;
S3、将步骤S1和步骤S2记录下的陀螺仪数据分别求均值,并消除两次数据中的陀螺仪常值漂移,将消除常值漂移后的陀螺仪真值带入滚转角计算公式,完成姿态辨识。
进一步的,所述S1中的陀螺仪数据包括:
进一步的,所述S2中的陀螺仪数据包括:
进一步的,所述S3中消除两次数据中的陀螺仪常值漂移后的陀螺仪真值表示为:
其中,为旋转180°前弹体的俯仰角速率测量值,为旋转180°前弹体的偏航
角速率测量值,为俯仰角速率真值,为偏航角速率真值且和均为恒定值,为旋转180°后弹体的俯仰角速率测量值,为旋转180°后弹体的偏航角速率测量值。
进一步的,所述S2中保持滚转角稳定状态至第二时刻的时间长度为:
本发明具有以下有益效果:
在低精度陀螺和不增加额外测量元件的情况下,本发明在求解原理上做出创新,提出一种基于旋转调制法的制导炮弹空中姿态辨识方法,可以满足制导炮弹空中对准的高精度要求。
附图说明
图1为本发明一种基于旋转调制法的制导炮弹空中姿态辨识方法流程示意图。
图2为本发明实施例弹体坐标系和伪弹体坐标系关系示意图。
图3为本发明实施例发射坐标系和弹体坐标系关系示意图。
图4为本发明实施例绕x轴转180度示意图。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
本文使用到以下坐标系及坐标系转换
1)地心地固坐标系(e系)
地心地固坐标系(Earth-Centered Earth-Fixed frame,ECEF),原点为地球中心,轴在赤道平面内并且指向本初子午线,轴为地球自转轴并且指向北极,轴在赤
道平面内并且与轴、轴构成右手直角坐标系。
2)弹体坐标系(b系)
弹体坐标系(Body frame),坐标系原点O b 为弹体质心,x b 轴沿弹体纵轴指向弹体正前,y b 轴在弹体主对称轴平面内并且指向弹体上方,z b 轴与y b 轴、x b 轴构成右手直角坐标系并且指向弹体右方。
3)伪弹体坐标系(w系)
伪弹体坐标系是为旋转调制系统需求设定的坐标系。伪弹体坐标系和弹体坐标系
的关系如图1所示,结合弹体坐标系给出伪弹体坐标系的定义:在弹体绕x b 轴以角速度旋
转开始时刻,伪弹体坐标系与弹体坐标系重合,伪弹体坐标系原点O b 为弹体质心,x w 轴沿弹
体纵轴指向弹体正前,y w 轴在弹体主对称轴平面内并且指向弹体上方,z w 轴与x w 轴、y w 轴构
成右手直角坐标系并且指向弹体右方。旋转开始后,伪弹体坐标系三轴指向不变,仍保持为
旋转开始时刻的指向。
4)弹体坐标系与伪弹体坐标系之间的转换关系
5)滚转角的估算
利用坐标转换的方法可以将转动角速度投影到弹体坐标系:
于是,得到关于姿态角的三个微分方程
整理得
由式(6)解得滚转角为:
由式(9)知,有了和,就可以进行滚转角辨识。通常,制导炮弹的弹道倾角变
化率很小(通常在1°/s以下),导致和的测量的数值很小。当陀螺常值漂移很大时,式
(9)的辨识结果不好,因此本申请引入旋转调制法进行改进,具体方式为:
一种基于旋转调制法的制导炮弹空中姿态辨识方法,包括如下步骤:
S1、导弹升空后弹体消旋并保持滚转角稳定状态至第一时刻,记录弹体稳定后至第一时刻之间陀螺仪数据。
S2、使导弹绕x轴旋转180°并保持滚转角稳定状态至第二时刻,记录弹体稳定后至第二时刻的陀螺仪数据;
S3、将步骤S1和步骤S2记录下的陀螺仪数据分别求均值,并消除两次数据中的陀螺仪常值漂移,将消除常值漂移后的陀螺仪真值带入滚转角计算公式,完成姿态辨识。
由式(13)和式(14)得
转180度方案中,有
将式(16)代入式(12),得
将式(11)和式(17)代入(15),可以消去陀螺仪的常值漂移,得
根据式(18)可将式(9)转化为:
本发明中应用了具体实施例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
本领域的普通技术人员将会意识到,这里所述的实施例是为了帮助读者理解本发明的原理,应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。本领域的普通技术人员可以根据本发明公开的这些技术启示做出各种不脱离本发明实质的其它各种具体变形和组合,这些变形和组合仍然在本发明的保护范围内。
Claims (2)
1.一种基于旋转调制法的制导炮弹空中姿态辨识方法,其特征在于,包括如下步骤:
S1、导弹升空后弹体消旋并保持滚转角稳定状态至第一时刻,记录弹体稳定后至第一时刻之间陀螺仪数据,包括:
S2、使导弹绕x轴旋转180°并保持滚转角稳定状态至第二时刻,记录弹体稳定后至第二时刻的陀螺仪数据,包括:
S3、将步骤S1和步骤S2记录下的陀螺仪数据分别求均值,并消除两次数据中的陀螺仪常值漂移,消除两次数据中的陀螺仪常值漂移后的陀螺仪真值表示为:
其中,ωy为旋转180°前弹体的俯仰角速率测量值,ωz为旋转180°前弹体的偏航角速率测量值,为俯仰角速率真值,为偏航角速率真值且和均为恒定值,ωy′为旋转180°后弹体的俯仰角速率测量值,ωz′为旋转180°后弹体的偏航角速率测量值;将消除常值漂移后的陀螺仪真值带入滚转角计算公式,完成姿态辨识,其中,
滚转角γ的计算公式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210285182.6A CN114383603B (zh) | 2022-03-23 | 2022-03-23 | 一种基于旋转调制法的制导炮弹空中姿态辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210285182.6A CN114383603B (zh) | 2022-03-23 | 2022-03-23 | 一种基于旋转调制法的制导炮弹空中姿态辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114383603A CN114383603A (zh) | 2022-04-22 |
CN114383603B true CN114383603B (zh) | 2022-06-28 |
Family
ID=81206372
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210285182.6A Active CN114383603B (zh) | 2022-03-23 | 2022-03-23 | 一种基于旋转调制法的制导炮弹空中姿态辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114383603B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114970013B (zh) * | 2022-05-12 | 2023-08-15 | 北京自动化控制设备研究所 | 一种旋转炮弹初始对准方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102052921A (zh) * | 2010-11-19 | 2011-05-11 | 哈尔滨工程大学 | 一种单轴旋转捷联惯导系统初始航向的确定方法 |
CN105659816B (zh) * | 2009-04-30 | 2013-04-10 | 北京理工大学 | 高速旋转制导炮弹对地滚转角检测仪 |
CN103075930A (zh) * | 2012-12-25 | 2013-05-01 | 中北大学 | 适用于高速旋转弹体炮口初始姿态的测量方法 |
CN105115508A (zh) * | 2015-08-27 | 2015-12-02 | 北京航天控制仪器研究所 | 基于后数据的旋转制导炮弹快速空中对准方法 |
CN106840195A (zh) * | 2016-12-19 | 2017-06-13 | 中北大学 | 一种旋转式半捷联微惯性测量系统误差抑制方法 |
CN107314718A (zh) * | 2017-05-31 | 2017-11-03 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
CN113701752A (zh) * | 2021-08-27 | 2021-11-26 | 浙江大学 | 一种旋转弹用全捷联姿态测量装置及方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10261176B2 (en) * | 2013-05-15 | 2019-04-16 | Flir Systems, Inc. | Rotating attitude heading reference systems and methods |
CN105241319B (zh) * | 2015-08-27 | 2016-11-30 | 北京航天控制仪器研究所 | 一种高速自旋制导炮弹空中实时对准方法 |
-
2022
- 2022-03-23 CN CN202210285182.6A patent/CN114383603B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105659816B (zh) * | 2009-04-30 | 2013-04-10 | 北京理工大学 | 高速旋转制导炮弹对地滚转角检测仪 |
CN102052921A (zh) * | 2010-11-19 | 2011-05-11 | 哈尔滨工程大学 | 一种单轴旋转捷联惯导系统初始航向的确定方法 |
CN103075930A (zh) * | 2012-12-25 | 2013-05-01 | 中北大学 | 适用于高速旋转弹体炮口初始姿态的测量方法 |
CN105115508A (zh) * | 2015-08-27 | 2015-12-02 | 北京航天控制仪器研究所 | 基于后数据的旋转制导炮弹快速空中对准方法 |
CN106840195A (zh) * | 2016-12-19 | 2017-06-13 | 中北大学 | 一种旋转式半捷联微惯性测量系统误差抑制方法 |
CN107314718A (zh) * | 2017-05-31 | 2017-11-03 | 中北大学 | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 |
CN107883940A (zh) * | 2017-10-31 | 2018-04-06 | 北京理工大学 | 一种制导炮弹用高动态姿态测量方法 |
CN113701752A (zh) * | 2021-08-27 | 2021-11-26 | 浙江大学 | 一种旋转弹用全捷联姿态测量装置及方法 |
Non-Patent Citations (2)
Title |
---|
chen kai et.al.SINS/BDS Integrated Navigation for Hypersonic Boost-Glide Vehicles in the Launch-Centered Inertial Frame.《MATHEMATICAL PROBLEMS in Engineering》.2020,第1-16页. * |
佘浩平等.GPS/INS组合制导弹药空中对准的初始滚转角估计新算法.《兵工学报》.2011,第32卷(第10期),第1265-1270页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114383603A (zh) | 2022-04-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9689684B2 (en) | Inertial navigation system | |
CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN108318052A (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN109373833B (zh) | 适用于旋转弹初始姿态和速度联合测量方法 | |
US8519313B2 (en) | Projectile navigation enhancement method | |
CN108871326B (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN109823571A (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
US10539421B2 (en) | Inertial navigation system with compensation of roll scale factor error | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN104697521B (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
WO2020114293A1 (zh) | 基于磁测滚转的旋转弹炮口初始参数测量方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN114383603B (zh) | 一种基于旋转调制法的制导炮弹空中姿态辨识方法 | |
CN113551668A (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN111504256A (zh) | 一种基于最小二乘法的滚转角实时估计方法 | |
CN113050143A (zh) | 一种发射惯性坐标系下的紧耦合导航方法 | |
CN110986934B (zh) | 一体化双轴旋转惯导天文组合导航系统的导航方法及系统 | |
CN114993305A (zh) | 一种基于发射坐标系的制导炮弹组合导航方法 | |
RU2423658C2 (ru) | Способ управления и стабилизации подвижного носителя, интегрированная система, устройство приведения зеркала антенны в поворотное движение в двух взаимно перпендикулярных плоскостях и устройство приведения в действие дифференциальных аэродинамических рулей для его осуществления | |
CN114353784B (zh) | 一种基于运动矢量的制导炮弹空中姿态辨识方法 | |
CN109813302B (zh) | 最佳可用导航星快速确定方法 | |
CN113108787A (zh) | 一种长航时惯导/卫星全球组合导航方法 | |
CN115060256B (zh) | 一种基于发射坐标系的制导炮弹空中姿态辨识方法 | |
CN115031763B (zh) | 一种基于角速率信息的旋转弹快速对准方法 | |
CN111089588B (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 |