CN113697131B - 刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 - Google Patents
刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 Download PDFInfo
- Publication number
- CN113697131B CN113697131B CN202110995865.6A CN202110995865A CN113697131B CN 113697131 B CN113697131 B CN 113697131B CN 202110995865 A CN202110995865 A CN 202110995865A CN 113697131 B CN113697131 B CN 113697131B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- sliding mode
- attitude
- unwinding
- rigid
- 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 24
- 239000011159 matrix material Substances 0.000 claims description 10
- 239000000126 substance Substances 0.000 claims description 6
- HOWHQWFXSLOJEF-MGZLOUMQSA-N systemin Chemical compound NCCCC[C@H](N)C(=O)N[C@@H](CCSC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CC(O)=O)C(=O)OC(=O)[C@@H]1CCCN1C(=O)[C@H]1N(C(=O)[C@H](CC(O)=O)NC(=O)[C@H](CCCN=C(N)N)NC(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H]2N(CCC2)C(=O)[C@H]2N(CCC2)C(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@@H](NC(=O)[C@H](C)N)C(C)C)CCC1 HOWHQWFXSLOJEF-MGZLOUMQSA-N 0.000 claims description 3
- 108010050014 systemin Proteins 0.000 claims description 3
- 238000009795 derivation Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种刚体航天器的抗退绕滑模姿态跟踪控制方法及系统,所述方法包括如下步骤:步骤S1:建立刚体航天器姿态跟踪误差的运动学方程和动力学方程;步骤S2:采用双曲正弦函数构造滑模函数,使得滑模面包含两个平衡点;步骤S3:基于李雅普诺夫稳定性理论,设计抗退绕滑模姿态跟踪控制算法;步骤S4:设计动态参数,给出两个平衡点对应的吸引域;步骤S5:将抗退绕滑模姿态跟踪控制算法应用于刚体航天器跟踪控制,避免航天器发生退绕的情况。本发明通过抗退绕滑模姿态跟踪控制方法可以使航天器系统具有良好的稳定性,当航天器系统受到外部干扰进行姿态跟踪时,航天器的姿态能很快趋于稳定,无退绕现象。
Description
技术领域
本发明属于刚体航天器技术领域,涉及一种刚体航天器的带动态参数的抗退绕滑模姿态跟踪控制方法及系统。
背景技术
传统的姿态控制算法中,在航天器进行姿态机动的过程中发生退绕现象。在这种情况下,可能会发生下述两种现象:一、当航天器的初始姿态与期望姿态相同、角速度误差较小时,如果qe0=-1,那么航天器需要旋转2π角度重新回到期望的姿态;二、当航天器绕欧拉轴转角的一阶导数的初始值接近0,且航天器接近期望姿态时,如果此时qe0接近-1。那么,在控制律的作用下,首先航天器旋转角减小至0,然后增大远离期望的姿态,最后角速度误差减小至0,航天器再次到达期望姿态。上述描述的两种现象被称为“退绕现象”。发生退绕现象的航天器可能需要绕欧拉轴的旋转一个大于2π的旋转角才能完成姿态跟踪任务。退绕现象会造成能量损耗。目前抗退绕的姿态控制律非常少,而且现有的抗退绕姿态控制律并没有给出抗退绕性能的证明,并且没有给出闭环系统两个平衡点对应的收敛域。
发明内容
为了解决现有技术中的问题,本发明提供了一种刚体航天器的抗退绕滑模姿态跟踪控制方法及系统。本发明通过抗退绕滑模姿态跟踪控制方法可以使刚体航天器在姿态跟踪过程中无退绕现象。
本发明的目的是通过以下技术方案实现的:
一种刚体航天器的抗退绕滑模姿态跟踪控制方法,包括如下步骤:
步骤S1:建立如下刚体航天器姿态跟踪误差的运动学方程和动力学方程:
其中,qe∈R4为航天器本体姿态,ωe∈R3为航天器本体坐标系相对于期望坐标系的姿态角速度在本体坐标系下的姿态角速度;ωd∈R3为期望坐标系相对于惯性坐标系在期望坐标系下的姿态角速度;d为上界已知的时变外部干扰,J∈R3×3为刚体航天器的对称的转动惯量矩阵;u为作用在刚体航天器上的外部控制力矩;ωb∈R3为航天器本体坐标系相对于惯性坐标系的姿态角速度;qe0,qev分别为qe的标量部分和向量部分,I3为3×3的单位矩阵;
步骤S2:为了避免姿态变量在滑模面上滑动期间出现退绕现象,采用双曲正弦函数构造滑模函数,使得滑模面包含两个平衡点;
步骤S3:基于李雅普诺夫稳定性理论,设计如下抗退绕滑模姿态跟踪控制算法:
步骤S4:设计抗退绕滑模姿态跟踪控制算法的动态参数,给出两个平衡点对应的吸引域,其中,动态参数β2(t)为:
步骤S5:将抗退绕滑模姿态跟踪控制算法应用于刚体航天器跟踪控制,避免航天器发生退绕的情况。
一种实现上述方法的抗退绕滑模姿态跟踪控制系统,包括方程建立模块、滑模函数模块、算法设计模块、应用模块,其中:
所述方程建立模块用于建立刚体航天器姿态跟踪误差的运动学方程和动力学方程;
所述滑模函数模块用于构造滑模函数,使得滑模面包含两个平衡点;
所述算法设计模块用于基于李雅普诺夫理论,设计抗退绕滑模姿态机动控制算法;
所述应用模块用于将抗退绕滑模姿态机动控制算法应用于刚体航天器姿态跟踪控制系统,避免航天器发生退绕的情况。
相比于现有技术,本发明具有如下优点:
1、本发明通过抗退绕滑模姿态跟踪控制方法可以使航天器系统具有良好的稳定性,当航天器系统受到外部干扰进行姿态跟踪时,航天器的姿态能很快趋于稳定,无退绕现象。
2、本发明解决了刚体航天器姿态跟踪过程中存在退绕的问题。该方法采用误差四元数法来表示刚体航天器姿态跟踪误差的运动学方程,然后采用双曲正弦函数设计滑模函数,并结合Lyapunov直接法,最后设计出抗退绕滑模姿态跟踪控制算法,从而有效地避免了航天器发生退绕的情况。并且,通过设计提出的控制律的动态参数,给出了闭环系统两个平衡点对应的吸引域。
3、本发明与CN111874266A不同之处有两点:(1)处理的不是同一类姿态控制问题。CN111874266A处理的是刚体航天器静态-静态姿态机动控制问题,而本发明处理的是刚体航天器的姿态跟踪控制问题。(2)设计的控制律不同。CN111874266A设计的控制律是不同有限时间收敛特性,而本发明设计的控制律是有限时间控制律。
附图说明
图1为本发明刚体航天器的抗退绕滑模姿态跟踪控制方法的流程图。
具体实施方式
下面结合附图对本发明的技术方案作进一步的说明,但并不局限于此,凡是对本发明技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,均应涵盖在本发明的保护范围中。
本发明提供了一种刚体航天器的抗退绕滑模姿态跟踪控制方法,如图1所示,所述方法包括如下步骤:
步骤S1:建立刚体航天器姿态跟踪误差的运动学方程和动力学方程。
本步骤中,姿态跟踪误差的运动学方程和动力学方程为基于四元数描述的运动学方程和动力学方程。航天器本体坐标系的运动学方程和动力学方程基于四元数描述,具体公式如下:
其中,qb为航天器本体坐标系相对于惯性坐标系的姿态四元数;qb0为qb的标量部分,qbv为qb的向量部分,且qbv=[qb1 qb2 qb3]T;为航天器本体坐标系相对于惯性坐标系的姿态角速度;I3为3×3的单位矩阵;针对任何一个三维向量x=[x1,x2,x3]T,x×为下述的反对称矩阵:
显然,对于任意一个3维的列向量x,x×是一个反对称矩阵。
刚体航天器的动力学方程具体如下:
定义航天器本体坐标系相对于期望坐标系的姿态误差四元数为定义航天器本体坐标系相对于期望坐标系的姿态角速度在本体坐标系下的姿态角速度表示为qe0,分别为qe的标量部分和向量部分。航天器从期望坐标系转到本体坐标系的姿态旋转矩阵R(qe)为:
ωe=ω-R(qe)ωd (7)。
其中,
且有:
另外,误差四元数可以用下述欧拉轴角表示:
步骤S2:为了避免姿态变量在滑模面上滑动期间出现退绕现象,采用双曲正弦函数构造滑模函数,使得滑模面包含两个平衡点。
本步骤中,采用双曲正弦构造的滑模函数如下:
s=ωe+λσ (12);
本步骤中,如果基于姿态跟踪误差四元数的刚体航天器的动力学方程的姿态误差被限制在滑模面s=0上时,姿态误差变量ωe,qev收敛至0。此外,当姿态误差变量在滑模面s=0上,无退绕现象。
步骤S3:基于李雅普诺夫稳定性理论,设计抗退绕滑模姿态跟踪控制算法。
本步骤中,针对航天器的姿态误差方程,考虑如下形式的状态反馈控制律:
u=ueq+un+uf (13);
航天器系统(公式(8))的名义部分为:
将该式和公式(8)的第二个方程代入公式(14),可得:
ueq=-τ-λJσ (15)。
控制项un设计为:
un=-β1Jf(s) (16);
其中,参数β1>0。控制项uf设计为:
uf=-β2(t)Jf(s) (17);
其中,β2(t)为一个正值的函数,且
总结上述推导,本发明设计的抗退绕滑模姿态机动控制方法为:
步骤S4:设计控制律的动态参数,给出两个平衡点对应的吸引域。
本步骤中,设计的动态参数β2(t)为:
闭环系统的稳定性分析:
本步骤中,针对刚体航天器的姿态误差方程(8),如果设计的抗退绕刚体航天器的参数γ2(t)选择为:
那么,有下述结论:
(1)滑模函数s在有限时间内趋于0;
(2)在系统的状态变量到达滑模面之前不会出现退绕现象。
步骤S5:将抗退绕滑模姿态跟踪控制算法应用于刚体航天器跟踪控制,避免航天器发生退绕的情况。
一种实现上述方法的抗退绕滑模姿态跟踪控制系统,包括方程建立模块、滑模函数模块、算法设计模块、应用模块,其中:
所述方程建立模块用于建立刚体航天器姿态跟踪误差的运动学方程和动力学方程;
所述滑模函数模块用于构造滑模函数,使得滑模面包含两个平衡点;
所述算法设计模块用于基于李雅普诺夫理论,设计抗退绕滑模姿态机动控制算法;
所述应用模块用于将抗退绕滑模姿态机动控制算法应用于刚体航天器姿态跟踪控制系统,避免航天器发生退绕的情况。
Claims (3)
1.一种刚体航天器的抗退绕滑模姿态跟踪控制方法,其特征在于所述方法包括如下步骤:
步骤S1:建立如下刚体航天器姿态跟踪误差的运动学方程和动力学方程:
其中,qe∈R4为航天器本体姿态,ωe∈R3为航天器本体坐标系相对于期望坐标系的姿态角速度在本体坐标系下的姿态角速度;ωd∈R3为期望坐标系相对于惯性坐标系在期望坐标系下的姿态角速度;d为上界已知的时变外部干扰,J∈R3×3为刚体航天器的对称的转动惯量矩阵;u为作用在刚体航天器上的外部控制力矩;ωb∈R3为航天器本体坐标系相对于惯性坐标系的姿态角速度;qe0,qev分别为qe的标量部分和向量部分,I3为3×3的单位矩阵;
步骤S2:采用双曲正弦函数构造滑模函数,使得滑模面包含两个平衡点,所述滑模函数如下:
s=ωe+λσ;
步骤S3:基于李雅普诺夫稳定性理论,设计如下抗退绕滑模姿态跟踪控制算法:
步骤S4:设计抗退绕滑模姿态跟踪控制算法的动态参数,给出两个平衡点对应的吸引域,其中,动态参数β2(t)为:
步骤S5:将抗退绕滑模姿态跟踪控制算法应用于刚体航天器跟踪控制,避免航天器发生退绕的情况。
3.一种实现权利要求1-2任一项所述方法的抗退绕滑模姿态跟踪控制系统,其特征在于所述系统包括方程建立模块、滑模函数模块、算法设计模块、应用模块,其中:
所述方程建立模块用于建立刚体航天器姿态跟踪误差的运动学方程和动力学方程;
所述滑模函数模块用于构造滑模函数,使得滑模面包含两个平衡点;
所述算法设计模块用于基于李雅普诺夫理论,设计抗退绕滑模姿态机动控制算法;
所述应用模块用于将抗退绕滑模姿态机动控制算法应用于刚体航天器姿态跟踪控制系统,避免航天器发生退绕的情况。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110995865.6A CN113697131B (zh) | 2021-08-27 | 2021-08-27 | 刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110995865.6A CN113697131B (zh) | 2021-08-27 | 2021-08-27 | 刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113697131A CN113697131A (zh) | 2021-11-26 |
CN113697131B true CN113697131B (zh) | 2022-04-22 |
Family
ID=78656036
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110995865.6A Active CN113697131B (zh) | 2021-08-27 | 2021-08-27 | 刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113697131B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114488790B (zh) * | 2021-12-17 | 2023-07-04 | 西南科技大学 | 一种基于名义模型的全向移动机器人自适应滑膜控制方法 |
CN114879708B (zh) * | 2022-04-19 | 2023-03-14 | 四川大学 | 一种固定时间收敛的航天器姿态跟踪抗退绕控制方法 |
CN116954068A (zh) * | 2023-06-16 | 2023-10-27 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种基于连续滑模的抗退绕姿轨联合机动控制算法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6454217B1 (en) * | 2000-09-28 | 2002-09-24 | Space Systems/Loral, Inc. | Method and apparatus for rate integration supplement for attitude referencing with quaternion differencing |
CN101708780B (zh) * | 2009-11-26 | 2012-12-05 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN108663936B (zh) * | 2018-05-08 | 2019-06-25 | 中国人民解放军战略支援部队航天工程大学 | 模型不确定航天器无退绕姿态跟踪有限时间控制方法 |
CN108646556B (zh) * | 2018-05-08 | 2019-06-25 | 中国人民解放军战略支援部队航天工程大学 | 输入饱和航天器无退绕姿态跟踪控制方法 |
CN108563126B (zh) * | 2018-05-28 | 2021-08-03 | 浙江工业大学 | 基于双曲正弦增强型幂次趋近律和快速终端滑模面的四旋翼飞行器自适应控制方法 |
CN110083171A (zh) * | 2019-04-30 | 2019-08-02 | 哈尔滨工业大学(深圳) | 挠性航天器的动态滑模姿态跟踪控制的方法及系统 |
CN111874266B (zh) * | 2020-03-27 | 2022-03-01 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 |
-
2021
- 2021-08-27 CN CN202110995865.6A patent/CN113697131B/zh active Active
Non-Patent Citations (2)
Title |
---|
使用变速控制力矩陀螺的航天器鲁棒自适应姿态跟踪控制;刘军等;《航空学报》;20080115;第29卷(第01期);第159-164页 * |
刚体航天器姿态跟踪的时变滑模控制(英文);靳永强等;《Chinese Journal of Aeronautics》;20080815(第04期);第352-360页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113697131A (zh) | 2021-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113697131B (zh) | 刚体航天器的抗退绕滑模姿态跟踪控制方法及系统 | |
CN111874266B (zh) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 | |
Sun et al. | A composite control scheme for 6DOF spacecraft formation control | |
Nanos et al. | On the dynamics and control of flexible joint space manipulators | |
CN112904728B (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
Xia et al. | Robust adaptive backstepping neural networks control for spacecraft rendezvous and docking with input saturation | |
CN107263481B (zh) | 一种多自由度机器人的类脑学习控制方法 | |
Rastegari et al. | Multiple impedance control of space free-flying robots via virtual linkages | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
CN115649491B (zh) | 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法 | |
Jin et al. | Observer-based fixed-time tracking control for space robots in task space | |
CN109782787A (zh) | 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法 | |
CN113619814B (zh) | 一种交会对接最后逼近段相对姿轨耦合控制方法 | |
An et al. | Adaptive trajectory tracking controller design for a quadrotor UAV with payload variation | |
Nguyen et al. | Super-twisting observer-based sliding mode control with fuzzy variable gains and its applications to fully-actuated hexarotors | |
Zhang et al. | A novel nonlinear control for tracking and rendezvous with a rotating non-cooperative target with translational maneuver | |
CN109683480A (zh) | 考虑执行器故障的非线性机械系统类固定时间控制方法 | |
Jia et al. | Decentralized adaptive sliding mode control of a space robot actuated by control moment gyroscopes | |
CN116069050A (zh) | 一种抗扰动的旋翼无人机吊载系统减摇控制方法及装置 | |
CN114740733A (zh) | 一种航天器姿态重定向的最优固定时间滑模控制方法 | |
CN110405761A (zh) | 一种机器人关节的仿生粘弹性控制方法 | |
Sun et al. | Robust adaptive relative position and attitude control for spacecraft autonomous proximity | |
Park | Robust and optimal attitude control of spacecraft with inertia uncertainties using minimal kinematic parameters | |
Zhao et al. | Neural-network-based adaptive finite-time control for a two-degree-of-freedom helicopter system with an event-triggering mechanism |
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 |