CN106909165B - 基于导引头多传感器的旋转导弹弹体姿态信息提取方法 - Google Patents

基于导引头多传感器的旋转导弹弹体姿态信息提取方法 Download PDF

Info

Publication number
CN106909165B
CN106909165B CN201710100568.4A CN201710100568A CN106909165B CN 106909165 B CN106909165 B CN 106909165B CN 201710100568 A CN201710100568 A CN 201710100568A CN 106909165 B CN106909165 B CN 106909165B
Authority
CN
China
Prior art keywords
coordinate system
optical axis
missile
quasi
axis coordinate
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
Application number
CN201710100568.4A
Other languages
English (en)
Other versions
CN106909165A (zh
Inventor
杨雨
冯昊
朱雯雯
孔寒雪
蒋虎超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Aerospace Control Technology Institute
Original Assignee
Shanghai Aerospace Control Technology Institute
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Aerospace Control Technology Institute filed Critical Shanghai Aerospace Control Technology Institute
Priority to CN201710100568.4A priority Critical patent/CN106909165B/zh
Publication of CN106909165A publication Critical patent/CN106909165A/zh
Application granted granted Critical
Publication of CN106909165B publication Critical patent/CN106909165B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/107—Simultaneous control of position or course in three dimensions specially adapted for 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/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)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)

Abstract

本发明涉及一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，包含：S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及S1中的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及S1中的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息。本发明在不增加传感器的情况下，利用导引头和消旋平台上的传感器信息，通过信息复用算法得到弹体姿态信息，实现制导控制，有效提升弹体阻尼及导弹动态性能。

Description

基于导引头多传感器的旋转导弹弹体姿态信息提取方法
技术领域
本发明涉及一种旋转导弹弹体姿态信息的提取方法，具体是指一种基于导引头多传感器的旋转导弹弹体姿态信息的提取方法，能够在不增加额外传感器的情况下，利用导引头及消旋平台的传感器信息资源提取旋转导弹弹体姿态信息，用于制导控制，提升导弹的动态性能；属于旋转导弹导航、制导与控制的技术领域。
背景技术
对于旋转导弹而言，由于受到导弹弹体旋转速度的限制，其弹体姿态和运动信息的测量一般需安装消旋平台和相应的陀螺。
目前，用于防空的旋转导弹多采用低成本设计，并且不对弹体姿态进行测量，制导控制系统采用开环控制，这种方式的局限性有以下两方面：
1、导致导弹阻尼偏小，一般不大于0.3，而过载响应的超调较大，半震荡次数大于3，且稳定时间长。
2、旋转导弹的制导控制系统抗气动摄动能力差，鲁棒性差，制导精度容易受到影响。
发明内容
本发明的目的是提供一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，在不增加传感器的情况下，利用导引头和消旋平台上的传感器信息，通过信息复用算法得到弹体姿态信息，从而实现制导控制，有效提升弹体阻尼及导弹的动态性能。
为实现上述目的，本发明提供一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，包含以下步骤：
S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；
S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；
S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；
S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息。
所述的引导头采用红外凝视成像导引头。
所述的S1中，光轴坐标系通过三次旋转可与准弹体坐标系完全重合，三次旋转的角度由导引头上的内框码盘、外框码盘和消旋平台上的消旋陀螺的输出信息获得，通过这三个旋转的角度来构造光轴坐标系到准弹体坐标系的转换矩阵：
其中，L(-γ,-λy,-λz)为光轴坐标系到准弹体坐标系的转换矩阵；γ为消旋平台与导弹弹体纵轴之间的角度，通过消旋陀螺积分输出；λy为外框架转角，通过外框码盘直接输出；λz为内框架转角，通过内框码盘直接输出。
所述的S2中，导引头上的内框陀螺、外框陀螺和稳定陀螺分别测量得到光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示；ωxg为稳定陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωyg为外框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωzg为内框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示。
所述的S3中，根据内框码盘、外框码盘和消旋陀螺的输出信息，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息：
其中，为准弹体坐标系相对光轴坐标系的角速度信息；通过消旋陀螺直接输出；通过外框码盘微分输出；通过内框码盘微分输出。
所述的S4中，根据S2中得到的光轴坐标系相对惯性坐标系的角速度信息，以及S3中得到的准弹体坐标系相对光轴坐标系的角速度信息，计算准弹体坐标系相对于惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为准弹体坐标系相对于惯性坐标系的角速度信息。
综上所述，本发明提供的基于导引头多传感器的旋转导弹弹体姿态信息提取方法，是一种在不增加传感器的情况下，利用红外凝视成像导引头上的传感器信息以及消旋平台上的传感器信息，通过信息复用算法计算弹体姿态信息的方法。本发明在节省硬件成本的同时，通过信息复用得到的弹体姿态信息还可以直接引入阻尼回路，对旋转导弹的稳定控制系统进行设计，实现制导控制，有效提升弹体阻尼，以及导弹的动态性能。
附图说明
图1为本发明中的基于导引头多传感器的旋转导弹弹体姿态信息提取方法的示意图。
具体实施方式
以下结合图1，详细说明本发明的一个优选实施例。
如图1所示，为本发明所提供的基于导引头多传感器的旋转导弹弹体姿态信息提取方法，包含以下步骤：
S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；
S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；
S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；
S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息。
所述的引导头采用红外凝视成像导引头。
所述的S1中，光轴坐标系通过三次旋转可以与准弹体坐标系完全重合，三次旋转的角度由导引头上的内框码盘、外框码盘和消旋平台上的消旋陀螺的输出信息获得，通过这三个旋转的角度来构造光轴坐标系到准弹体坐标系的转换矩阵：
其中，L(-γ,-λy,-λz)为光轴坐标系到准弹体坐标系的转换矩阵；γ为消旋平台与导弹弹体纵轴之间的角度，通过消旋陀螺积分输出；λy为外框架转角，通过外框码盘直接输出；λz为内框架转角，通过内框码盘直接输出。
所述的S2中，导引头上的内框陀螺、外框陀螺和稳定陀螺分别测量得到光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示；ωxg为稳定陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωyg为外框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωzg为内框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示。
所述的S3中，根据内框码盘、外框码盘和消旋陀螺的输出信息，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息：
其中，为准弹体坐标系相对光轴坐标系的角速度信息；通过消旋陀螺直接输出；通过外框码盘微分输出；通过内框码盘微分输出。
所述的S4中，根据S2中得到的光轴坐标系相对惯性坐标系的角速度信息，以及S3中得到的准弹体坐标系相对光轴坐标系的角速度信息，计算准弹体坐标系相对于惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为准弹体坐标系相对于惯性坐标系的角速度信息，其由经姿态转换后的陀螺输出信号以及框架偏转角的微分信号两部分组成。
综上所述，本发明所提供的基于导引头多传感器的旋转导弹弹体姿态信息提取方法，是一种在不增加传感器的情况下，利用红外凝视成像导引头上的传感器信息以及消旋平台上的传感器信息，通过信息复用算法计算弹体姿态信息的方法。本发明在节省硬件成本的同时，通过信息复用得到的弹体姿态信息还可以直接引入阻尼回路，对旋转导弹的稳定控制系统进行设计，实现制导控制，有效提升弹体阻尼，以及导弹的动态性能。
尽管本发明的内容已经通过上述优选实施例作了详细介绍，但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后，对于本发明的多种修改和替代都将是显而易见的。因此，本发明的保护范围应由所附的权利要求来限定。

Claims (2)

1.一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，其特征在于，包含以下步骤：
S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；
光轴坐标系通过三次旋转可与准弹体坐标系完全重合，三次旋转的角度由导引头上的内框码盘、外框码盘和消旋平台上的消旋陀螺的输出信息获得，通过这三个旋转的角度来构造光轴坐标系到准弹体坐标系的转换矩阵：
其中，L(-γ,-λy,-λz)为光轴坐标系到准弹体坐标系的转换矩阵；γ为消旋平台与导弹弹体纵轴之间的角度，通过消旋陀螺积分输出；λy为外框架转角，通过外框码盘直接输出；λz为内框架转角，通过内框码盘直接输出；
S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；
导引头上的内框陀螺、外框陀螺和稳定陀螺分别测量得到光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示；ωxg为稳定陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωyg为外框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；ωzg为内框陀螺输出的光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示；
S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；
根据内框码盘、外框码盘和消旋陀螺的输出信息，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息：
其中，为准弹体坐标系相对光轴坐标系的角速度信息；通过消旋陀螺直接输出；通过外框码盘微分输出；通过内框码盘微分输出；
S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息；
根据S2中得到的光轴坐标系相对惯性坐标系的角速度信息，以及S3中得到的准弹体坐标系相对光轴坐标系的角速度信息，计算准弹体坐标系相对于惯性坐标系的角速度信息在准弹体坐标系下的表示：
其中，为准弹体坐标系相对于惯性坐标系的角速度信息。
2.如权利要求1所述的基于导引头多传感器的旋转导弹弹体姿态信息提取方法，其特征在于，所述的导引头采用红外凝视成像导引头。
CN201710100568.4A 2017-02-23 2017-02-23 基于导引头多传感器的旋转导弹弹体姿态信息提取方法 Active CN106909165B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710100568.4A CN106909165B (zh) 2017-02-23 2017-02-23 基于导引头多传感器的旋转导弹弹体姿态信息提取方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710100568.4A CN106909165B (zh) 2017-02-23 2017-02-23 基于导引头多传感器的旋转导弹弹体姿态信息提取方法

Publications (2)

Publication Number Publication Date
CN106909165A CN106909165A (zh) 2017-06-30
CN106909165B true CN106909165B (zh) 2019-12-03

Family

ID=59208824

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710100568.4A Active CN106909165B (zh) 2017-02-23 2017-02-23 基于导引头多传感器的旋转导弹弹体姿态信息提取方法

Country Status (1)

Country Link
CN (1) CN106909165B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107860273B (zh) * 2017-10-31 2019-06-18 中国工程物理研究院电子工程研究所 一种以旋转弹弹旋周期作为控制基准的新型旋转弹控制方法
CN109373998B (zh) * 2018-10-11 2020-07-17 重庆天箭惯性科技股份有限公司 基于多传感器数据的旋转体姿态测量方法
CN110440793A (zh) * 2019-06-14 2019-11-12 上海航天控制技术研究所 一种基于导引头测量信息的目标运动信息估计方法
CN111812603B (zh) * 2020-07-17 2021-04-09 中国人民解放军海军航空大学 一种反舰导弹雷达导引头动态性能验证系统

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101226392A (zh) * 2007-11-20 2008-07-23 北京航空航天大学 一种小型机载高精度低成本单自由度光电稳定器
WO2008115216A2 (en) * 2006-12-01 2008-09-25 Aai Corporation Apparatus, method and computer program product for weapon flyout modeling and target damage assesment
CN101403593A (zh) * 2008-11-04 2009-04-08 北京航空航天大学 基于横滚/偏摆结构的两轴捷联平台光轴超半球稳定方法
CN102175391A (zh) * 2010-12-15 2011-09-07 河北汉光重工有限责任公司 红外制导导弹导引头重心位置的测量装置及其测量方法
CN105021092A (zh) * 2015-06-30 2015-11-04 北京航天长征飞行器研究所 一种捷联寻的导引头的制导信息提取方法
CN105423823A (zh) * 2015-10-29 2016-03-23 中国科学院长春光学精密机械与物理研究所 激光制导导弹的注入式半实物仿真系统
CN105865272A (zh) * 2016-05-27 2016-08-17 北京航空航天大学 一种用于半捷联制导导弹的一体化控制方法
CN106054612A (zh) * 2016-06-29 2016-10-26 河南科技大学 一种btt导弹飞行轨迹自动控制方法
CN106093629A (zh) * 2016-06-03 2016-11-09 上海机电工程研究所 红外旋转导弹的弹载计算机的单元测试系统及测试方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8436283B1 (en) * 2008-07-11 2013-05-07 Davidson Technologies Inc. System and method for guiding and controlling a missile using high order sliding mode control

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2008115216A2 (en) * 2006-12-01 2008-09-25 Aai Corporation Apparatus, method and computer program product for weapon flyout modeling and target damage assesment
CN101226392A (zh) * 2007-11-20 2008-07-23 北京航空航天大学 一种小型机载高精度低成本单自由度光电稳定器
CN101403593A (zh) * 2008-11-04 2009-04-08 北京航空航天大学 基于横滚/偏摆结构的两轴捷联平台光轴超半球稳定方法
CN102175391A (zh) * 2010-12-15 2011-09-07 河北汉光重工有限责任公司 红外制导导弹导引头重心位置的测量装置及其测量方法
CN105021092A (zh) * 2015-06-30 2015-11-04 北京航天长征飞行器研究所 一种捷联寻的导引头的制导信息提取方法
CN105423823A (zh) * 2015-10-29 2016-03-23 中国科学院长春光学精密机械与物理研究所 激光制导导弹的注入式半实物仿真系统
CN105865272A (zh) * 2016-05-27 2016-08-17 北京航空航天大学 一种用于半捷联制导导弹的一体化控制方法
CN106093629A (zh) * 2016-06-03 2016-11-09 上海机电工程研究所 红外旋转导弹的弹载计算机的单元测试系统及测试方法
CN106054612A (zh) * 2016-06-29 2016-10-26 河南科技大学 一种btt导弹飞行轨迹自动控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Modified attitude pursuit guidance law for low cost missiles using strap—down seekers;SONG Tao，etc;《Journal of Beijing Institute of Technology》;20141231;第23卷(第2期);第158-164页 *
红外旋转弹导引头捷联惯导系统的姿态算法研究;王业卿，等;《红外旋转弹导引头捷联惯导系统的姿态算法研究》;20131231;第33卷(第3期);第36-42页 *

Also Published As

Publication number Publication date
CN106909165A (zh) 2017-06-30

Similar Documents

Publication Publication Date Title
CN106909165B (zh) 基于导引头多传感器的旋转导弹弹体姿态信息提取方法
EP2434256B1 (en) Camera and inertial measurement unit integration with navigation data feedback for feature tracking
Han et al. A novel method to integrate IMU and magnetometers in attitude and heading reference systems
CN105157705B (zh) 一种半捷联雷达导引头视线角速度提取方法
CN111024070A (zh) 一种基于航向自观测的惯性足绑式行人定位方法
CN106662443A (zh) 用于垂直轨迹确定的方法和系统
WO2020114293A1 (zh) 基于磁测滚转的旋转弹炮口初始参数测量方法
CN103487054B (zh) 一种新型手持室内定位系统的定位方法
US11408735B2 (en) Positioning system and positioning method
CN104697521B (zh) 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法
CN105865490B (zh) 一种惯性稳定平台固定基座多位置自瞄准方法
US20160363448A1 (en) Determining Sensor Orientation in Indoor Navigation
CN106767846B (zh) 三轴稳定卫星不用陀螺的姿态获取方法和系统
CN109696178A (zh) 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质
CN109685852B (zh) 相机与惯性传感器的标定方法、系统、设备及存储介质
EP2710333B1 (en) Method for remotely determining an absolute azimuth of a target point
JP2007232444A (ja) 慣性航法装置およびその誤差補正方法
CN207095572U (zh) 一种用于飞行系统中头盔姿态测量的硬件平台
Jaekel et al. An inertial navigation system with acoustic obstacle detection for pedestrian applications
JP5190134B2 (ja) 角速度検出方法及びその装置
CN105222764B (zh) 一种对惯性角速度传感器进行地球自转补偿的方法
Xinxi et al. The performance impact evaluation on bias of gyro and accelerometer for foot-mounted INS
AU2018100564A4 (en) The invention of using integrated circuit board with embedded IMU algorithms to for Cricket equipment (ball) traction. Usage of gyroscope, accelerometer and magnetometer (compass) injected into the cricket ball acquires readings during ball motions. Embedded processor performs calculations of ball’s orientation and earth referenced acceleration. Data is transmitted wirelessly to the client's equipment about the flight: velocity, flight time, revolution rate, flight distance.
Liu et al. Implementation and Evaluation of Attitude Heading and Reference System Based on MEMS
Zhang et al. An Improved Double-Layer Kalman Filter Attitude Algorithm For Motion Capture 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