CN110989644B - 一种考虑目标点多终端约束的飞行器轨迹规划方法 - Google Patents

一种考虑目标点多终端约束的飞行器轨迹规划方法 Download PDF

Info

Publication number
CN110989644B
CN110989644B CN201911205204.8A CN201911205204A CN110989644B CN 110989644 B CN110989644 B CN 110989644B CN 201911205204 A CN201911205204 A CN 201911205204A CN 110989644 B CN110989644 B CN 110989644B
Authority
CN
China
Prior art keywords
track
terminal
constraint
landing
trajectory planning
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
CN201911205204.8A
Other languages
English (en)
Other versions
CN110989644A (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.)
Harbin Institute of Technology
Shanghai Aerospace System Engineering Institute
Original Assignee
Harbin Institute of Technology
Shanghai Aerospace System Engineering 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 Harbin Institute of Technology, Shanghai Aerospace System Engineering Institute filed Critical Harbin Institute of Technology
Priority to CN201911205204.8A priority Critical patent/CN110989644B/zh
Publication of CN110989644A publication Critical patent/CN110989644A/zh
Application granted granted Critical
Publication of CN110989644B publication Critical patent/CN110989644B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明记载一种考虑目标点多终端约束的飞行器轨迹规划方法,属于飞行器轨迹优化与制导技术领域,具体技术方案如下:一种考虑目标点多终端约束的飞行器轨迹规划方法,包括以下步骤:步骤一:建立垂直起降重复使用运载器返回段轨迹优化模型;步骤二、建立终端约束模型;步骤三:对轨迹优化问题进行凸化处理;步骤四:应用原始对偶内点法对凸优化问题进行求解。本发明可应用于垂直起降飞行器返回段在线轨迹规划中,对于未来的垂直起降重复使用运载器返回着陆制导方法具有借鉴和参考价值。

Description

一种考虑目标点多终端约束的飞行器轨迹规划方法
技术领域
本发明属于飞行器轨迹优化与制导技术领域,具体涉及一种考虑目标点多终端约束的飞行器轨迹规划方法。
背景技术
垂直起降飞行器能够有效降低航天运载任务成本,引起了航天学者的广泛关注。近年来,美国太空探索技术公司的猎鹰9火箭多次发射与子级回收成功,子级返回技术成为了重点研究项目。为了保证子级的精确返回回收,首先应保证其返回段再入大气的精度。传统航天器制导方法一般只针对落点位置进行约束,导致速度偏差大,无法再入回收。且传统的针对入轨问题的终端约束复杂,很难实现在线快速计算。本发明针对上述问题,提出了考虑再入点约束的垂直起降重复使用运载器返回段轨迹规划方法,在简化的终端约束模型基础上,应用凸优化算法进行轨迹在线规划,同时尽量减少返回过程中的燃料消耗以提高火箭运载能力。
发明内容
本发明为了解决传统的轨迹规划与制导无法满足返回段再入落点位置与速度高精度需求的技术问题,在基于凸优化的在线轨迹规划方法框架下,解决垂直起降重复使用运载器高精度再入返回问题,提出了一种考虑目标点多终端约束的飞行器轨迹规划方法。所采取的技术方案如下:
一种考虑目标点多终端约束的飞行器轨迹规划方法,包括以下步骤:
步骤一:建立垂直起降重复使用运载器返回段轨迹优化模型;
步骤二、建立终端约束模型;
步骤三:对轨迹优化问题进行凸化处理;
步骤四:应用原始对偶内点法对凸优化问题进行求解。
进一步的,所述步骤一中,建立垂直起降重复使用运载器返回段轨迹优化模型的具体过程如下:针对垂直起降重复使用运载器返回段轨迹规划问题,为了节省燃料,在燃料秒耗量固定条件下,建立以时间最优为性能指标的轨迹优化模型,所述轨迹优化模型为:
min J=tf (1)
Figure BDA0002296789150000011
Figure BDA0002296789150000012
Figure BDA0002296789150000013
ψ(rf,Vf)=0 (5)
||u||=T (6)
其中,V为速度,r为位置,ψ为终端约束,m为质量,u为火箭发动机推力矢量,g为地球引力,T为发动机总推力,Isp为发动机比冲,g0为海平面重力加速度,J为性能指标函数,t为发动机工作时间,下标f表示终端参数值,
Figure BDA0002296789150000021
为位置的微分量,
Figure BDA0002296789150000022
为速度的微分量,
Figure BDA0002296789150000023
为质量的微分量。
进一步的,步骤二中,首先,给出近焦点坐标系定义:坐标原点为地心,X方向为轨道近地点方向,Y方向在轨道平面内,为近地点处速度方向,Z方向与X、Y方向构成右手坐标系;在该坐标系下,根据子级关机位置[rfx,rfy,rfz]与速度[Vfx,Vfy,Vfz],基于椭圆轨道动力学和解析几何原理建立终端约束模型如下:
①为保证轨道平面精度,有
rfz=0 (7)
Vfz=0 (8)
②为保证子级进入预定轨道,需保证关机点位于椭圆轨道上,根据椭圆方程,有:
Figure BDA0002296789150000024
式中,a为轨道半长轴,b为轨道半短轴,c2=a2-b2
③同时,还需满足速度约束和动量矩约束
Figure BDA0002296789150000025
rfxVfy-rfyVfx-h=0 (11)
h为标准角动量,e为轨道偏心率。
进一步的,步骤三中,对轨迹优化问题进行凸化处理,首先,将动力学模型进行离散处理,
Figure BDA0002296789150000026
其中,D为flip-Radau微分矩阵,f(x,u)为微分方程的右端函数,τi,(i=1,...,N)为(-1,1]区间内的配点,N为配点数量,τ0为在-1处的离散点,x为状态变量,包括位置和速度,u为控制量,即推力方向,下标0表示初始参数值。
进一步的,方程(12)可进一步凸化处理:
Figure BDA0002296789150000031
式中,
Figure BDA0002296789150000032
Figure BDA0002296789150000033
为线性化系统矩阵,根据动力学方程求得,k为迭代次数,Δt为时间更新量;
同时,推力约束可凸化为:
||u||≤T。 (14)
本发明有益效果:
本发明提出的一种考虑目标点多终端约束的飞行器轨迹规划方法,首先针对垂直起降重复使用运载器返回段轨迹规划问题,建立了相应的轨迹优化模型。随后,在近焦点坐标系建立了简化的终端约束模型,为轨迹优化问题快速精确求解奠定基础。最后对轨迹规划问题进行凸化处理,并应用原始对偶内点算法进行求解。该方法可应用于垂直起降飞行器返回段在线轨迹规划中,对于未来的垂直起降重复使用运载器返回着陆制导方法具有借鉴和参考价值。
附图说明
图1是近焦点坐标系示意图;
图2是终端轨道平面示意图。
具体实施方式
下面结合附图1和2及具体实施例对本发明做进一步说明,但本发明不受实施例的限制。
实施例1:
一种考虑目标点多终端约束的飞行器轨迹规划方法,即考虑再入点约束的垂直起降重复使用运载器返回段轨迹规划方法,包括以下步骤:
步骤一:建立垂直起降重复使用运载器返回段轨迹优化模型;
步骤二、建立终端约束模型;
步骤三:对轨迹优化问题进行凸化处理;
步骤四:应用原始对偶内点法对凸优化问题进行求解。
进一步地,步骤一,建立垂直起降重复使用运载器返回段轨迹优化模型的具体过程如下:针对垂直起降重复使用运载器返回段轨迹规划问题,为了节省燃料,在燃料秒耗量固定条件下,建立以时间最优为性能指标的轨迹优化模型,所述轨迹优化模型为:
min J=tf (1)
Figure BDA0002296789150000041
Figure BDA0002296789150000042
Figure BDA0002296789150000043
ψ(rf,Vf)=0 (5)
||u||=T (6)
其中,V为速度,r为位置,ψ为终端约束,m为质量,u为火箭发动机推力矢量,g为地球引力,T为发动机总推力,Isp为发动机比冲,g0为海平面重力加速度,J为性能指标函数,t为发动机工作时间,下标f表示终端参数值,
Figure BDA0002296789150000044
为位置的微分量,
Figure BDA0002296789150000045
为速度的微分量,
Figure BDA0002296789150000046
为质量的微分量。
进一步地,步骤二所述建立终端约束模型过程中,为了保证返回精度,需要同时考虑子级返回再入位置以及速度约束,该约束可等价转换为入轨约束,即子级发动机工作结束时,进入标准关机点所在惯性椭圆轨道,即可保证返回再入位置以及速度精度。根据轨道动力学原理,关机点需要满足五个轨道根数约束,包括:半长轴、偏心率、轨道倾角、升交点赤经和近心点角距。然而,轨道根数的表达形式非常复杂,在轨迹规划的过程中,严重影响算法精度和收敛性。本发明研究一种基于近焦点坐标系的终端约束模型建立方法。首先,给出近交点坐标系定义:坐标原点为地心,X方向为轨道近地点方向,Y方向在轨道平面内,为近地点处速度方向,Z方向与X、Y方向构成右手坐标系。如图1所示:
在该坐标系下,可根据子级关机位置[rfx,rfy,rfz]与速度[Vfx,Vfy,Vfz],基于椭圆轨道动力学和解析几何原理建立终端约束模型如下:
①为保证轨道平面精度,有
rfz=0 (7)
Vfz=0 (8)
②为保证子级进入预定轨道,需保证关机点位于椭圆轨道上,根据椭圆方程,有:
Figure BDA0002296789150000047
式中,a为轨道半长轴,b为轨道半短轴,c2=a2-b2
③同时,还需满足速度约束和动量矩约束
Figure BDA0002296789150000051
rfxVfy-rfyVfx-h=0 (11)
h为标准角动量,e为轨道偏心率。
进一步的,对轨迹优化问题进行凸化处理,首先,将动力学模型进行离散处理。
Figure BDA0002296789150000052
其中,D为flip-Radau微分矩阵,f(x,u)为微分方程的右端函数,τi,(i=1,...,N)为(-1,1]区间内的配点,N为配点数量,τ0为在-1处的离散点,x为状态变量,包括位置和速度,u为控制量,即推力方向,下标0表示初始参数值。
方程(12)可进一步凸化处理:
Figure BDA0002296789150000053
式中,
Figure BDA0002296789150000054
Figure BDA0002296789150000055
为线性化系统矩阵,根据动力学方程求得,式中,k为迭代次数,Δt为时间更新量。
同时,推力约束可凸化为:
||u||≤T (14)
进一步的,应用原始对偶内点法对凸优化问题进行求解,即应用原始对偶内点法对凸化后的轨迹规划问题进行迭代求解。该方法为现有技术,本发明不再赘述。
虽然本发明已以较佳的实施例公开如上,但其并非用以限定本发明,任何熟悉此技术的人,在不脱离本发明的精神和范围内,都可以做各种改动和修饰,因此本发明的保护范围应该以权利要求书所界定的为准。

Claims (1)

1.一种考虑目标点多终端约束的飞行器轨迹规划方法,其特征在于,包括以下步骤:
步骤一:建立垂直起降重复使用运载器返回段轨迹优化模型;具体过程如下:针对垂直起降重复使用运载器返回段轨迹规划问题,为了节省燃料,在燃料秒耗量固定条件下,建立以时间最优为性能指标的轨迹优化模型,所述轨迹优化模型为:
min J=tf (1)
Figure FDA0002967739300000011
Figure FDA0002967739300000012
Figure FDA0002967739300000013
ψ(rf,Vf)=0 (5)
||u||=T (6)
其中,V为速度,r为位置,ψ为终端约束,m为质量,u为火箭发动机推力矢量,g为地球引力,T为发动机总推力,Isp为发动机比冲,g0为海平面重力加速度,J为性能指标函数,t为发动机工作时间,下标f表示终端参数值,
Figure FDA0002967739300000014
为位置的微分量,
Figure FDA0002967739300000017
为速度的微分量,
Figure FDA0002967739300000015
为质量的微分量;
步骤二、建立终端约束模型;首先,给出近焦点坐标系定义:坐标原点为地心,X方向为轨道近地点方向,Y方向在轨道平面内,为近地点处速度方向,Z方向与X、Y方向构成右手坐标系;在该坐标系下,根据子级关机位置[rfx,rfy,rfz]与速度[Vfx,Vfy,Vfz],基于椭圆轨道动力学和解析几何原理建立终端约束模型如下:
①为保证轨道平面精度,有
rfz=0 (7)
Vfz=0 (8)
②为保证子级进入预定轨道,需保证关机点位于椭圆轨道上,根据椭圆方程,有:
Figure FDA0002967739300000016
式中,a为轨道半长轴,b为轨道半短轴,c2=a2-b2
③同时,还需满足速度约束和动量矩约束
Figure FDA0002967739300000021
rfxVfy-rfyVfx-h=0 (11)
h为标准角动量,e为轨道偏心率;
步骤三:对轨迹优化问题进行凸化处理;首先,将动力学模型进行离散处理,
Figure FDA0002967739300000022
其中,D为flip-Radau微分矩阵,f(x,u)为微分方程的右端函数,τi,(i=1,...,N)为(-1,1]区间内的配点,N为配点数量,τ0为在-1处的离散点,x为状态变量,包括位置和速度,u为控制量,即推力方向,下标0表示初始参数值;
方程(12)可进一步凸化处理:
Figure FDA0002967739300000023
式中,
Figure FDA0002967739300000024
Figure FDA0002967739300000025
为线性化系统矩阵,根据动力学方程求得,k为迭代次数,Δt为时间更新量;
同时,推力约束可凸化为:
||u||≤T;
步骤四:应用原始对偶内点法对凸优化问题进行求解。
CN201911205204.8A 2019-11-29 2019-11-29 一种考虑目标点多终端约束的飞行器轨迹规划方法 Active CN110989644B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911205204.8A CN110989644B (zh) 2019-11-29 2019-11-29 一种考虑目标点多终端约束的飞行器轨迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911205204.8A CN110989644B (zh) 2019-11-29 2019-11-29 一种考虑目标点多终端约束的飞行器轨迹规划方法

Publications (2)

Publication Number Publication Date
CN110989644A CN110989644A (zh) 2020-04-10
CN110989644B true CN110989644B (zh) 2021-04-23

Family

ID=70088599

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911205204.8A Active CN110989644B (zh) 2019-11-29 2019-11-29 一种考虑目标点多终端约束的飞行器轨迹规划方法

Country Status (1)

Country Link
CN (1) CN110989644B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112208796B (zh) * 2020-09-09 2021-11-02 北京航空航天大学 一种重力场混合线性化方法
CN112287560B (zh) * 2020-11-12 2023-07-04 北京航天自动控制研究所 一种用于火箭在线轨迹规划的求解器设计方法
CN112947573B (zh) * 2021-03-12 2022-02-15 北京理工大学 终端时间约束下的高超声速飞行器再入制导方法
CN113483758B (zh) * 2021-06-21 2023-10-20 北京理工大学 多约束行星着陆轨迹矢量规划方法
CN113483764B (zh) * 2021-07-07 2022-09-02 哈尔滨工业大学 一种基于在线传感的智能飞行器任务路径规划方法
CN114995126A (zh) * 2022-05-07 2022-09-02 北京控制工程研究所 一种最优月面盘旋飞跃轨迹生成方法
CN115202380B (zh) * 2022-07-06 2023-07-07 北京理工大学 基于分段多项式的地外天体着陆轨迹规划方法
CN115421388B (zh) * 2022-09-23 2023-05-12 南京理工大学 一种基于凸优化的远程导弹末级多姿态约束在线轨迹规划方法
CN117826616B (zh) * 2024-03-04 2024-05-10 西北工业大学 一种基于序列凸优化的飞行器快速轨迹规划方法及装置

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103995540A (zh) * 2014-05-22 2014-08-20 哈尔滨工业大学 一种高超声速飞行器的有限时间轨迹快速生成方法
CN104035335A (zh) * 2014-05-27 2014-09-10 北京航空航天大学 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律
CN106020231A (zh) * 2016-05-30 2016-10-12 中国人民解放军国防科学技术大学 基于再入点参数的高超声速飞行器再入轨迹优化方法
CN109470252A (zh) * 2018-10-23 2019-03-15 哈尔滨工业大学 一种基于凸优化的垂直起降重复使用运载器快速轨迹优化方法
EP3506041A1 (en) * 2017-12-29 2019-07-03 Deutsches Zentrum für Luft- und Raumfahrt e.V. Method, apparatus and spacecraft for constrained atmospheric entry
CN109974538A (zh) * 2019-03-25 2019-07-05 哈尔滨工业大学 一种垂直起降可重复使用运载器多终端约束上升段制导方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8332085B2 (en) * 2010-08-30 2012-12-11 King Fahd University Of Petroleum And Minerals Particle swarm-based micro air launch vehicle trajectory optimization method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103995540A (zh) * 2014-05-22 2014-08-20 哈尔滨工业大学 一种高超声速飞行器的有限时间轨迹快速生成方法
CN104035335A (zh) * 2014-05-27 2014-09-10 北京航空航天大学 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律
CN106020231A (zh) * 2016-05-30 2016-10-12 中国人民解放军国防科学技术大学 基于再入点参数的高超声速飞行器再入轨迹优化方法
EP3506041A1 (en) * 2017-12-29 2019-07-03 Deutsches Zentrum für Luft- und Raumfahrt e.V. Method, apparatus and spacecraft for constrained atmospheric entry
CN109470252A (zh) * 2018-10-23 2019-03-15 哈尔滨工业大学 一种基于凸优化的垂直起降重复使用运载器快速轨迹优化方法
CN109974538A (zh) * 2019-03-25 2019-07-05 哈尔滨工业大学 一种垂直起降可重复使用运载器多终端约束上升段制导方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Advanced Modeling and Trajectory Optimization Framework for Reusable Launch Vehicles;Briese, Lale Evrim,等;《IEEE Aerospace Conference》;20181231;第1-18页 *
Geometry and time updaters-based arbitrary-yaw iterative explicit guidance for fixed-thrust boost back of vertical take-off/vertical landing reusable launch vehicles;Changzhu Wei,等;《Aerospace Science and Technology》;20191004;第95卷;第1-18页 *
RLV再入轨迹机载快速优化;王明光,等;《宇航学报》;20050531;第26卷(第3期);第253-256页 *
垂直起降重复使用运载器返回制导与控制;韦常柱,等;《航空学报》;20190725;第40卷(第7期);第1-24页 *
火箭返回着陆问题高精度快速轨迹优化算法;王劲博,等;《控制理论与应用》;20180331;第35卷(第3期);第389-398页 *

Also Published As

Publication number Publication date
CN110989644A (zh) 2020-04-10

Similar Documents

Publication Publication Date Title
CN110989644B (zh) 一种考虑目标点多终端约束的飞行器轨迹规划方法
CN106697333B (zh) 一种航天器轨道控制策略的鲁棒性分析方法
CN112249369B (zh) 一种火箭动力定点着陆制导方法
CN111444603B (zh) 一种返回式航天器时间最短离轨轨迹快速规划方法
CN106444430B (zh) 运载火箭一子级再入控制系统及方法、仿真系统及方法
CN109911249B (zh) 低推重比飞行器的星际转移有限推力入轨迭代制导方法
CN103995540A (zh) 一种高超声速飞行器的有限时间轨迹快速生成方法
CN112550770B (zh) 一种基于凸优化的火箭软着陆轨迹规划方法
CN104309822B (zh) 一种基于参数优化的航天器单脉冲水滴形绕飞轨迹悬停控制方法
CN113343442B (zh) 一种求解固定时间有限燃料多脉冲转移轨道的方法及系统
CN112395689B (zh) 基于凸优化的火箭故障后在线重构方法
Sun et al. Roto-translational spacecraft formation control using aerodynamic forces
CN102819266A (zh) 一种拟周期j2不变相对轨道编队飞行控制方法
CN113867143A (zh) 地外天体安全软着陆解析避障制导方法
CN113569391B (zh) 地月转移轨道的参数确定方法、装置、设备及介质
CN108536009B (zh) 一种混合小推力航天器的轨道保持和扰动抑制方法
CN113343561A (zh) 一种求解最优月球飞掠转移轨道的方法及系统
Calhoun et al. Entry vehicle control system design for the mars science laboratory
CN114265420B (zh) 适于高动态、控制慢响应的制导控制一体化设计方法
CN114690793B (zh) 基于滑模控制的可重复使用运载火箭垂直软着陆制导方法
CN116203840A (zh) 可重复使用运载器自适应增益调度控制方法
CN112389679B (zh) 一种考虑多种摄动力的小卫星常值推力轨道递推方法
De Oliveira et al. Reusable launchers re-entry controlled dynamics simulator
Belokon et al. Control of hybrid unmanned aerial vehicle motion in transitional modes
Meng et al. Coordinated approach control method of tethered space robot 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