CN107765554B - 一种基于自适应控制节点的月球探测器软着陆最优控制系统 - Google Patents

一种基于自适应控制节点的月球探测器软着陆最优控制系统 Download PDF

Info

Publication number
CN107765554B
CN107765554B CN201711115234.0A CN201711115234A CN107765554B CN 107765554 B CN107765554 B CN 107765554B CN 201711115234 A CN201711115234 A CN 201711115234A CN 107765554 B CN107765554 B CN 107765554B
Authority
CN
China
Prior art keywords
control
fuel consumption
module
soft landing
lunar
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.)
Expired - Fee Related
Application number
CN201711115234.0A
Other languages
English (en)
Other versions
CN107765554A (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.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
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 Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201711115234.0A priority Critical patent/CN107765554B/zh
Publication of CN107765554A publication Critical patent/CN107765554A/zh
Application granted granted Critical
Publication of CN107765554B publication Critical patent/CN107765554B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Magnetic Resonance Imaging Apparatus (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种基于自适应控制节点的月球探测器软着陆最优控制系统,该系统由速度传感器、距离探测器、MCU、燃料消耗系统、软着陆状态显示构成。月球探测器准备软着陆时,速度传感器、距离探测器测量当前该探测器的下降速度、与月球表面之间的距离,并将测量数据传送给MCU,MCU立即执行自适应控制节点最优控制方法,计算出使月球探测器安全着陆并且最少消耗燃料的燃料消耗速率控制策略,将其转换为运行指令传送给燃料消耗系统,并实时显示当前软着陆状态。本发明能够保证月球探测器安全软着陆并且最大程度地减少燃料的消耗。

Description

一种基于自适应控制节点的月球探测器软着陆最优控制系统
技术领域
本发明涉及月球软着陆控制领域,主要是一种基于自适应控制节点的月球探测器软着陆最优控制系统。在月球探测器将要着陆时,该系统能够计算出最优的软着陆策略,以保证探测器安全着陆并且最大程度地减少燃料的消耗。
背景技术
二十世纪五十年代末至今,美国、前苏联/俄罗斯、日本、欧洲航天局、中国和印度先后进行了月球探测,九十年代以来兴起了新一轮的热潮。其中,月球探测器软着陆是一种非常重要的技术手段。软着陆就是在落地之前通过一定的手段减小垂直速度,使之以一个可以接受的速度落地,以保护飞行器和航天员。由于月球上没有空气,类似于真空,用降落伞是不可能的,而气垫不好控制力度,目前的技术是靠月球探测器自身的反作用力实现软着陆。现今,国内外众多专家学者都对此展开了深入研究。
发明内容
为了使月球探测器安全着陆并且最大程度地减少燃料的消耗,本发明提供了一种基于自适应控制节点的月球探测器软着陆最优控制系统,该系统借助MCU作为最优控制方法的实现载体。
本发明的目的是通过以下技术方案来实现的:一种基于自适应控制节点的月球探测器软着陆最优控制系统,能够计算出最优的软着陆策略,以保证探测器安全着陆并且最大程度地减少燃料的消耗。其特征在于:由速度传感器、距离探测器、MCU、燃料消耗系统、软着陆状态显示构成。所述系统的运行过程包括:
步骤A1:月球探测器准备软着陆时开启速度传感器以及距离探测器,用于实时测量当前该探测器的下降速度以及与月球表面之间的距离,并将测量数据传送给MCU;
步骤A2:MCU执行内部的自适应控制节点最优控制方法,计算出使月球探测器安全着陆并且最少消耗燃料的燃料消耗速率控制策略;
步骤A3:MCU将得到的燃料消耗速率控制策略转换为燃料消耗系统运行指令,传送给燃料消耗系统,并实时显示当前软着陆状态。
所述的MCU,包括信息采集模块、初始化模块、结束时间处理模块、控制向量参数化模块、非线性规划(Nonlinear Programming,NLP)问题求解模块、终止条件判断模块、自适应控制节点分配模块、控制指令输出模块。
月球探测器的软着陆过程可以描述为:
Figure BDA0001466175420000021
其中t表示时间,t0表示软着陆过程开始时间,tf表示软着陆过程结束时间,且tf不固定;
Figure BDA0001466175420000022
被称为状态变量,表示月球探测器的速度、加速度、质量、与月球表面之间的距离等物理参数,x0是其初始值,
Figure BDA0001466175420000023
是其一阶导数;u(t)表示月球探测器的燃料消耗速率,ul、uu分别为其下限值和上限值;
Figure BDA0001466175420000024
是根据能量守恒以及力学原理建立的微分方程组;
Figure BDA0001466175420000025
是对月球探测器软着陆结束时刻的物理参数建立的约束条件。nx,ng分别是状态变量和约束的数量。
假设以Φ[x(tf)]表示燃料的总消耗量,则使燃料消耗最少的数学模型可表示为:
Figure BDA0001466175420000026
其中J[u(t)]表示控制目标,由燃料消耗速率u(t)决定。该问题本质上是一个最优控制问题。
本发明解决该问题所采用的技术方案是:在MCU中集成了自适应控制节点最优控制方法,并以此为基础构建了一套最优控制系统。所述控制系统的结构包括速度传感器、距离探测器、MCU、燃料消耗系统、软着陆状态显示。所述系统的各组成部分均由月球探测器内数据总线统一连接。
所述系统的运行过程如下:
步骤C1:月球探测器准备软着陆时开启速度传感器以及距离探测器,用于实时测量当前该探测器的下降速度以及与月球表面之间的距离,并将测量数据传送给MCU;
步骤C2:MCU执行内部的自适应控制节点最优控制方法,计算出使月球探测器安全着陆并且最少消耗燃料的燃料消耗速率控制策略;
步骤C3:MCU将得到的燃料消耗速率控制策略转换为燃料消耗系统运行指令,传送给燃料消耗系统,并实时显示当前软着陆状态。
集成了自适应控制节点最优控制方法的MCU是本发明的核心,其内部包括信息采集模块、初始化模块、结束时间处理模块、控制向量参数化模块、非线性规划(NonlinearProgramming,NLP)问题求解模块、终止条件判断模块、自适应控制节点分配模块、控制指令输出模块。
信息采集模块包括当前下降速度采集、与月球表面之间的距离采集两个子模块。
结束时间处理模块引入新的时间变量υ,使得
t=(tf-t0)υ+t0 (3)
从而将结束时间tf不固定的数学模型(2)转换为控制时域为[0,1]的数学模型,如下所示:
Figure BDA0001466175420000031
其中,
控制向量参数化模块采用分段常量策略来实现燃料消耗速率控制,具体如下:
假设整个控制时域[0,1]被划分为p(p>0)个控制子区间[υk-1k)(k=1,2,...,p),并且
0<υ1<…<υp-1<υp=1 (6)
这样,
Figure BDA0001466175420000033
可表示为:
Figure BDA0001466175420000034
其中,
Figure BDA0001466175420000035
为常数,表示
Figure BDA0001466175420000036
在控制子区间[υk-1k)内的参数值,χk(υ)为单位开关函数,其定义如下:
从而,燃料消耗速率控制参数可由向量
Figure BDA0001466175420000038
表示。
NLP问题求解模块包括序列二次规划(Sequential Quadratic Programming,SQP)求解、联立微分方程组求解两个子模块。联立微分方程组包括方程组(9)
Figure BDA0001466175420000041
和方程组(10)
Figure BDA0001466175420000042
其中,
Figure BDA0001466175420000043
Figure BDA0001466175420000044
利用四阶Runge-Kutta算法求解联立微分方程组(9)、(10),可以得到数学模型(4)的目标函数值
Figure BDA0001466175420000045
以及目标函数对控制参数向量的一阶梯度信息:
Figure BDA0001466175420000046
同样,可以得到数学模型(4)中的约束函数值
Figure BDA0001466175420000047
以及约束函数对控制参数向量的一阶梯度信息:
自适应控制节点分配模块提供了一种自适应分配控制节点的策略,具体如下:
假设经过第l次迭代,得到的目标函数最优值为J*l,最优控制参数为
Figure BDA00014661754200000410
相应的控制网格为
Figure BDA00014661754200000411
通过将Δl中的每个控制子区间进行二等分,得到控制网格
Figure BDA00014661754200000412
及初始控制参数
Figure BDA00014661754200000413
对于
Figure BDA00014661754200000414
中当前取值为的各个参数
Figure BDA00014661754200000416
为了评估其对目标函数J下降量的影响,定义相对于J的灵敏度为:
Figure BDA00014661754200000418
其中,
Figure BDA00014661754200000419
表示不超过(j+1)/2的最大整数。
假设在控制区间
Figure BDA00014661754200000420
内,
Figure BDA00014661754200000421
分别为第l-1次和第l次所获得的最优控制参数值。如果以下条件满足:
Figure BDA0001466175420000051
其中,εuv>0为给定阈值,则令
s2k-1=0且s2k=0 (17)
对于Δl'中的控制节点
Figure BDA0001466175420000052
如果在下一次迭代中将其保留,需满足:
Figure BDA0001466175420000053
Figure BDA0001466175420000054
其中,rsu>0为给定系数,
Figure BDA0001466175420000055
为平均灵敏度,其定义如下:
Figure BDA0001466175420000056
如果式(18)不满足,则将该控制节点消除。
当控制节点
Figure BDA0001466175420000057
Figure BDA0001466175420000058
都被消除时,如果以下条件满足
Figure BDA00014661754200000510
其中,给定系数rsl∈(0,rsu]、εuh>0,则控制节点也应该被消除。
经过以上控制网格二等分以及控制节点消除等步骤,控制网格Δl'可作为下一次迭代的控制网格Δl+1
所述MCU产生燃料消耗系统运行指令的过程如下:
步骤D1:信息采集模块获取月球探测器当前下降速度以及与月球表面之间的距离;
步骤D2:初始化模块运行,设置初始控制网格数目p、燃料消耗速率控制策略的初始猜测值
Figure BDA00014661754200000512
设定常数值εuv>0、εuh>0、rsu>0、rsl∈(0,rsu],设置最大迭代次数lmax≥1以及终止误差tolJ>0,并令迭代计数l=0;
步骤D3:结束时间处理模块将数学模型(2)转换为数学模型(4);
步骤D4:控制向量参数化模块采用分段常量策略来表示燃料消耗速率控制曲线,如果l=0,则将控制时域等分为p段而得到当前控制网格,并令所有控制参数值为
Figure BDA00014661754200000513
否则,采用Δl作为当前控制网格,每个控制子区间内的参数值为对应控制时域内
Figure BDA00014661754200000514
的值;
步骤D5:NLP问题求解模块中的SQP求解模块运行,并且通过联立微分方程组求解模块获取目标函数值、目标函数对控制参数向量的一阶梯度信息、约束函数值、约束函数对控制参数向量的一阶梯度信息,最终得到当前控制网格下的目标函数最优值J*l以及相应的最优控制参数
Figure BDA00014661754200000515
步骤D6:终止条件判断模块运行,对于l>0,如果l=lmax
Figure BDA0001466175420000061
则执行步骤D8,否则,执行步骤D7;
步骤D7:自适应控制节点分配模块运行,获得新的控制网格Δl+1,令迭代计数l=l+1,并转到步骤D4;
步骤D8:控制指令输出模块将当前控制时域按(3)转换到实际控制时域,并将获得的最优燃料消耗速率控制策略输出。
控制指令输出模块将当前控制时域按转换到实际控制时域,并将获得的最优燃料消耗速率控制策略输出。
本发明的有益效果主要表现在:基于自适应控制节点的月球探测器软着陆最优控制系统,能够计算出探测器最优的软着陆策略,可以适应问题的最优控制曲线,特别是找到问题的不连续点,能够获得较高的精度;采用自适应策略之后,下一次最优控制曲线的初始估计值是当前迭代的最优曲线,由此可以获得较快的收敛速度,减少探测器最优的软着陆策略的计算时间。本发明在保证月球探测器安全软着陆的情况下,并且能够最大程度地减少燃料的消耗。保证月球探测器安全软着陆并且最大程度地减少燃料的消耗。
附图说明
图1是本发明的功能示意图;
图2是本发明的结构示意图;
图3是本发明MCU内部模块结构图;
图4是对实施实例1获得的燃料消耗速率控制策略图;
图5是图4中燃料消耗速率控制策略所对应的各状态变量变化图
具体实施方式
如图1所示,月球探测器的软着陆过程可以描述为:
其中t表示时间,t0表示软着陆过程开始时间,tf表示软着陆过程结束时间,且tf不固定;被称为状态变量,表示月球探测器的速度、加速度、质量、与月球表面之间的距离等物理参数,x0是其初始值,是其一阶导数;u(t)表示月球探测器的燃料消耗速率,ul、uu分别为其下限值和上限值;是根据能量守恒以及力学原理建立的微分方程组;
Figure BDA0001466175420000072
是对月球探测器软着陆结束时刻的物理参数建立的约束条件。nx,ng分别是状态变量和约束的数量。
假设以Φ[x(tf)]表示燃料的总消耗量,则使燃料消耗最少的数学模型可表示为:
Figure BDA0001466175420000073
其中J[u(t)]表示控制目标,由燃料消耗速率u(t)决定。该问题本质上是一个最优控制问题。
本发明解决该问题所采用的技术方案是:在MCU中集成了自适应控制节点最优控制方法,并以此为基础构建了一套最优控制系统。所述控制系统的结构如图2所示,包括速度传感器、距离探测器、MCU、燃料消耗系统、软着陆状态显示。所述系统的各组成部分均由月球探测器内数据总线统一连接。
所述系统的运行过程如下:
步骤C4:月球探测器准备软着陆时开启速度传感器以及距离探测器,用于实时测量当前该探测器的下降速度以及与月球表面之间的距离,并将测量数据传送给MCU;
步骤C5:MCU执行内部的自适应控制节点最优控制方法,计算出使月球探测器安全着陆并且最少消耗燃料的燃料消耗速率控制策略;
步骤C6:MCU将得到的燃料消耗速率控制策略转换为燃料消耗系统运行指令,传送给燃料消耗系统,并实时显示当前软着陆状态。
集成了自适应控制节点最优控制方法的MCU是本发明的核心,如图3所示,其内部包括信息采集模块、初始化模块、结束时间处理模块、控制向量参数化模块、非线性规划(Nonlinear Programming,NLP)问题求解模块、终止条件判断模块、自适应控制节点分配模块、控制指令输出模块。
信息采集模块包括当前下降速度采集、与月球表面之间的距离采集两个子模块。
结束时间处理模块引入新的时间变量υ,使得
t=(tf-t0)υ+t0 (24)
从而将结束时间tf不固定的数学模型(2)转换为控制时域为[0,1]的数学模型,如下所示:
Figure BDA0001466175420000081
其中,
Figure BDA0001466175420000082
控制向量参数化模块采用分段常量策略来实现燃料消耗速率控制,具体如下:
假设整个控制时域[0,1]被划分为p(p>0)个控制子区间[υk-1k)(k=1,2,...,p),并且
0<υ1<…<υp-1<υp=1 (27)
这样,
Figure BDA0001466175420000083
可表示为:
Figure BDA0001466175420000084
其中,
Figure BDA0001466175420000085
为常数,表示在控制子区间[υk-1k)内的参数值,χk(υ)为单位开关函数,其定义如下:
Figure BDA0001466175420000087
从而,燃料消耗速率控制参数可由向量表示。
NLP问题求解模块包括序列二次规划(Sequential Quadratic Programming,SQP)求解、联立微分方程组求解两个子模块。联立微分方程组包括方程组(9)
Figure BDA0001466175420000089
和方程组(10)
Figure BDA00014661754200000810
其中,
Figure BDA00014661754200000811
Figure BDA0001466175420000091
利用四阶Runge-Kutta算法求解联立微分方程组(9)、(10),可以得到数学模型(4)的目标函数值以及目标函数对控制参数向量的一阶梯度信息:
Figure BDA0001466175420000093
同样,可以得到数学模型(4)中的约束函数值
Figure BDA0001466175420000094
以及约束函数对控制参数向量的一阶梯度信息:
Figure BDA0001466175420000095
自适应控制节点分配模块提供了一种自适应分配控制节点的策略,具体如下:
假设经过第l次迭代,得到的目标函数最优值为J*l,最优控制参数为
Figure BDA0001466175420000096
Figure BDA0001466175420000097
相应的控制网格为
Figure BDA0001466175420000098
通过将Δl中的每个控制子区间进行二等分,得到控制网格
Figure BDA0001466175420000099
及初始控制参数
Figure BDA00014661754200000910
对于
Figure BDA00014661754200000911
中当前取值为的各个参数
Figure BDA00014661754200000913
为了评估其对目标函数J下降量的影响,定义
Figure BDA00014661754200000914
相对于J的灵敏度为:
Figure BDA00014661754200000915
其中,表示不超过(j+1)/2的最大整数。
假设在控制区间
Figure BDA00014661754200000917
内,分别为第l-1次和第l次所获得的最优控制参数值。如果以下条件满足:
Figure BDA00014661754200000919
其中,εuv>0为给定阈值,则令
s2k-1=0且s2k=0 (38)
对于Δl'中的控制节点
Figure BDA00014661754200000920
如果在下一次迭代中将其保留,需满足:
Figure BDA00014661754200000921
Figure BDA00014661754200000922
其中,rsu>0为给定系数,为平均灵敏度,其定义如下:
如果式(18)不满足,则将该控制节点消除。
当控制节点
Figure BDA0001466175420000101
Figure BDA0001466175420000102
都被消除时,如果以下条件满足
Figure BDA0001466175420000104
其中,给定系数rsl∈(0,rsu]、εuh>0,则控制节点
Figure BDA0001466175420000105
也应该被消除。
经过以上控制网格二等分以及控制节点消除等步骤,控制网格Δl'可作为下一次迭代的控制网格Δl+1
所述MCU产生燃料消耗系统运行指令的过程如下:
步骤D9:信息采集模块获取月球探测器当前下降速度以及与月球表面之间的距离;
步骤D10:初始化模块运行,设置初始控制网格数目p、燃料消耗速率控制策略的初始猜测值
Figure BDA0001466175420000106
设定常数值εuv>0、εuh>0、rsu>0、rsl∈(0,rsu],设置最大迭代次数lmax≥1以及终止误差tolJ>0,并令迭代计数l=0;
步骤D11:结束时间处理模块将数学模型(2)转换为数学模型(4);
步骤D12:控制向量参数化模块采用分段常量策略来表示燃料消耗速率控制曲线,如果l=0,则将控制时域等分为p段而得到当前控制网格,并令所有控制参数值为
Figure BDA0001466175420000107
否则,采用Δl作为当前控制网格,每个控制子区间内的参数值为对应控制时域内
Figure BDA0001466175420000108
的值;
步骤D13:NLP问题求解模块中的SQP求解模块运行,并且通过联立微分方程组求解模块获取目标函数值、目标函数对控制参数向量的一阶梯度信息、约束函数值、约束函数对控制参数向量的一阶梯度信息,最终得到当前控制网格下的目标函数最优值J*l以及相应的最优控制参数
Figure BDA0001466175420000109
步骤D14:终止条件判断模块运行,对于l>0,如果l=lmax
Figure BDA00014661754200001010
则执行步骤D8,否则,执行步骤D7;
步骤D15:自适应控制节点分配模块运行,获得新的控制网格Δl+1,令迭代计数l=l+1,并转到步骤D4;
步骤D16:控制指令输出模块将当前控制时域按(3)转换到实际控制时域,并将获得的最优燃料消耗速率控制策略输出。
实施实例1
某月球探测器软着陆的数学模型如下:
Figure BDA0001466175420000111
其中,x1(t)、x2(t)、x3(t)分别表示探测器与月球表面之间的距离(m)、下降速度(m/s)、燃料消耗量(kg),u(t)表示燃料消耗速率(kg/s)。
当探测器开始软着陆时,速度传感器、距离探测器测量到当前该探测器的下降速度为-2m/s、与月球表面之间的距离为10m,并将这些测量数据传送给MCU的信息采集模块。MCU立即开始运行自适应控制节点最优控制方法,其运行过程如图3所示,为:
步骤E1:初始化模块2运行,设置初始控制网格数目p=4、燃料消耗速率控制策略的初始猜测值
Figure BDA0001466175420000112
设定常数值εuv=10-6、εuh=10-3、rsu=0.25、rsl=0.2,设置最大迭代次数lmax=4以及终止误差tolJ=10-6,并令迭代计数l=0;
步骤E2:结束时间处理模块3运行,将数学模型(43)转换为数学模型(4)的形式;
步骤E3:控制向量参数化模块4采用分段常量策略来表示燃料消耗速率控制曲线,如果l=0,则将控制时域等分为p段而得到当前控制网格,并令所有控制参数值为
Figure BDA0001466175420000113
否则,采用Δl作为当前控制网格,每个控制子区间内的参数值为对应控制时域内
Figure BDA0001466175420000114
的值;
步骤E4:NLP问题求解模块5中的SQP求解模块运行,并且通过联立微分方程组求解模块获取目标函数值、目标函数对控制参数向量的一阶梯度信息、约束函数值、约束函数对控制参数向量的一阶梯度信息,最终得到当前控制网格下的目标函数最优值J*l以及相应的最优控制参数
Figure BDA0001466175420000115
步骤E5:终止条件判断模块6运行,对于l>0,如果l=lmax
Figure BDA0001466175420000116
则执行步骤E7,否则,执行步骤E6;
步骤E6:自适应控制节点分配模块7运行,获得新的控制网格Δl+1,令迭代计数l=l+1,并转到步骤E3;
步骤E7:控制指令输出模块8将当前控制时域按(3)转换到实际控制时域,并将获得的最优燃料消耗速率控制策略输出。
自适应控制节点最优控制方法得到的最优燃料消耗速率控制曲线如图4所示,完全满足控制要求。图5显示了月球探测器与月球表面之间距离、下降速度的变化曲线,可以看到,在软着陆结束时其值均为0。
最后,MCU将得到的燃料消耗速率控制策略转换为燃料消耗系统运行指令,传送给燃料消耗系统,并实时显示当前软着陆状态。
上述实施例用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明作出的任何修改和改变,都落入本发明的保护范围。

Claims (1)

1.一种基于自适应控制节点的月球探测器软着陆最优控制系统,能够计算出最优的软着陆策略,以保证探测器安全着陆并且最大程度地减少燃料的消耗; 其特征在于:由速度传感器、距离探测器、MCU、燃料消耗系统、软着陆状态显示构成; 所述系统的运行过程包括:
步骤A1:月球探测器准备软着陆时开启速度传感器以及距离探测器,用于实时测量当前该探测器的下降速度以及与月球表面之间的距离,并将测量数据传送给MCU;
步骤A2:MCU执行内部的自适应控制节点最优控制方法,计算出使月球探测器安全着陆并且最少消耗燃料的燃料消耗速率控制策略;
步骤A3:MCU将得到的燃料消耗速率控制策略转换为燃料消耗系统运行指令,传送给燃料消耗系统,并实时显示当前软着陆状态;
所述的MCU,包括信息采集模块、初始化模块、结束时间处理模块、控制向量参数化模块、非线性规划(Nonlinear Programming,NLP)问题求解模块、终止条件判断模块、自适应控制节点分配模块、控制指令输出模块;
月球探测器的软着陆过程可以描述为:
Figure FDA0002280972590000011
其中t表示时间,t0表示软着陆过程开始时间,tf表示软着陆过程结束时间,且tf不固定;
Figure FDA0002280972590000012
被称为状态变量,表示月球探测器的速度、加速度、质量、与月球表面之间的距离物理参数,x0是其初始值,
Figure FDA0002280972590000013
是其一阶导数;u(t)表示月球探测器的燃料消耗速率,ul、uu分别为其下限值和上限值;
Figure FDA0002280972590000014
是根据能量守恒以及力学原理建立的微分方程组;
Figure FDA0002280972590000015
是对月球探测器软着陆结束时刻的物理参数建立的约束条件;nx,ng分别是状态变量和约束的数量;
假设以Φ[x(tf)]表示燃料的总消耗量,则使燃料消耗最少的数学模型可表示为:
Figure FDA0002280972590000021
其中J[u(t)]表示控制目标,由燃料消耗速率u(t)决定;
信息采集模块包括当前下降速度采集、与月球表面之间的距离采集两个子模块;
结束时间处理模块引入新的时间变量υ,使得
t=(tf-t0)υ+t0 (3)
从而将结束时间tf不固定的数学模型(2)转换为控制时域为[0,1]的数学模型,如下所示:
其中,
Figure FDA0002280972590000023
控制向量参数化模块采用分段常量策略来实现燃料消耗速率控制,具体如下:
假设整个控制时域[0,1]被划分为p个控制子区间[υk-1k),p>0,k=1,2,...,p,并且
0<υ1<…<υp-1<υp=1 (6)
这样,
Figure FDA0002280972590000024
可表示为:
Figure FDA0002280972590000025
其中,
Figure FDA0002280972590000026
为常数,表示
Figure FDA0002280972590000027
在控制子区间[υk-1k)内的参数值,χk(υ)为单位开关函数,其定义如下:
Figure FDA0002280972590000028
从而,燃料消耗速率控制参数可由向量
Figure FDA0002280972590000029
表示;
NLP问题求解模块包括序列二次规划(Sequential Quadratic Programming,SQP)求解、联立微分方程组求解两个子模块; 联立微分方程组包括方程组(9)
Figure FDA0002280972590000031
和方程组(10)
Figure FDA0002280972590000032
其中,
Figure FDA0002280972590000033
Figure FDA0002280972590000034
利用四阶Runge-Kutta算法求解联立微分方程组(9)、(10),可以得到数学模型(4)的目标函数值
Figure FDA0002280972590000035
以及目标函数对控制参数向量的一阶梯度信息:
Figure FDA0002280972590000036
同样,可以得到数学模型(4)中的约束函数值
Figure FDA0002280972590000037
以及约束函数对控制参数向量的一阶梯度信息:
Figure FDA0002280972590000038
自适应控制节点分配模块提供了一种自适应分配控制节点的策略,具体如下:
假设经过第l次迭代,得到的目标函数最优值为J*l,最优控制参数为
Figure FDA0002280972590000039
Figure FDA00022809725900000310
相应的控制网格为
Figure FDA00022809725900000311
通过将Δl中的每个控制子区间进行二等分,得到控制网格及初始控制参数
Figure FDA00022809725900000313
对于
Figure FDA00022809725900000314
中当前取值为的各个参数
Figure FDA00022809725900000316
为了评估其对目标函数J下降量的影响,定义
Figure FDA00022809725900000317
相对于J的灵敏度为:
Figure FDA00022809725900000318
其中,
Figure FDA00022809725900000319
表示不超过(j+1)/2的最大整数;
假设在控制区间
Figure FDA00022809725900000320
内,
Figure FDA00022809725900000321
分别为第l-1次和第l次所获得的最优控制参数值; 如果以下条件满足:
Figure FDA0002280972590000041
其中,εuv>0为给定阈值,则令
s2k-1=0且s2k=0 (17)
对于Δl'中的控制节点
Figure FDA0002280972590000042
如果在下一次迭代中将其保留,需满足:
Figure FDA0002280972590000043
Figure FDA0002280972590000044
其中,rsu>0为给定系数,为平均灵敏度,其定义如下:
Figure FDA0002280972590000046
如果式(18)不满足,则将该控制节点消除;
当控制节点
Figure FDA0002280972590000047
都被消除时,如果以下条件满足
Figure FDA0002280972590000049
其中,给定系数rsl∈(0,rsu]、εuh>0,则控制节点
Figure FDA00022809725900000411
也应该被消除;
经过以上控制网格二等分以及控制节点消除等步骤,控制网格Δl'可作为下一次迭代的控制网格Δl+1
所述MCU产生燃料消耗系统运行指令的过程如下:
步骤B1:信息采集模块获取月球探测器当前下降速度以及与月球表面之间的距离;
步骤B2:初始化模块运行,设置初始控制网格数目p、燃料消耗速率控制策略的初始猜测值
Figure FDA00022809725900000412
设定常数值εuv>0、εuh>0、rsu>0、rsl∈(0,rsu],设置最大迭代次数lmax≥1以及终止误差tolJ>0,并令迭代计数l=0;
步骤B3:结束时间处理模将结束时间不固定的月球探测器软着陆数学模型转换为控制时域为[0,1]的数学模型;
步骤B4:控制向量参数化模块采用分段常量策略来表示燃料消耗速率控制曲线,如果l=0,则将控制时域等分为p段而得到当前控制网格,并令所有控制参数值为
Figure FDA00022809725900000413
否则,采用Δl作为当前控制网格,每个控制子区间内的参数值为对应控制时域内的值;
步骤B5:NLP问题求解模块中的SQP求解模块运行,并且通过联立微分方程组求解模块获取目标函数值、目标函数对控制参数向量的一阶梯度信息、约束函数值、约束函数对控制参数向量的一阶梯度信息,最终得到当前控制网格下的目标函数最优值J*l以及相应的最优控制参数
Figure FDA00022809725900000415
步骤B6:终止条件判断模块运行,对于l>0,如果l=lmax
Figure FDA0002280972590000051
则执行步骤B8,否则,执行步骤B7;
步骤B7:自适应控制节点分配模块运行,获得新的控制网格Δl+1,令迭代计数l=l+1,并转到步骤B4;
步骤B8:控制指令输出模块将当前控制时域按转换到实际控制时域,并将获得的最优燃料消耗速率控制策略输出。
CN201711115234.0A 2017-11-13 2017-11-13 一种基于自适应控制节点的月球探测器软着陆最优控制系统 Expired - Fee Related CN107765554B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711115234.0A CN107765554B (zh) 2017-11-13 2017-11-13 一种基于自适应控制节点的月球探测器软着陆最优控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711115234.0A CN107765554B (zh) 2017-11-13 2017-11-13 一种基于自适应控制节点的月球探测器软着陆最优控制系统

Publications (2)

Publication Number Publication Date
CN107765554A CN107765554A (zh) 2018-03-06
CN107765554B true CN107765554B (zh) 2020-03-03

Family

ID=61273887

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711115234.0A Expired - Fee Related CN107765554B (zh) 2017-11-13 2017-11-13 一种基于自适应控制节点的月球探测器软着陆最优控制系统

Country Status (1)

Country Link
CN (1) CN107765554B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111031258B (zh) * 2020-01-15 2021-02-05 北京航天飞行控制中心 月球车导航相机曝光参数确定方法及装置
CN112215417B (zh) * 2020-10-12 2022-08-09 北京理工大学 柔性连接多节点小天体探测器着陆点最优分配方法
CN112987691B (zh) * 2021-02-25 2023-02-03 北京空间飞行器总体设计部 一种地外天体表面软着陆闭环随动控制试验方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101464664A (zh) * 2009-01-09 2009-06-24 浙江工业大学 基于单种群和预交叉的差分进化算法的间歇反应器最优控制方法
CN101872444A (zh) * 2010-05-21 2010-10-27 杭州电子科技大学 一种结合中期修正策略的间歇过程批到批优化方法
CN101887239A (zh) * 2010-06-30 2010-11-17 浙江大学 一种自适应的工业过程最优控制系统及方法
CN103309234A (zh) * 2013-06-08 2013-09-18 浙江大学 一种基于正交配置优化的间歇反应釜控制系统
CN103309371A (zh) * 2013-06-08 2013-09-18 浙江大学 一种基于控制变量参数化方法的间歇反应釜控制系统
CN103557511A (zh) * 2013-11-18 2014-02-05 华北电力大学(保定) 一种电站锅炉主蒸汽温度全程控制方法
CN103853127A (zh) * 2012-12-06 2014-06-11 天津市电力公司 一种寻求在dcs中最优控制变量值的方法
CN103926835A (zh) * 2014-04-04 2014-07-16 北京航空航天大学 一种基于干扰观测器的着陆器动力下降段优化控制方法
CN107065571A (zh) * 2017-06-06 2017-08-18 上海航天控制技术研究所 一种基于机器学习算法的地外天体软着陆制导控制方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101464664A (zh) * 2009-01-09 2009-06-24 浙江工业大学 基于单种群和预交叉的差分进化算法的间歇反应器最优控制方法
CN101872444A (zh) * 2010-05-21 2010-10-27 杭州电子科技大学 一种结合中期修正策略的间歇过程批到批优化方法
CN101887239A (zh) * 2010-06-30 2010-11-17 浙江大学 一种自适应的工业过程最优控制系统及方法
CN103853127A (zh) * 2012-12-06 2014-06-11 天津市电力公司 一种寻求在dcs中最优控制变量值的方法
CN103309234A (zh) * 2013-06-08 2013-09-18 浙江大学 一种基于正交配置优化的间歇反应釜控制系统
CN103309371A (zh) * 2013-06-08 2013-09-18 浙江大学 一种基于控制变量参数化方法的间歇反应釜控制系统
CN103557511A (zh) * 2013-11-18 2014-02-05 华北电力大学(保定) 一种电站锅炉主蒸汽温度全程控制方法
CN103926835A (zh) * 2014-04-04 2014-07-16 北京航空航天大学 一种基于干扰观测器的着陆器动力下降段优化控制方法
CN107065571A (zh) * 2017-06-06 2017-08-18 上海航天控制技术研究所 一种基于机器学习算法的地外天体软着陆制导控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于自适应模拟退火遗传算法的月球软着陆轨道优化;朱建丰 等;《航空学报》;20070715;第28卷(第4期);论文第806-811页 *
自适应控制向量参数化动态优化研究;王立伟;《中国优秀硕士学位论文全文数据库基础科学辑》;20170815(第08期);第一、三、四章 *

Also Published As

Publication number Publication date
CN107765554A (zh) 2018-03-06

Similar Documents

Publication Publication Date Title
CN107765554B (zh) 一种基于自适应控制节点的月球探测器软着陆最优控制系统
CN107656439B (zh) 一种基于自适应控制网格的月球探测器软着陆最优控制系统
CN107885082B (zh) 一种基于正交配置优化的月球着陆器轨迹控制器
CN106684910B (zh) 一种基于模糊控制的虚拟同步机虚拟惯性自适应调节方法及频率控制方法
CN102419597B (zh) 一种限定相对姿态的大规模编队航天器姿态一致控制方法
CN108241292A (zh) 一种基于扩张状态观测器的水下机器人滑模控制方法
CN105955023B (zh) 一种用于快速运动控制系统的模型预测控制方法
CN107942661B (zh) 一种基于自适应优化控制节点的月球探测器软着陆最优控制系统
WO2023168772A1 (zh) 一种飞行器动态特性模拟的时间并行扰动域更新方法
CN107703759B (zh) 一种基于自适应优化控制网格的月球探测器软着陆最优控制系统
CN111766890B (zh) 不依赖神经网络近似的航天器保性能姿态控制方法
CN104657595B (zh) 一种单颗粒曳力模型系数标定方法
CN114722498A (zh) 一种基于生成对抗网络的翼型设计方法
CN107942967B (zh) 一种基于自适应优化控制网格的间歇反应器最优控制系统
CN107908159B (zh) 基于自适应控制节点的活塞流管式反应器最优控制系统
CN108448569A (zh) 一种大电网机电暂态仿真数值收敛性的识别和提高方法
Grillo et al. An EKF based method for path following in turbulent air
CN107857196B (zh) 一种桥式集装箱起重机摆动最优控制系统
Yang et al. Aerodynamic parameters identification and adaptive LADRC attitude control of quad-rotor model
CN103853049B (zh) 纵向飞行模型簇复合频率鲁棒控制器设计方法
CN103823367B (zh) 纵向飞行模型簇颤振抑制复合频率鲁棒控制器设计方法
CN107894754A (zh) 一种基于自适应控制节点的间歇反应器最优控制系统
CN109782784B (zh) 一种基于复合快速终端滑模的二旋翼飞行器有限时间自适应控制方法
CN113479344B (zh) 一种可快速解算的分布式卫星姿态协同控制方法
CN116258077A (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
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20200303

Termination date: 20211113