CN111221254B - 一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 - Google Patents
一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 Download PDFInfo
- Publication number
- CN111221254B CN111221254B CN202010222952.3A CN202010222952A CN111221254B CN 111221254 B CN111221254 B CN 111221254B CN 202010222952 A CN202010222952 A CN 202010222952A CN 111221254 B CN111221254 B CN 111221254B
- Authority
- CN
- China
- Prior art keywords
- time
- spacecraft
- attitude
- terminal
- optimal control
- 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
- 238000000034 method Methods 0.000 title claims abstract description 57
- 206010048669 Terminal state Diseases 0.000 claims abstract description 8
- 238000005265 energy consumption Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 abstract description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000012804 iterative process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于割线法确定终端时间的航天器姿态调整能量‑时间混合最优控制方法,首先,根据航天器的转动惯量建立其受控姿态运动学方程。第二,确定姿态调整过程的初始、终端状态,并描述状态、控制变量受到的约束。第三,根据运动学方程、姿态调整过程的边界条件和约束,建立能量‑时间混合最优控制问题。第四,将原始的能量‑时间最优控制问题转化为一系列具有固定终端时间的最优控制问题,利用割线法迭代逼近真实的终端时间,进而求解原始问题。本发明能够方便的考虑任务中状态变量与控制变量的约束,并确定终端时间,避免传统直接转化为非线性数学规划问题求解过程中存在的强非线性问题,对于航天器姿态调整任务的高效、可靠求解具有重要意义。
Description
技术领域
本发明属于航天器姿态控制领域,涉及一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法。
背景技术
太空中运行的航天器需要频繁地进行姿态调整,以完成对地或对其他航天器的信号传输。航天器姿态调整任务中,任务消耗的能量与完成任务的时间是评价任务效能的两个关键因素。现有研究中通常提前设置固定的任务时长,从而利用最优控制方法,实现能量最有意义下的姿态调整过程。然而,设置固定的任务时长通常不能充分发挥控制器的能力,无法实现姿态调整任务的快速完成。事实上,在能量-时间混合最优的框架下,可以进行姿态调整任务中能量消耗与任务时长两方面的均衡,是一种较为理想的求解策略。但是,能量-时间混合最优控制问题中,终端时间是不固定的。若直接将问题离散成非线性数学规划问题,则数值算法中配点的位置将是终端时间的线性函数,在进一步利用配点生成对应位置状态变量和控制变量相关信息时,将会产生极为复杂的非线性关系,使得导致的非线性规划问题的非线性程度极高,从而严重增加了对高质量初始猜测的依赖。这在很大程度上影响了求解效率,甚至会造成无法收敛的状况。
发明内容
为了解决上述技术问题,本发明将航天器姿态调整对应的能量-时间混合最优控制问题,转化为一系列具有固定终端时间的能量最优控制问题,在提供两个合理的终端时间初始猜测的基础上,根据终端时间不定最优控制问题中终端时间相关的横截条件,利用割线法,实现终端时间的迭代确定。由于在每个迭代步中,求解的是一个具有明确终端时间的最优控制问题,配点位置是确定的,可以使用成熟的最优控制数值方法快速实现求解,从而保证了整个求解过程的效率与鲁棒性。
为了达到上述目的,本发明采用的技术方案为:
一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法,首先,根据航天器的转动惯量,建立航天器的受控姿态运动学方程。第二,确定姿态调整过程的初始状态与终端状态,并使用不等式描述航天器姿态调整过程中状态变量与控制变量受到的约束。第三,根据航天器的运动学方程、姿态调整过程的边界条件和约束,建立能量-时间混合最优控制问题。第四,将原始的能量-时间最优控制问题转化为一系列具有固定终端时间的最优控制问题,利用割线法迭代逼近真实的终端时间以实现原始问题的求解。本发明的计算流程图如图1所示,包括以下步骤:
步骤1:建立航天器的受控姿态运动学方程;
使用状态空间x描述航天器的姿态,并确定对应的控制变量u,根据航天器的转动惯量,建立如下的航天器受控姿态运动学方程:
其中,t为时间变量。
步骤2:确定航天器姿态调整过程中的初始与终端状态,并设定状态变量与控制变量的相关约束条件;
记姿态调整任务的开始时刻为ts,航天器对应的初始状态为xs。记姿态调整任务中期待的航天器终端状态为xf。
为完成特定的信息传出任务,姿态调整过程中航天器的姿态需要满足一定的条件;同时,为避免控制饱和,需要对控制变量时间相应的箱型约束。为此,将姿态调整任务中状态变量与控制变量对应的约束条件采用如下的不等式约束描述:
h(x,u,t)≤0 (2)
步骤3:建立航天器姿态调整过程的能量-时间混合最优控制问题
根据航天器的受控姿态运动学方程,以及姿态调整任务的边界条件和存在的约束条件,建立如下的能量-时间混合最优控制问题:
其中,tf为姿态调整任务结束的时刻,ts为姿态调整任务开始的时刻,x(ts)为姿态调整任务的初始边界条件,x(tf)为姿态调整任务的终端边界条件,T=tf-ts表示姿态调整任务的执行时间,为姿态调整任务的能量消耗,α为能量-时间混合最优控制问题中执行时间的权重。
当问题P收敛时,应满足如下的横截条件:
其中,λ为问题P对应的协态变量。
步骤4:利用割线法迭代逼近真实的终端时间以实现原始问题的求解
步骤4-1:设置两个合理的终端时间的初始猜测,并提供对应的状态变量与控制变量的初始猜测;
设置两个合理的终端时间的初始猜测为与将问题P中终端时间tf分别固定为建立子问题P(j),使用数值算法进行求解子问题P(j),记收状态变量、控制变量和协态变量的收敛解分别为x(j)、λ(j)与u(j),并计算
步骤4-2:迭代过程初始化
设置收敛误差ε,令迭代指标k=2。所述收敛误差ε根据期望的数值解精度进行选取,一般不大于10-2。
步骤4-3:更新迭代指标k=k+1。
步骤4-4:利用割线法更新终端时间为:
步骤4-5:流程判断
本发明相对于现有技术,有益效果在于:在能量-时间混合最优控制框架下求解航天器姿态调整任务,能够方便的考虑任务中状态变量与控制变量的约束,将原始的终端时间不定最优控制问题转化为一系列终端时间固定问题,并利用割线法迭代确定终端时间,避免了传统直接转化为非线性数学规划问题求解过程中存在的强非线性问题,对于航天器姿态调整任务的高效、可靠求解具有重要意义。本发明中阐述的方法具有很强的可操作性和可行性,便于实际应用。
附图说明
图1为本发明的计算流程图。
图2为本发明利用割线法确定终端时间的原理图。
图3为本发明实施例中航天器的示意图。
图4为本发明实施例中状态变量的变化历程。
图5为本发明实施例中控制输入的变化历程。
图6为本发明实施例中终端时间的迭代历程。
具体实施方式
以下结合具体实施例对本发明做进一步说明。
图2为一航天器示意图,其绕轴1、轴2、轴3的转动惯量分别为I1=86.24,I2=85.07与I3=113.59(单位kg·m2)。绕轴1、轴2、轴3的角速度分别记为ωk(k=1,2,3)(单位rad/s)。由动量轮提供的转矩分别为uk(k=1,2,3)(单位N·m)。
一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法,包括以下步骤:
步骤1:建立航天器的受控姿态运动学方程
使用状态空间x=[ω1,ω2,ω3]T描述航天器的姿态,并选取控制变量u=[u1,u2,u3]T,建立如下的航天器受控姿态运动学方程
步骤2:确定航天器姿态调整过程中的初始与终端状态,并设定状态变量与控制变量的相关约束条件
记姿态调整任务的开始时刻为ts=0s,航天器对应的初始状态为xs=[0.01,0.005,0.001]T。记姿态调整任务中期待的航天器终端状态为xf=[0,0,0]T。
姿态调整过程中,要求角速度ω1(t)满足如下约束条件
ω1(t)-(5×10-6t2-5×10-4t+0.016)≤0 (7)
控制变量满足如下约束
|uk|≤0.02,(k=1,2,3) (8)
将公式(7)~(8)中的约束条件使用如下的不等式约束描述
h(x,u,t)≤0 (9)
步骤3:建立航天器姿态调整过程的能量-时间混合最优控制问题
根据航天器的受控姿态运动学方程(6),以及姿态调整任务的边界条件和存在的约束条件(9),建立如下的能量-时间混合最优控制问题:
其中,tf为姿态调整任务结束的时刻,T=tf表示姿态调整任务的执行时间,取能量-时间混合最优控制问题中执行时间的权重为α=1×10-4。当问题P收敛时,应满足如下的横截条件
其中λ为问题P对应的协态变量。
步骤4:利用割线法迭代逼近真实的终端时间以实现原始问题的求解
步骤4-1:设置两个合理的终端时间的初始猜测,并提供对应的状态变量与控制变量的初始猜测
设置两个合理的终端时间的初始猜测与将问题P中终端时间tf分别固定为建立子问题P(j),使用数值算法进行求解子问题P(j),记收状态变量、控制变量和协态变量的收敛解分别为x(j)、λ(j)与u(j),并计算
步骤4-2:迭代过程初始化
设置收敛误差ε=1×10-10,令迭代指标k=2。
步骤4-3:更新迭代指标
更新迭代指标k=k+1。
步骤4-4:利用割线法更新终端时间
根据图2,利用割线法更新终端时间为
步骤4-5:流程判断
根据上述步骤,经过7次迭代收敛,终端时间为tf=66.99087s,性能指标J=0.01370051217。计算得到的航天的状态变量与控制输入的时间历程分别如图4~图5所示,终端时间的迭代历程如图6所示。
本发明将航天器姿态调整对应的能量-时间混合最优控制问题,转化为一系列具有固定终端时间的能量最优控制问题,在提供两个合理的终端时间初始猜测的基础上,根据终端时间不定最优控制问题中终端时间相关的横截条件,利用割线法,实现终端时间的迭代确定。由于在每个迭代步中,求解的是一个具有明确终端时间的最优控制问题,配点位置是确定的,可以使用成熟的最优控制数值方法快速实现求解,从而保证了整个求解过程的效率与鲁棒性。
以上所述实施例仅表达本发明的实施方式,但并不能因此而理解为对本发明专利的范围的限制,应当指出,对于本领域的技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些均属于本发明的保护范围。
Claims (2)
1.一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法,其特征在于,包括以下步骤:
步骤1:建立航天器的受控姿态运动学方程;
使用状态空间x描述航天器的姿态,并确定对应的控制变量u,根据航天器的转动惯量,建立如下的航天器受控姿态运动学方程
其中,t为时间变量;
步骤2:确定航天器姿态调整过程中的初始与终端状态,并设定状态变量与控制变量的相关约束条件;
记姿态调整任务的开始时刻为ts,航天器对应的初始状态为xs;记姿态调整任务中期待的航天器终端状态为xf;
为完成特定的信息传出任务,姿态调整过程中航天器的姿态需要满足一定条件;同时,为避免控制饱和,需要对控制变量时间相应的箱型约束;为此,将姿态调整任务中状态变量与控制变量对应的约束条件使用如下的不等式约束描述:
h(x,u,t)≤0 (2)
步骤3:建立航天器姿态调整过程的能量-时间混合最优控制问题;
根据航天器的受控姿态运动学方程,以及姿态调整任务的边界条件和存在的约束条件,建立如下的能量-时间混合最优控制问题:
其中,tf为姿态调整任务结束的时刻,ts为姿态调整任务开始的时刻,x(ts)为姿态调整任务的初始边界条件,x(tf)为姿态调整任务的终端边界条件,T=tf-ts表示姿态调整任务的执行时间,为姿态调整任务的能量消耗,α为能量-时间混合最优控制问题中执行时间的权重;
当问题P收敛时,应满足如下的横截条件
其中,λ为问题P对应的协态变量;
步骤4:利用割线法迭代逼近真实的终端时间以实现原始问题的求解;
步骤4-1:设置两个合理的终端时间的初始猜测,并提供对应的状态变量与控制变量的初始猜测;
设置两个合理的终端时间的初始猜测与将问题P中终端时间tf分别固定为j=1,2,建立子问题P(j),使用数值算法进行求解子问题P(j),记收状态变量、控制变量和协态变量的收敛解分别为x(j)、λ(j)与u(j),并计算
步骤4-2:迭代过程初始化,设置收敛误差ε,令迭代指标k=2;
步骤4-3:更新迭代指标k=k+1;
步骤4-4:利用割线法更新终端时间为:
步骤4-5:流程判断;
2.根据权利要求1所述的一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法,其特征在于,所述收敛误差ε根据期望的数值解精度进行选取,不大于10-2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010222952.3A CN111221254B (zh) | 2020-03-26 | 2020-03-26 | 一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010222952.3A CN111221254B (zh) | 2020-03-26 | 2020-03-26 | 一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111221254A CN111221254A (zh) | 2020-06-02 |
CN111221254B true CN111221254B (zh) | 2021-08-10 |
Family
ID=70808035
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010222952.3A Active CN111221254B (zh) | 2020-03-26 | 2020-03-26 | 一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111221254B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102354215A (zh) * | 2011-05-18 | 2012-02-15 | 航天东方红卫星有限公司 | 一种任务最佳观测时刻点的确定方法 |
CN109062243A (zh) * | 2018-10-31 | 2018-12-21 | 长光卫星技术有限公司 | 一种多约束下航天器能量最优的自主碰撞规避方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5251855A (en) * | 1990-05-09 | 1993-10-12 | Agence Spatiale Europeenne | Spacecraft propulsion system thruster firing system |
EP1979409A1 (en) * | 2006-01-10 | 2008-10-15 | ExxonMobil Chemical Patents Inc. | Films incorporating polymeric material combinations, articles made therefrom, and methods of making such films and articles |
FR2915525B1 (fr) * | 2007-04-25 | 2012-10-12 | Peugeot Citroen Automobiles Sa | Procede et dispositif de regulation du regime d'un moteur equipe d'une commande en couple |
US8360180B2 (en) * | 2007-12-31 | 2013-01-29 | Caterpillar Inc. | System for controlling a hybrid energy system |
CN103591963B (zh) * | 2013-10-22 | 2016-06-08 | 浙江大学 | 一种微型化星敏感器及其实现方法 |
CN104331083A (zh) * | 2014-11-21 | 2015-02-04 | 大连大学 | 一种航天器大角度姿态控制参数优化方法 |
CN108984934B (zh) * | 2018-07-26 | 2022-09-27 | 西北工业大学 | 一种基于周向或切向混合连续小推力的轨道设计方法 |
CN110908396B (zh) * | 2019-11-28 | 2023-02-21 | 天津大学 | 可重复使用运载器全阶段再入返回制导方法 |
-
2020
- 2020-03-26 CN CN202010222952.3A patent/CN111221254B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102354215A (zh) * | 2011-05-18 | 2012-02-15 | 航天东方红卫星有限公司 | 一种任务最佳观测时刻点的确定方法 |
CN109062243A (zh) * | 2018-10-31 | 2018-12-21 | 长光卫星技术有限公司 | 一种多约束下航天器能量最优的自主碰撞规避方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111221254A (zh) | 2020-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020124938A1 (zh) | 柔性关节机械臂分数阶滑模优化控制方法 | |
CN109901403A (zh) | 一种自主水下机器人神经网络s面控制方法 | |
JP4825099B2 (ja) | ブレード翼型設計方法 | |
CN104698842B (zh) | 一种基于内点法的lpv模型非线性预测控制方法 | |
CN110543184B (zh) | 一种刚性飞行器的固定时间神经网络控制方法 | |
CN114839880B (zh) | 一种基于柔性关节机械臂的自适应控制方法 | |
CN107272409B (zh) | 一种基于迭代学习的直线伺服系统振动抑制方法 | |
CN110471281B (zh) | 一种轨迹跟踪控制的变论域模糊控制系统及控制方法 | |
CN114169230A (zh) | 一种机器人动力学参数的辨识方法 | |
CN110488854B (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
CN111221254B (zh) | 一种基于割线法确定终端时间的航天器姿态调整能量-时间混合最优控制方法 | |
CN112580274A (zh) | 一种适用于组合动力高超声速飞机的轨迹优化方法 | |
CN115139301A (zh) | 基于拓扑结构自适应神经网络的机械臂运动规划方法 | |
CN114297797B (zh) | 基于ann的燃机透平阻尼叶片结构等效刚度阻尼分析方法 | |
CN112093078B (zh) | 一种高精度高效率飞行器轨迹优化与制导切换方法 | |
CN114063458A (zh) | 一种非三角结构系统不依赖初始条件的预设性能控制方法 | |
CN110119085B (zh) | 一种Manutec R3型工业机器人动态优化系统 | |
Shao et al. | A simulation data-driven design approach for rapid product optimization | |
CN111381496A (zh) | 一种独立尾缘欠驱动机翼颤振滑模控制方法 | |
CN108415247B (zh) | 一种基于标称信息的时标分离飞行器弹性体鲁棒控制方法 | |
CN110977971A (zh) | 一种基于模糊集理论的Delta机器人控制方法 | |
Sharkawy et al. | A robust fuzzy tracking control scheme for robotic manipulators with experimental verification | |
Guangcun et al. | Control of quadrotor drone with partial state observation via reinforcement learning | |
CN109711527B (zh) | 一种基于粒子群优化算法的机器人操纵方法 | |
CN112948973B (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 |