CN113060306A - 有限推力的多脉冲交会迭代制导方法、装置及电子设备 - Google Patents
有限推力的多脉冲交会迭代制导方法、装置及电子设备 Download PDFInfo
- Publication number
- CN113060306A CN113060306A CN202110348007.2A CN202110348007A CN113060306A CN 113060306 A CN113060306 A CN 113060306A CN 202110348007 A CN202110348007 A CN 202110348007A CN 113060306 A CN113060306 A CN 113060306A
- Authority
- CN
- China
- Prior art keywords
- vector
- pulse
- current pulse
- representing
- angle
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/242—Orbits and trajectories
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本申请涉及一种有限推力的多脉冲交会迭代制导方法、装置及电子设备。所述迭代制导方法的思想是在多脉冲滑移轨道规划的基础上,下一个脉冲速度增益计算是对前一次脉冲因为有限推力产生的干扰进行实时校正计算,利用双脉冲原理,但是对于当前状态的计算是根据导航测量得到的相对状态,这样依次迭代校正,最后一个脉冲是不能校正的,其有限推力引起的误差就是制导误差。
Description
技术领域
本申请涉及航天器制导技术领域,特别是涉及一种有限推力的多脉冲交会迭代制导方法、装置及电子设备。
背景技术
近程交会涉及两个飞行器的相对运动,是交会过程的后期阶段,依赖于相对导航方式接近目标,导航设备包括相对GPS,激光雷达等。
双脉冲轨道转移理论上可以实现轨道交会,但是由于第二个脉冲的速度增益可能较大无法实现精确控制,达不到交会的目的,而需要研究多脉冲转移,但多脉冲转移没有唯一解,理论上具有无穷多个解,也就是与脉冲发生的时刻、脉冲大小及其次数有关。通常要进行优化,工程上为简化多脉冲求解,往往给定约束轨道和交会时间,从中选取脉冲数、及其发生时刻、脉冲大小,获得次优解。如果多冲量机动每次冲量施加的时间不固定,直接对机动时间和能量进行优化需要解一个非常复杂的非线性问题。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提高控制精度的一种有限推力的多脉冲交会迭代制导方法、装置及电子设备。
一种有限推力的多脉冲交会迭代制导方法,所述方法包括:
获取初始时刻和交会目标轨道根数;根据所述初始时刻和所述交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数。
获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;所述状态矢量包括位置矢量和速度矢量。
设置初始时刻为当前脉冲时刻。
根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵。
根据所述追踪器位置矢量、所述追踪器速度矢量、所述目标器位置矢量、所述目标器速度矢量以及所述转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量。
根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将所述相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益。
根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据所述绝对速度增益,确定有限推力;根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影。
对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止。
根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度。
根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
一种有限推理的多脉冲交会迭代导航制导装置,所述装置包括:
交会目标轨道参数获取模块:用于获取初始时刻和交会目标轨道根数;根据所述初始时刻和所述交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数。
初始状态参数获取模块:用于获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;所述状态矢量包括位置矢量和速度矢量。
迭代制导参数设置模块:用于设置初始时刻为当前脉冲时刻。
迭代制导模:根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵;根据所述追踪器位置矢量、所述追踪器速度矢量、所述目标器位置矢量、所述目标器速度矢量以及所述转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量;根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将所述相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益;根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据所述绝对速度增益,确定有限推力;根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止。
最后一个脉冲制导模块:用于根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度。
迭代制导误差确定模块,用于根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
上述有限推力的多脉冲交会迭代制导方法、装置及电子设备,所述迭代制导方法的思想是在多脉冲滑移轨道规划的基础上,下一个脉冲速度增益计算是对前一次脉冲因为有限推力产生的干扰进行实时校正计算,利用双脉冲原理,但是对于当前状态的计算是根据导航测量得到的相对状态,这样依次迭代校正,最后一个脉冲是不能校正的,其有限推力引起的误差就是制导误差。
附图说明
图1为一个实施例中有限推力的多脉冲交会迭代制导方法的流程示意图;
图2为另一个实施例中有限推力的多脉冲交会迭代制导方法的流程示意图;
图3为另一个实施例中有限推力的多脉冲交会迭代制导装置的结构框图;
图4为另一个实施例中一个实施例中电子设备的内部结构图;
图5为其中一个实施例中近距离30公里3脉冲指数交会轨道绝对轨迹示意图;
图6为其中一个实施例中近距离20公里4脉冲快速交会轨道相对轨迹示意图;
图7为其中一个实施例中近距离114公里3脉冲指数交会轨道绝对轨迹示意图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,如图1所示,提供了一种有限推力的多脉冲交会迭代制导方法,包括以下步骤:
步骤100,获取初始时刻和交会目标轨道根数;根据初始时刻和交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数。
步骤102,获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;状态矢量包括位置矢量和速度矢量。
步骤104,设置初始时刻为当前脉冲时刻。
步骤106,根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵。
步骤108,根据追踪器位置矢量、追踪器速度矢量、目标器位置矢量、目标器速度矢量以及转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量。
步骤110,根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益。
步骤112,根据绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据绝对速度增益,确定有限推力;根据偏航角、俯仰角以及有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影。
步骤114,对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止。
真空段目标器和追踪器在J2000坐标系中的动力学方程表达式为:
如果已知脉冲速度增益:ΔVr=[ΔVx ΔVy ΔVz]T
则相对目标坐标系的常值偏航角为:ψr=sin-1(-ΔVz/A1)
相对目标坐标系的常值俯仰角为:
积分时间tgo就可知道追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再指定下一个脉冲的时刻,经数值积分可得追踪器和目标器的位置和速度。
步骤116,根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度。
步骤118,根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
上述有限推力的多脉冲交会迭代制导方法中,所述迭代制导方法的思想是在多脉冲滑移轨道规划的基础上,下一个脉冲速度增益计算是对前一次脉冲因为有限推力产生的干扰进行实时校正计算,利用双脉冲原理,但是对于当前状态的计算是根据导航测量得到的相对状态,这样依次迭代校正,最后一个脉冲是不能校正的,其有限推力引起的误差就是制导误差。。
在其中一个实施例中,轨道根数包括:轨道半长轴、轨道偏心率、轨道倾角、升交点赤经、近地点幅角以及指定历元的平近点角;步骤106还包括:
根据当前脉冲时刻目标器位置矢量和目标器速度矢量,得到经典轨道根数、偏近点角、真近点角以及纬度幅角。根据轨道根数的轨道偏心率和平近点角,确定偏近点角;偏近点角的计算公式如下:
其中:E代表偏近点角;M代表平近点角,e代表轨道偏心率。
根据偏近点角和真近点角f之间的关系,得到真近点角,真近点角f与偏近点角E的关系式为:
其中:f代表真近点角;E代表偏近点角;e代表轨道偏心率。
将近地点幅角和真近点角求和,得到距升交点纬度幅角。根据距升交点纬度幅角、轨道倾角以及升交点赤经,确定J2000坐标系到目标轨道坐标系的当前脉冲时刻转换矩阵;当前脉冲时刻转换矩阵的计算公式为:A(tm)=AuAiAΩ
其中:u代表距升交点纬度幅角;i代表距升交点纬度幅角;Ω代表升交点赤经;AΩ,Ai,Au为旋转矩阵,分别为:
在其中一个实施例中,步骤110还包括:根据当前脉冲时刻相对位置矢量和下一脉冲时刻相对位置矢量,得到当前脉冲施加后的相对速度;当前脉冲施加后的相对速度的计算公式为:
根据当前脉冲施加前后的相对速度矢量,确定当前脉冲时刻速度增益矢量;根据下一脉冲施加前后的相对速度矢量,确定下一脉冲时刻的速度增益矢量;当前脉冲时刻速度增益矢量和下一脉冲时刻的速度增益矢量计算公式如下:
其中代表当前脉冲时刻速度增益矢量,代表下一脉冲时刻的速度增益矢量,代表当前脉冲施加前的相对速度矢量,代表当前脉冲施加后的相对速度矢量;代表下一脉冲施加前的相对速度矢量,代表下一脉冲施加后的相对速度矢量。
在其中一个实施例中,步骤112还包括:根据绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角以及发动机工作时间;偏航角计算公式和俯仰角的计算公式为:
发动机工作时间计算公式为:
根据绝对速度增益,确定有限推力。根据偏航角、俯仰角以及有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影的表达式为:
其中,ax、ay、az代表推力加速度在X、Y、Z轴上的投影,F代表有限推力,ψr代表相对目标坐标系的偏航角,代表相对目标坐标系的俯仰角,A-1代表当前脉冲时刻的转移矩阵,m0代表变轨发动机的初始质量,代表变轨发动机理论秒流量,t代表时间。
在一个实施例中,如图2所示,提供了一种有限推力的多脉冲交会迭代制导方法,其实施流程步骤包括:
(2)计算变化矩阵A,在轨道坐标系中计算C-W制导需要的初始相对位置和相对速度矢量
(3)指定交会终端状态针对值
(4)求标准指数轨道多脉冲导航点上的时间、相对位置
其中r0、rT分别为初、终端相对位置矢量。每次冲量时间tm、理论相对位置
(5)运用双脉冲理论求当前两个导航点脉冲前后的相对速度和相对速度增益
其中:
注意nτ不能为π的整数倍,否则会出现奇异点,设计过程中应避免,所以双脉冲矢量的速度增益为:
(6)将相对速度增益转换到j2000坐标系中的速度增益
(7)求追踪器在该脉冲时刻的俯仰偏航姿态角
(8)按常值推力实现相对速度增益关机或按时间关机
(9)积分12自由度两飞行器的动力学方程,飞行到下一个脉冲时刻,脉冲前的相对速度有积分求得,转移时间间隔由转移轨道规划已经求得(不能再重新规划下一个脉冲的时间),重复以上过程。
应该理解的是,虽然图1-2的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1-2中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中,如图3所示,提供了一种有限推理的多脉冲交会迭代导航制导装置,包括:交会目标轨道参数获取模块、初始状态参数获取模块、迭代制导参数设置模块、迭代制导模块、最后一个脉冲制导模块以及迭代制导误差确定模块,其中:
交会目标轨道参数获取模块:用于获取初始时刻和交会目标轨道根数;根据初始时刻和交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数。
初始状态参数获取模块:用于获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;状态矢量包括位置矢量和速度矢量。
迭代制导参数设置模块:用于设置初始时刻为当前脉冲时刻。
迭代制导模:根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵;根据追踪器位置矢量、追踪器速度矢量、目标器位置矢量、目标器速度矢量以及转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量;根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益;根据绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据绝对速度增益,确定有限推力;根据偏航角、俯仰角以及有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止。
最后一个脉冲制导模块:用于根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度。
迭代制导误差确定模块,用于根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
在其中一个事实例中,轨道根数包括:轨道半长轴、轨道偏心率、轨道倾角、升交点赤经、近地点幅角以及指定历元的平近点角;迭代制导模块还用于:
根据当前脉冲时刻目标器位置矢量和目标器速度矢量,得到经典轨道根数、偏近点角、真近点角以及纬度幅角。
根据轨道根数的轨道偏心率和平近点角,确定偏近点角;偏近点角的计算公式如下:
其中:E代表偏近点角;M代表平近点角,e代表轨道偏心率。
根据偏近点角和真近点角f之间的关系,得到真近点角,真近点角f与偏近点角E的关系式为:
其中:f代表真近点角;E代表偏近点角;e代表轨道偏心率。
将近地点幅角和真近点角求和,得到距升交点纬度幅角。
根据距升交点纬度幅角、轨道倾角以及升交点赤经,确定J2000坐标系到目标轨道坐标系的当前脉冲时刻转换矩阵;当前脉冲时刻转换矩阵的计算公式为:
A(tm)=AuAiAΩ
其中:u代表距升交点纬度幅角;i代表距升交点纬度幅角;Ω代表升交点赤经;AΩ,Ai,Au为旋转矩阵。
在其中一个实施例中,迭代制导模块还用于:根据当前脉冲时刻相对位置矢量和下一脉冲时刻相对位置矢量,得到当前脉冲施加后的相对速度;当前脉冲施加后的相对速度的计算公式为:
根据当前脉冲施加前后的相对速度矢量,确定当前脉冲时刻速度增益矢量;根据下一脉冲施加前后的相对速度矢量,确定下一脉冲时刻的速度增益矢量;当前脉冲时刻速度增益矢量和下一脉冲时刻的速度增益矢量计算公式如下:
其中代表当前脉冲时刻速度增益矢量,代表下一脉冲时刻的速度增益矢量,代表当前脉冲施加前的相对速度矢量,代表当前脉冲施加后的相对速度矢量;代表下一脉冲施加前的相对速度矢量,代表下一脉冲施加后的相对速度矢量。
在其中一个事实例中,迭代制导模块还用于:根据绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角以及发动机工作时间;偏航角计算公式和俯仰角的计算公式为:
发动机工作时间计算公式为:
根据绝对速度增益,确定有限推力。根据偏航角、俯仰角以及有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影的表达式为:
其中,ax、ay、az代表推力加速度在X、Y、Z轴上的投影,F代表有限推力,ψr代表相对目标坐标系的偏航角,代表相对目标坐标系的俯仰角,A-1代表当前脉冲时刻的转移矩阵,m0代表变轨发动机的初始质量,代表变轨发动机理论秒流量,t代表时间。
关于有限推力的多脉冲交会迭代制导装置的具体限定可以参见上文中对于有限推力的多脉冲交会迭代制导方法的限定,在此不再赘述。上述有限推力的多脉冲交会迭代制导装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种电子设备,该电子设备可以是终端,其内部结构图可以如图4所示。电子设备包括通过系统总线连接的处理器、存储器、网络接口、显示屏和输入装置。其中,该电子设备的处理器用于提供计算和控制能力。该电子设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该电子设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种有限推力的多脉冲交会迭代制导方法。该电子设备的显示屏可以是液晶显示屏或者电子墨水显示屏,该电子设备的输入装置可以是显示屏上覆盖的触摸层,也可以是电子设备外壳上设置的按键、轨迹球或触控板,还可以是外接的键盘、触控板或鼠标等。
本领域技术人员可以理解,图4中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的电子设备的限定,具体的电子设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种电子设备,包括存储器和处理器,该存储器存储有计算机程序,该处理器执行计算机程序时实现上述实施例中方法的步骤。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述实施例中方法的步骤。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
在一个有限推力的多脉冲交会迭代制导方法的仿真验证实施例中,
初始相对距离19.8公里,初始相对速度34m/s,推力档位选取为:6000N(脉冲速度增益大于10m/s),2000N(脉冲速度增益5~10m/s),600N(脉冲速度增益小于5m/s),分别选取四个设计轨道,同时脉冲次数选为3、4,仿真结果如表1、表2所示。近距离30公里3脉冲指数交会轨道绝对轨迹示意图如图5所示,近距离20公里4脉冲快速交会轨道相对轨迹示意图如图6所示,其中图6(a)为X-Y平面转移轨迹示意图,6(b)为空间转移轨迹示意图。
表1三脉冲仿真结果
表2四脉冲仿真结果
可以看出,当选取快速约束轨道时,终端相对距离误差较小,且在四脉冲时出现最优解,终端误差仅32.66米,终端速度误差和脉冲能量消耗也较合理。慢速轨道的终端位置误差过大,多项式轨道的终端位置和速度误差很小,交会时间很短,但能量消耗过大。
在另一个仿真实施例中,初始相对距离114公里,初始相对速度129m/s,设计轨道选取指数轨道,交会时间4920s,推力档位选取为:6000N(脉冲速度增益大于10m/s),2000N(脉冲速度增益5~10m/s),600N(脉冲速度增益小于5m/s)。三脉冲、四脉冲以及五脉冲仿真结果如表3-5所示,近距离114公里3脉冲指数交会轨道绝对轨迹如图7所示。
表3三脉冲仿真结果
表4四脉冲仿真结果
表4五脉冲仿真结果
脉冲数的选择不仅与速度增益有关,还与姿控燃料和校正精度有关。在相同速度增益的情况下,脉冲数较多,有利于轨道校正控制,但姿控的负担加重。因为远距离交会,耗时26小时,需要重新进行姿态确定,有时还与地面测控有关。所以本算例远程初始交会4脉冲最优,7脉冲次之,10脉冲可放弃。
可见,从这个具有114公里和129m/s的相对初始误差工况可以看出,在有限推力情况下,由于C-W制导的脉冲速度指令不可能瞬间实现,引力加速度对相对轨道的影响较大,特别是初始距离和初始速度的误差越大,则影响越大,需要的实际速度增益也越来越大于弹道规划给出的脉冲速度增益;并且预期的C-W脉冲制导指令结束后,仍然存在较大位置和速度误差,比如本仿真算例在4脉冲制导仿真结束情况下,位置误差23.249公里,速度误差23.55m/s。这说明还需要在导航测量支持的情况下,进行第二次近距离的C-W制导控制,显然仍然是3脉冲或4脉冲。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种有限推力的多脉冲交会迭代制导方法,其特征在于,所述方法包括:
获取初始时刻和交会目标轨道根数;根据所述初始时刻和所述交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数;
获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;所述状态矢量包括位置矢量和速度矢量;
设置初始时刻为当前脉冲时刻;
根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵;
根据所述追踪器位置矢量、所述追踪器速度矢量、所述目标器位置矢量、所述目标器速度矢量以及所述转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量;
根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将所述相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益;
根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据所述绝对速度增益,确定有限推力;根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;
对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止;
根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度;
根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
2.根据权利要求1所述的方法,其特征在于,轨道根数包括:轨道半长轴、轨道偏心率、轨道倾角、升交点赤经、近地点幅角以及指定历元的平近点角;
根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵,包括:
根据当前脉冲时刻目标器位置矢量和目标器速度矢量,得到经典轨道根数、偏近点角、真近点角以及纬度幅角;
根据轨道根数的轨道偏心率和平近点角,确定偏近点角;所述偏近点角的计算公式如下:
其中:E代表偏近点角;M代表平近点角,e代表轨道偏心率;
根据偏近点角和真近点角f之间的关系,得到真近点角,真近点角f与偏近点角E的关系式为:
其中:f代表真近点角;E代表偏近点角;e代表轨道偏心率;
将所述近地点幅角和所述真近点角求和,得到距升交点纬度幅角;
根据距升交点纬度幅角、轨道倾角以及升交点赤经,确定J2000坐标系到目标轨道坐标系的当前脉冲时刻转换矩阵;所述当前脉冲时刻转换矩阵的计算公式为:
A(tm)=AuAiAΩ
其中:u代表距升交点纬度幅角;i代表距升交点纬度幅角;Ω代表升交点赤经;AΩ,Ai,Au为旋转矩阵,分别为:
3.根据权利要求1所述的方法,其特征在于,根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将所述相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益,包括:
根据当前脉冲时刻相对位置矢量和下一脉冲时刻相对位置矢量,得到当前脉冲施加后的相对速度;所述当前脉冲施加后的相对速度的计算公式为:
根据当前脉冲施加前后的相对速度矢量,确定当前脉冲时刻速度增益矢量;根据下一脉冲施加前后的相对速度矢量,确定下一脉冲时刻的速度增益矢量;所述当前脉冲时刻速度增益矢量和所述下一脉冲时刻的速度增益矢量计算公式如下:
4.根据权利要求1所述的方法,其特征在于,根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据所述绝对速度增益,确定有限推力;根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影,包括:
根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角以及发动机工作时间;所述偏航角计算公式和俯仰角的计算公式为:
发动机工作时间计算公式为:
根据所述绝对速度增益,确定有限推力;
根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影的表达式为:
5.一种有限推理的多脉冲交会迭代导航制导装置,其特征在于,所述装置包括:
交会目标轨道参数获取模块:用于获取初始时刻和交会目标轨道根数;根据所述初始时刻和所述交会轨道根数采用标准转移轨道规划,得到多脉冲交会迭代制导的总时间和脉冲数;
初始状态参数获取模块:用于获取初始时刻J2000坐标系中追踪器状态矢量和目标器状态矢量;所述状态矢量包括位置矢量和速度矢量;
迭代制导参数设置模块:用于设置初始时刻为当前脉冲时刻;
迭代制导模:根据当前脉冲时刻的目标器位置矢量和目标器速度矢量,得到J2000坐标系到目标轨道坐标系当前脉冲时刻的转换矩阵;根据所述追踪器位置矢量、所述追踪器速度矢量、所述目标器位置矢量、所述目标器速度矢量以及所述转换矩阵,得到当前脉冲时刻相对位置矢量和相对速度矢量;根据标准轨道方程,得到下一脉冲时刻追踪器相对位置矢量;根据当前脉冲时刻相对位置矢量和相对速度矢量以及下一脉冲时刻追踪器相对位置矢量,采用双脉冲理论,得到当前脉冲施加前后相对速度和相对速度增益,将所述相对速度增益利用转换矩阵进行逆转换,得到绝对速度增益;根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角和发动机工作时间;根据所述绝对速度增益,确定有限推力;根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;对真空段J2000坐标系中目标器动力学方程和追踪器动力学方程在当前脉冲时刻与下一脉冲时刻之间进行积分,得到下一脉冲时刻目标器状态矢量以及追踪器的状态矢量;更新当前脉冲时刻,进行下一次迭代制导,直到下一脉冲为最后一个脉冲为止;
最后一个脉冲制导模块:用于根据推力加速度投影在发动机工作时间内进行积分,得到追踪器在J2000坐标系中的直角坐标位置和速度,经自由段,再在最后一个脉冲时刻,经数值积分可得追踪器和目标器的直角坐标速度和速度;
迭代制导误差确定模块,用于根据最后一个脉冲时刻追踪器的速度矢量和目标器的速度矢量,得到迭代制导速度误差。
6.根据权利要求5所述的装置,其特征在于,轨道根数包括:轨道半长轴、轨道偏心率、轨道倾角、升交点赤经、近地点幅角以及指定历元的平近点角;迭代制导模块还用于:
根据当前脉冲时刻目标器位置矢量和目标器速度矢量,得到经典轨道根数、偏近点角、真近点角以及纬度幅角;
根据轨道根数的轨道偏心率和平近点角,确定偏近点角;所述偏近点角的计算公式如下:
其中:E代表偏近点角;M代表平近点角,e代表轨道偏心率;
根据偏近点角和真近点角f之间的关系,得到真近点角,真近点角f与偏近点角E的关系式为:
其中:f代表真近点角;E代表偏近点角;e代表轨道偏心率;
将所述近地点幅角和所述真近点角求和,得到距升交点纬度幅角;
根据距升交点纬度幅角、轨道倾角以及升交点赤经,确定J2000坐标系到目标轨道坐标系的当前脉冲时刻转换矩阵;所述当前脉冲时刻转换矩阵的计算公式为:
A(tm)=AuAiAΩ
其中:u代表距升交点纬度幅角;i代表距升交点纬度幅角;Ω代表升交点赤经;AΩ,Ai,Au为旋转矩阵,分别为:
7.根据权利要求5所述的装置,其特征在于,迭代制导模块还用于:
根据当前脉冲时刻相对位置矢量和下一脉冲时刻相对位置矢量,得到当前脉冲施加后的相对速度;所述当前脉冲施加后的相对速度的计算公式为:
根据当前脉冲施加前后的相对速度矢量,确定当前脉冲时刻速度增益矢量;根据下一脉冲施加前后的相对速度矢量,确定下一脉冲时刻的速度增益矢量;所述当前脉冲时刻速度增益矢量和所述下一脉冲时刻的速度增益矢量计算公式如下:
8.根据权利要求5所述的装置,其特征在于,迭代制导模块还用于:
根据所述绝对速度增益、当前质量、变轨发动机设计参数,得到追踪器当前脉冲时刻的偏航角、俯仰角以及发动机工作时间;所述偏航角计算公式和俯仰角的计算公式为:
发动机工作时间计算公式为:
根据所述绝对速度增益,确定有限推力;
根据所述偏航角、所述俯仰角以及所述有限推力,得到当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影;当前脉冲时刻追踪器喷气推力在J2000坐标系中的推力加速度投影的表达式为:
9.一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至4中任一项所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至4中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110348007.2A CN113060306B (zh) | 2021-03-31 | 2021-03-31 | 有限推力的多脉冲交会迭代制导方法、装置及电子设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110348007.2A CN113060306B (zh) | 2021-03-31 | 2021-03-31 | 有限推力的多脉冲交会迭代制导方法、装置及电子设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113060306A true CN113060306A (zh) | 2021-07-02 |
CN113060306B CN113060306B (zh) | 2022-02-08 |
Family
ID=76564800
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110348007.2A Active CN113060306B (zh) | 2021-03-31 | 2021-03-31 | 有限推力的多脉冲交会迭代制导方法、装置及电子设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113060306B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116552817A (zh) * | 2023-07-12 | 2023-08-08 | 银河航天(北京)网络技术有限公司 | 优化卫星轨道控制的方法、设备和存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5222023A (en) * | 1991-04-02 | 1993-06-22 | Space Systems/Loral, Inc. | Compensated transition for spacecraft attitude control |
CN105930305A (zh) * | 2016-04-14 | 2016-09-07 | 清华大学深圳研究生院 | 一种三脉冲交会接近制导方法 |
CN107992682A (zh) * | 2017-12-05 | 2018-05-04 | 北京理工大学 | 一种行星际多体系统小行星探测最优多脉冲转移方法 |
CN110032768A (zh) * | 2019-03-15 | 2019-07-19 | 中国西安卫星测控中心 | 一种使用精确动力学模型的四脉冲轨道交会优化方法 |
CN110077626A (zh) * | 2019-03-14 | 2019-08-02 | 北京空间飞行器总体设计部 | 一种三脉冲地月L2点Halo轨道的捕获方法 |
US20190352021A1 (en) * | 2016-04-29 | 2019-11-21 | Quicklaunch, Inc. | Orbital mechanics of impulsive launch |
CN111090941A (zh) * | 2019-12-17 | 2020-05-01 | 哈尔滨工业大学 | 一种基于多目标优化算法的航天器最优Lambert轨道交会方法 |
CN111268176A (zh) * | 2020-01-17 | 2020-06-12 | 中国人民解放军国防科技大学 | 一种摄动轨道四脉冲交会快速优化方法 |
-
2021
- 2021-03-31 CN CN202110348007.2A patent/CN113060306B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5222023A (en) * | 1991-04-02 | 1993-06-22 | Space Systems/Loral, Inc. | Compensated transition for spacecraft attitude control |
CN105930305A (zh) * | 2016-04-14 | 2016-09-07 | 清华大学深圳研究生院 | 一种三脉冲交会接近制导方法 |
US20190352021A1 (en) * | 2016-04-29 | 2019-11-21 | Quicklaunch, Inc. | Orbital mechanics of impulsive launch |
CN107992682A (zh) * | 2017-12-05 | 2018-05-04 | 北京理工大学 | 一种行星际多体系统小行星探测最优多脉冲转移方法 |
CN110077626A (zh) * | 2019-03-14 | 2019-08-02 | 北京空间飞行器总体设计部 | 一种三脉冲地月L2点Halo轨道的捕获方法 |
CN110032768A (zh) * | 2019-03-15 | 2019-07-19 | 中国西安卫星测控中心 | 一种使用精确动力学模型的四脉冲轨道交会优化方法 |
CN111090941A (zh) * | 2019-12-17 | 2020-05-01 | 哈尔滨工业大学 | 一种基于多目标优化算法的航天器最优Lambert轨道交会方法 |
CN111268176A (zh) * | 2020-01-17 | 2020-06-12 | 中国人民解放军国防科技大学 | 一种摄动轨道四脉冲交会快速优化方法 |
Non-Patent Citations (4)
Title |
---|
刘源等: "多脉冲异面交会对接转移轨道的优化", 《光学精密工程》 * |
刘胜等: "基于C-W方程的近程导引制导与控制方法", 《上海航天》 * |
尤岳等: "考虑轨控调姿的共面椭圆轨道寻的交会", 《南京航空航天大学学报》 * |
李晨光等: "多脉冲C-W交会的优化方法", 《宇航学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116552817A (zh) * | 2023-07-12 | 2023-08-08 | 银河航天(北京)网络技术有限公司 | 优化卫星轨道控制的方法、设备和存储介质 |
CN116552817B (zh) * | 2023-07-12 | 2023-09-08 | 银河航天(北京)网络技术有限公司 | 优化卫星轨道控制的方法、设备和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN113060306B (zh) | 2022-02-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Olds et al. | IRVE-3 post-flight reconstruction | |
CN104007665A (zh) | 一种固液动力飞行器飞行仿真测试系统 | |
CN105573337B (zh) | 一种满足再入角和航程约束的离轨制动闭路制导方法 | |
Wolf et al. | Systems for pinpoint landing at Mars | |
Wolf et al. | Performance trades for Mars pinpoint landing | |
CN114280934B (zh) | 一种可重复使用运载火箭全程轨迹规划方法 | |
Lugo et al. | Overview of a generalized numerical predictor-corrector targeting guidance with application to human-scale mars entry, descent, and landing | |
CN113525721B (zh) | 卫星轨道变换方法、装置、电子设备及存储介质 | |
Wolf et al. | Toward improved landing precision on Mars | |
CN113602532A (zh) | 一种固体运载火箭入轨修正方法 | |
CN113060306B (zh) | 有限推力的多脉冲交会迭代制导方法、装置及电子设备 | |
CN113093776A (zh) | 一种航天器的离轨参数确定方法及装置 | |
CN115392540A (zh) | 一种用于月球轨道交会制导的快速预报方法 | |
Lee et al. | Optimal Trajectory Generation for Mars Atmospheric Entry Guidance using Parameter Optimization | |
Yu et al. | Approximate analytical solutions for launch-vehicle ascent trajectory | |
CN114935277A (zh) | 一种滑翔增程制导炮弹理想弹道的在线规划方法 | |
CN114186378A (zh) | 一种航天器的变轨控制方法、装置、电子设备和存储介质 | |
Pontani et al. | Variable-time-domain neighboring optimal guidance and attitude control for low-thrust orbit transfers | |
Saranathan | Algorithmic Advances to Increase the Fidelity of Conceptual Hypersonic Mission Design | |
Sagliano | Apollo 11 reloaded: Optimization-based trajectory reconstruction | |
Mease et al. | Advanced hypersonic entry guidance for mars pinpoint landing | |
Hormigo et al. | Nonlinear dynamic inversion-based guidance and control for a pinpoint mars entry | |
McRonald et al. | From LEO to the Planets using Waveriders | |
Zhang et al. | An Integrated Trajectory Guidance and Attitude Control Law with Enhanced Anti-Disturbance Capability for Mars Pinpoint Landing | |
Teren | Explicit guidance equations for multistage boost trajectories |
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 |