CN109484674B - 一种基于目标轨道参数的实时轨道机动控制方法 - Google Patents

一种基于目标轨道参数的实时轨道机动控制方法 Download PDF

Info

Publication number
CN109484674B
CN109484674B CN201811187583.8A CN201811187583A CN109484674B CN 109484674 B CN109484674 B CN 109484674B CN 201811187583 A CN201811187583 A CN 201811187583A CN 109484674 B CN109484674 B CN 109484674B
Authority
CN
China
Prior art keywords
angle
program angle
flight time
program
pitch
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
CN201811187583.8A
Other languages
English (en)
Other versions
CN109484674A (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.)
General Designing Institute of Hubei Space Technology Academy
Original Assignee
General Designing Institute of Hubei Space Technology Academy
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 General Designing Institute of Hubei Space Technology Academy filed Critical General Designing Institute of Hubei Space Technology Academy
Priority to CN201811187583.8A priority Critical patent/CN109484674B/zh
Publication of CN109484674A publication Critical patent/CN109484674A/zh
Application granted granted Critical
Publication of CN109484674B publication Critical patent/CN109484674B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude control algorithms for spacecraft attitude control

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于目标轨道参数的实时轨道机动控制方法,涉及制导控制技术领域。在每个迭代计算周期内始终以目标轨道根数为计算条件,根据运载器发射诸元参数的初值,外推至理论关机点,计算理论关机点的地心矢经、绝对速度、当地弹道倾角和轨道倾角,求出相对于目标标称值的偏差量以及对应的雅可比矩阵;根据雅可比矩阵求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量并进行修正并作为下一个迭代计算周期的初值;根据当前迭代计算周期内的计算出的飞行程序角和剩余飞行时间进行姿态控制和关机控制。实现了运载器制导控制系统的实时解算,具有较强的工程应用价值。

Description

一种基于目标轨道参数的实时轨道机动控制方法
技术领域
本发明涉及制导控制技术领域,具体是涉及一种基于目标轨道参数的实时轨道机动控制方法。
背景技术
随着航天事业的发展,航天发射任务越来越趋向于多样化和复杂化,对运载器的机动性、灵活性、适应性以及最终的入轨精度都提出了更高的要求,因此需要研制一种制导精度更高适应能力更强的自适应制导方法。而传统的迭代制导方法继承于早期的多项式制导思想,利用最优控制理论发展起来的一种自适应制导方式,通过控制发动机的关机时间和推力方向,实现对运载器三个速度分量和三个位置分量中的五个分量的终端约束,通过对终端位置速度的约束,进而调整运载器飞行的程序角和剩余飞行时间。运载器运用此种迭代制导方式的阶段普遍具有轴向过载相对较大、飞行时间长、理论速度增量较大等特点。
发明人发现现有技术中至少存在如下问题:
当运载器飞行段提供的推力较小,特别是提供的加速度远小于重力加速度时或者发动机理论开机时间较短、提供的理论速度增量相对较小的情况下时,目前传统的迭代制导方案对以上飞行状态的适应性较差,对弹道偏差的适应性较弱,而且在计算过程中存在着计算无法收敛的风险。
发明内容
本发明的目的是为了克服上述背景技术的不足,提供一种基于目标轨道参数的实时轨道机动控制方法,
本发明提供一种基于目标轨道参数的实时轨道机动控制方法,包括以下步骤:
在每个迭代计算周期内始终以目标轨道根数为计算条件,根据运载器发射诸元参数的初值,外推至理论关机点,计算理论关机点的地心矢经、绝对速度、当地弹道倾角和轨道倾角,求出相对于目标标称值的偏差量以及对应的雅可比矩阵;
根据雅可比矩阵求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量,进行修正并作为下一个迭代计算周期的初值;根据当前迭代计算周期内的计算出的飞行程序角和剩余飞行时间进行姿态控制和关机控制。
在上述方案的基础上,具体包括以下步骤:
S1、装订发射诸元数据的初值;
S2、根据运载器末助推发动机点火的状态,以装订的发射诸元数据的初值为起点外推至理论关机点,根据外推理论关机点的位置速度计算理论关机点的轨道根数;
S3、外推结束后根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i;
S4、计算相对于装订的目标轨道的标称值的偏差量;
S5、分别计算目标轨道地心矢经、绝对速度、当地弹道倾角和轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率的偏导数,即对应的雅可比矩阵;
S6、对雅可比矩阵求逆,同时采用计算出的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量;
S7、判断剩余飞行时间是否小于△T,若是,进入步骤S8,若否进入步骤S9;
S8、按照最后一次迭代计算的剩余飞行时间关机,结束;
S9、采用步骤S6计算出的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量对初始俯仰程序角、初始偏航程序角、剩余飞行时间和俯仰程序角变化率进行修正,并作为下一个迭代周期计算的发射诸元数据的初值;返回步骤S2进行下一个迭代周期的计算。
在上述方案的基础上,所述装订发射诸元数据的初值,具体包括以下步骤:
运载器发射前,在地面装订相关发射诸元参数;
运载器发射后,在设定的导航坐标系内进行导航计算,并按照设定的发射时序飞行至末助推段。
在上述方案的基础上,所述发射诸元参数包括:发射纬度、经度、高程、射向、目标轨道根数、入轨点地心矢径、入轨点绝对速度、入轨点当地弹道倾角、轨道倾角、末助推点火时刻的初始俯仰程序角、初始偏航程序角、剩余飞行时间初值、初始俯仰程序角变化率、各级飞行程序角。
在上述方案的基础上,所述外推结束后,根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i,具体计算方法为:
以末助推点火点的位置速度作为轨道外推的起点,以惯组当前敏感到的视速度增量为基准,以当前的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率为初值,当剩余飞行时间满足要求时,外推结束,外推结束后根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i。
在上述方案的基础上,所述雅可比矩阵的具体形式为:
Figure GDA0001936493070000041
Figure GDA0001936493070000042
分别为地心矢径相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000043
分别为绝对速度相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000044
分别为当地弹道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000045
分别为轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数。
在上述方案的基础上,所述对雅可比矩阵求逆,同时采用计算出的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量,具体公式为:
Figure GDA0001936493070000051
其中,
Figure GDA0001936493070000052
ψn、Tn
Figure GDA0001936493070000053
分别为当前迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,
Figure GDA0001936493070000054
ψn+1、Tn+1
Figure GDA0001936493070000055
分别为下一个迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,Rbz、Vbz、θbz、ibz分别为标准入轨点的地心矢径、标准入轨点的绝对速度、标准入轨点的当地弹道倾角和标准入轨点的轨道倾角。
在上述方案的基础上,所述运载器末助推发动机点火的状态为点火时运载器三个方向的位置、三个方向的速度、点火时的加速度等状态变量。
与现有技术相比,本发明的优点如下:
本发明提供的基于目标轨道参数的实时轨道机动控制方法,在每个迭代计算周期内始终以目标轨道根数为计算条件,根据运载器发射诸元参数的初值,外推至理论关机点,计算理论关机点的地心矢经、绝对速度、当地弹道倾角和轨道倾角,求出相对于目标标称值的偏差量以及对应的雅可比矩阵;根据雅可比矩阵求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量并进行修正并作为下一个迭代计算周期的初值;根据当前迭代计算周期内的计算出的飞行程序角和剩余飞行时间进行姿态控制和关机控制。实现了运载器制导控制系统的实时解算,方法简单易于工程实现,具有较强的工程应用价值。与传统的制导方案相比,本发明方法实时性强,制导精度高,对轨道偏差的适应性强,箭上飞行软件简单,对地面诸元准备计算工作要求低,适用于各种情况下大气层外高精度制导的运载器。
附图说明
图1为本发明实施例的基于目标轨道参数的实时轨道机动控制方法的流程示意图;
图2为本发明实施例的基于目标轨道参数的实时轨道机动控制方法的俯仰程序角曲线;
图3为本发明实施例的基于目标轨道参数的实时轨道机动控制方法的偏航程序角曲线;
图4为本发明实施例的基于目标轨道参数的实时轨道机动控制方法的剩余飞行时间曲线。
具体实施方式
下面将结合本发明实施例对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
下面结合具体实施例对本发明作进一步说明,但不作为本发明的限定。
实施例1:
参见图1所示,本发明实施例提供一种基于目标轨道参数的实时轨道机动控制方法,包括以下步骤:
在每个迭代计算周期内始终以目标轨道根数为计算条件,根据运载器发射诸元参数的初值,外推至理论关机点,计算理论关机点的地心矢经、绝对速度、当地弹道倾角和轨道倾角,求出相对于目标标称值的偏差量以及对应的雅可比矩阵;
根据雅可比矩阵求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量并进行修正并作为下一个迭代计算周期的初值;根据当前迭代计算周期内的计算出的飞行程序角和剩余飞行时间进行姿态控制和关机控制。
本发明实施例在始终满足目标轨道根数约束的条件下,根据实际偏差量来修正当前飞行的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率,箭载计算机根据实时解算结果规划出一条满足性能指标的飞行轨道用于控制,相对于运载器末级入轨段其他的制导方式而言,本发明方法实时性强、计算简单且制导精度高,轨道偏差不累积,具有良好的偏差适应性和轨道调整能力,适用于对入轨精度要求较高的运载器。
实施例2:
在实施例1的基础上,基于目标轨道参数的实时轨道机动控制方法具体包括以下步骤:
A、运载器在发射前需要装订诸元数据,主要包括:发射经度、纬度、高程、射向、迭代计算俯仰程序角初值和偏航程序角初值、剩余飞行时间初值、俯仰程序角变化率初值、目标轨道数据等诸元参数;
B、运载器末助推发动机点火后,以当前的状态为起点,外推至理论关机点,计算关机点的轨道根数,进而求得关机点的地心矢径、绝对速度、当地弹道倾角和轨道倾角,并计算相对于标称值的偏差量;
C、分别计算目标轨道地心矢经、绝对速度、当地弹道倾角和轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率的偏导数,即对应的雅可比矩阵,对雅可比矩阵求逆同时利用上述计算的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前状态下需要的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量;
D、利用上述计算的飞行程序角和剩余飞行时间进行姿态控制和关机控制,如果剩余飞行时间小于△T,则停止迭代计算,并按照最后一次迭代计算的剩余飞行时间关机;如果剩余飞行时间大于△T,则将步骤C中所计算的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量返回至步骤A,作为步骤A重新迭代计算的初值,再次进行迭代流程的计算,直至剩余飞行时间满足要求,制导计算结束。
其中,上述步骤B中,运载器末助推发动机点火的状态主要是指点火时运载器三个方向的位置、三个方向的速度、点火时的加速度等状态变量,以装订的标准情况下末级点火时的俯仰程序角、偏航程序角、俯仰程序角变化率以及末级发动机的剩余飞行时间作为计算初始值,外推计算至理论关机点(即理论入轨点),得到关机点的位置速度。根据外推关机点的位置速度计算外推关机点的轨道根数,由轨道根数可得到理论关机点的地心矢径、绝对速度、当地弹道倾角和轨道倾角,并与装订的标准地心矢径、标准绝对速度、标准当地弹道倾角和标准轨道倾角作差得到地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差。
本发明实施例对多级运载器的末助推段对入轨精度、轨道适应性以及轨道调整能力等均有较高的要求,在每个计算周期内始终以目标轨道的轨道根数作为控制终端条件,根据运载器当前的飞行状态,外推至理论关机点,计算理论关机点处的地心矢经、绝对速度、当地弹道倾角和轨道倾角,求出相对于标称值的偏差量以及对应的雅可比矩阵,在始终满足目标轨道根数约束的条件下,根据实际偏差量来修正当前飞行的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率,箭载计算机根据实时解算结果规划出一条满足性能指标的飞行轨道用于控制,相对于运载器末级入轨段其他的制导方式而言,本发明实施例实时性强、计算简单且制导精度高,轨道偏差不累积,具有良好的偏差适应性和轨道调整能力,适用于对入轨精度要求较高的运载器。
实施例3:
在实施例2的基础上,基于目标轨道参数的实时轨道机动控制方法具体包括以下步骤:
S1、装订发射诸元数据的初值;
S2、根据运载器末助推发动机点火的状态,以装订的发射诸元数据的初值为起点进行外推计算,根据外推理论关机点的位置速度计算理论关机点的轨道根数;
其中外推计算主要是指运载器的速度位置外推,具体计算公式如下:
Figure GDA0001936493070000091
Figure GDA0001936493070000092
Figure GDA0001936493070000093
Figure GDA0001936493070000094
Figure GDA0001936493070000101
Figure GDA0001936493070000102
其中,T为运载器剩余飞行时间,
Figure GDA0001936493070000103
程序俯仰角和程序偏航角,a为视加速度;VXT、VYT、VZT、XT、YT、ZT分别为外推理论关机点的速度位置,VX0、VY0、VZ0为当前点的速度
Figure GDA0001936493070000104
gx0、gy0、gz0为当前点加速度分量,gxc、gyc、gzc为外推理论关机点重力加速度分量
S3、外推结束后根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i;
其中地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i均可根据理论关机点的速度位置计算得到,属于本领域的专业基础知识,在此不再单列出计算方法;
S4、并计算相对于装订的目标轨道的标称值的偏差量;
S5、分别计算目标轨道地心矢经、绝对速度、当地弹道倾角和轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率的偏导数,即对应的雅可比矩阵;
S6、对雅可比矩阵求逆,同时采用计算出的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量;
S7、判断剩余飞行时间是否小于△T,若是,进入步骤S8,若否进入步骤S9;
S8、按照最后一次迭代计算的剩余飞行时间关机,结束;
S9、采用步骤S6计算出的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量对初始俯仰程序角、初始偏航程序角、剩余飞行时间和俯仰程序角变化率进行修正,并作为下一个迭代周期计算的发射诸元数据的初值;返回步骤S2进行下一个迭代周期的计算,结束。
本发明实施例实现了运载器制导控制系统的实时解算,方法简单易于工程实现,具有较强的工程应用价值。与传统的制导方案相比,本发明方法实时性强,制导精度高,对轨道偏差的适应性强,箭上飞行软件简单,对地面诸元准备计算工作要求低,适用于各种情况下大气层外高精度制导的运载器。
实施例4:
在实施例1的基础上,所述发射诸元参数包括:发射纬度、经度、高程、射向、目标轨道根数、入轨点地心矢径、入轨点绝对速度、入轨点当地弹道倾角、轨道倾角、末助推点火时刻的初始俯仰程序角、初始偏航程序角、剩余飞行时间初值、初始俯仰程序角变化率、各级飞行程序角。
所述外推结束后,根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i,具体计算方法为:
以末助推点火点的位置速度作为轨道外推的起点,以惯组当前敏感到的视速度增量为基准,以当前的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率为初值,当剩余飞行时间满足要求时,外推结束,外推结束后根据关机点的位置速度计算出关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i。所述运载器末助推发动机点火的状态为点火时运载器三个方向的位置、三个方向的速度、点火时的加速度等状态变量。
本发明实施例在始终满足目标轨道根数约束的条件下,根据实际偏差量来修正当前飞行的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率,箭载计算机根据实时解算结果规划出一条满足性能指标的飞行轨道用于控制,相对于运载器末级入轨段其他的制导方式而言,本发明方法实时性强、计算简单且制导精度高,轨道偏差不累积,具有良好的偏差适应性和轨道调整能力,适用于对入轨精度要求较高的运载器。
实施例5:
在实施例1的基础上,所述为雅可比矩阵的具体形式为:
Figure GDA0001936493070000121
Figure GDA0001936493070000122
分别为地心矢径相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000123
分别为绝对速度相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000124
分别为当地弹道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure GDA0001936493070000125
分别为轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数。
所述对雅可比矩阵求逆,同时采用上述计算的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量,具体公式为:
Figure GDA0001936493070000131
其中,
Figure GDA0001936493070000132
ψn、Tn
Figure GDA0001936493070000133
分别为当前迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,
Figure GDA0001936493070000134
ψn+1、Tn+1
Figure GDA0001936493070000135
分别为下一个迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,Rbz、Vbz、θbz、ibz分别为标准入轨点的地心矢径、标准入轨点的绝对速度、标准入轨点的当地弹道倾角和标准入轨点的轨道倾角。
图2为迭代计算的俯仰程序角曲线,图3为迭代计算的偏航程序角曲线,图4为剩余飞行时间曲线。从仿真曲线可以看出,俯仰程序角和偏航程序角线性度良好,变化平缓,对姿态控制系统而言具有良好的适应性。
本领域的技术人员可以对本发明实施例进行各种修改和变型,倘若这些修改和变型在本发明权利要求及其等同技术的范围之内,则这些修改和变型也在本发明的保护范围之内。说明书中未详细描述的内容为本领域技术人员公知的现有技术。

Claims (8)

1.一种基于目标轨道参数的实时轨道机动控制方法,其特征在于,包括以下步骤:
在每个迭代计算周期内始终以目标轨道根数为计算条件,根据运载器发射诸元参数的初值,外推至理论关机点,计算理论关机点的地心矢径、绝对速度、当地弹道倾角和轨道倾角,求出相对于目标标称值的偏差量以及对应的雅可比矩阵;
根据雅可比矩阵求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量,进行修正并作为下一个迭代计算周期的初值;根据当前迭代计算周期内的计算出的飞行程序角和剩余飞行时间进行姿态控制和关机控制。
2.如权利要求1所述的方法,其特征在于,具体包括以下步骤:
S1、装订发射诸元数据的初值;
S2、根据运载器末助推发动机点火的状态,以装订的发射诸元数据的初值为起点外推至理论关机点,根据外推理论关机点的位置速度计算理论关机点的轨道根数;
S3、外推结束后根据理论关机点的位置速度计算出理论关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i;
S4、计算相对于装订的目标轨道的标称值的偏差量;
S5、分别计算目标轨道地心矢径、绝对速度、当地弹道倾角和轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率的偏导数,即对应的雅可比矩阵;
S6、对雅可比矩阵求逆,同时采用计算出的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量;
S7、判断剩余飞行时间是否小于△T,若是,进入步骤S8,若否进入步骤S9;
S8、按照最后一次迭代计算的剩余飞行时间关机,结束;
S9、采用步骤S6计算出的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量对初始俯仰程序角、初始偏航程序角、剩余飞行时间和俯仰程序角变化率进行修正,并作为下一个迭代周期计算的发射诸元数据的初值;返回步骤S2进行下一个迭代周期的计算。
3.如权利要求2所述的方法,其特征在于,所述装订发射诸元数据的初值,具体包括以下步骤:
运载器发射前,在地面装订相关发射诸元参数;
运载器发射后,在设定的导航坐标系内进行导航计算,并按照设定的发射时序飞行至末助推段。
4.如权利要求2所述的方法,其特征在于,所述发射诸元参数包括:发射纬度、经度、高程、射向、目标轨道根数、入轨点地心矢径、入轨点绝对速度、入轨点当地弹道倾角、轨道倾角、末助推点火时刻的初始俯仰程序角、初始偏航程序角、剩余飞行时间初值、初始俯仰程序角变化率、各级飞行程序角。
5.如权利要求2所述的方法,其特征在于:
所述外推结束后,根据理论关机点的位置速度计算出理论关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i,具体计算方法为:
以末助推点火点的位置速度作为轨道外推的起点,以惯组当前敏感到的视速度增量为基准,以当前的俯仰程序角、偏航程序角、剩余飞行时间以及俯仰程序角变化率为初值,当剩余飞行时间满足要求时,外推结束,外推结束后根据理论关机点的位置速度计算出理论关机点的地心矢径R、绝对速度V、当地弹道倾角θ、轨道倾角i。
6.如权利要求2所述的方法,其特征在于:所述雅可比矩阵的具体形式为:
Figure FDA0002694533370000031
Figure FDA0002694533370000032
分别为地心矢径相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure FDA0002694533370000033
分别为绝对速度相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure FDA0002694533370000034
分别为当地弹道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数;
Figure FDA0002694533370000035
分别为轨道倾角相对于俯仰程序角、偏航程序角、剩余飞行时间、俯仰程序角变化率的偏导数。
7.如权利要求6所述的方法,其特征在于:
所述对雅可比矩阵求逆,同时采用计算出的地心矢径偏差、绝对速度偏差、当地弹道倾角偏差和轨道倾角偏差,求得当前迭代计算周期内的俯仰程序角修正量、偏航程序角修正量、剩余飞行时间修正量以及俯仰程序角变化率修正量,具体公式为:
Figure FDA0002694533370000041
其中,
Figure FDA0002694533370000042
ψn、Tn
Figure FDA0002694533370000043
分别为当前迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,
Figure FDA0002694533370000044
ψn+1、Tn+1
Figure FDA0002694533370000045
分别为下一个迭代计算周期的俯仰程序角、偏航程序角、剩余飞行时间和俯仰程序角变化率,Rbz、Vbz、θbz、ibz分别为标准入轨点的地心矢径、标准入轨点的绝对速度、标准入轨点的当地弹道倾角和标准入轨点的轨道倾角。
8.如权利要求2所述的方法,其特征在于:
所述运载器末助推发动机点火的状态的状态变量包括点火时运载器三个方向的位置、三个方向的速度和点火时的加速度。
CN201811187583.8A 2018-10-12 2018-10-12 一种基于目标轨道参数的实时轨道机动控制方法 Active CN109484674B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811187583.8A CN109484674B (zh) 2018-10-12 2018-10-12 一种基于目标轨道参数的实时轨道机动控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811187583.8A CN109484674B (zh) 2018-10-12 2018-10-12 一种基于目标轨道参数的实时轨道机动控制方法

Publications (2)

Publication Number Publication Date
CN109484674A CN109484674A (zh) 2019-03-19
CN109484674B true CN109484674B (zh) 2020-12-25

Family

ID=65690602

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811187583.8A Active CN109484674B (zh) 2018-10-12 2018-10-12 一种基于目标轨道参数的实时轨道机动控制方法

Country Status (1)

Country Link
CN (1) CN109484674B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110203422B (zh) * 2019-05-31 2021-09-03 中国人民解放军63729部队 针对面目标区域探测的快速响应卫星轨道设计方法
CN110466803B (zh) * 2019-07-03 2021-11-30 中国人民解放军63686部队 基于等倾角姿态控制的自旋稳定卫星姿态预测方法
CN110562490B (zh) * 2019-07-31 2021-03-26 北京控制工程研究所 一种轨道注入参数正确性在轨自主诊断方法和系统
CN110510155B (zh) * 2019-09-02 2021-03-16 江苏深蓝航天有限公司 在线迭代的着陆制导方法及包含该方法的系统、存储器
CN111256545B (zh) * 2019-12-10 2022-07-01 中国船舶重工集团有限公司第七一0研究所 一种水雷高速打击实时修正方法
CN111547274B (zh) * 2020-03-19 2023-08-29 上海航天控制技术研究所 一种航天器高精度自主目标预报方法
CN112416019B (zh) * 2020-11-30 2022-09-27 北京航天自动控制研究所 一种起飞时刻偏差补偿方法
CN113022893B (zh) * 2021-02-26 2022-12-13 北京控制工程研究所 一种空间交会拦截自主自适应远程制导方法和系统
CN113734468B (zh) * 2021-08-30 2023-02-03 北京宇航系统工程研究所 一种基于迭代制导的轨道面精确控制方法
CN114396837B (zh) * 2021-12-24 2023-11-10 北京航天自动控制研究所 一种基于末端程序角保持的迭代制导方法、设备及介质
CN114326813B (zh) * 2021-12-31 2023-06-20 北京航天自动控制研究所 一种无动力飞行器的剩余飞行时间预测方法和系统
CN114132531B (zh) * 2022-01-28 2022-06-24 中国人民解放军32035部队 一种低轨空间目标轨道修正方法、装置及电子设备
CN114735239B (zh) * 2022-04-27 2022-10-18 中国人民解放军32039部队 航天器轨道机动控制方法、装置和电子设备

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2424954C1 (ru) * 2010-05-25 2011-07-27 Федеральное государственное унитарное предприятие Московское опытно-конструкторское бюро "Марс" (ФГУП МОКБ "Марс") Способ управления движением разгонного блока на участке доразгона
CN106507769B (zh) * 2009-05-08 2013-01-23 中国人民解放军国防科学技术大学 轨道机动受限的空间交会地面导引段轨道控制方法
CN103198187A (zh) * 2013-04-02 2013-07-10 哈尔滨工业大学 基于微分修正的深空探测器的轨道设计方法
CN103728976A (zh) * 2013-12-30 2014-04-16 北京航空航天大学 一种基于广义标控脱靶量概念的多过程约束和多终端约束末制导律
CN106843272A (zh) * 2017-02-28 2017-06-13 北京航空航天大学 一种具有终端速度、弹道倾角和过载约束的显式制导律
CN106892136A (zh) * 2017-02-16 2017-06-27 北京航天自动控制研究所 一种基于天地通讯的航天飞行器轨道规划方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101858969A (zh) * 2010-03-26 2010-10-13 航天东方红卫星有限公司 一种基于优化虚拟转动的卫星目标姿态预先确定方法
DE102012000331B4 (de) * 2012-01-11 2018-08-16 Jena-Optronik Gmbh Verfahren und Sensorsystem zur Lagebestimmung eines Flugobjekts
FR3030456B1 (fr) * 2014-12-17 2016-12-16 Thales Sa Procede de guidage pour la mise a poste d'un satellite
JP6537462B2 (ja) * 2016-02-12 2019-07-03 三菱電機株式会社 衛星自律制御装置、人工衛星、衛星管理システム、衛星自律制御方法及び衛星自律制御プログラム

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106507769B (zh) * 2009-05-08 2013-01-23 中国人民解放军国防科学技术大学 轨道机动受限的空间交会地面导引段轨道控制方法
RU2424954C1 (ru) * 2010-05-25 2011-07-27 Федеральное государственное унитарное предприятие Московское опытно-конструкторское бюро "Марс" (ФГУП МОКБ "Марс") Способ управления движением разгонного блока на участке доразгона
CN103198187A (zh) * 2013-04-02 2013-07-10 哈尔滨工业大学 基于微分修正的深空探测器的轨道设计方法
CN103728976A (zh) * 2013-12-30 2014-04-16 北京航空航天大学 一种基于广义标控脱靶量概念的多过程约束和多终端约束末制导律
CN106892136A (zh) * 2017-02-16 2017-06-27 北京航天自动控制研究所 一种基于天地通讯的航天飞行器轨道规划方法
CN106843272A (zh) * 2017-02-28 2017-06-13 北京航空航天大学 一种具有终端速度、弹道倾角和过载约束的显式制导律

Also Published As

Publication number Publication date
CN109484674A (zh) 2019-03-19

Similar Documents

Publication Publication Date Title
CN109484674B (zh) 一种基于目标轨道参数的实时轨道机动控制方法
CN107966156B (zh) 一种适用于运载火箭垂直回收段的制导律设计方法
CN109398762B (zh) 一种固体火箭基于椭圆转移轨道的入轨式弹道设计方法
CN109740198B (zh) 一种基于解析预测的滑翔飞行器三维再入制导方法
CN109798902A (zh) 一种适用于运载火箭入轨修正的迭代制导方法
CN111306989A (zh) 一种基于平稳滑翔弹道解析解的高超声速再入制导方法
CN111692919B (zh) 超近射程的飞行器精确制导控制方法
CN104567545B (zh) Rlv大气层内主动段的制导方法
CN109398763A (zh) 一种基于有限推力有限工作时间情况下的航天器精确入轨控制方法
CN112461060A (zh) 一种火箭末级离轨控制方法和装置
CN109269504B (zh) 一种具有末端约束的姿态机动路径规划方法
CN114967725B (zh) 靶标的姿态控制方法、计算机设备及介质
CN110425943B (zh) 面向变质心飞行器的工程化再入制导方法
CN113602532A (zh) 一种固体运载火箭入轨修正方法
CN115265292B (zh) 非轴对称运载火箭减载控制方法及存储设备
CN114879717B (zh) 靶标的快速转平方法、计算机设备及介质
CN109460049B (zh) 基于惯性指向模式的地球同步轨道卫星远地点变轨方法
CN113847913A (zh) 一种基于弹道模型约束的弹载组合导航方法
CN112304169A (zh) 一种基于推力调节的运载火箭制导方法及系统
CN113834386B (zh) 一种固体运载火箭大气层外制导控制方法
CN107102547B (zh) 一种基于滑模控制理论的rlv着陆段制导律获取方法
CN115562314A (zh) 运载火箭子级落区控制方法、系统、介质及计算机设备
CN115079565A (zh) 变系数的带落角约束制导方法、装置和飞行器
CN112329135B (zh) 多级固体火箭能量处理方法、系统、终端及介质
CN106021835B (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