CN109164819B - 刚体航天器的反步自适应滑模大角度姿态机动控制方法 - Google Patents
刚体航天器的反步自适应滑模大角度姿态机动控制方法 Download PDFInfo
- Publication number
- CN109164819B CN109164819B CN201810959512.9A CN201810959512A CN109164819B CN 109164819 B CN109164819 B CN 109164819B CN 201810959512 A CN201810959512 A CN 201810959512A CN 109164819 B CN109164819 B CN 109164819B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- rigid
- following
- self
- attitude
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000009795 derivation Methods 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 230000001052 transient effect Effects 0.000 abstract description 4
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Evolutionary Computation (AREA)
- Mathematical Analysis (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Algebra (AREA)
- Medical Informatics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种刚体航天器的反步自适应滑模大角度姿态机动控制方法,包括以下步骤:S1、建立刚体航天器基于误差姿态四元数的运动学方程和动力学方程;S2、设计反步自适应滑模大角度姿态机动控制算法。本发明的有益效果是:可以使航天器系统具有良好的稳定性,当航天器系统惯量发生较大变化时,航天器的姿态能很快趋于稳定;拥有较快的瞬态响应能力。
Description
技术领域
本发明涉及刚体航天器,尤其涉及一种刚体航天器的反步自适应滑模 大角度姿态机动控制方法。
背景技术
传统的姿态控制算法中,不考虑航天器的转动惯量存在摄动,并且传 统的滑模控制算法存在抖振问题,瞬态响应时间长。
发明内容
为了解决现有技术中的问题,本发明提供了一种刚体航天器的反步自 适应滑模大角度姿态机动控制方法。
本发明提供了一种刚体航天器的反步自适应滑模大角度姿态机动控制 方法,包括以下步骤:
S1、建立刚体航天器基于误差姿态四元数的运动学方程和动力学方程;
S2、设计反步自适应滑模大角度姿态机动控制算法。
作为本发明的进一步改进,步骤S1包括:
建立刚体航天器基于误差姿态四元数的运动学方程和动力学方程如下:
其中,qb为航天器本体坐标系相对于惯性坐标系的姿态四元数;qb0为qb的标量部分,qbv为qb的向量部分,并且,qbv=[qb1,qb2,qb3]T;为航天器本体坐标系相对于惯性坐标系的姿态角速度;I3为3×3的单位 矩阵;对于任意的x×表示:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵;为刚体 航天器的对称的转动惯量矩阵,并且, 为转动惯量名义部分, ΔJ为转动惯量不确定性部分;为作用在刚体航天器上的外部控制力 矩; 为时变的外部干扰。
作为本发明的进一步改进,步骤S2包括:
根据方程(1),设计反步自适应滑模大角度姿态机动控制算法:
其中,λ,c>0;
最后,设计控制律(2),有limt→∞qev=limt→∞z2=0成立。
作为本发明的进一步改进,步骤S1包括:
建立刚体航天器基于四元数的运动学方程和动力学方程如下:
其中,qb为航天器本体坐标系相对于惯性坐标系的姿态四元数;qb0为 qb的标量部分,qbv为qb的向量部分,并且,qbv=[qb1,qb2,qb3]T;为航天器本体坐标系相对于惯性坐标系的姿态角速度;I3为3×3的单位 矩阵;对于任意的x×表示:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵。
刚体航天器的动力学方程为:
令
令
经过上述推导,可得刚体航天器的系统模型如下:
作为本发明的进一步改进,步骤S2包括:
建立刚体航天器的反步自适应滑模大角度姿态机动控制算法;
Step 201针对刚体航天器的系统模型(8),定义如下变量:
设计如下的虚拟控制算法:
其中,λ>0。
定义如下Lyapunov函数:
结合刚体航天器的系统模型(8)和虚拟控制算法(9),对上述Lyapunov 函数求时间导数,可得:
针对刚体航天器子系统(10),采用下述的自适应控制算法:
选择下述的Lyapunov函数:
对上述Lyapunov函数求导,并利用控制算法(11),可得:
Step 203设计如下的滑模函数:
s=z2=ωb+λqev (12)
定理:针对刚体航天器系统(8),采用滑模函数(12)和下述的反步 自适应滑模控制算法,刚体航天器系统(8)的状态最终趋于0:
其中,λ,c>0。
证明:选择如下的Lyapunov函数:
结合控制算法(13),对上述Lyapunov函数求导可得:
本发明的有益效果是:通过上述方案,可以使航天器系统具有良好的 稳定性,当航天器系统惯量发生较大变化时,航天器的姿态能很快趋于稳 定;拥有较快的瞬态响应能力。
附图说明
图1是本发明一种刚体航天器的反步自适应滑模大角度姿态机动控制 方法的simulink模型示意图。
具体实施方式
下面结合附图说明及具体实施方式对本发明作进一步说明。
一种刚体航天器的反步自适应滑模大角度姿态机动控制算法,包括:
首先,建立刚体航天器基于四元数的运动学方程和动力学方程如下:
其中,qb为航天器本体坐标系相对于惯性坐标系的姿态四元数;qb0为 qb的标量部分,qbv为qb的向量部分,并且,qbv=[qb1,qb2,qb3]T;为航天器本体坐标系相对于惯性坐标系的姿态角速度;I3为3×3的单位 矩阵;对于任意的x×表示:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵。;为刚 体航天器的转动惯量矩阵(对称),并且, 为转动惯量名义部 分,ΔJ为转动惯量不确定性部分;为作用在刚体航天器上的外部控制 力矩; 为时变的外部干扰。
接下来,建立刚体航天器(14)的反步自适应滑模大角度姿态机动控 制算法。
Step 1针对刚体航天器(8),定义如下变量:
设计如下的虚拟控制算法:
其中,λ>0。
针对刚体航天器子系统(10),采用下述的自适应控制算法:
Step 3设计如下的滑模函数:
s=z2=ωb+λqev (18)
定理针对刚体航天器系统(8),采用滑模函数(12)和下述的反步自 适应滑模控制算法,刚体航天器系统(8)的状态最终趋于0:
其中,λ,c>0。
下面本发明将通过实例说明反步自适应滑模大角度姿态机动控制算法 与的控制效果。
d=[sin(0.2t),2cos(0.3t),3sin(0.4t)]T×10-3N·m
本体姿态四元数qb(0)的初始值为:
qb(0)=[0.7071,0.4082,0.4082,0.4082]T
本体姿态角ωb(0)的初始值为:
ωb(0)=[0.2,-0.3,0.2]T
反步自适应滑模大角度姿态机动控制算法的参数为:
λ=0.5;c=1
本发明提供的一种刚体航天器的反步自适应滑模大角度姿态机动控制 方法,针对转动惯量存不确定性的刚体航天器姿态机动问题,设计了一种 反步自适应滑模姿态机动控制算法。该发明算法的目的在于解决刚体航天 器姿态控制问题。该发明采用误差四元数法来表示刚体航天器姿态的运动 学方程,建立转动惯量存在不确定性的航天器动力学方程。然后利用反步 法、自适应控制、滑模控制,并结合Lyapunov直接法,逐步设计出了反步 自适应滑模姿态控制算法。最后,运用MATLAB中的simulink模块验证设 计的控制算法的有效性,如图1所示。
本发明提供的一种刚体航天器的反步自适应滑模大角度姿态机动控制 方法,相比现有技术,具有如下进步:
1、采用本发明设计的反步自适应滑模大角度姿态机动控制方法可以使 航天器系统具有良好的稳定性,当航天器系统惯量发生较大变化时,航天 器的姿态能很快趋于稳定;
2、拥有较快的瞬态响应能力。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说 明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术 领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若 干简单推演或替换,都应当视为属于本发明的保护范围。
Claims (3)
1.一种刚体航天器的反步自适应滑模大角度姿态机动控制方法,其特征在于,包括以下步骤:
S1、建立刚体航天器基于误差姿态四元数的运动学方程和动力学方程;
S2、设计反步自适应滑模大角度姿态机动控制算法;
步骤S1包括:
建立刚体航天器基于误差姿态四元数的运动学方程和动力学方程如下:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵;为刚体航天器的对称的转动惯量矩阵,并且, 为转动惯量名义部分,△J为转动惯量不确定性部分;为作用在刚体航天器上的外部控制力矩;为时变的外部干扰;
步骤S2包括:
根据方程(1),设计反步自适应滑模大角度姿态机动控制算法:
其中,λ,c>0;
最后,设计控制律(2),有limt→∞qev=limt→∞z2=0成立。
2.根据权利要求1所述的刚体航天器的反步自适应滑模大角度姿态机动控制方法,其特征在于:步骤S1包括:
建立刚体航天器基于四元数的运动学方程和动力学方程如下:
其中,qb为航天器本体坐标系相对于惯性坐标系的姿态四元数;qb0为qb的标量部分,qbv为qb的向量部分,并且,qbv=[qb1,qb2,qb3]T;为航天器本体坐标系相对于惯性坐标系的姿态角速度;I3为3×3的单位矩阵;对于任意的x×表示:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵;
刚体航天器的动力学方程为:
令
令
经过上述推导,可得刚体航天器的系统模型如下:
3.根据权利要求2所述的刚体航天器的反步自适应滑模大角度姿态机动控制方法,其特征在于:步骤S2包括:
建立刚体航天器的反步自适应滑模大角度姿态机动控制算法;
Step 201针对刚体航天器的系统模型(8),定义如下变量:
设计如下的虚拟控制算法:
其中,λ>0;
定义如下Lyapunov函数:
结合刚体航天器的系统模型(8)和虚拟控制算法(9),对上述Lyapunov函数求时间导数,可得:
针对刚体航天器子系统(10),采用下述的自适应控制算法:
选择下述的Lyapunov函数:
对上述Lyapunov函数求导,并利用控制算法(11),可得:
Step 203设计如下的滑模函数:
s=z2=ωb+λqev (12)
定理:针对刚体航天器的系统模型(8),采用滑模函数(12)和下述的反步自适应滑模控制算法,使得刚体航天器的系统模型(8)的状态最终趋于0:
其中,λ,c>0;
证明:选择如下的Lyapunov函数:
结合控制算法(13),对上述Lyapunov函数求导可得:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810959512.9A CN109164819B (zh) | 2018-08-22 | 2018-08-22 | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810959512.9A CN109164819B (zh) | 2018-08-22 | 2018-08-22 | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109164819A CN109164819A (zh) | 2019-01-08 |
CN109164819B true CN109164819B (zh) | 2021-09-14 |
Family
ID=64896489
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810959512.9A Expired - Fee Related CN109164819B (zh) | 2018-08-22 | 2018-08-22 | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109164819B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110134137B (zh) * | 2019-06-18 | 2021-11-23 | 哈尔滨工业大学(深圳) | 基于扩张状态观测器的航天器姿态跟踪控制方法 |
CN110550239B (zh) * | 2019-08-30 | 2022-07-08 | 南京航空航天大学 | 基于饱和反步法的航天器分布式姿态超敏捷机动控制方法 |
CN111413995B (zh) * | 2020-03-24 | 2021-03-05 | 北京科技大学 | 双刚体特征点间相对位置跟踪与姿态同步控制方法及系统 |
CN111874266B (zh) * | 2020-03-27 | 2022-03-01 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103412491A (zh) * | 2013-08-27 | 2013-11-27 | 北京理工大学 | 一种挠性航天器特征轴姿态机动指数时变滑模控制方法 |
CN105404304A (zh) * | 2015-08-21 | 2016-03-16 | 北京理工大学 | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 |
CN106886149A (zh) * | 2017-02-23 | 2017-06-23 | 哈尔滨工业大学 | 一种航天器鲁棒有限时间饱和姿态跟踪控制方法 |
CN107678281A (zh) * | 2017-10-16 | 2018-02-09 | 哈尔滨工业大学深圳研究生院 | 基于修正型罗德里格参数的挠性航天器自适应姿态控制律 |
CN107703742A (zh) * | 2017-09-06 | 2018-02-16 | 南京邮电大学 | 一种柔性航天器传感器故障调节方法 |
CN107728628A (zh) * | 2017-08-25 | 2018-02-23 | 中国人民解放军火箭军装备研究院 | 角速度不可量测条件下航天器姿态有限时间追踪控制方法 |
CN107861383A (zh) * | 2017-10-23 | 2018-03-30 | 天津大学 | 基于自适应观测器的卫星故障诊断与容错控制方法 |
CN108153322A (zh) * | 2017-12-06 | 2018-06-12 | 北京航空航天大学 | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 |
CN108427428A (zh) * | 2018-03-25 | 2018-08-21 | 哈尔滨工程大学 | 基于改进迭代算法的自适应滑模变结构航天器姿态控制方法 |
-
2018
- 2018-08-22 CN CN201810959512.9A patent/CN109164819B/zh not_active Expired - Fee Related
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103412491A (zh) * | 2013-08-27 | 2013-11-27 | 北京理工大学 | 一种挠性航天器特征轴姿态机动指数时变滑模控制方法 |
CN105404304A (zh) * | 2015-08-21 | 2016-03-16 | 北京理工大学 | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 |
CN106886149A (zh) * | 2017-02-23 | 2017-06-23 | 哈尔滨工业大学 | 一种航天器鲁棒有限时间饱和姿态跟踪控制方法 |
CN107728628A (zh) * | 2017-08-25 | 2018-02-23 | 中国人民解放军火箭军装备研究院 | 角速度不可量测条件下航天器姿态有限时间追踪控制方法 |
CN107703742A (zh) * | 2017-09-06 | 2018-02-16 | 南京邮电大学 | 一种柔性航天器传感器故障调节方法 |
CN107678281A (zh) * | 2017-10-16 | 2018-02-09 | 哈尔滨工业大学深圳研究生院 | 基于修正型罗德里格参数的挠性航天器自适应姿态控制律 |
CN107861383A (zh) * | 2017-10-23 | 2018-03-30 | 天津大学 | 基于自适应观测器的卫星故障诊断与容错控制方法 |
CN108153322A (zh) * | 2017-12-06 | 2018-06-12 | 北京航空航天大学 | 一种考虑时变的转动惯量的航天器姿态跟踪自适应容错控制方法 |
CN108427428A (zh) * | 2018-03-25 | 2018-08-21 | 哈尔滨工程大学 | 基于改进迭代算法的自适应滑模变结构航天器姿态控制方法 |
Non-Patent Citations (3)
Title |
---|
丛炳龙等.刚体航天器姿态跟踪系统的自适应积分滑模控制.《航空学报》.2013,第34卷(第3期),第620-628页. * |
刚体航天器姿态有限时间稳定控制;方辉等;《系统工程学报》;20140630;第29卷(第3期);第299-308,314页 * |
刚体航天器姿态跟踪系统的自适应积分滑模控制;丛炳龙等;《航空学报》;20130325;第34卷(第3期);第620-628页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109164819A (zh) | 2019-01-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109164819B (zh) | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 | |
Wang et al. | Robust H∞ attitude tracking control of a quadrotor UAV on SO (3) via variation-based linearization and interval matrix approach | |
CN110716566B (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN105159304B (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
Dierks et al. | Control of nonholonomic mobile robot formations: Backstepping kinematics into dynamics | |
Lai et al. | Adaptive position/attitude tracking control of aerial robot with unknown inertial matrix based on a new robust neural identifier | |
CN107688295A (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
Kang et al. | Pseudospectral optimal control theory makes debut flight, saves NASA $1 M in under three hours | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
CN111874266B (zh) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 | |
CN108037662A (zh) | 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN107992084B (zh) | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 | |
CN107065913B (zh) | 挠性航天器的滑模变结构姿态控制方法 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN116009594B (zh) | 一种基于零和博弈的高超声速飞行器状态约束容错控制方法 | |
CN107247459A (zh) | 抗干扰飞行控制方法及装置 | |
CN110488854B (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
CN112130584B (zh) | 基于命令滤波的四旋翼飞行器有限时间自适应控制方法 | |
Zhang et al. | Finite-time attitude optimization maneuver control for coupled spacecraft under attitude measurement errors and actuator faults | |
CN115959307B (zh) | 一种绳系卫星的预定时间姿态稳定控制方法 | |
CN112305917A (zh) | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 | |
Huang et al. | Robust control allocation in attitude fault-tolerant control for combined spacecraft under measurement uncertainty | |
CN107942672A (zh) | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN117055604A (zh) | 一种无人飞艇误差受限移动路径跟踪控制方法 | |
CN113703471B (zh) | 刚体航天器基于mrp参数的抗退绕滑模姿态机动控制方法 |
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 |
Granted publication date: 20210914 |
|
CF01 | Termination of patent right due to non-payment of annual fee |