CN103926835B - 一种基于干扰观测器的着陆器动力下降段优化控制方法 - Google Patents
一种基于干扰观测器的着陆器动力下降段优化控制方法 Download PDFInfo
- Publication number
- CN103926835B CN103926835B CN201410136042.8A CN201410136042A CN103926835B CN 103926835 B CN103926835 B CN 103926835B CN 201410136042 A CN201410136042 A CN 201410136042A CN 103926835 B CN103926835 B CN 103926835B
- Authority
- CN
- China
- Prior art keywords
- centerdot
- gamma
- rightarrow
- lander
- lambda
- 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
Links
Landscapes
- Feedback Control In General (AREA)
Abstract
一种基于干扰观测器的着陆器动力下降段优化控制方法,针对着陆器在动力下降段含有干扰的系统状态空间模型,设计一种抗干扰优化控制方法;首先,建立带有干扰的着陆器动力下降段系统状态空间模型;其次,基于含有干扰的状态空间模型,设计干扰观测器;然后,基于系统标称模型,设计着陆器燃料最优控制器;最后,基于干扰观测器与最优控制器,设计复合控制方法;本方法具有抗干扰性强、工作可靠性高、着陆器燃料消耗可得到优化等优点,适用于航天领域行星着陆器在动力下降段精确优化控制中。
Description
技术领域
本发明涉及一种基于干扰观测器的着陆器动力下降段优化控制方法,主要应用于行星着陆器在动力下降段以燃料最优的方式精确抗干扰着陆。
背景技术
作为距离地球最近的行星之一,火星与地球有很多相似之处,成为人类深空探测的首选目标星体。近几十年来,行星探测活动尤其是着陆探测活动越来越频繁。随着科学技术的进步与工程经验的积累,火星探测器在火星表面的着陆精度在过去的四十余年中不断提高,从“海盗号”的200km到“探路者号”的150km再到“火星漫游者号”的35km,直到最近“好奇号”的10km着陆范围。在这些火星任务中,着陆器只需安全地着陆在目标点附近即可。然而,在下一代火星任务中如采样返回和人类探测则需要着陆器在火星表面感兴趣的特定地点精确软着陆,定义为着陆在目标点100m范围内。
火星着陆器在着陆过程中要经历火星大气进入段、伞降段和末端的动力下降段。由于在降落伞下降阶段,火星着陆器会随风自由漂移不受控制,因此在动力下降段,着陆器有可能不得不从制动点飞行数千米到达目标着陆地点。在这个过程中,火星着陆器不可避免的会受到火星风等外部干扰。由于火星着陆器受到有效载荷的严格限制,不能通过传感器测量到所有干扰,因此,需要设计干扰观测器来估计干扰的影响。
在动力下降段,火星着陆器不但有可能需要从制动点飞行数千米到达目标着陆地点,也有可能为了规避着陆点障碍重新规划路径从而增加航程,然而火星着陆器携带的可用燃料是有限的,因此,必须对着陆器的燃料消耗进行优化控制,以增大着陆器的可达区域。现有的控制方法主要为“阿波罗”多项式控制方法,这种控制方法没有考虑着陆器燃料的最优消耗,也没有考虑到着陆器在动力下降过程中遇到的各种干扰。为了解决这些问题,需要设计一种行星着陆器在动力下降段的抗干扰优化控制方法。
发明内容
本发明的技术解决问题是:针对行星着陆器在动力下降阶段受到的干扰,提供一种干扰观测器估计干扰并进行燃料优化的控制方法,解决了行星着陆器在动力下降过程中因受到干扰导致着陆精度降低的问题,提高行星着陆器的着陆精度,同时实现了燃料的优化控制。
本发明的技术解决方案为:一种基于干扰观测器的着陆器动力下降段优化控制方法,其实现步骤如下:
第一步,建立带有干扰的着陆器动力下降段系统状态空间模型为:
着陆器在动力下降段的燃料消耗率为:
其中,m(t)为着陆器的质量,t为时间变量;k=1/ve,ve=geIsp,ge为地球表面重力加速度,Isp为制动发动机的比冲;T(t)为制动发动机的推力;
定义着陆器在动力下降段的特征速度为C(t),有:
其中,初始条件为C(t0)=0,t0为着陆器开始制动的时刻,Γ(t)=T(t)/m(t),Γ(t)为比推力的大小;Γ(t)有最大与最小边界,为:
0≤Γmin(t)≤Γ(t)≤Γmax(t)
其中,Γmin(t)=Tmin/m(t),Γmax(t)=Tmax/m(t),Tmin为制动发动机的最小推力,Tmax为制动发动机的最大推力,这个时变的边界取决于着陆器质量的变化;给定了C(t),则着陆器相对应的质量为:
m(t)=m(t0)exp[-kC(t)]
其中,m(t0)为着陆器在动力下降段开始制动时的质量;
设定着陆器的位置和速度变量建立在笛卡尔坐标系中,计划着陆点位于坐标系原点,假设这个坐标系是惯性的,则带有干扰的着陆器动力下降段系统状态空间模型为:
其中,x轴与y轴互相垂直组成水平面xoy,h轴与xoy平面垂直朝向上方,x轴与h轴组成xoh平面,y轴与h轴组成yoh平面;x(t)与y(t)分别为着陆器在x轴与y轴上的位置坐标,h(t)为着陆器在h轴上的位置坐标;u(t)与v(t)分别为着陆器在x轴与y轴上的速度,w(t)为着陆器在h轴上的速度;ψ为T(t)与xoh平面的夹角,θ为T(t)在xoh平面上的投影与h轴的夹角;g为着陆行星表面重力加速度;dx、dy与dh分别为着陆器在x、y与h轴上受到的干扰。
第二步,基于第一步所述的包含干扰的着陆器系统状态空间模型,设计干扰观测器为:
其中,与分别为观测器对干扰dx、dy与dh的估计值;Lx、Ly与Lh分别为x、y与h轴上观测器的增益,定义辅助向量令:
其中,px、py与ph分别为观测器在x、y与h轴上的中间辅助变量,有:
因此得:
所以得:
第三步,基于系统标称模型,设计燃料最优控制器为:
着陆器动力下降段系统状态空间标称模型为:
用向量表示为:
其中, 定义为与同方向的单位向量,即
为使着陆器在动力下降阶段实现燃料消耗最优,目标函数设为着陆器着陆时质量最大,即:
J=-C(tf)
其中,J为所求目标函数,tf为着陆器着陆的时刻,与此最优控制问题相关联的Hamilton函数为:
其中,和分别是与状态变量C(t)相关的协态变量,根据庞特里亚金极大值原理,最优控制可以使得Hamilton函数达到最大,令上标*代表最优控制值;因为Γ(t)是非负的,因此应该与同方向,λv为的模,Hamilton函数可以表示为:
其中,为的最优值,Hamilton函数取最大,则:
其中,Γ*(t)为Γ(t)的最优值,为Γ(t)的开关函数。
第四步,基于设计的干扰观测器与燃料最优控制器,设计复合控制方法为:
其中,即为着陆器在动力下降段以燃料最优的消耗进行抗干扰的控制器。
本发明与现有技术相比的优点在于:
本发明的一种基于干扰观测器的着陆器动力下降段优化控制方法是设计干扰观测器来估计着陆器在动力下降过程中受到的干扰;基于标称模型设计燃料最优控制器;在干扰观测器与最优控制器的基础上,设计复合控制方法对着陆器燃料进行优化控制,设计的复合控制方法可以使行星着陆器以最优的燃料实现安全精确着陆。
附图说明
图1为本发明一种基于干扰观测器的着陆器动力下降段优化控制方法的设计流程图。
具体实施方式
本发明所述的一种基于干扰观测器的着陆器动力下降段优化控制方法设计步骤为:首先,建立带有干扰的行星着陆器动力下降段系统状态空间模型;其次,基于带有干扰的状态空间模型,设计干扰观测器;然后,基于系统标称模型,设计行星着陆器燃料最优控制器;最后,基于干扰观测器与最优控制器,设计复合控制方法;具体实施步骤如下:
第一步,建立带有干扰的火星着陆器动力下降段系统状态空间模型为:
火星着陆器在动力下降段的燃料消耗率为:
其中,m(t)为火星着陆器的质量,t为时间变量;k=1/ve,ve=geIsp,ge为地球表面重力加速度,Isp为制动发动机的比冲;T(t)为制动发动机的推力;
定义火星着陆器在动力下降段的特征速度为C(t),有:
其中,初始条件为C(t0)=0,t0为着陆器开始制动的时刻,Γ(t)=T(t)/m(t),Γ(t)为比推力的大小;Γ(t)有最大与最小边界,为:
0≤Γmin(t)≤Γ(t)≤Γmax(t)
其中,Γmin(t)=Tmin/m(t),Γmax(t)=Tmax/m(t),Tmin为制动发动机的最小推力,Tmax为制动发动机的最大推力,这个时变的边界取决于火星着陆器质量的变化;给定了C(t),则火星着陆器相对应的质量为:
m(t)=m(t0)exp[-kC(t)]
其中,m(t0)为火星着陆器在动力下降段开始制动时的质量;
设定火星着陆器的位置和速度变量建立在笛卡尔坐标系中,计划着陆点位于坐标系原点,假设这个坐标系是惯性的,则带有干扰的火星着陆器动力下降段系统状态空间模型为:
其中,x轴与y轴互相垂直组成水平面xoy,h轴与xoy平面垂直朝向上方,x轴与h轴组成xoh平面,y轴与h轴组成yoh平面;x(t)与y(t)分别为着陆器在x轴与y轴上的位置坐标,h(t)为着陆器在h轴上的位置坐标;u(t)与v(t)分别为着陆器在x轴与y轴上的速度,w(t)为着陆器在h轴上的速度;ψ为T(t)与xoh平面的夹角,θ为T(t)在xoh平面上的投影与h轴的夹角;g为着陆行星表面重力加速度;dx、dy与dh分别为着陆器在x、y与h轴上受到的干扰。
第二步,基于第一步所述的包含干扰的火星着陆器系统状态空间模型,设计干扰观测器为:
其中,与分别为观测器对干扰dx、dy与dh的估计值;Lx、Ly与Lh分别为x、y与h轴上观测器的增益,定义辅助向量令:
其中,px、py与ph分别为观测器在x、y与h轴上的中间辅助变量,有:
因此得:
所以得:
第三步,基于标称模型,设计燃料最优控制器为:
火星着陆器动力下降段系统状态空间标称模型为:
用向量表示为:
其中, 定义为与同方向的单位向量,即
为使火星着陆器在动力下降阶段实现燃料消耗最优,目标函数设为火星着陆器着陆时质量最大,即:
J=-C(tf)
其中,J为所求目标函数,tf为着陆器着陆时刻,与此最优控制问题相关联的Hamilton函数为:
其中,和λC分别是与状态变量C(t)相关的协态变量,根据庞特里亚金极大值原理,最优控制可以使得Hamilton函数达到最大,令上标*代表最优控制值;因为Γ(t)是非负的,因此应该与同方向,λv为的模,Hamilton函数可以表示为:
其中,为的最优值,Hamilton函数取最大,则:
其中,Γ*(t)为Γ(t)的最优值,为Γ(t)的开关函数。
第四步,基于设计的干扰观测器与燃料最优控制器,设计复合控制方法为:
其中,即为着陆器在动力下降段以燃料最优的消耗进行抗干扰的控制器。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (1)
1.一种基于干扰观测器的着陆器动力下降段优化控制方法,其特征在于包括以下步骤:
(1)建立带有干扰的着陆器动力下降段系统状态空间模型;
所述的带有干扰的着陆器动力下降段系统状态空间模型为:
着陆器在动力下降段的燃料消耗率为:
其中,m(t)为着陆器的质量,t为时间变量;k=1/ve,ve=geIsp,ge为地球表面重力加速度,Isp为制动发动机的比冲;T(t)为制动发动机的推力;
定义着陆器在动力下降段的特征速度为C(t),有:
其中,初始条件为C(t0)=0,t0为着陆器开始制动的时刻,Γ(t)=T(t)/m(t),Γ(t)为比推力的大小;Γ(t)有最大与最小边界,为:
0≤Γmin(t)≤Γ(t)≤Γmax(t)
其中,Γmin(t)=Tmin/m(t),Γmax(t)=Tmax/m(t),Tmin为制动发动机的最小推力,Tmax为制动发动机的最大推力,这个时变的边界取决于着陆器质量的变化;给定了C(t),则着陆器相对应的质量为:
m(t)=m(t0)exp[-kC(t)]
其中,m(t0)为着陆器在动力下降段开始制动时的质量;
设定着陆器的位置和速度变量建立在笛卡尔坐标系中,计划着陆点位于坐标系原点,假设这个坐标系是惯性的,则带有干扰的着陆器动力下降段系统状态空间模型为:
其中,x轴与y轴互相垂直组成水平面xoy,h轴与xoy平面垂直朝向上方,x轴与h轴组成xoh平面,y轴与h轴组成yoh平面;x(t)与y(t)分别为着陆器在x轴与y轴上的位置坐标,h(t)为着陆器在h轴上的位置坐标;u(t)与v(t)分别为着陆器在x轴与y轴上的速度,w(t)为着陆器在h轴上的速度;ψ为T(t)与xoh平面的夹角,θ为T(t)在xoh平面上的投影与h轴的夹角;g为着陆行星表面重力加速度;dx、dy与dh分别为着陆器在x、y与h轴上受到的干扰;
(2)基于第一步的带有干扰的状态空间模型,设计干扰观测器;
所述的设计干扰观测器为:
其中,与分别为观测器对干扰dx、dy与dh的估计值;Lx、Ly与Lh分别为x、y与h轴上干扰观测器的增益,定义辅助向量令:
其中,px、py与ph分别为观测器在x、y与h轴上的中间辅助变量,有:
因此得:
所以得:
(3)基于系统标称模型,设计燃料最优控制器;
所述的设计燃料最优控制器为:
着陆器动力下降段系统状态空间标称模型为:
用向量表示为:
其中, 定义为与同方向的单位向量,即
为使着陆器在动力下降阶段实现燃料消耗最优,目标函数设为着陆器着陆时质量最大,即:
J=-C(tf)
其中,J为所求目标函数,tf为着陆器着陆的时刻,与此最优控制问题相关联的Hamilton函数为:
其中,和cC分别是与状态变量C(t)相关的协态变量,根据庞特里亚金极大值原理,最优控制能够使得Hamilton函数达到最大,令上标*代表最优控制值,因为Γ(t)是非负的,因此应该与同方向,λv为的模,Hamilton函数能够表示为:
其中,为的最优值,Hamilton函数取最大,则:
其中,Γ*(t)为Γ(t)的最优值,为Γ(t)的开关函数;
(4)基于第二步和第三步,设计复合控制方法,
所述的设计复合控制方法为:
其中, 即为着陆器在动力下降段以燃料最优的消耗进行抗干扰的控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410136042.8A CN103926835B (zh) | 2014-04-04 | 2014-04-04 | 一种基于干扰观测器的着陆器动力下降段优化控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410136042.8A CN103926835B (zh) | 2014-04-04 | 2014-04-04 | 一种基于干扰观测器的着陆器动力下降段优化控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103926835A CN103926835A (zh) | 2014-07-16 |
CN103926835B true CN103926835B (zh) | 2016-06-29 |
Family
ID=51145095
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410136042.8A Active CN103926835B (zh) | 2014-04-04 | 2014-04-04 | 一种基于干扰观测器的着陆器动力下降段优化控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103926835B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104192322B (zh) * | 2014-07-22 | 2016-03-02 | 北京航空航天大学 | 一种行星动力下降段轨迹在线生成的抗干扰制导控制方法 |
CN105843238B (zh) * | 2016-03-31 | 2017-06-06 | 北京航空航天大学 | 一种未知频率谐波干扰下的火星着陆器抗干扰控制器 |
CN105938368B (zh) * | 2016-05-26 | 2019-01-15 | 北京航空航天大学 | 一种基于有限时间摩擦估计的挠性航天器姿态控制方法 |
CN107203133B (zh) * | 2017-05-23 | 2019-10-11 | 浙江大学 | 一种智能的月球软着陆轨道控制器 |
CN107168056B (zh) * | 2017-05-23 | 2019-10-11 | 浙江大学 | 一种自适应的月球软着陆轨道快速优化控制器 |
CN107202584B (zh) * | 2017-07-06 | 2020-02-14 | 北京理工大学 | 一种行星精确着陆抗扰制导方法 |
CN107340716B (zh) * | 2017-07-06 | 2020-02-14 | 北京理工大学 | 一种行星着陆动力下降几何凸轨迹制导方法 |
CN107703759B (zh) * | 2017-11-13 | 2020-05-08 | 浙江大学 | 一种基于自适应优化控制网格的月球探测器软着陆最优控制系统 |
CN107831664A (zh) * | 2017-11-13 | 2018-03-23 | 浙江大学 | 一种基于自适应控制网格的间歇反应器最优控制系统 |
CN107844056A (zh) * | 2017-11-13 | 2018-03-27 | 浙江大学 | 一种基于自适应优化控制网格的活塞流管式反应器最优控制系统 |
CN107831663A (zh) * | 2017-11-13 | 2018-03-23 | 浙江大学 | 一种基于自适应优化控制节点的间歇反应器最优控制系统 |
CN107942661B (zh) * | 2017-11-13 | 2020-02-28 | 浙江大学 | 一种基于自适应优化控制节点的月球探测器软着陆最优控制系统 |
CN107765554B (zh) * | 2017-11-13 | 2020-03-03 | 浙江大学 | 一种基于自适应控制节点的月球探测器软着陆最优控制系统 |
CN107807528A (zh) * | 2017-11-13 | 2018-03-16 | 浙江大学 | 一种基于自适应优化控制节点的活塞流管式反应器最优控制系统 |
CN107656439B (zh) * | 2017-11-13 | 2020-03-03 | 浙江大学 | 一种基于自适应控制网格的月球探测器软着陆最优控制系统 |
CN108196449B (zh) * | 2017-12-26 | 2020-04-24 | 北京理工大学 | 最优着陆轨迹设计的协变量初值确定方法 |
CN109375511B (zh) * | 2018-11-19 | 2021-11-26 | 曲阜师范大学 | 抗干扰量化控制模型获取方法及系统、控制器和控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010113750A (ja) * | 2008-11-05 | 2010-05-20 | Hitachi Ltd | 光ディスク装置 |
CN103303495A (zh) * | 2013-04-11 | 2013-09-18 | 北京控制工程研究所 | 一种动力下降过程干扰力矩的估计方法 |
CN103425146A (zh) * | 2013-08-01 | 2013-12-04 | 北京航空航天大学 | 一种基于角加速度的惯性稳定平台干扰观测器设计方法 |
CN103466100A (zh) * | 2013-08-23 | 2013-12-25 | 北京控制工程研究所 | 一种着陆器软着陆姿态控制方法 |
CN103662090A (zh) * | 2013-12-13 | 2014-03-26 | 北京控制工程研究所 | 一种智能动力下降轨迹在线规划方法 |
-
2014
- 2014-04-04 CN CN201410136042.8A patent/CN103926835B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010113750A (ja) * | 2008-11-05 | 2010-05-20 | Hitachi Ltd | 光ディスク装置 |
CN103303495A (zh) * | 2013-04-11 | 2013-09-18 | 北京控制工程研究所 | 一种动力下降过程干扰力矩的估计方法 |
CN103425146A (zh) * | 2013-08-01 | 2013-12-04 | 北京航空航天大学 | 一种基于角加速度的惯性稳定平台干扰观测器设计方法 |
CN103466100A (zh) * | 2013-08-23 | 2013-12-25 | 北京控制工程研究所 | 一种着陆器软着陆姿态控制方法 |
CN103662090A (zh) * | 2013-12-13 | 2014-03-26 | 北京控制工程研究所 | 一种智能动力下降轨迹在线规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103926835A (zh) | 2014-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103926835B (zh) | 一种基于干扰观测器的着陆器动力下降段优化控制方法 | |
Moore et al. | Robust post-stall perching with a simple fixed-wing glider using LQR-Trees | |
CN104317300B (zh) | 一种基于模型预测控制的平流层飞艇平面路径跟踪控制方法 | |
CN104035335A (zh) | 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律 | |
Dwyer Cianciolo et al. | Entry, descent, and landing guidance and control approaches to satisfy Mars human mission landing criteria | |
CN104192322B (zh) | 一种行星动力下降段轨迹在线生成的抗干扰制导控制方法 | |
CN103728980A (zh) | 航天器相对轨道的控制方法 | |
CN106335655B (zh) | 一种火星器器分离轨道设计方法 | |
CN103625637B (zh) | 一种大型飞机侧向阵风缓和方法 | |
CN103955224B (zh) | 一种用于相对运动视线跟踪的姿态控制方法 | |
CN104155990A (zh) | 考虑攻角约束的高超声速飞行器俯仰通道姿态控制方法 | |
CN101893892B (zh) | 一种无人机自动伞降回收控制方法 | |
CN103064423B (zh) | 多约束多航天器飞行间距预示及碰撞规避方法 | |
CN104267734A (zh) | 一种燃料最省的火星复杂地形区安全着陆轨迹生成方法 | |
CN108873929A (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN106483974A (zh) | 一种固定翼无人机近距离几何避障方法 | |
CN102929284A (zh) | 一种飞行器孤岛降落复飞决策方法 | |
CN204719241U (zh) | 一种基于无人机的航空磁力探测装置 | |
CN104536448A (zh) | 一种基于Backstepping法的无人机姿态系统控制方法 | |
CN104932266A (zh) | 一种基于前馈补偿的着陆器进入段精确控制方法 | |
He et al. | Command filtered backstepping sliding mode control for the hose whipping phenomenon in aerial refueling | |
CN104494845B (zh) | 无模型干扰在线估计的小天体探测器着陆控制方法 | |
CN103412573A (zh) | 基于级联方程的椭圆轨道航天器相对位置退步控制方法 | |
JP2015168315A (ja) | 誘導装置、誘導装置搭載宇宙機 | |
CN104634183B (zh) | 一种基于升阻比实时估计的自适应制导方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |