CN110032204B - 输入时延下多空间飞行器姿态协同控制方法 - Google Patents
输入时延下多空间飞行器姿态协同控制方法 Download PDFInfo
- Publication number
- CN110032204B CN110032204B CN201910334255.4A CN201910334255A CN110032204B CN 110032204 B CN110032204 B CN 110032204B CN 201910334255 A CN201910334255 A CN 201910334255A CN 110032204 B CN110032204 B CN 110032204B
- Authority
- CN
- China
- Prior art keywords
- fuzzy
- aircraft
- time delay
- matrix
- controller
- 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 52
- 239000011159 matrix material Substances 0.000 claims abstract description 37
- 230000009466 transformation Effects 0.000 claims abstract description 10
- 150000001875 compounds Chemical class 0.000 claims description 18
- 238000004891 communication Methods 0.000 claims description 10
- 239000000126 substance Substances 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 230000036544 posture Effects 0.000 description 4
- 230000001360 synchronised effect Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000001934 delay Effects 0.000 description 2
- 102000002274 Matrix Metalloproteinases Human genes 0.000 description 1
- 108010000684 Matrix Metalloproteinases Proteins 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation 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
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (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
技术领域
本发明涉及一种多空间飞行器姿态协同控制方法,特别涉及一种输入时延下多空间飞行器姿态协同控制方法。
背景技术
文献“Decentralized Consensus Control of A Rigid-Body SpacecraftFormation with Communication Delay,Journal of Guidance Control and Dynamics,2016,39(4),838-851”公开了一种基于非线性补偿的多空间飞行器姿态协同控制方法。该方法研究了多个空间飞行器的姿态同步一致性问题,设计了输入时延控制算法,将系统中的非线性项作为控制补偿项反馈到控制输入中。文献中所述的基于非线性补偿控制的方法优点在于控制器易于设计,存在的技术问题在于其针对输入时延的鲁棒性较弱,在较大时延下系统的性能较差。
发明内容
为了克服现有多空间飞行器姿态协同控制方法对输入时延的鲁棒性较弱的不足,本发明提供一种输入时延下多空间飞行器姿态协同控制方法。该方法利用模糊理论将多飞行器姿态动力学系统构建为由一系列模糊逻辑组成的模糊系统,针对构建出的模糊系统设计分布式控制器,得到闭环系统,并将该闭环系统进行等价转化,针对转化后的等价系统,利用时延依赖李雅普诺夫稳定性理论和线性矩阵不等式方法给出保证系统稳定的充分条件,并设计控制器参数。本发明方法针对输入时延的鲁棒性更强,在较大时延下仍能保证系统具有较好的性能。
本发明解决其技术问题所采用的技术方案:一种输入时延下多空间飞行器姿态协同控制方法,其特点是包括以下步骤:
步骤一、利用模糊理论将多飞行器姿态动力学系统构建为由一系列模糊逻辑组成的模糊系统。给出如下多飞行器姿态动力学模型:
式中,Ji表示惯性矩阵;qi(t)和qi0(t)分别表示姿态四元数的矢量和标量部分;ωi(t)表示姿态角速度;ui(t)表示作用于飞行器的控制输入;τ(t)表示输入时延变量,且有0≤τ(t)≤τ和其中τ和ρ为正的常数。式(1)化作如下状态空间方程的形式:
式中,
为便于构建模糊系统,定义如下变量:
xi(t)=[xi1(t)xi2(t)xi3(t)xi4(t)xi5(t)xi6(t)]T,
ωi(t)=[ωi1(t)ωi2(t)ωi3(t)]T,
qi(t)=[qi1(t)qi2(t)qi3(t)]T.
利用模糊系统准则,将式(2)中所示的非线性系统化作如下模糊系统:
式中,
步骤二、针对步骤一中构建出的模糊系统(4)设计姿态同步控制器,得到闭环系统,并将该闭环系统进行等价转化。利用模糊准则设计如下姿态同步模糊控制器:
式中,
将式(6)代入到式(4)中,得到如下所示的闭环系统:
式中,
式中,
步骤三、针对步骤二中转化得到的等价系统(8),利用时延依赖李雅普诺夫稳定性理论和线性矩阵不等式方法给出保证系统稳定的充分条件,并设计控制器参数。针对等价变换之后的模糊系统(8),选取如下李雅普诺夫函数:
式中,
本发明的有益效果是:该方法利用模糊理论将多飞行器姿态动力学系统构建为由一系列模糊逻辑组成的模糊系统,针对构建出的模糊系统设计分布式控制器,得到闭环系统,并将该闭环系统进行等价转化,针对转化后的等价系统,利用时延依赖李雅普诺夫稳定性理论和线性矩阵不等式方法给出保证系统稳定的充分条件,并设计控制器参数。本发明方法针对输入时延的鲁棒性更强,在较大时延下仍能保证系统具有较好的性能。
由于采用基于模糊理论的姿态协同控制方法和时延依赖李雅普诺夫稳定性理论,能够对输入时延具有更强的鲁棒性,保证系统在较大的时延下仍具有良好的控制性能。取输入时延最大值分别为2秒、6秒、10秒这3种情况,采用文献中给出的非线性补偿方法时,多飞行器系统实现姿态同步的时间分别为40秒、100秒、120秒,而最大控制输入力矩分别为0.48N·m、6.6N·m、7N·m;采用本发明方法能够保证多飞行器系统的姿态分别在40秒、50秒、80秒内同步收敛,而所需的最大控制输入力矩则分别为0.19N·m、0.3N·m、0.51N·m。因此,相比于背景技术的非线性补偿方法,本发明方法能够以更小的控制力矩来实现更快的姿态角同步收敛速度,且输入时延越大,本发明所提出方法的优势越明显。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明输入时延下多空间飞行器姿态协同控制方法的流程图。
图2是本发明方法实施例中3个空间飞行器之间的通讯拓扑结构。
图3是本发明方法实施例中,在基于模糊理论的控制方法作用下,第1、第2个飞行器之间的相对姿态角误差曲线。
图4是本发明方法实施例中,在文献给出的非线性补偿控制方法作用下,第1、第2个飞行器之间的相对姿态角误差曲线。
图5是本发明方法实施例中,在基于模糊理论的控制方法作用下,第1个飞行器的控制输入曲线。
图6是本发明方法实施例中,在文献给出的非线性补偿控制方法作用下,第1个飞行器的控制输入曲线。
具体实施方式
参照图1-6。本发明输入时延下多空间飞行器姿态协同控制方法具体步骤如下:
步骤一、利用模糊理论将多飞行器姿态动力学系统构建为由一系列模糊逻辑组成的模糊系统。首先给出如下多飞行器姿态动力学模型:
式中,Ji表示惯性矩阵;qi(t)和qi0(t)分别表示姿态四元数的矢量和标量部分;ωi(t)表示姿态角速度;ui(t)表示作用于飞行器的控制输入;τ(t)表示输入时延变量,且有0≤τ(t)≤τ和其中τ和ρ为正的常数。此外,式(1)还可化作如下状态空间方程的形式:
式中,
为便于构建模糊系统,定义如下变量:
xi(t)=[xi1(t)xi2(t)xi3(t)xi4(t)xi5(t)xi6(t)]T,
ωi(t)=[ωi1(t)ωi2(t)ωi3(t)]T,
qi(t)=[qi1(t)qi2(t)qi3(t)]T.
利用模糊系统准则,将式(2)中所示的非线性系统化作如下模糊系统:
式中,
步骤二、针对步骤一中构建出的模糊系统(4)设计姿态同步控制器,得到闭环系统,并将该闭环系统进行等价转化。首先利用模糊准则设计如下姿态同步模糊控制器:
式中,
将式(6)代入到式(4)中,便可得到如下所示的闭环系统:
式中,
式中,
步骤三、针对步骤二中转化得到的等价系统(8),利用时延依赖李雅普诺夫稳定性理论和线性矩阵不等式方法给出保证系统稳定的充分条件,并设计控制器参数。针对等价变换之后的模糊系统(8),选取如下李雅普诺夫函数:
式中,
此外,由于数值仿真软件MATLAB中已有非常成熟的用于求解线性矩阵不等式的工具箱,因此不等式(10)可直接利用工具箱进行求解。
采用以下实施例验证本发明的有益效果:
假设系统中有3个飞行器,且自身状态信息均可获取,飞行器之间的通信拓扑结构如图2所示,因此通信拓扑对应的拉普拉斯矩阵和描述自身状态信息的权矩阵为
取3个飞行器的惯性矩阵分别为
将4组工作点代入到原系统中,便可得到4组模糊规则对应的系数矩阵。再令R=I3,便可计算出式(6)中给出的控制器对应的控制增益矩阵,如下所示:
此外,根据文献中采取的非线性补偿控制方法,给出如下所示的非线性补偿姿态同步控制器:
对于式(12)中的非线性补偿控制器,取k=0.05。
选取3个飞行器的状态初值分别为
q1(0)=[0.50.50.5]T,ω1(0)=[-0.1-0.1-0.1]T,
q2(0)=[0.40.40.4]T,ω2(0)=[-0.08-0.08-0.08]T,
q3(0)=[0.30.30.3]T,ω3(0)=[-0.06-0.06-0.06]T.
再选取3种不同的输入时延τ(t),便可得到在不同的输入时延影响下,多空间飞行器系统在文献中给出的非线性补偿控制器(12)和本发明基于模糊理论的控制器(5)作用下的姿态角误差曲线和控制输入曲线。通过仿真曲线可知,当输入时延为τ(t)=sin(0.1t)+1秒,即最大时延为2秒时,两种控制器均能保证飞行器的姿态角在40秒内同步收敛,本发明方法所需的最大控制力矩则为0.19N·m,而文献中采用的方法所需的最大控制力矩则为0.48N·m;当输入时延为τ(t)=3sin(0.1t)+3秒,即最大时延为6秒时,本发明方法能够保证飞行器的姿态角在50秒内同步收敛,所需的最大控制力矩则为0.3N·m,而文献中采用的方法能够保证飞行器的姿态角在100秒内同步收敛,所需的最大控制力矩则为6.6N·m;当输入时延为τ(t)=5sin(0.1t)+5秒,即最大时延为10秒时,本发明方法能够保证飞行器的姿态角在80秒内同步收敛,所需的最大控制力矩则为0.51N·m,而文献中采用的方法能够保证飞行器的姿态角在120秒内同步收敛,所需的最大控制力矩则为7N·m。因此,相比于文献中给出的非线性补偿方法,本发明基于模糊理论的方法能够以更小的控制力矩来实现更快的姿态角收敛速度,且输入时延越大,本发明方法的优势越明显。
本发明未详细介绍的内容(如图论、线性矩阵不等式、李雅普诺夫稳定性理论)属于本领域公共常识。
Claims (1)
1.一种输入时延下多空间飞行器姿态协同控制方法,其特征在于包括以下步骤:
步骤一、利用模糊理论将多飞行器姿态动力学系统构建为由一系列模糊逻辑组成的模糊系统;给出如下多飞行器姿态动力学模型:
式中,Ji表示惯性矩阵;qi(t)和qi0(t)分别表示姿态四元数的矢量和标量部分;ωi(t)表示姿态角速度;ui(t)表示作用于飞行器的控制输入;τ(t)表示输入时延变量,且有0≤τ(t)≤τ和其中τ和ρ为正的常数;式(1)化作如下状态空间方程的形式:
式中,
为便于构建模糊系统,定义如下变量:
xi(t)=[xi1(t)xi2(t)xi3(t)xi4(t)xi5(t)xi6(t)]T,
ωi(t)=[ωi1(t)ωi2(t)ωi3(t)]T,
qi(t)=[qi1(t)qi2(t)qi3(t)]T.
利用模糊系统准则,将式(2)中所示的非线性系统化作如下模糊系统:
式中,
步骤二、针对步骤一中构建出的模糊系统(4)设计姿态同步控制器,得到闭环系统,并将该闭环系统进行等价转化;利用模糊准则设计如下姿态同步模糊控制器:
式中,
将式(6)代入到式(4)中,得到如下所示的闭环系统:
式中,
式中,
步骤三、针对步骤二中转化得到的等价系统(8),利用时延依赖李雅普诺夫稳定性理论和线性矩阵不等式方法给出保证系统稳定的充分条件,并设计控制器参数;针对等价变换之后的模糊系统(8),选取如下李雅普诺夫函数:
式中,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910334255.4A CN110032204B (zh) | 2019-04-24 | 2019-04-24 | 输入时延下多空间飞行器姿态协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910334255.4A CN110032204B (zh) | 2019-04-24 | 2019-04-24 | 输入时延下多空间飞行器姿态协同控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110032204A CN110032204A (zh) | 2019-07-19 |
CN110032204B true CN110032204B (zh) | 2022-07-29 |
Family
ID=67239930
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910334255.4A Expired - Fee Related CN110032204B (zh) | 2019-04-24 | 2019-04-24 | 输入时延下多空间飞行器姿态协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110032204B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110362103B (zh) * | 2019-08-19 | 2023-02-10 | 西北工业大学 | 分布式自主水下航行器姿态协同优化控制方法 |
CN112099516B (zh) * | 2020-08-24 | 2022-08-02 | 西北工业大学 | 一种基于模糊线性化理论的卫星集群姿态跟踪控制方法 |
CN113479344B (zh) * | 2021-07-07 | 2022-09-23 | 西北工业大学 | 一种可快速解算的分布式卫星姿态协同控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102880182A (zh) * | 2012-09-12 | 2013-01-16 | 北京航空航天大学 | 一种存在网络随机延迟的微小型无人飞行器控制方法 |
CN104460322A (zh) * | 2014-12-23 | 2015-03-25 | 冶金自动化研究设计院 | 不确定性时延双时标系统模糊时延状态反馈控制方法 |
CN109189080A (zh) * | 2018-11-12 | 2019-01-11 | 西北工业大学 | 基于模糊理论的多自主海洋航行器系统分布式控制方法 |
-
2019
- 2019-04-24 CN CN201910334255.4A patent/CN110032204B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102880182A (zh) * | 2012-09-12 | 2013-01-16 | 北京航空航天大学 | 一种存在网络随机延迟的微小型无人飞行器控制方法 |
CN104460322A (zh) * | 2014-12-23 | 2015-03-25 | 冶金自动化研究设计院 | 不确定性时延双时标系统模糊时延状态反馈控制方法 |
CN109189080A (zh) * | 2018-11-12 | 2019-01-11 | 西北工业大学 | 基于模糊理论的多自主海洋航行器系统分布式控制方法 |
Non-Patent Citations (2)
Title |
---|
Improved order-reduction method for cooperative tracking control of time-delayed multi-spacecraft network;Zhuo Zhang等;《Science Direct》;20081231;第2849-2873页 * |
空间飞行器姿态网络控制系统的模糊变结构控制;徐利杰 等;《宇航学报》;20080331;第29卷(第2期);第590-595页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110032204A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110456807B (zh) | 一种多航天器一致性动态增益控制方法 | |
CN109901603B (zh) | 一种输入时延下多空间飞行器姿态协同控制方法 | |
CN110032204B (zh) | 输入时延下多空间飞行器姿态协同控制方法 | |
Mahmood et al. | Decentrailized formation flight control of quadcopters using robust feedback linearization | |
CN110347181B (zh) | 基于能耗的无人机分布式编队控制方法 | |
CN112631335B (zh) | 一种基于事件触发的多四旋翼无人机固定时间编队方法 | |
Lee et al. | Autopilot design of tilt-rotor UAV using particle swarm optimization method | |
CN112099516B (zh) | 一种基于模糊线性化理论的卫星集群姿态跟踪控制方法 | |
Ye et al. | Control-oriented modeling and adaptive backstepping control for a nonminimum phase hypersonic vehicle | |
An et al. | Differentiator based full-envelope adaptive control of air-breathing hypersonic vehicles | |
CN113268083A (zh) | 基于动态事件触发的多无人机系统编队跟踪控制方法 | |
Uang et al. | Robust adaptive optimal tracking design for uncertain missile systems: a fuzzy approach | |
Pashilkar et al. | Adaptive back-stepping neural controller for reconfigurable flight control systems | |
CN114237041A (zh) | 一种基于预设性能的空-地协同固定时间容错控制方法 | |
CN111439392B (zh) | 一种航天器编队位置协同控制方法 | |
CN109189080B (zh) | 基于模糊理论的多自主海洋航行器系统分布式控制方法 | |
CN112623259B (zh) | 针对高超声速飞行器数据丢包的自抗扰控制器设计方法 | |
Yang et al. | Fuzzy approximation-based adaptive finite-time tracking control for a quadrotor UAV with actuator faults | |
CN117452975A (zh) | 一种四旋翼无人机集群的保性能协同编队控制设计方法 | |
Alam et al. | On the internal stability of non‐linear dynamic inversion: application to flight control | |
Zhang et al. | Robust cooperative formation control of fixed-wing unmanned aerial vehicles | |
Liu et al. | Optimal switching control for Morphing aircraft with Aerodynamic Uncertainty | |
Cappello et al. | Distributed control of multi-agent systems via linear quadratic differential games with partial information | |
CN114047778A (zh) | 一种小型飞机短距离自动着陆横侧向控制方法 | |
Zhu et al. | A PID based approximation-free controller with prescribed performance function for model helicopter attitude control |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220729 |