CN105258698B - 一种高动态自旋制导炮弹空中组合导航方法 - Google Patents

一种高动态自旋制导炮弹空中组合导航方法 Download PDF

Info

Publication number
CN105258698B
CN105258698B CN201510657504.5A CN201510657504A CN105258698B CN 105258698 B CN105258698 B CN 105258698B CN 201510657504 A CN201510657504 A CN 201510657504A CN 105258698 B CN105258698 B CN 105258698B
Authority
CN
China
Prior art keywords
moment
guided cartridge
spin
speed
cartridge
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
CN201510657504.5A
Other languages
English (en)
Other versions
CN105258698A (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.)
China Aerospace Times Electronics Corp
Original Assignee
China Aerospace Times Electronics Corp
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 China Aerospace Times Electronics Corp filed Critical China Aerospace Times Electronics Corp
Priority to CN201510657504.5A priority Critical patent/CN105258698B/zh
Publication of CN105258698A publication Critical patent/CN105258698A/zh
Application granted granted Critical
Publication of CN105258698B publication Critical patent/CN105258698B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/165—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 combined with non-inertial navigation instruments
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F41—WEAPONS
    • F41G—WEAPON SIGHTS; AIMING
    • F41G3/00—Aiming or laying means
    • F41G3/22—Aiming or laying means for vehicle-borne armament, e.g. on aircraft
    • 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/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • 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/52—Determining velocity
    • 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)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Navigation (AREA)

Abstract

一种高动态自旋制导炮弹空中组合导航方法，通过自旋制导炮弹空中粗对准方法得到初始时刻的位置、速度和姿态，利用惯性导航系统进行导航解算得到每一时刻的导航结果；根据对应时间下GPS输出的导航信息得到对应时刻的航向角、俯仰角、三个速度以及三个速度误差值、俯仰角误差值和航向角误差值，并作为9维卡尔曼滤波估计的观测阵C，估算出对应时刻的三个姿态角修正值、三个速度修正值和三个陀螺仪零偏值，进而得到自旋制导炮弹空中对应时刻的姿态、速度和位置信息。本发明实现了高动态自旋制导炮弹空中失重情况下的组合导航，同时通过卡尔曼滤波器实现了对导航噪声和陀螺仪零偏的滤除，提高了自旋制导炮弹的落点精度，增加了制导炮弹的可控性。

Description

一种高动态自旋制导炮弹空中组合导航方法
技术领域
本发明涉及一种空中组合导航方法，尤其涉及一种高动态自旋制导炮弹空中组合导航方法，属于制导控制技术和组合导航系统设计技术，可用于无人机、自旋制导炮弹等需要在空中组合导航的场合。
背景技术
自旋制导炮弹是一种在空中发射，需要进行导航和控制的一种高精度武器，它包含了惯性导航和GPS等系统，通过GPS来修正惯性导航系统的误差，达到精确打击目标的能力。组合导航即从惯导相对其他导航系统提供的导航参数(如速度等)的偏差中估计出惯导系统的失准角并校正之。
惯性导航系统是一个基于加速度二次积分的航程推算系统，它完全依靠机械设备和相应的算法自动、独立完成导航任务，和外界不发生任何光、电联系。由于其具有隐蔽性好、工作环境不受气象条件限制等优点，成为航天、航空、航海领域中一种广泛使用的主要导航系统。惯性导航系统的优点是，不需要任何外来信息也不向外辐射任何信息，可在任何介质和任何环境条件下实现导航，且能输出炮弹的位置、速度、方位和姿态等多种导航参数，系统地频带宽，能跟踪运载体的任何机动运动，导航输出数据平稳，短期稳定性好。但惯性系统具有固有的缺点：导航精度随时间而发散，且长期稳定性差。为此，需要引入GPS输出的导航信息进行制导炮弹空中对准，提高制导炮弹的打击精度。GPS导航系统导航精度高，且不随时间发散，但其频带窄，当运载体做较高机动运动时，接收机的码环和载波环极易失锁而丢失信号，从而完全丧失导航能力。因此，需要将惯性导航系统和GPS结合起来进行组合导航。传统组合导航中地面常用的Kalman滤波算法一般采用经纬度、水平速度中的一个或者几个作为观测量，其他参数作为被观测量，进行组合。在空中的自旋制导炮弹与地面情况不同，因自旋制导炮弹处于高动态自旋转状态，且处于失重情况下，加速度计输出几乎为零。三个加速度计不仅包含了自身的误差，因为使用的是MEMS加速度计，故自身误差较大，而且包含了杆臂效应，导致测量得到的加速度计输出结果不准，从而导致真实的加速度信息被隐没在噪声中，不能作为真实结果应用。速度变化与姿态变化之间的耦合关系弱，不能有效的通过速度和位置的偏差观测出姿态角信息。常用的组合导航方法是采用速度和位置作为观测量的Kalman滤波算法实现的经典对准方案，由于不考虑惯导工作环境中的随机干扰因素和失重状态，如阵风等引起的自旋制导炮弹的随机晃动、飞行过程中空气动力的随机改变引起的制导炸弹结构的饶曲变形等，导致导航精度不高且需要时间长。
发明内容
本发明解决的技术问题是：克服现有技术的不足，提供一种高动态自旋制导炮弹空中组合导航方法，该方法能够快速、精确地得到制导炮弹在空中的位置、速度和姿态，有效的提高了自旋制导炮弹空中导航精度。
本发明的技术解决方案是：一种高动态自旋制导炮弹空中组合导航方法，步骤如下：
(1)根据惯性导航系统测得的加速度和角速度信息和GPS测得的速度和位置信息，利用自旋制导炮弹空中粗对准方法计算得到自旋制导炮弹在空中飞行初始时刻实际的位置信息[la0 phia0 h0]、速度信息[Ve0 Vn0 Vu0]和姿态信息[θ0 γ0 ψ0],其中la0表示粗对准得到的初始经度，phia0表示粗对准得到的初始纬度，h0表示粗对准得到的初始高度，Ve0表示粗对准得到的初始东向速度，Vn0表示粗对准得到的初始北向速度，Vu0表示粗对准得到的初始天向速度，θ0表示粗对准得到的初始俯仰角，γ0表示粗对准得到的初始横滚角，ψ0表示粗对准得到的初始航向角；
(2)自旋制导炮弹在tn时刻采集惯性导航系统测得的加速度和角速度信息，并根据测得的加速度和角速度信息以及tn-1时刻自旋制导炮弹实际的姿态、位置和速度信息进行导航解算，获得tn时刻通过惯性导航系统解算出的自旋制导炮弹的姿态信息[θn γnψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]，其中ψn为tn时刻自旋制导炮弹的航向角，θn为tn时刻自旋制导炮弹的俯仰角，γn为tn时刻自旋制导炮弹的横滚角，lan为tn时刻自旋制导炮弹的经度，phian为tn时刻自旋制导炮弹的纬度，hn为tn时刻自旋制导炮弹的高度，Ven为tn时刻自旋制导炮弹的东向速度，Vnn为tn时刻自旋制导炮弹的北向速度，Vun为tn时刻自旋制导炮弹的天向速度，进入步骤(3)，其中n的初始值为1；
(3)在tn时刻，自旋制导炮弹判断是否接收到GPS输出的速度和位置信息，如果没有接收到，则将步骤(2)的导航解算结果作为tn时刻自旋制导炮弹实际的速度、位置和姿态信息，进入步骤(5)；否则，进入步骤(4)；
(4)自旋制导炮弹根据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]计算tn时刻自旋制导炮弹的俯仰角θgn和航向角ψgn，并依据tn时刻接收到的GPS的速度信息[Vgen VgnnVgun]和tn时刻惯性导航系统解算出的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]进行组合导航计算，得到tn时刻自旋制导炮弹实际的速度、位置和姿态信息；其中，Vgen为tn时刻GPS输出的东向速度，Vgnn为tn时刻GPS输出的北向速度，Vgun为tn时刻GPS输出的天向速度；进入步骤(5)；
(5)n的值加1后返回步骤(2)，计算出自旋制导炮弹在空中飞行每一时刻的实际速度、位置和姿态信息，用于作为自旋制导炮弹导航和控制的测量信息，直到自旋制导炮弹命中目标为止；
上述各步骤中，tn与tn-1的时间间隔为惯性导航系统的测量周期。
所述步骤(4)自旋制导炮弹根据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]计算tn时刻自旋制导炮弹的俯仰角θgn和航向角ψgn的方法为：
所述步骤(4)中依据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]和tn时刻惯性导航系统解算出的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven VnnVun]进行组合导航计算，得到tn时刻自旋制导炮弹实际的速度、位置和姿态信息的实现方式为：
(3.1)利用量测阵H和观测阵C，根据卡尔曼滤波算法解算出tn时刻的状态估计量Xn，
其中δVce＝Ven-Vegn，
δVcn＝Vnn-Vgnn，δVcu＝Vun-Vgun，δθc＝θn-θgn，δψc＝ψn-ψgn
其中δVen为tn时刻自旋制导炮弹的东向速度修正值，δVnn为tn时刻自旋制导炮弹的北向速度修正值，δVun为tn时刻自旋制导炮弹的天向速度修正值，δθn为tn时刻自旋制导炮弹的俯仰角修正值，δγn为tn时刻自旋制导炮弹的横滚角修正值，δψn为tn时刻自旋制导炮弹的航向角修正值，为tn时刻自旋制导炮弹的三个陀螺仪零偏修正值；
(3.2)按照如下公式，利用tn时刻惯性导航系统解算出的速度信息[Ven Vnn Vun]计算tn时刻自旋制导炮弹实际的速度信息：
VKen＝Ven-Xn(1)
VKnn＝Vnn-Xn(2)
VKun＝Vun-Xn(3)
其中VKen表示组合导航后tn时刻自旋制导炮弹实际的东向速度，VKnn表示组合导航后tn时刻自旋制导炮弹实际的北向速度，VKun表示组合导航后tn时刻自旋制导炮弹实际的天向速度，Xn(1)表示tn时刻自旋制导炮弹的东向速度修正值，Xn(2)表示tn时刻自旋制导炮弹的北向速度修正值，Xn(3)表示tn时刻自旋制导炮弹的天向速度修正值；
(3.3)按照如下公式，利用tn时刻惯性导航系统解算出的姿态信息[θn γn ψn]计算tn时刻自旋制导炮弹实际的姿态信息：
γKn＝arcsin(Cbnn(3,2))
θKn＝-arctan(Cbnn(3,1)/Cbnn(3,3))
ψKn＝ψgn
其中，Cbnn＝Cnn*Cbn，
Cbn＝CnbT
其中Cnb表示tn时刻组合导航前从导航坐标系到载体坐标系的转换矩阵，Cbn表示tn时刻组合导航前从载体坐标系到导航坐标系的转换矩阵，Cnn表示tn时刻姿态修正矩阵，Cbnn表示tn时刻组合导航后从载体坐标系到导航坐标系的转换矩阵，γKn表示组合导航后tn时刻自旋制导炮弹实际的横滚角，θKn表示组合导航后tn时刻自旋制导炮弹实际的俯仰角，ψKn表示组合导航后tn时刻自旋制导炮弹实际的航向角；Xn(4)表示tn时刻自旋制导炮弹的俯仰角修正值，Xn(5)表示tn时刻自旋制导炮弹的横滚角修正值；
(3.4)tn时刻惯性导航系统解算出的位置信息[lan phian hn]即为tn时刻自旋制导炮弹实际的位置信息。
本发明与现有技术相比的优点如下：
(1)现有的卡尔曼滤波算法采用位置和速度作为观测量，但在空中炮弹处于失重情况下，位置和速度与炮弹姿态角之间的耦合关系弱，不能良好的估算出真实的姿态信息。本发明第一次将俯仰角和航向角作为观测量，通过三个角度之间的耦合关系来估算真实的横滚角信息，收敛速度快，且精度高。
(2)现有的Kalman滤波采用姿态误差引起加速度计输出在导航坐标系下的误差，再通过速度作为观测量，观测出姿态误差，但制导炮弹在空中飞行过程中处于失重和高动态自旋状态下，故加速度计输出几乎为零，且因加速度计自身误差和杆臂效应引起的误差导致加表输出结果不可信，采用现有的Kalman滤波算法对加速度计性能和杆臂效应补偿要求高。本方法直接把航向角和俯仰角作为观测量，不再使用加速度计的信息去估计姿态信息，这样可以不用考虑加速度计性能和杆臂效应，降低了对惯性导航系统中加速度计的要求，从而降低了系统设计的难度。
(3)本发明通过采用GPS信息和惯性导航系统输出的陀螺加速度计信息进行组合导航，通过GPS速度信息计算航向角和俯仰角，并合理利用了两者信息，不仅修正了位置、速度和姿态等，而且减小了位置速度的噪声，同时能够估算出陀螺仪的零偏，从而进一步提高了自旋制导炮弹的导航精度。
附图说明
图1为本发明的自旋制导炮弹空中组合导航流程图；
图2为使用本发明方法设计的卡尔曼滤波速度误差估计效果图；
图3为使用本发明方法设计的卡尔曼滤波姿态误差估计效果图；
图4为使用本发明方法设计的卡尔曼滤波陀螺零偏估计效果图；
图5为使用本发明方法得到的组合导航曲线和GPS的输出曲线示意图。
具体实施方式
由于制导炮弹在空中时处于一种机动状态，不能通过惯性导航系统本身进行自对准，需要引入GPS辅助信息进行惯性导航系统初始状态的测量和解算，惯性导航系统本身存在仪表误差、初始对准误差、重力异常等，惯性导航系统长时间工作时导航误差随时间发散。为此，需要引入GPS输出的导航信息进行制导炮弹空中对准，提高制导炮弹的打击精度。空中因处于高机动状态，且不被遮挡，GPS信号好，三维速度可信度高，可通过三维速度解算航向角和俯仰角。
如图1所示，本发明提出一种高动态自旋制导炮弹空中组合导航方法，步骤如下：
(1)根据惯性导航系统测得的加速度和角速度信息和GPS测得的速度和位置信息，利用自旋制导炮弹空中粗对准方法计算得到自旋制导炮弹在空中飞行初始时刻实际的位置信息[la0 phia0 h0]、速度信息[Ve0 Vn0 Vu0]和姿态信息[θ0 γ0 ψ0],其中la0表示粗对准得到的初始经度，phia0表示粗对准得到的初始纬度，h0表示粗对准得到的初始高度，Ve0表示粗对准得到的初始东向速度，Vn0表示粗对准得到的初始北向速度，Vu0表示粗对准得到的初始天向速度，θ0表示粗对准得到的初始俯仰角，γ0表示粗对准得到的初始横滚角，ψ0表示粗对准得到的初始航向角；
(2)根据在tn时刻采集惯性导航系统测得的加速度和角速度信息，并根据测得的加速度和角速度信息以及tn-1时刻自旋制导炮弹实际的姿态、位置和速度信息进行导航解算，获得tn时刻通过惯性导航系统解算出的自旋制导炮弹的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]，其中ψn为tn时刻自旋制导炮弹的航向角，θn为tn时刻自旋制导炮弹的俯仰角，γn为tn时刻自旋制导炮弹的横滚角，lan为tn时刻自旋制导炮弹的经度，phian为tn时刻自旋制导炮弹的纬度，hn为tn时刻自旋制导炮弹的高度，Ven为tn时刻自旋制导炮弹的东向速度，Vnn为tn时刻自旋制导炮弹的北向速度，Vun为tn时刻自旋制导炮弹的天向速度，进入步骤(3)，其中n的初始值为1；
(3)在tn时刻，自旋制导炮弹判断是否接收到GPS输出的速度和位置信息，如果没有接收到，则将步骤(2)的导航解算结果作为tn时刻自旋制导炮弹实际的速度、位置和姿态信息，进入步骤(5)；否则，进入步骤(4)；
(4)自旋制导炮弹根据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]计算tn时刻自旋自转炮弹的俯仰角θgn和航向角ψgn，并通过和tn时刻惯性导航系统解算出的自旋制导炮弹的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]进行组合导航计算，得到tn时刻自旋制导炮弹实际的速度、位置和姿态信息；其中，Vgen为tn时刻GPS输出的东向速度，Vgnn为tn时刻GPS输出的北向速度，Vgun为tn时刻GPS输出的天向速度，θgn为tn时刻GPS输出的速度计算得到的俯仰角，ψgn为tn时刻GPS输出的速度计算得到的航向角；进入步骤(5)；
(5)n的值加1后返回步骤(2)，依次类推，计算出每一时刻自旋制导炮弹空中的实际速度、位置和姿态信息，将组合导航解算后得到的三个姿态和三个速度反馈到导航解算中，作为下一时刻导航解算的初始值，进入解算，最终获得制导炮弹的导航轨迹和飞行控制参数。
上述各步骤中，tn与tn-1的时间间隔为惯性导航系统的测量周期。
所述步骤(4)计算得到tn时刻GPS输出的速度计算得到的俯仰角和航向角方法为：
所述步骤(4)中进行组合导航计算方法为：
本发明重新设计了卡尔曼滤波算法，
利用量测阵H和观测阵C，根据卡尔曼滤波算法解算tn时刻的状态估计量Xn：δVce＝Ven-Vgen，
δVcn＝Vnn-Vgnn，δVcu＝Vun-Vgun，δθc＝θn-θgn，δψc＝ψn-ψgn
其中δVen为tn时刻自旋制导炮弹的东向速度修正值，δVnn为tn时刻自旋制导炮弹的北向速度修正值，δVun为tn时刻自旋制导炮弹的天向速度修正值，δθn为tn时刻自旋制导炮弹的俯仰角修正值，δγn为tn时刻自旋制导炮弹的横滚角修正值，δψn为tn时刻自旋制导炮弹的航向角修正值，为tn时刻自旋制导炮弹的三个陀螺仪零偏值；根据Xn可以得到tn时刻东向速度修正值，北向速度修正值，天向速度修正值，俯仰角修正值，横滚角修正值，航向角修正值，三个陀螺仪零偏修正值。
所述步骤(4)的组合导航计算三个速度解算方法为：
VKen＝Ven-Xn(1)
VKnn＝Vnn-Xn(2)
VKun＝Vun-Xn(3)
其中VKen表示组合导航后tn时刻自旋制导炮弹实际的东向速度，VKnn表示组合导航后tn时刻自旋制导炮弹实际的北向速度，VKun表示组合导航后tn时刻自旋制导炮弹实际的天向速度，Xn(1)表示tn时刻自旋制导炮弹的东向速度修正值，Xn(2)表示tn时刻自旋制导炮弹的北向速度修正值，Xn(3)表示tn时刻自旋制导炮弹的天向速度修正值。
所述步骤(4)的组合导航计算三个姿态解算方法为：
Cbn＝CnbT
Cbnn＝Cnn*Cbn
γKn＝arcsin(Cbnn(3,2))
θKn＝-arctan(Cbnn(3,1)/Cbnn(3,3))
ψKn＝ψgn
其中Cnb表示tn时刻组合导航前从导航坐标系到载体坐标系的转换矩阵，Cbn表示tn时刻组合导航前从载体坐标系到导航坐标系的转换矩阵，Cnn表示tn时刻姿态修正矩阵，Cbnn表示tn时刻组合导航后从载体坐标系到导航坐标系的转换矩阵，γKn表示tn时刻组合导航后的横滚角，θKn表示tn时刻组合导航后的俯仰角，ψKn表示tn时刻组合导航后的航向角。Xn(4)表示tn时刻自旋制导炮弹的俯仰角修正值，Xn(5)表示tn时刻自旋制导炮弹的横滚角修正值。
tn时刻惯性导航系统解算出的位置信息[lan phian hn]即为tn时刻自旋制导炮弹实际的位置信息。
通过上述方法即可完成高动态自旋制导炮弹空中组合导航。
本发明通过自旋制导炮弹空中粗对准方法得到初始时刻的三个位置、三个速度和三个姿态，与惯性导航系统数据进行导航解算，得到对应的导航结果，包含三个位置、三个姿态(航向角、俯仰角、横滚角)和三个速度；通过解算对应时间下的GPS输出的导航信息得到自旋制导炮弹空中对应时刻的航向角和俯仰角，计算对应时刻的三个速度误差值、俯仰角误差值和航向角误差值，作为9维卡尔曼滤波估计的观测阵C，估算出对应时刻的三个姿态角修正值、三个速度修正值和三个陀螺仪零偏修正，对高动态自旋炮弹进行空中组合导航解算，得到了自旋制导炮弹空中对应时刻的三个姿态信息和三个速度信息，从而获得制导炮弹的导航轨迹和飞行控制参数。相比其它高动态自旋制导炮弹空中组合导航方法，本发明实现了高动态自旋制导炮弹空中失重情况下的组合导航问题，同时通过卡尔曼滤波器实现了对导航噪声和陀螺仪零偏的滤除，提高了自旋制导炮弹初始对准参数的精确性和修正算法的快速性，降低系统设计难度，提高了动态自旋制导炮弹的导航精度以及落点精度，增加了制导炮弹的可控性。
图2为本发明方法设计的卡尔曼滤波速度误差估计效果图，图中第一行为东向速度修正曲线，第二行为北向速度修正曲线，第三行为天向速度修正曲线，可以从图中看出，速度误差收敛，且水平速度误差值在1m/s以内，高度速度误差值在2m/s,达到组合导航修正速度的效果。图3为本发明方法设计的卡尔曼滤波姿态误差估计效果图，图中第一行为俯仰角误差修正值，第二行为横滚角误差修正值，第三行为航向角误差修正值，可以从图中看出，姿态误差收敛，达到组合导航修正速度的效果。图4为本发明方法设计的卡尔曼滤波陀螺仪零偏估计效果图，图中第一行为X轴陀螺零偏估计值，第二行为Y轴陀螺零偏估计值，第三行为Z轴陀螺零偏估计值，可以从图中看出，零偏估计值收敛，且与所使用的陀螺仪相对应，估算结果准确。图5为使用本发明方法得到的组合导航曲线和GPS的输出曲线示意图，第一行依次分别为经度、纬度、高度，第二行依次分别为东向速度、北向速度、天向速度，第三行依次分别为俯仰角、横滚角和航向角。其中GPS输出结果用线表示，组合导航结果用点表示，从图中可以看出，组合导航结果与GPS输出相比，两者重合的较好，说明组合导航算法修正了惯性导航系统的输出，满足了制导炮弹空中导航控制的要求。
本发明未详细描述内容为本领域技术人员公知技术。

Claims (2)

1.一种高动态自旋制导炮弹空中组合导航方法，其特征在于步骤如下：
(1)根据惯性导航系统测得的加速度和角速度信息和GPS测得的速度和位置信息，利用自旋制导炮弹空中粗对准方法计算得到自旋制导炮弹在空中飞行初始时刻实际的位置信息[la0 phia0 h0]、速度信息[Ve0 Vn0 Vu0]和姿态信息[θ0 γ0 ψ0],其中la0表示粗对准得到的初始经度，phia0表示粗对准得到的初始纬度，h0表示粗对准得到的初始高度，Ve0表示粗对准得到的初始东向速度，Vn0表示粗对准得到的初始北向速度，Vu0表示粗对准得到的初始天向速度，θ0表示粗对准得到的初始俯仰角，γ0表示粗对准得到的初始横滚角，ψ0表示粗对准得到的初始航向角；
(2)自旋制导炮弹在tn时刻采集惯性导航系统测得的加速度和角速度信息，并根据测得的加速度和角速度信息以及tn-1时刻自旋制导炮弹实际的姿态、位置和速度信息进行导航解算，获得tn时刻通过惯性导航系统解算出的自旋制导炮弹的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]，其中ψn为tn时刻自旋制导炮弹的航向角，θn为tn时刻自旋制导炮弹的俯仰角，γn为tn时刻自旋制导炮弹的横滚角，lan为tn时刻自旋制导炮弹的经度，phian为tn时刻自旋制导炮弹的纬度，hn为tn时刻自旋制导炮弹的高度，Ven为tn时刻自旋制导炮弹的东向速度，Vnn为tn时刻自旋制导炮弹的北向速度，Vun为tn时刻自旋制导炮弹的天向速度，进入步骤(3)，其中n的初始值为1；
(3)在tn时刻，自旋制导炮弹判断是否接收到GPS输出的速度和位置信息，如果没有接收到，则将步骤(2)的导航解算结果作为tn时刻自旋制导炮弹实际的速度、位置和姿态信息，进入步骤(5)；否则，进入步骤(4)；
(4)自旋制导炮弹根据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]计算tn时刻自旋制导炮弹的俯仰角θgn和航向角ψgn，并依据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]和tn时刻惯性导航系统解算出的姿态信息[θnγnψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]进行组合导航计算，得到tn时刻自旋制导炮弹实际的速度、位置和姿态信息；其中，Vgen为tn时刻GPS输出的东向速度，Vgnn为tn时刻GPS输出的北向速度，Vgun为tn时刻GPS输出的天向速度；进入步骤(5)；
依据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]和tn时刻惯性导航系统解算出的姿态信息[θn γn ψn]、位置信息[lan phian hn]以及速度信息[Ven Vnn Vun]进行组合导航计算，得到tn时刻自旋制导炮弹实际的速度、位置和姿态信息的实现方式为：
(4.1)利用量测阵H和观测阵C，根据卡尔曼滤波算法解算出tn时刻的状态估计量Xn，
其中δVce＝Ven-Vgen，δVcn＝Vnn-Vgnn，δVcu＝Vun-Vgun，δθc＝θn-θgn，δψc＝ψn-ψgn
其中δVen为tn时刻自旋制导炮弹的东向速度修正值，δVnn为tn时刻自旋制导炮弹的北向速度修正值，δVun为tn时刻自旋制导炮弹的天向速度修正值，δθn为tn时刻自旋制导炮弹的俯仰角修正值，δγn为tn时刻自旋制导炮弹的横滚角修正值，δψn为tn时刻自旋制导炮弹的航向角修正值，为tn时刻自旋制导炮弹的三个陀螺仪零偏修正值；
(4.2)按照如下公式，利用tn时刻惯性导航系统解算出的速度信息[Ven Vnn Vun]计算tn时刻自旋制导炮弹实际的速度信息：
VKen＝Ven-Xn(1)
VKnn＝Vnn-Xn(2)
VKun＝Vun-Xn(3)
其中VKen表示组合导航后tn时刻自旋制导炮弹实际的东向速度，VKnn表示组合导航后tn时刻自旋制导炮弹实际的北向速度，VKun表示组合导航后tn时刻自旋制导炮弹实际的天向速度，Xn(1)表示tn时刻自旋制导炮弹的东向速度修正值，Xn(2)表示tn时刻自旋制导炮弹的北向速度修正值，Xn(3)表示tn时刻自旋制导炮弹的天向速度修正值；
(4.3)按照如下公式，利用tn时刻惯性导航系统解算出的姿态信息[θn γn ψn]计算tn时刻自旋制导炮弹实际的姿态信息：
γKn＝arcsin(Cbnn(3,2))
θKn＝-arctan( Cbnn(3,1)/ Cbnn(3,3))
ψKn＝ψgn
其中，Cbnn＝Cnn*Cbn，
Cbn＝Cnb T
其中Cnb表示tn时刻组合导航前从导航坐标系到载体坐标系的转换矩阵，Cbn表示tn时刻组合导航前从载体坐标系到导航坐标系的转换矩阵，Cnn表示tn时刻姿态修正矩阵，Cbnn表示tn时刻组合导航后从载体坐标系到导航坐标系的转换矩阵，γKn表示组合导航后tn时刻自旋制导炮弹实际的横滚角，θKn表示组合导航后tn时刻自旋制导炮弹实际的俯仰角，ψKn表示组合导航后tn时刻自旋制导炮弹实际的航向角；Xn(4)表示tn时刻自旋制导炮弹的俯仰角修正值，Xn(5)表示tn时刻 自旋制导炮弹的横滚角修正值；
(4.4)tn时刻惯性导航系统解算出的位置信息[lan phian hn]即为tn时刻自旋制导炮弹实际的位置信息；
(5)n的值加1后返回步骤(2)，计算出自旋制导炮弹在空中飞行每一时刻的实际速度、位置和姿态信息，用于作为自旋制导炮弹导航和控制的测量信息，直到自旋制导炮弹命中目标为止；
上述各步骤中，tn与tn-1的时间间隔为惯性导航系统的测量周期。
2.根据权利要求1所述的高动态自旋制导炮弹空中组合导航方法，其特征在于：所述步骤(4)自旋制导炮弹根据tn时刻接收到的GPS的速度信息[Vgen Vgnn Vgun]计算tn时刻自旋制导炮弹的俯仰角θgn和航向角ψgn的方法为：
CN201510657504.5A 2015-10-13 2015-10-13 一种高动态自旋制导炮弹空中组合导航方法 Active CN105258698B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510657504.5A CN105258698B (zh) 2015-10-13 2015-10-13 一种高动态自旋制导炮弹空中组合导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510657504.5A CN105258698B (zh) 2015-10-13 2015-10-13 一种高动态自旋制导炮弹空中组合导航方法

Publications (2)

Publication Number Publication Date
CN105258698A CN105258698A (zh) 2016-01-20
CN105258698B true CN105258698B (zh) 2017-12-19

Family

ID=55098482

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510657504.5A Active CN105258698B (zh) 2015-10-13 2015-10-13 一种高动态自旋制导炮弹空中组合导航方法

Country Status (1)

Country Link
CN (1) CN105258698B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107202578B (zh) * 2017-05-10 2020-11-24 陕西瑞特测控技术有限公司 一种基于mems技术的捷联式垂直陀螺仪解算方法
CN108680153B (zh) * 2018-05-21 2022-02-11 北京理工大学 基于陀螺信号重构的制导炮弹直接圆锥误差补偿方法
CN109211230B (zh) * 2018-09-07 2022-02-15 东南大学 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法
CN109059914B (zh) * 2018-09-07 2021-11-02 东南大学 一种基于gps和最小二乘滤波的炮弹滚转角估计方法
CN111380405B (zh) * 2018-12-29 2021-01-15 北京理工大学 带有捷联导引头的高动态飞行器的制导控制系统
CN110398242B (zh) * 2019-05-27 2021-05-14 西安微电子技术研究所 一种高旋高过载条件飞行器的姿态角确定方法
CN110941285A (zh) * 2019-11-29 2020-03-31 云南大学 一种基于双ip核的无人机飞行控制系统
CN110986937B (zh) * 2019-12-19 2022-05-17 北京三快在线科技有限公司 用于无人设备的导航装置、方法及无人设备
CN111288988A (zh) * 2020-02-20 2020-06-16 云南电网有限责任公司电力科学研究院 一种架空机器人组合定位方法
CN111366156A (zh) * 2020-04-17 2020-07-03 云南电网有限责任公司电力科学研究院 基于神经网络辅助的变电站巡检机器人导航方法及系统
CN112378400A (zh) * 2020-10-30 2021-02-19 湖南航天机电设备与特种材料研究所 一种双天线gnss辅助的捷联惯导组合导航方法
CN113642144B (zh) * 2021-06-21 2024-02-09 北京航天飞腾装备技术有限责任公司 一种基于导航与导引头框架角信息的剩余飞行时间解算方法
CN118274828B (zh) * 2024-06-03 2024-09-17 西安现代控制技术研究所 一种多特征融合的远程制导火箭弹末段组合导航切换方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102830414A (zh) * 2012-07-13 2012-12-19 北京理工大学 一种基于sins/gps的组合导航方法
CN104457446A (zh) * 2014-11-28 2015-03-25 北京航天控制仪器研究所 一种自旋制导炮弹的空中自对准方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8502126B2 (en) * 2010-05-27 2013-08-06 Raytheon Company System and method for navigating an object

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102830414A (zh) * 2012-07-13 2012-12-19 北京理工大学 一种基于sins/gps的组合导航方法
CN104457446A (zh) * 2014-11-28 2015-03-25 北京航天控制仪器研究所 一种自旋制导炮弹的空中自对准方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
"GPS/INS组合制导弹药空中对准的初始滚转角估计新算法";佘浩平 等，;《兵工学报》;20111031;第32卷(第10期);1265-1270页 *
"INS/GPS组合导航在大失准角情况下行进对准技术的研究";王盛 等，;《导航与控制》;20120831;第11卷(第3期);34-37页 *

Also Published As

Publication number Publication date
CN105258698A (zh) 2016-01-20

Similar Documents

Publication Publication Date Title
CN105258698B (zh) 一种高动态自旋制导炮弹空中组合导航方法
CN106527491B (zh) 一种固定翼无人机控制系统及横侧向飞行轨迹控制方法
KR100761011B1 (ko) 카메라형 태양센서를 이용한 관성항법시스템의자세보정장치 및 방법
CN105180728B (zh) 基于前数据的旋转制导炮弹快速空中对准方法
Wang et al. A GNSS/INS integrated navigation algorithm based on Kalman filter
CN109597427A (zh) 一种基于无人机的炸弹随遇攻击规划方法及系统
CN105115508A (zh) 基于后数据的旋转制导炮弹快速空中对准方法
CN106979781B (zh) 基于分布式惯性网络的高精度传递对准方法
CN111366148B (zh) 适用于机载光电观瞄系统多次观察的目标定位方法
CN112611394B (zh) 一种在发射坐标系下的飞行器姿态对准方法及系统
CN102878872B (zh) 一种针对导引头失锁情况的制导信息处理方法
CN112197761A (zh) 一种高精度多旋翼机协同定位方法及系统
CN107478110B (zh) 一种基于状态观测器的旋转弹姿态角计算方法
CN105785415A (zh) 一种制导炮弹的空中轨迹预测方法
CN110398242B (zh) 一种高旋高过载条件飞行器的姿态角确定方法
CN105486307A (zh) 针对机动目标的视线角速率估计方法
CN105241319B (zh) 一种高速自旋制导炮弹空中实时对准方法
CN201004180Y (zh) 无人机姿态控制系统
CN109857140A (zh) 运载火箭俯仰程序角计算方法、系统、设备及存储介质
CN111367305B (zh) 一种高轨光压作用下导引伴飞稳定性控制方法及系统
CN115542363B (zh) 一种适用于垂直下视航空吊舱的姿态测量方法
CN110017809B (zh) 利用地磁信息和光流传感器解算飞行器姿态的方法
CN112729305B (zh) 一种基于单飞行器导引头图像信息的多目标定位方法
CN105674988B (zh) 一种mems等效单轴旋转惯导的传递对准方法
Yingchao et al. Line-of-sight rate estimation based on attitude dynamics for strap-down seeker

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