CN111498147B - 挠性航天器的有限时间分段滑模姿态跟踪控制算法 - Google Patents
挠性航天器的有限时间分段滑模姿态跟踪控制算法 Download PDFInfo
- Publication number
- CN111498147B CN111498147B CN202010258906.9A CN202010258906A CN111498147B CN 111498147 B CN111498147 B CN 111498147B CN 202010258906 A CN202010258906 A CN 202010258906A CN 111498147 B CN111498147 B CN 111498147B
- Authority
- CN
- China
- Prior art keywords
- flexible
- finite
- attitude
- sliding mode
- tracking 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.)
- Expired - Fee Related
Links
- 230000011218 segmentation Effects 0.000 title claims abstract description 13
- 238000000034 method Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000013016 damping Methods 0.000 claims description 4
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 230000001629 suppression Effects 0.000 abstract description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Chemical & Material Sciences (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Operations Research (AREA)
- Evolutionary Computation (AREA)
- Algebra (AREA)
- Geometry (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- Computer Hardware Design (AREA)
Abstract
本发明公开了挠性航天器的有限时间分段滑模姿态跟踪控制算法,该方法包括(S1)建立挠性航天器基于误差四元数和欧拉轴/角的运动学方程和动力学方程;(S2)采用分段滑模面函数,并基于Lyapunov有限时间稳定函数确定有限时间分段滑模跟踪控制律;(S3)构造挠性模态观测器测量挠性状态变量,设计带挠性模态观测器的有限时间分段滑模姿态跟踪控制律;(S4)运用MATLAB中的Simulink模块验证设计的控制算法的有效性。通过上述方案,本发明达到了解决挠性航天器在执行任务过程中存在有界干扰和惯性不确定性时的姿态控制及挠性附件的振动抑制问题的目的,具有很高的实用价值和推广价值。
Description
技术领域
本发明属于挠性航天器姿态控制技术领域,具体地讲,是涉及挠性航天器的有限时间分段滑模姿态跟踪控制算法。
背景技术
传统的挠性航天器姿态滑模控制算法中,不考虑挠性航天器的惯性存在不确定性和外界干扰,并且传统的滑模控制算法只保证系统状态在单一滑模面滑动,并且无法保证系统状态有限时间稳定。因此如何解决现有技术存在的技术问题是本领域技术人员亟需解决的问题。
发明内容
为了克服现有技术中的上述不足,本发明提供一种挠性航天器的有限时间分段滑模姿态跟踪控制算法,能够解决挠性航天器在执行任务过程中存在有界干扰和惯性不确定性时的姿态控制及挠性附件的振动抑制问题。
为了实现上述目的,本发明采用的技术方案如下:
挠性航天器的有限时间分段滑模姿态跟踪控制算法,包括如下步骤:
(S1)建立挠性航天器基于误差四元数和欧拉轴/角的运动学方程和动力学方程;
(S2)采用分段滑模面函数,并基于Lyapunov有限时间稳定函数确定有限时间分段滑模跟踪控制律;
(S3)构造挠性模态观测器测量挠性状态变量,设计带挠性模态观测器的有限时间分段滑模姿态跟踪控制律;
(S4)运用MATLAB中的Simulink模块验证设计的控制算法的有效性。
进一步地,所述步骤(S1)中以姿态四元数和欧拉轴/角表示方法建立挠性航天器姿态误差的运动学方程,采用混合坐标法对中心刚体带有挠性附件、外部干扰、惯性不确定性的挠性航天器建立动力学方程。
进一步地,所述运动学方程如下所示:
进一步地,所述动力学方程如下所示:
其中,Jmb为刚体部分的转动惯量且J为耦合转动惯量,是期望值,为转动惯量不确定系;δ为挠性航天器的挠性部分与刚体主体之间的耦合矩阵;ωd为期望速度,R为旋转矩阵,Rωd为两变量相乘;C,K分别为阻尼矩阵和刚度矩阵。
进一步地,所述步骤(S2)中分段滑模面函数如下所示:
其中,k1,k2,k3,α,β,γ均为正标量的参数,且γ满足1/2<γ<1。
进一步地,所述步骤(S2)中Lyapunov有限时间稳定函数如下所示:
其中,Vq为Lyapunov函数;qv为姿态四元数矢量部分;T为矩阵的转置。。
具体地,所述步骤(S3)中带挠性模态观测器的有限时间分段滑模姿态跟踪控制律如下:
其中,p为正数,满足1>p>0;se为单位方向向量且满足se=s/||s||;λ为正数,满足且λM为最大特征值,sgn(s)为s的符号函数;k为正的可调参数;s为滑模面;l1、l2、l3、Δ均为引入的中间变量,无实际含义。
与现有技术相比,本发明具有以下有益效果:
(1)本发明针对存在外界干扰和惯量不确定性的挠性航天器姿态控制问题,设计了一种有限时间分段滑模姿态控制算法。该算法利用姿态四元数和欧拉轴/角表示方法建立挠性航天器姿态误差运动学方程和动力学方程,采用分段滑模控制思想,基于Ltapunov有限时间稳定定理设计一种有限时间分段滑模跟踪控制律,同时构造挠性模态观测器测量挠性状态变量,设计带挠性模态观测器的有限时间分段滑模跟踪控制律,最后,运用MATLAB中的Simulink模块验证设计的控制算法的有效性。从而有效地解决挠性航天器在执行任务过程中存在有界干扰和惯性不确定性时的姿态控制及挠性附件的振动抑制问题。
附图说明
图1为本发明的系统流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明,本发明的实施方式包括但不限于下列实施例。
实施例
如图1所示,挠性航天器的有限时间分段滑模姿态跟踪控制算法,包括如下步骤:
(S1)建立挠性航天器基于误差四元数和欧拉轴/角的运动学方程和动力学方程;
以姿态四元数和欧拉轴/角为基础的挠性航天器姿态误差运动学方程分别如下所示:
其中qe0,qev分别为姿态误差四元数的标量部分与向量部分,
挠性航天的动力学方程如下
C=diag{2ξ1ωn1,2ξ2ωn2,…,2ξNωnN}
考虑N个弹性模态,其对应的自然角频率为ωni,i=1,2,...,N,对应的阻尼为ξi,i=1,2,...,N;η为挠性模态,ψ是与挠性模态和误差角速度相关的中间变量;u表示控制力矩,d表示有界外部干扰力矩,假设为外部干扰力矩的上界;旋转矩阵R具有如下定义:
(S2)采用分段滑模面函数,并基于Lyapunov有限时间稳定函数确定有限时间分段滑模跟踪控制律;
设计如下分段滑模面函数S:
其中,k1,k2,k3,α,β,γ均为正标量的参数且γ满足1/2<γ<1。为保证三段滑动模态的连续性,控制参数满足如下关系:
k1=αk2,k2=βγ-1k3
三段滑动模态分别为恒角速度的机动阶段、慢减速阶段和收敛阶段。首先,保证在前两阶段滑模面的有限时间滑动:
在收敛阶段,要满足qv有限时间收敛到0,由此角速度ω在沿着滑模面滑动也将收敛于0。
证明方法为选择Lyapunov函数:
对其求导得到利用有限时间稳定定理得证。
(S3)构造挠性模态观测器测量挠性状态变量,设计带挠性模态观测器的有限时间分段滑模姿态跟踪控制律;
设计的挠性卫星有限时间分段滑模姿态跟踪控制律如下:
其中,p是正数,满足1>p>0,se是单位方向向量且满足se=s/||s||,λ是正数,满足(λM表示最大特征值),sgn(s)是s的符号函数。当1/2<γ<1时,保证了挠性航天器的控制器不存在奇异问题。
为了证明控制器有限时间稳定,选取如下的Lyapunov函数:
在实际应用中模态η和ψ难以测量时,针对挠性航天器姿态误差系统设计基于动态观测器的滑模控制律。
动态观测器形式如下:
正定对称矩阵P满足下述Lyapunov方程:
针对挠性模态不可测的情形下,设计如下多模态滑模面:
设计的基于动态观测器的挠性卫星有限时间分段滑模姿态跟踪控制律如下:
其中,
(S4)运用MATLAB中的Simulink模块验证设计的控制算法的有效性。
上述实施例仅为本发明的优选实施例,并非对本发明保护范围的限制,但凡采用本发明的设计原理,以及在此基础上进行非创造性劳动而做出的变化,均应属于本发明的保护范围之内。
Claims (6)
1.挠性航天器的有限时间分段滑模姿态跟踪控制算法,其特征在于,包括如下步骤:
(S1)建立挠性航天器基于误差四元数和欧拉轴/角的运动学方程和动力学方程;
(S2)采用分段滑模面函数,并基于Lyapunov有限时间稳定函数确定有限时间分段滑模跟踪控制律;
(S3)构造挠性模态观测器测量挠性状态变量,设计带挠性模态观测器的有限时间分段滑模姿态跟踪控制律;具体控制律如下:
其中,p为正数,满足1>p>0;se为单位方向向量且满足se=s/||s||;λ为正数,满足且λM为最大特征值,sgn(s)为s的符号函数;k为正的可调参数;s为滑模面;l1、l2、l3、Δ均为引入的中间变量,无实际含义;ωd为期望角速度;qev为姿态误差四元数的向量部分;η为挠性模态,ψ是与挠性模态和误差角速度相关的中间变量;u表示控制力矩,d表示有界外部干扰力矩;α,β均为正的标量参数,无实际含义;
(S4)运用MATLAB中的Simulink模块验证设计的控制算法的有效性。
2.根据权利要求1所述的挠性航天器的有限时间分段滑模姿态跟踪控制算法,其特征在于,所述步骤(S1)中以误差四元数和欧拉轴/角表示方法建立挠性航天器姿态误差的运动学方程,采用混合坐标法对中心刚体带有挠性附件、外部干扰、惯性不确定性的挠性航天器建立动力学方程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010258906.9A CN111498147B (zh) | 2020-04-03 | 2020-04-03 | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010258906.9A CN111498147B (zh) | 2020-04-03 | 2020-04-03 | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111498147A CN111498147A (zh) | 2020-08-07 |
CN111498147B true CN111498147B (zh) | 2021-09-21 |
Family
ID=71871825
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010258906.9A Expired - Fee Related CN111498147B (zh) | 2020-04-03 | 2020-04-03 | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111498147B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113325861B (zh) * | 2021-06-02 | 2023-03-24 | 上海海事大学 | 一种非奇异预设时间四旋翼无人机姿态跟踪控制方法 |
CN113671978B (zh) * | 2021-08-20 | 2023-12-01 | 大连海事大学 | 一种基于符号函数的动力定位固定时间控制方法 |
CN114229039B (zh) * | 2021-12-14 | 2023-09-15 | 内蒙古工业大学 | 一种充液柔性航天器自适应无角速度复合控制方法 |
CN114326399B (zh) * | 2021-12-28 | 2023-12-05 | 天津大学 | 一种宽频惯性基准单元有限时间抗干扰控制方法 |
CN114400935B (zh) * | 2021-12-31 | 2024-02-23 | 西安理工大学 | 基于快速有限时间控制的感应电机复合控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106406086A (zh) * | 2016-05-26 | 2017-02-15 | 北京航空航天大学 | 一种基于滑模干扰观测器的大挠性航天器干扰补偿方法 |
CN107065913A (zh) * | 2017-05-10 | 2017-08-18 | 哈尔滨工业大学深圳研究生院 | 挠性航天器的滑模变结构姿态控制算法 |
CN107943062A (zh) * | 2017-09-13 | 2018-04-20 | 哈尔滨工业大学深圳研究生院 | 带外部干扰力矩的挠性卫星姿态滑模控制方法 |
CN109213184A (zh) * | 2018-11-06 | 2019-01-15 | 哈尔滨工业大学(深圳) | 挠性航天器的有限时间多模态滑模姿态控制算法 |
CN109507892A (zh) * | 2019-01-22 | 2019-03-22 | 哈尔滨工业大学(深圳) | 挠性航天器的自适应滑模姿态稳定控制方法 |
CN110083171A (zh) * | 2019-04-30 | 2019-08-02 | 哈尔滨工业大学(深圳) | 挠性航天器的动态滑模姿态跟踪控制的方法及系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5723582B2 (ja) * | 2010-11-30 | 2015-05-27 | インターナショナル・ビジネス・マシーンズ・コーポレーションInternational Business Machines Corporation | スライディング・モード制御方式において、制御器を構成する方法、プログラム及びシステム |
-
2020
- 2020-04-03 CN CN202010258906.9A patent/CN111498147B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106406086A (zh) * | 2016-05-26 | 2017-02-15 | 北京航空航天大学 | 一种基于滑模干扰观测器的大挠性航天器干扰补偿方法 |
CN107065913A (zh) * | 2017-05-10 | 2017-08-18 | 哈尔滨工业大学深圳研究生院 | 挠性航天器的滑模变结构姿态控制算法 |
CN107943062A (zh) * | 2017-09-13 | 2018-04-20 | 哈尔滨工业大学深圳研究生院 | 带外部干扰力矩的挠性卫星姿态滑模控制方法 |
CN109213184A (zh) * | 2018-11-06 | 2019-01-15 | 哈尔滨工业大学(深圳) | 挠性航天器的有限时间多模态滑模姿态控制算法 |
CN109507892A (zh) * | 2019-01-22 | 2019-03-22 | 哈尔滨工业大学(深圳) | 挠性航天器的自适应滑模姿态稳定控制方法 |
CN110083171A (zh) * | 2019-04-30 | 2019-08-02 | 哈尔滨工业大学(深圳) | 挠性航天器的动态滑模姿态跟踪控制的方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111498147A (zh) | 2020-08-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111498147B (zh) | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 | |
CN103412491B (zh) | 一种挠性航天器特征轴姿态机动指数时变滑模控制方法 | |
CN108527372B (zh) | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 | |
CN107831655B (zh) | 微陀螺仪的分数阶自适应反演模糊滑模控制方法 | |
CN108227504B (zh) | 微陀螺分数阶自适应模糊神经反演终端滑模控制方法 | |
CN111874266B (zh) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 | |
CN110543184B (zh) | 一种刚性飞行器的固定时间神经网络控制方法 | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN113306747A (zh) | 基于so(3)群的挠性航天器姿态稳定控制方法和系统 | |
CN109213184B (zh) | 挠性航天器的有限时间多模态滑模姿态控制算法 | |
CN108710296B (zh) | 微陀螺仪的分数阶自适应快速终端滑模控制方法 | |
CN108663936B (zh) | 模型不确定航天器无退绕姿态跟踪有限时间控制方法 | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN113619814B (zh) | 一种交会对接最后逼近段相对姿轨耦合控制方法 | |
CN105912007A (zh) | 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法 | |
CN107861386A (zh) | 一种基于角速度观测器的抗干扰姿态控制地面验证系统及其控制方法 | |
CN111459188A (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN110488854B (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
CN107943062A (zh) | 带外部干扰力矩的挠性卫星姿态滑模控制方法 | |
CN108427277A (zh) | 基于非对称时变反正切型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法 | |
CN108536164B (zh) | 挠性航天器无角速度测量的姿态控制方法 | |
CN117022674A (zh) | 一种抗退绕挠性航天器姿态跟踪复合控制方法 | |
CN114536348B (zh) | 一种高欠驱动空间机械臂运动灵巧性评估方法 | |
CN113848958B (zh) | 基于四元数的全驱动抗退绕水下机器人有限时间容错轨迹跟踪控制方法 | |
CN114987800A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210921 |
|
CF01 | Termination of patent right due to non-payment of annual fee |