CN107202584A - 一种行星精确着陆抗扰制导方法 - Google Patents

一种行星精确着陆抗扰制导方法 Download PDF

Info

Publication number
CN107202584A
CN107202584A CN201710544571.5A CN201710544571A CN107202584A CN 107202584 A CN107202584 A CN 107202584A CN 201710544571 A CN201710544571 A CN 201710544571A CN 107202584 A CN107202584 A CN 107202584A
Authority
CN
China
Prior art keywords
mrow
msub
mtd
mtr
msup
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
Application number
CN201710544571.5A
Other languages
English (en)
Other versions
CN107202584B (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.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
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 Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN201710544571.5A priority Critical patent/CN107202584B/zh
Publication of CN107202584A publication Critical patent/CN107202584A/zh
Application granted granted Critical
Publication of CN107202584B publication Critical patent/CN107202584B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Astronomy & Astrophysics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)

Abstract

本发明公开的一种行星精确着陆抗扰制导方法，涉及一种行星精确着陆制导方法，属于深空探测技术领域。通过在行星下降过程中引入能够直接处理非线性及非凸约束的非线性模型预测控制方法，仅在有限维的滚动时域上计算行星精确着陆轨迹优化问题，降低计算量与求解难度，实现行星精确着陆制导律和最优轨迹的在线生成；同时，考虑下降过程中的外界扰动，采用扩张状态观测器对外界扰动进行实时估计并修正控制量，实现扰动补偿与抑制，提高着陆任务的安全性。本发明具有如下两个优点：(1)能够降低行星精确着陆轨迹优化问题的计算量与求解难度，实现最优轨迹的在线生成；(2)降低外界扰动对系统的影响，提高着陆任务的安全性。

Description

一种行星精确着陆抗扰制导方法
技术领域
本发明涉及一种行星精确着陆制导方法，尤其涉及一种行星精确着陆抗扰制导方法，属于深空探测技术领域。
背景技术
为了在行星探测任务中获取更高的科学回报，未来深空任务要求探测器抵达比以往更为复杂的地形表面，这对着陆精度提出了很高的要求。然而，在下降过程中存在的环境扰动等不确定因素可能导致探测器偏离标称轨迹，产生不可预测的严重后果，从而危及到整个着陆任务的安全性。为了消除这些不利因素的影响，需要在任务设计过程中将外界扰动纳入考虑，在线生成相应制导指令引导探测器在不违背工程约束的前提下着陆在指定的安全着陆点。目前，受制于星载计算机的计算和存储能力，能够在线进行实时计算的轨迹优化算法十分有限，对约束形式要求也十分严格，导致在线生成的轨迹难以保证最优性，且在外界环境变化时，系统无法及时做出调整，影响正常下降过程。为了满足实时轨迹生成及抗扰需求，需要设计一种考虑外界扰动的在线制导方法，在行星着陆过程中随时估计作用于系统的外界扰动并在输出控制量中对干扰做出补偿，从而保证探测器安全精确的着陆在预定着陆点，提高任务的成功率。
发明内容
本发明目的为提供一种行星精确着陆抗扰制导方法，具有如下两个优点：(1)能够降低行星精确着陆轨迹优化问题的计算量与求解难度，实现最优轨迹的在线生成；(2)考虑下降过程中的外界扰动，采用扩张状态观测器对扰动进行实时估计并修正控制量，降低外界扰动对系统的影响，提高着陆任务的安全性。
所述的外界扰动为控制指令外作用于开环系统的所有有界扰动，例如环境变化、天体摄动等未知扰动。
本发明的目的是通过下述技术方案实现的。
本发明公开的一种行星精确着陆抗扰制导方法，通过在行星下降过程中引入能够直接处理非线性及非凸约束的非线性模型预测控制方法，仅在有限维的滚动时域上计算行星精确着陆轨迹优化问题，降低计算量与求解难度，实现行星精确着陆制导律和最优轨迹的在线生成；同时，考虑下降过程中的外界扰动，采用扩张状态观测器对外界扰动进行实时估计并修正控制量，实现扰动补偿与抑制，提高着陆任务的安全性。
本发明公开的一种行星精确着陆抗扰制导方法，包括如下步骤：
步骤一、在线生成行星精确着陆制导律和最优轨迹。
将行星着陆动力学方程离散成线性控制系统，考虑探测器在着陆过程中受到的工程约束，并将燃耗与着陆误差设为优化性能指标，根据非线性模型预测控制方法形成并求解滚动时域上的最优轨迹优化问题，在线生成行星精确着陆制导律和最优轨迹。
步骤一的具体实现方法为：
将行星着陆动力学方程进行离散
其中，r(t)为探测器位置，v(t)为探测器速度，u(t)为控制量，g为行星引力加速度，Δt为时间间隔。令系统状态x(t)＝[r(t)T,v(t)T]T，离散后的模型转化为
x(t+1)＝Adx(t)+Bdu(t)+Cdg (2)
其中，
探测器在下降过程中受到的工程约束包括：
初始时刻t0及末端时刻tf状态约束
控制量u和速度v幅值约束
umin≤||u||≤umax (4)
||v||≤vmax (5)
保证着陆点始终可见的视线角θ约束
其中探测器位置r＝[x,y,z]T，相机视线方向单位矢量最大视线角为θmax。避免下降过程中与地表突起发生碰撞的滑翔角φ约束
其中着陆点固连坐标系竖直方向单位矢量e3＝[0,0,1]T，最大滑翔角为φmax。将燃耗与着陆误差设为优化性能指标，从而行星精确着陆问题转化成为滚动时域上的离散优化问题
umin≤||u||≤umax (4)
||v||≤vmax (5)
其中，N为滚动时域长度，P,Q,R分别为末端状态、中间状态及控制向量的权重矩阵，k为第k个滚动时域。
通过求解有限时间内的约束优化问题，保留得到的最优控制序列中第一步的值作为当前时间段的控制量，用动力学递推公式(2)计算下一时刻的状态x(t+1)并作为下一步的初始状态再次进行离散优化问题求解，如此循环，直到探测器到达末端状态，即实现在线生成行星精确着陆制导律和最优轨迹。
步骤二、估计与补偿外界扰动，降低外界扰动对系统的影响，提高着陆任务的安全性。
根据步骤一得到的行星精确着陆在线制导律，考虑下降过程中的外界扰动，引入扩张状态观测器，通过对所述的外界扰动的实时估计，调整控制量大小，实现扰动补偿与抑制，提高着陆任务的安全性。
步骤二具体实现方法为：
考虑下降过程中外界扰动对探测器的影响，对动力学模型(2)进行进一步的转化。令x1＝r,x2＝v，带外界扰动的系统表示为
其中f(t)为外界扰动。为了更好的估计实际外界扰动f(t)大小，将其记为系统的扩张状态变量
其中w(t)为外界扰动变化率。扩张的状态为x(t)＝[x1(t)T,x2(t)T,x3(t)T]T，扩张后的系统表示为
系统矩阵AE和输出CE矩阵分别为
系统的能观性矩阵满秩，即
故系统能观，构造的扩张状态观测器为
其中，e为扩张状态观测器输出z1与实际系统输出y的差值，z1,z2,z3分别为扩张状态观测器的三个状态分量，β01,β02,β03为扩张状态观测器参数，系统中控制变量u由步骤一生成。为了避免实际数值仿真中出现震颤现象，采用以下连续幂函数替代式(13)中的fe与fe1
其中α,δ为连续幂函数参数。选择合适的β01,β02,β03，即能实现对所有状态变量的准确估计
因此，系统状态与所受到的扰动大小都能够通过系统的实时输入输出信息来进行估计。得到扰动估计量后，通过在步骤一中求解最优问题得到的最优控制量u(t)中加入估计值z3(t)以实现扰动的实时补偿与抑制，降低外界扰动对系统的影响，提高着陆任务的安全性，抗扰制导律为
um(t)＝u(t)-z3(t) (16)
有益效果：
1、本发明公开的一种行星精确着陆抗扰制导方法，通过在行星下降过程中引入能够直接处理非线性及非凸约束的非线性模型预测控制方法，仅在有限维的滚动时域上计算行星精确着陆轨迹优化问题，降低计算量与求解难度，实现行星精确着陆制导律和最优轨迹的在线生成。
2、本发明公开的一种行星精确着陆抗扰制导方法，根据得到的行星精确着陆在线制导律，考虑下降过程中的外界扰动，引入扩张状态观测器，通过对所述外界扰动的实时估计，调整控制量大小，实现扰动补偿与抑制，提高着陆任务的安全性。
附图说明
图1为本发明公开的一种行星精确着陆抗扰制导方法流程图；
图2为无扰动时最优轨迹及其在三个平面上的投影；
图3为无扰动时三轴位置、速度及加速度变化；
图4为扩张状态观测器估计结果，其中(a)为位置矢量估计结果，(b)为速度矢量估计结果，(c)为外界扰动估计结果；
图5为标称最优控制与考虑干扰修正后的控制变化曲线对比；
图6为不补偿扰动时三轴位置累积误差变化曲线。
具体实施方式
为了更好的说明本发明的目的和优点，下面结合附图和实例对发明内容做进一步说明。
实施例1：
为了验证方法的可行性，针对火星着陆动力下降段，采用着陆点固连坐标系，探测器动力下降段的初始位置r0为[-400,700,520]Tm，初始速度v0为[19.34,-9.15,-29.16]Tm/s，末端位置rf为[0,0,0]Tm，末端速度vf为[0,0,0]Tm/s，火星重力加速度g为[0,0,-3.7114]Tm/s2，负号表示方向竖直向下，最大控制量幅值umax为15m/s2，最小控制量幅值umin为-15m/s2，最大速度幅值vmax为60m/s，滑翔角约束φmax为72°，视线角约束且θmax为50°，着陆时间tf为30s，采样间隔Δt为1s，滚动时域长度N为10，。
本实施例公开的一种行星精确着陆抗扰制导方法，包括如下步骤：
步骤一、在线生成行星精确着陆制导律和最优轨迹。
将行星着陆动力学方程进行离散
其中，r(t)为探测器位置，v(t)为探测器速度，u(t)为控制量，g为行星引力加速度，Δt为时间间隔。令系统状态x(t)＝[r(t)T,v(t)T]T，离散后的模型转化为
x(t+1)＝Adx(t)+Bdu(t)+Cdg (18)
其中，
探测器在下降过程中受到的工程约束包括：
初始时刻t0及末端时刻tf状态约束
控制量u和速度v幅值约束
-15m/s2≤||u||≤15m/s2 (20)
||v||≤60m/s (21)
保证着陆点始终可见的视线角θ约束
其中探测器位置r＝[x,y,z]T，相机视线方向单位矢量最大视线角为θmax。避免下降过程中与地表突起发生碰撞的滑翔角φ约束
其中着陆点固连坐标系竖直方向单位矢量e3＝[0,0,1]T，最大滑翔角为φmax。将燃耗与着陆误差设为优化性能指标，从而行星精确着陆问题转化成为滚动时域上的离散优化问题
s.t.
x(t+1)＝Adx(t)+Bdu(t)+Cdg (18)
||v||≤60m/s (21)
其中，N为滚动时域长度，P,Q,R分别为末端状态、中间状态及控制向量的权重矩阵，k为第k个滚动时域。
通过采用内点法的IPOPT工具包对有限时间内的燃耗最优问题进行快速求解，保留得到的最优控制序列中第一步的值作为当前时间段的控制量，用动力学递推公式(18)计算下一时刻的状态x(t+1)并作为下一步的初始状态再次进行离散优化问题求解，如此循环，直到探测器到达末端状态，在线生成行星精确着陆制导律和最优轨迹,得到无扰动情况下的最优着陆轨迹如图2所示，其中粗实线表示燃耗最优轨迹，三条虚线分别为该轨迹在x-y,y-z,x-z三个平面上的投影，图3分别给出了、横向、纵向及竖直方向三轴的位置、速度与加速度变化曲线。
步骤二、估计与补偿外界扰动，降低外界扰动对系统的影响，提高着陆任务的安全性。
考虑下降过程中外界扰动对探测器的影响，对动力学模型(18)进行进一步的转化。令x1＝r,x2＝v，带外界扰动的系统表示为
其中f(t)为外界扰动，本实施例中采用以下形式的扰动模型
其中a1＝a2＝a3＝300，ω1＝ω2＝ω3＝0.5。为了更好的估计实际外界扰动f(t)大小，将其记为系统的扩张状态变量
其中w(t)为外界扰动变化率。扩张的状态为x(t)＝[x1(t)T,x2(t)T,x3(t)T]T，扩张后的系统表示为
系统矩阵AE和输出CE矩阵分别为
系统的能观性矩阵满秩，即
故系统能观，构造的扩张状态观测器为
其中，e为扩张状态观测器输出z1与实际系统输出y的差值，z1,z2,z3分别为扩张状态观测器的三个状态分量，β01,β02,β03为扩张状态观测器参数，系统中控制变量u由步骤一生成。此处令扩张状态观测器的初始值与下降段初始值相等以减小超调带来的影响，即z1(0)＝r0,z2(0)＝v0,z3(0)＝0。为了避免实际数值仿真中出现震颤现象，采用以下连续幂函数替代式(30)中的fe与fe1
其中α,δ为连续幂函数参数。令观测步长h＝0.01，参数β01＝100,β02＝300,β03＝1000，即能实现对所有状态变量的准确估计
对位置、速度以及扰动的实时观测估计如图4(a)-(c)所示，图中的xij与zij中，i＝1,2,3分别表示探测器位置、探测器速度、外界扰动，j＝1,2,3分别表示横向、纵向、竖向。能够看到，在三个方向上状态观测器均能较好的跟踪扩张的三个状态量，实现对探测器实时位置、速度及所受扰动的实时估计。
因此，系统状态与所受到的扰动大小都能够通过系统的实时输入输出信息来进行估计。得到扰动估计量后，通过在步骤一中求解最优问题得到的最优控制量u(t)中加入估计值z3(t)以实现扰动的实时补偿与抑制，降低外界扰动对系统的影响，提高着陆任务的安全性，抗扰制导律为
um(t)＝u(t)-z3(t) (33)
图5比较了标称最优控制u(t)与在此基础上对干扰进行修正的控制量um(t)间的差别，其中实线表示标称最优控制u(t)变化，虚线表示考虑干扰修正后的控制um(t)变化。对标称最优控制u(t)与修正后的控制量um(t)之差进行积分，得到不抗扰时制导律在三轴上产生的位置累积误差，如图6所示。由于本实施例中采用的是余弦函数形式的扰动，因此位置累积误差的变化在下降过程中能够在一定程度上进行相互抵消，最终抗扰制导律使得探测器着陆在目标着陆点，不抗扰的最优制导律则使探测器着陆在目标着陆点附近，着陆误差为14.74m。采用不同形式的扰动进行仿真，产生的累积误差变化情况也将不同，如采用线性变化形式的扰动，累积误差将呈现单调递增。由此可以看出，在下降过程中实时估计与补偿外界扰动对于行星精确着陆任务的重要性。
本发明保护范围不仅局限于实施例，实施例用于解释本发明，凡与本发明在相同原理和构思条件下的变更或修改均在本发明公开的保护范围之内。

Claims (4)

1.一种行星精确着陆抗扰制导方法，其特征在于：包括如下步骤，
步骤一、在线生成行星精确着陆制导律和最优轨迹；
将行星着陆动力学方程离散成线性控制系统，考虑探测器在着陆过程中受到的工程约束，并将燃耗与着陆误差设为优化性能指标，根据非线性模型预测控制方法形成并求解滚动时域上的最优轨迹优化问题，在线生成行星精确着陆制导律和最优轨迹；
步骤二、估计与补偿外界扰动，降低外界扰动对系统的影响，提高着陆任务的安全性；
根据步骤一得到的行星精确着陆在线制导律，考虑下降过程中的外界扰动，引入扩张状态观测器，通过对所述的外界扰动的实时估计，调整控制量大小，实现扰动补偿与抑制，提高着陆任务的安全性。
2.如权利要求1所述的一种行星精确着陆抗扰制导方法，其特征在于：步骤一的具体实现方法为，
将行星着陆动力学方程进行离散
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>r</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <mi>r</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>&amp;Delta;</mi> <mi>t</mi> <mo>+</mo> <mi>g</mi> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中，r(t)为探测器位置，v(t)为探测器速度，u(t)为控制量，g为行星引力加速度，Δt为时间间隔；令系统状态x(t)＝[r(t)T,v(t)T]T，离散后的模型转化为
x(t+1)＝Adx(t)+Bdu(t)+Cdg (2)
其中，
<mrow> <msub> <mi>A</mi> <mi>d</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> <mtd> <mrow> <msub> <mi>&amp;Delta;tI</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <msub> <mi>B</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mi>C</mi> <mi>d</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;tI</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
探测器在下降过程中受到的工程约束包括：
初始时刻t0及末端时刻tf状态约束
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>=</mo> <mi>x</mi> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msubsup> <mi>r</mi> <mn>0</mn> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>v</mi> <mn>0</mn> <mi>T</mi> </msubsup> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>=</mo> <mi>x</mi> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msubsup> <mi>r</mi> <mi>f</mi> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>v</mi> <mi>f</mi> <mi>T</mi> </msubsup> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
控制量u和速度v幅值约束
umin≤||u||≤umax (4)
||v||≤vmax (5)
保证着陆点始终可见的视线角θ约束
<mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msup> <mi>r</mi> <mi>T</mi> </msup> <msub> <mi>y</mi> <mi>b</mi> </msub> </mrow> <mrow> <mo>|</mo> <mo>|</mo> <mi>r</mi> <mo>|</mo> <mo>|</mo> </mrow> </mfrac> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msubsup> <mi>xy</mi> <mi>b</mi> <mn>1</mn> </msubsup> <mo>+</mo> <msubsup> <mi>yy</mi> <mi>b</mi> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>zy</mi> <mi>b</mi> <mn>3</mn> </msubsup> </mrow> <msqrt> <mrow> <msup> <mi>x</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>&amp;GreaterEqual;</mo> <msub> <mi>cos&amp;theta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
其中探测器位置r＝[x,y,z]T，相机视线方向单位矢量最大视线角为θmax；避免下降过程中与地表突起发生碰撞的滑翔角φ约束
<mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> <mo>=</mo> <mfrac> <mrow> <msup> <mi>r</mi> <mi>T</mi> </msup> <mo>&amp;CenterDot;</mo> <msub> <mi>e</mi> <mn>3</mn> </msub> </mrow> <mrow> <mo>|</mo> <mo>|</mo> <mi>r</mi> <mo>|</mo> <mo>|</mo> </mrow> </mfrac> <mo>=</mo> <mfrac> <mi>z</mi> <msqrt> <mrow> <msup> <mi>x</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>&amp;GreaterEqual;</mo> <msub> <mi>cos&amp;phi;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
其中着陆点固连坐标系竖直方向单位矢量e3＝[0,0,1]T，最大滑翔角为φmax；将燃耗与着陆误差设为优化性能指标，从而行星精确着陆问题转化成为滚动时域上的离散优化问题
<mrow> <mtable> <mtr> <mtd> <mi>min</mi> </mtd> <mtd> <mrow> <mi>J</mi> <mo>=</mo> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mi>N</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mi>P</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mi>N</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>N</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mi>Q</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mi>u</mi> <msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mi>R</mi> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow> 1
s.t.
x(t+1)＝Adx(t)+Bdu(t)+Cdg (2)
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>=</mo> <mi>x</mi> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msubsup> <mi>r</mi> <mn>0</mn> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>v</mi> <mn>0</mn> <mi>T</mi> </msubsup> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mi>f</mi> </msub> <mo>=</mo> <mi>x</mi> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msubsup> <mi>r</mi> <mi>f</mi> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>v</mi> <mi>f</mi> <mi>T</mi> </msubsup> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
umin≤||u||≤umax (4)
||v||≤vmax (5)
<mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;theta;</mi> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msup> <mi>r</mi> <mi>T</mi> </msup> <msub> <mi>y</mi> <mi>b</mi> </msub> </mrow> <mrow> <mo>|</mo> <mo>|</mo> <mi>r</mi> <mo>|</mo> <mo>|</mo> </mrow> </mfrac> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msubsup> <mi>xy</mi> <mi>b</mi> <mn>1</mn> </msubsup> <mo>+</mo> <msubsup> <mi>yy</mi> <mi>b</mi> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>zy</mi> <mi>b</mi> <mn>3</mn> </msubsup> </mrow> <msqrt> <mrow> <msup> <mi>x</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>&amp;GreaterEqual;</mo> <msub> <mi>cos&amp;theta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;phi;</mi> <mo>=</mo> <mfrac> <mrow> <msup> <mi>r</mi> <mi>T</mi> </msup> <mo>&amp;CenterDot;</mo> <msub> <mi>e</mi> <mn>3</mn> </msub> </mrow> <mrow> <mo>|</mo> <mo>|</mo> <mi>r</mi> <mo>|</mo> <mo>|</mo> </mrow> </mfrac> <mo>=</mo> <mfrac> <mi>z</mi> <msqrt> <mrow> <msup> <mi>x</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>&amp;GreaterEqual;</mo> <msub> <mi>cos&amp;phi;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
其中，N为滚动时域长度，P,Q,R分别为末端状态、中间状态及控制向量的权重矩阵，k为第k个滚动时域；
通过求解有限时间内的约束优化问题，保留得到的最优控制序列中第一步的值作为当前时间段的控制量，用动力学递推公式(2)计算下一时刻的状态x(t+1)并作为下一步的初始状态再次进行离散优化问题求解，如此循环，直到探测器到达末端状态，即实现在线生成行星精确着陆制导律和最优轨迹。
3.如权利要求2所述的一种行星精确着陆抗扰制导方法，其特征在于：步骤二具体实现方法为，
考虑下降过程中外界扰动对探测器的影响，对动力学模型(2)进行进一步的转化；令x1＝r,x2＝v，带外界扰动的系统表示为
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>u</mi> <mo>+</mo> <mi>g</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
其中f(t)为外界扰动；为了更好的估计实际外界扰动f(t)大小，将其记为系统的扩张状态变量
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>w</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
其中w(t)为外界扰动变化率；扩张的状态为x(t)＝[x1(t)T,x2(t)T,x3(t)T]T，扩张后的系统表示为
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <mi>u</mi> <mo>+</mo> <mi>g</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <mi>w</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
系统矩阵AE和输出CE矩阵分别为
<mrow> <msub> <mi>A</mi> <mi>E</mi> </msub> <mo>=</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <msub> <mi>C</mi> <mi>E</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
系统的能观性矩阵满秩，即
<mrow> <mi>r</mi> <mi>a</mi> <mi>n</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>N</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>C</mi> <mi>E</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>C</mi> <mi>E</mi> </msub> <msub> <mi>A</mi> <mi>E</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>C</mi> <mi>E</mi> </msub> <msubsup> <mi>A</mi> <mi>E</mi> <mn>2</mn> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>I</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>O</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mn>9</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
故系统能观，构造的扩张状态观测器为
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>e</mi> <mo>=</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>y</mi> <mo>,</mo> <mi>f</mi> <mi>e</mi> <mo>=</mo> <mo>|</mo> <mi>e</mi> <msup> <mo>|</mo> <mn>0.5</mn> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> <mo>,</mo> <msub> <mi>fe</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>|</mo> <mi>e</mi> <msup> <mo>|</mo> <mn>0.25</mn> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&amp;beta;</mi> <mn>01</mn> </msub> <mi>e</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>&amp;beta;</mi> <mn>02</mn> </msub> <mi>f</mi> <mi>e</mi> <mo>+</mo> <mi>u</mi> <mo>+</mo> <mi>g</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>&amp;beta;</mi> <mn>03</mn> </msub> <msub> <mi>fe</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
其中，e为扩张状态观测器输出z1与实际系统输出y的差值，z1,z2,z3分别为扩张状态观测器的三个状态分量，β01,β02,β03为扩张状态观测器参数，系统中控制变量u由步骤一生成；为了避免实际数值仿真中出现震颤现象，采用以下连续幂函数替代式(13)中的fe与fe1
<mrow> <mi>f</mi> <mi>a</mi> <mi>l</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>,</mo> <mi>&amp;alpha;</mi> <mo>,</mo> <mi>&amp;delta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mo>|</mo> <mi>e</mi> <msup> <mo>|</mo> <mi>&amp;alpha;</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> <mo>,</mo> <mo>|</mo> <mi>e</mi> <mo>|</mo> <mo>&gt;</mo> <mi>&amp;delta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mi>e</mi> <msup> <mi>&amp;delta;</mi> <mi>&amp;alpha;</mi> </msup> </mfrac> <mo>,</mo> <mo>|</mo> <mi>e</mi> <mo>|</mo> <mo>&amp;le;</mo> <mi>&amp;delta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
其中α,δ为连续幂函数参数；选择合适的β01,β02,β03，即能实现对所有状态变量的准确估计
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;RightArrow;</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;RightArrow;</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;RightArrow;</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
因此，系统状态与所受到的扰动大小都能够通过系统的实时输入输出信息来进行估计；得到扰动估计量后，通过在步骤一中求解最优问题得到的最优控制量u(t)中加入估计值z3(t)以实现扰动的实时补偿与抑制，降低外界扰动对系统的影响，提高着陆任务的安全性，抗扰制导律为。
um(t)＝u(t)-z3(t) (16)
4.一种行星精确着陆抗扰制导方法，其特征在于：通过在行星下降过程中引入能够直接处理非线性及非凸约束的非线性模型预测控制方法，仅在有限维的滚动时域上计算行星精确着陆轨迹优化问题，降低计算量与求解难度，实现行星精确着陆制导律和最优轨迹的在线生成；同时，考虑下降过程中的外界扰动，采用扩张状态观测器对外界扰动进行实时估计并修正控制量，实现扰动补偿与抑制，提高着陆任务的安全性。
CN201710544571.5A 2017-07-06 2017-07-06 一种行星精确着陆抗扰制导方法 Active CN107202584B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710544571.5A CN107202584B (zh) 2017-07-06 2017-07-06 一种行星精确着陆抗扰制导方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710544571.5A CN107202584B (zh) 2017-07-06 2017-07-06 一种行星精确着陆抗扰制导方法

Publications (2)

Publication Number Publication Date
CN107202584A true CN107202584A (zh) 2017-09-26
CN107202584B CN107202584B (zh) 2020-02-14

Family

ID=59910614

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710544571.5A Active CN107202584B (zh) 2017-07-06 2017-07-06 一种行星精确着陆抗扰制导方法

Country Status (1)

Country Link
CN (1) CN107202584B (zh)

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108196449A (zh) * 2017-12-26 2018-06-22 北京理工大学 最优着陆轨迹设计的协变量初值确定方法
CN108279011A (zh) * 2018-01-30 2018-07-13 北京理工大学 行星探测着陆轨迹综合优化方法
CN108388135A (zh) * 2018-03-30 2018-08-10 上海交通大学 一种基于凸优化的火星着陆轨迹优化控制方法
CN108562293A (zh) * 2018-03-13 2018-09-21 北京理工大学 基于干扰观测器的行星着陆有限时间控制方法
CN109018440A (zh) * 2018-07-23 2018-12-18 哈尔滨工业大学 垂直起降运载火箭子级着陆段精确垂直软着陆四次多项式制导方法
CN109101035A (zh) * 2018-09-13 2018-12-28 西北工业大学 一种用于高空滑翔uuv纵平面弹道控制的方法
CN110095123A (zh) * 2019-05-31 2019-08-06 北京理工大学 不规则小天体表面路标观测信息评价优化方法
CN110209190A (zh) * 2019-03-01 2019-09-06 苏州纳飞卫星动力科技有限公司 一种卫星标称轨道无偏飞行控制的方法
CN110562493A (zh) * 2019-09-06 2019-12-13 北京理工大学 基于矢量轨迹的火星动力下降轨迹规划方法
CN112066999A (zh) * 2020-09-16 2020-12-11 北京控制工程研究所 一种行星着陆过程引力方向实时确定方法
CN112114521A (zh) * 2020-07-30 2020-12-22 南京航空航天大学 航天器智能预测控制进入制导方法
CN112269390A (zh) * 2020-10-15 2021-01-26 北京理工大学 考虑弹跳的小天体表面定点附着轨迹规划方法
CN112428278A (zh) * 2020-10-26 2021-03-02 北京理工大学 机械臂的控制方法、装置及人机协同模型的训练方法
CN113467241A (zh) * 2021-07-06 2021-10-01 北京理工大学 凸曲率着陆轨迹燃耗优化方法
CN113885318A (zh) * 2021-09-15 2022-01-04 北京理工大学 弱引力小天体柔性附着位姿协同控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2006076647A2 (en) * 2005-01-14 2006-07-20 Systems Technology, Inc. Autorotation flight control system
CN102945000A (zh) * 2012-11-29 2013-02-27 北京理工大学 基于可观测性约束的行星着陆轨迹随机优化方法
CN102968124A (zh) * 2012-11-29 2013-03-13 北京理工大学 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法
JP2013206460A (ja) * 2012-03-29 2013-10-07 Mitsubishi Electric Corp 多点境界値問題を解くことに基づいたシステム制御の最適化
CN103926835A (zh) * 2014-04-04 2014-07-16 北京航空航天大学 一种基于干扰观测器的着陆器动力下降段优化控制方法
CN105929835A (zh) * 2016-04-19 2016-09-07 北京理工大学 一种小行星附着轨迹抗差优化方法
CN106742069A (zh) * 2016-12-29 2017-05-31 北京理工大学 一种火星大气进入段最优预测制导方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2006076647A2 (en) * 2005-01-14 2006-07-20 Systems Technology, Inc. Autorotation flight control system
JP2013206460A (ja) * 2012-03-29 2013-10-07 Mitsubishi Electric Corp 多点境界値問題を解くことに基づいたシステム制御の最適化
CN102945000A (zh) * 2012-11-29 2013-02-27 北京理工大学 基于可观测性约束的行星着陆轨迹随机优化方法
CN102968124A (zh) * 2012-11-29 2013-03-13 北京理工大学 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法
CN103926835A (zh) * 2014-04-04 2014-07-16 北京航空航天大学 一种基于干扰观测器的着陆器动力下降段优化控制方法
CN105929835A (zh) * 2016-04-19 2016-09-07 北京理工大学 一种小行星附着轨迹抗差优化方法
CN106742069A (zh) * 2016-12-29 2017-05-31 北京理工大学 一种火星大气进入段最优预测制导方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
STAREK JOSEPH A.,ETC: "Nonlinear model predictive control strategy for low thrust spacecraft missions", 《OPTIMAL CONTROL APPLICATIONS AND METHODS》 *
于正湜，等: "行星着陆自主导航与制导控制研究现状与趋势", 《深空探测学报》 *
崔平远，等: "Receding Horizon-Based Dual Control Strategy for Pinpoint Planetary Landing", 《TRANSACTIONS OF THE JAPAN SOCIETY FOR AERONAUTICAL AND SPACE SCIENCES》 *

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108196449B (zh) * 2017-12-26 2020-04-24 北京理工大学 最优着陆轨迹设计的协变量初值确定方法
CN108196449A (zh) * 2017-12-26 2018-06-22 北京理工大学 最优着陆轨迹设计的协变量初值确定方法
CN108279011A (zh) * 2018-01-30 2018-07-13 北京理工大学 行星探测着陆轨迹综合优化方法
CN108279011B (zh) * 2018-01-30 2021-09-03 北京理工大学 行星探测着陆轨迹综合优化方法
CN108562293A (zh) * 2018-03-13 2018-09-21 北京理工大学 基于干扰观测器的行星着陆有限时间控制方法
CN108562293B (zh) * 2018-03-13 2021-05-28 北京理工大学 基于干扰观测器的行星着陆有限时间控制方法
CN108388135A (zh) * 2018-03-30 2018-08-10 上海交通大学 一种基于凸优化的火星着陆轨迹优化控制方法
CN108388135B (zh) * 2018-03-30 2020-11-10 上海交通大学 一种基于凸优化的火星着陆轨迹优化控制方法
CN109018440A (zh) * 2018-07-23 2018-12-18 哈尔滨工业大学 垂直起降运载火箭子级着陆段精确垂直软着陆四次多项式制导方法
CN109101035A (zh) * 2018-09-13 2018-12-28 西北工业大学 一种用于高空滑翔uuv纵平面弹道控制的方法
CN109101035B (zh) * 2018-09-13 2021-06-11 西北工业大学 一种用于高空滑翔uuv纵平面弹道控制的方法
CN110209190A (zh) * 2019-03-01 2019-09-06 苏州纳飞卫星动力科技有限公司 一种卫星标称轨道无偏飞行控制的方法
CN110209190B (zh) * 2019-03-01 2022-05-20 苏州纳飞卫星动力科技有限公司 一种卫星标称轨道无偏飞行控制的方法
CN110095123A (zh) * 2019-05-31 2019-08-06 北京理工大学 不规则小天体表面路标观测信息评价优化方法
CN110562493A (zh) * 2019-09-06 2019-12-13 北京理工大学 基于矢量轨迹的火星动力下降轨迹规划方法
CN110562493B (zh) * 2019-09-06 2021-03-30 北京理工大学 基于矢量轨迹的火星动力下降轨迹规划方法
CN112114521A (zh) * 2020-07-30 2020-12-22 南京航空航天大学 航天器智能预测控制进入制导方法
CN112114521B (zh) * 2020-07-30 2022-03-01 南京航空航天大学 航天器智能预测控制进入制导方法
CN112066999A (zh) * 2020-09-16 2020-12-11 北京控制工程研究所 一种行星着陆过程引力方向实时确定方法
CN112066999B (zh) * 2020-09-16 2022-08-12 北京控制工程研究所 一种行星着陆过程引力方向实时确定方法及装置
CN112269390B (zh) * 2020-10-15 2021-09-21 北京理工大学 考虑弹跳的小天体表面定点附着轨迹规划方法
CN112269390A (zh) * 2020-10-15 2021-01-26 北京理工大学 考虑弹跳的小天体表面定点附着轨迹规划方法
CN112428278A (zh) * 2020-10-26 2021-03-02 北京理工大学 机械臂的控制方法、装置及人机协同模型的训练方法
CN113467241A (zh) * 2021-07-06 2021-10-01 北京理工大学 凸曲率着陆轨迹燃耗优化方法
CN113467241B (zh) * 2021-07-06 2022-09-16 北京理工大学 凸曲率着陆轨迹燃耗优化方法
CN113885318A (zh) * 2021-09-15 2022-01-04 北京理工大学 弱引力小天体柔性附着位姿协同控制方法
CN113885318B (zh) * 2021-09-15 2023-09-12 北京理工大学 弱引力小天体柔性附着位姿协同控制方法

Also Published As

Publication number Publication date
CN107202584B (zh) 2020-02-14

Similar Documents

Publication Publication Date Title
CN107202584A (zh) 一种行星精确着陆抗扰制导方法
CN102981407B (zh) 一种基于自抗扰控制技术的坦克炮控伺服控制方法
CN106697333B (zh) 一种航天器轨道控制策略的鲁棒性分析方法
CN106773713A (zh) 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法
CN104444817B (zh) 欠驱动吊车自适应消摆定位控制方法
CN103116357B (zh) 一种具有抗干扰容错性能的滑模控制方法
CN103324083B (zh) 基于鲁棒观测器的非线性船舶运动控制方法
CN110376882A (zh) 基于有限时间扩张状态观测器的预定性能控制方法
CN104267734A (zh) 一种燃料最省的火星复杂地形区安全着陆轨迹生成方法
CN103926835A (zh) 一种基于干扰观测器的着陆器动力下降段优化控制方法
CN105174061B (zh) 基于伪谱法的双摆吊车全局时间最优轨迹规划方法
CN105182985A (zh) 高超声速飞行器俯冲段全量一体化制导控制方法
CN108388135A (zh) 一种基于凸优化的火星着陆轨迹优化控制方法
CN104876128A (zh) 带有状态约束的三维桥式吊车增强耦合非线性控制方法
CN109250153A (zh) 火星大气进入段轨迹最优跟踪制导方法
CN107544262A (zh) 一种运载火箭自适应精确回收控制方法
CN102981507A (zh) 一种软着陆自主障碍规避常推力器控制方法
CN102880052A (zh) 基于时标功能分解的高超声速飞行器执行器饱和控制方法
CN103303495A (zh) 一种动力下降过程干扰力矩的估计方法
CN108196449A (zh) 最优着陆轨迹设计的协变量初值确定方法
CN102591212A (zh) 一种时变测量延迟输出信号飞行器纵向运动状态观测方法
CN105930305B (zh) 一种三脉冲交会接近制导方法
CN102945000A (zh) 基于可观测性约束的行星着陆轨迹随机优化方法
CN105353790A (zh) 一种空间绳系机器人目标抓捕后复合体稳定控制方法
CN107817683A (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