一种全状态约束下绳系组合体稳定控制方法与流程

1.本发明属于航天技术领域，具体涉及一种绳系组合体稳定控制方法。


背景技术：

2.近期，众多国家针对空间合作目标的捕获开展了大量研究，并取得一系列丰硕的成果，但是针对失稳非合作目标捕获的控制理论和技术仍不完善。
3.空间绳系捕获器是通过挠性系绳将平台与目标航天器相连接而组成的新型空间组合体，是实现失稳非合作目标捕获的有效工具。空间绳系航天器抓捕失稳目标后会与目标形成空间绳系组合体，处于高速旋转失稳状态，对其进行稳定控制是开展后续轨道垃圾清理和拖曳移除等精细操作的必要前提。
4.目前，已有学者针对空间绳系组合体的控制方法开展研究。例如，王秉亨等(申请号为cn202110000112.7的中国专利)研究了一种利用偏置系绳摆杆来实现组合体系统的稳定控制问题，并设计了一类有效的分层滑模控制律；鲁迎波等(申请号为cn201811088097.0的中国专利)结合滑模控制和动态面技术提出了一种自适应控制方法以保证绳系组合体的快速稳定。但是，上述方案均未考虑绳系航天器抓捕过程中存在的两端航天器易碰撞、系绳易缠绕等问题，这些问题使得组合体的位置和速度等状态均需要在严格的约束范围内运行，给绳系组合体高精度稳定控制方案设计带来新的严峻挑战。因此，在系统存在复杂状态约束下，设计一种具有快速响应、高精度的稳定控制方案是十分必要的，已成为空间绳系航天器领域的研究重点。


技术实现要素：

5.为了克服现有技术的不足，本发明提供了一种全状态约束下绳系组合体稳定控制方法，旨在解决系统存在全状态约束，即位置和速度均受限制下的快速稳定控制问题。针对绳系组合体系统存在多种不确定性因素，设计自适应神经网络方案，实现对系统总和不确定性的快速、精确估计；其次分别考虑系统的广义位置和速度约束，设计障碍李雅普诺夫函数(barrier lyapunov function，blf)以解决全状态约束问题；随后，采用反步法设计鲁棒自适应控制器，保证状态约束和多种不确定性存在下绳系组合体系统的快速、高精度稳定控制；最后对设计的控制器进行李雅普诺夫稳定性证明。本发明可保证组合体系统的位置和速度始终在约束范围内运行，可实现多种不确定性存在下绳系组合体系统的快速、高精度稳定控制问题。
6.本发明解决其技术问题所采用的技术方案包括如下步骤：
7.步骤1：建立状态约束下的障碍李雅普诺夫函数；
8.步骤1-1：根据欧拉-拉格朗日方程，建立抓捕后绳系组合体系统的动力学方程如下所示：
[0009][0010]
式中q＝[α,β,l]
t
∈r3为系统广义位置坐标，其中α、β、l分别为系绳面内角、面外角
以及系绳长度；分别为系统的广义位置、速度和加速度变量；τ＝[τ
α
,τ
β
,τ
l
]
t
∈r3为广义力，τ
α
,τ
β
,τ
l
分别为面内角、面外角以及绳长的广义控制力矩；m(q)∈r3×3为正定对称矩阵，为科式力矩阵，g(q)∈r3为重力矩，d∈r3为外界扰动；
[0011]
步骤1-2：根据式(1)知，绳系组合体系统具有强耦合非线性特性，满足下述性质：
[0012]
性质1：m为可逆的对称正定矩阵，并且对于任意x∈r3，以下不等式(2)成立：
[0013]
m1x
t
x≤x
t
mx≤m2x
t
x
ꢀꢀꢀ
(2)
[0014]
其中m1和m2分别为m的最小和最大特征值；
[0015]
定义如下相关引理和假设：
[0016]
引理1：对于任意y1∈r3，若有||y1||＜ba,则以下不等式恒成立：
[0017][0018]
其中，ba为已知常数；
[0019]
假设1：期望轨迹qd及其导数均有界，即存在已知常数a0、a1满足||qd||≤a0≤k
c1
以及k
c1
、k
c2
分别为常数；
[0020]
定义系统动力学方程式(1)表示为：
[0021][0022]
式中，f(.)＝m-1
(x1,x2,t)(d-c(x1,x2)x
1-g(x1))中包含未知不确定性；
[0023]
步骤1-3：定义期望的组合体系统轨迹为qd(t)，位置跟踪误差为e＝x1(t)-qd(t)；在系统存在总不确定性的情况下保证状态q(t)能够跟踪参考轨迹qd(t)，并且保证系统状态始终满足约束条件：存在正数和使得对于任意t＞0，和均成立；
[0024]
为了简化书写，后续将省略自变量；
[0025]
步骤1-4：定义以下误差转换函数
[0026]
z1＝e,z2＝x
2-α1ꢀꢀꢀ
(5)
[0027]
其中z1和z2为误差转换函数向量，α1为系统虚拟控制量；
[0028]
考虑系统的位置约束，设计如下的障碍李雅普诺夫函数v1：
[0029][0030]
上式中其中a0由假设1给出；定义闭区间ω
z1
:＝{z1|||z1||＜k
b1
}，由z1＝x
1-yd得到成立；通过选择保证当时x1也在约束范围内；根据障碍李雅普诺夫函数特性知，若使得系统状态始终处于闭区间ω
z1
内，则系统应满足v1∈l
∞
，对于v1求导得：
[0031]
[0032]
步骤2：基于反步法设计鲁棒自适应控制器；
[0033]
步骤2-1：根据式(7)选取如下的虚拟控制量：
[0034][0035]
其中c1＞0为设计参数；将式(8)代入(7)中，被重写为：
[0036][0037]
令在区间ω
z1
中，为定值；
[0038]
步骤2-2：对误差转换函数z2求导得：
[0039][0040]
为了确保系统状态x2不违反约束，定义如下的障碍李雅普诺夫函数：
[0041][0042]
其中k
b2
为正数；
[0043]
步骤2-3：定义一个封闭集合ω
z2
:＝{z2|||z2||＜k
b2
}；由该定义得到，在集合ω
z2
内是有界的；为了保证必须保证z2在封闭集合ω
z2
内，因此k
b2
被选取为：
[0044][0045]
对v2沿着式(9)求取关于时间的导数，则有：
[0046][0047]
其中为系统总和不确定性；由于α1为变量x1、qd和的函数，则是变量x2、和的函数；f为状态量x1、x2的函数，为x1、x2、qd、和的函数；定义新的状态变量
[0048]
步骤3：设计自适应神经网络；
[0049]
步骤3-1：由于函数向量是未知的，故在控制器设计中采用自适应神经网络以估计不确定性
[0050]
根据神经网络逼近特性，得到：
[0051][0052]
其中w∈r
15
×3为未知的最优权重矩阵，δz(z)为神经网络的逼近误差；
[0053]
将式(14)代入式(13)中有：
[0054][0055]
根据杨氏不等式，则以下不等式(16)和(17)成立：
[0056][0057][0058]
其中||w||＝w和并且w和均为未知常数；
[0059]
根据不等式(16)和(17)有：
[0060][0061]
其中为未知常数，φ＝φ2(z) 1为需要设计的函数；
[0062]
综上，式(15)能被改写为：
[0063][0064]
步骤3-2：设计如下所示的鲁棒自适应控制器式(20)和自适应律式(21)：
[0065][0066][0067]
上式中λ为所设计的正标量，为闭区间ω
z2
内的正函数且有c
21
＞0，为未知参数b的估计值，并且由知对任意t＞0均有
[0068]
步骤3-3：根据以上控制器式(20)和(21)，得到如下定理：
[0069]
定理2：考虑存在全状态约束和系统不确定性的绳系组合体系统方程式(4)；若假设1成立，则对于任意初始状态满足z1(0)∈ω
z1
和z2(0)∈ω
z2
，所设计的鲁棒自适应控制器式(20)和自适应律式(21)能保证系统实现以下控制目标：
[0070]
1).闭环系统的所有信号均有界，且系统各状态均不违反约束，即对任意t＞0均有且
[0071]
2)跟踪误差z1和z2能够实现渐近收敛，且分别能收敛到区域和内；
[0072]
步骤4：对闭环系统进行李雅普诺夫稳定性证明；
[0073]
步骤4-1：选取候选李雅普诺夫函数表达式为：
[0074][0075]
其中为自适应估计误差；
[0076]
将鲁棒自适应控制器式(20)和自适应律式(21)代入式(22)的导数中，得到：
[0077][0078]
步骤4-2：根据m-1
为对称正定矩阵特性，对于任意向量θ∈r3均有θ
t
m-1
θ＝a(t)θ
t
θ，其中a(t)为有界函数且满足a和均为未知常数；
[0079]
因此，根据引理1，式(23)改写为：
[0080][0081]
其中κ＝min{2c1,2ac
21
,λ}，对式(24)积分得到如下表达式(25)：
[0082][0083]
式中，d为常值；
[0084]
1)从式(25)能够得出v3(t)为有界函数，则闭环系统的状态z1、z2和均有界；根据系统初始状态满足z1(0)∈ω
z1
和z2(0)∈ω
z2
，则得到z1(t)∈ω
z1
和z2(t)∈ω
z2
对于任意t＞0均成立；根据式(1)和(8)得到绳系组合体系统实际位置和速度时刻满足且
[0085]
2)根据式(25)得到：
[0086][0087]
因此z1最终会收敛到区域内；同理，z2最终会收敛到区域中；因此，系统的稳定性得以证明。
[0088]
优选地，所述系统的广义位置包括面内角、面外角和系绳长度。
[0089]
本发明的有益效果如下：
[0090]
1)、本发明方法设计了障碍李雅普诺夫函数，可保证组合体系统的位置和速度始终在约束范围内运行。
[0091]
2)、本发明方法提出自适应神经网络技术，可实现多种不确定性存在下绳系组合体系统的快速、高精度稳定控制问题。
[0092]
3)、本发明方法采用连续控制方案，可提升系统的控制性能。
附图说明
[0093]
图1为本发明系统的鲁棒自适应控制框图。
[0094]
图2本发明实施例在约束存在下的位置控制效果图。
具体实施方式
[0095]
下面结合附图和实施例对本发明进一步说明。
[0096]
一种全状态约束下绳系组合体稳定控制方法，包括如下步骤：
[0097]
步骤1：建立状态约束下的障碍李雅普诺夫函数；
[0098]
步骤1-1：根据欧拉-拉格朗日方程，建立抓捕后绳系组合体系统的动力学方程如下所示：
[0099][0100]
式中q＝[α,β,l]
t
∈r3为系统广义位置坐标，其中α、β、l分别为系绳面内角、面外角以及系绳长度；分别为系统的广义位置(包括面内角、面外角和系绳长度)、速度和加速度变量；τ＝[τ
α
,τ
β
,τ
l
]
t
∈r3为广义力；m(q)∈r3×3为正定对称矩阵，为科式力矩阵，g(q)∈r3为重力矩，d∈r3为外界扰动；
[0101]
步骤1-2：根据式(1)可知，绳系组合体系统具有强耦合非线性特性，满足下述性质：
[0102]
性质1：m为可逆的对称正定矩阵，并且对于任意x∈r3，以下不等式(2)成立：
[0103]
m1x
t
x≤x
t
mx≤m2x
t
x
ꢀꢀꢀ
(2)
[0104]
其中m1和m2分别为m的最小和最大特征值；
[0105]
定义如下相关引理和假设：
[0106]
引理1：对于任意y1∈r3，若有||y1||＜ba,则以下不等式恒成立：
[0107][0108]
假设1：期望轨迹qd及其导数均有界，即存在已知常数a0、a1满足||qd||≤a0≤k
c1
以及
[0109]
定义x1＝q,系统动力学方程式(1)表示为：
[0110][0111]
式中，f(.)＝m-1
(x1,x2,t)(d-c(x1,x2)x
1-g(x1))中包含未知不确定性；
[0112]
步骤1-3：定义期望的组合体系统轨迹为qd(t)，位置跟踪误差为e＝x1(t)-qd(t)；本方面目的为设计高性能控制器，使得在系统存在总不确定性的情况下保证状态q(t)能够跟踪参考轨迹qd(t)，并且保证系统状态始终满足约束条件：存在正数和使得对于任意t＞0，和均成立；
[0113]
为了简化书写，后续将省略自变量；
[0114]
步骤1-4：本发明将采用反步法设计鲁棒自适应控制方案，以实现全状态约束和多种不确定性存在下系统快速、高性能稳定控制。为了实现上述目标，定义以下误差转换函数
[0115]
z1＝e,z2＝x
2-α1ꢀꢀꢀ
(5)
[0116]
其中z1和z2为误差转换函数向量，α1为系统虚拟控制量；
[0117]
考虑系统的位置约束，设计如下的障碍李雅普诺夫函数v1：
[0118][0119]
上式中其中a0由假设1给出；定义闭区间ω
z1
:＝{z1|||z1||＜k
b1
}，由z1＝x
1-yd得到成立；通过选择保证当时x1也在约束范围内；根据障碍李雅普诺夫函数特性知，若使得系统状态始终处于闭区间ω
z1
内，则系统应满足v1∈l
∞
，对于v1求导得：
[0120][0121]
步骤2：基于反步法设计鲁棒自适应控制器；
[0122]
步骤2-1：根据式(7)选取如下的虚拟控制量：
[0123][0124]
其中c1＞0为设计参数；将式(8)代入(7)中，被重写为：
[0125]
[0126]
令在区间ω
z1
中，为定值；
[0127]
步骤2-2：对误差转换函数z2求导得：
[0128][0129]
为了确保系统状态x2不违反约束，定义如下的障碍李雅普诺夫函数：
[0130][0131]
步骤2-3：定义一个封闭集合ω
z2
:＝{z2|||z2||＜k
b2
}；由该定义得到，在集合ω
z2
内是有界的；为了保证必须保证z2在封闭集合ω
z2
内，根据虚拟控制量的定义，因此k
b2
被选取为：
[0132][0133]
对v2沿着式(9)求取关于时间的导数，则有：
[0134][0135]
其中为系统总和不确定性；由于α1为变量x1、qd和的函数，则是变量x2、和的函数；f为状态量x1、x2的函数，为x1、x2、qd、和的函数；定义新的状态变量
[0136]
步骤3：设计自适应神经网络；
[0137]
步骤3-1：由于函数向量是未知的，故在控制器设计中采用自适应神经网络以估计不确定性
[0138]
根据神经网络逼近特性，得到：
[0139][0140]
其中w∈r
15
×3为未知的最优权重矩阵，δz(z)为神经网络的逼近误差；
[0141]
将式(14)代入式(13)中有：
[0142][0143]
根据杨氏不等式，则以下不等式(16)和(17)成立：
[0144][0145][0146]
其中||w||＝w和并且w和均为未知常数；
[0147]
根据不等式(16)和(17)有：
[0148][0149]
其中为未知常数，φ＝φ2(z) 1为需要设计的函数；
[0150]
综上，式(15)能被改写为：
[0151][0152]
步骤3-2：由于上式中b和m-1
均为未知量，因此为了实现全状态约束和不确定性存在下绳系组合体系统的快速稳定，设计如下所示的鲁棒自适应控制器式(20)和自适应律式(21)：
[0153][0154][0155]
上式中λ为所设计的正标量，为闭区间ω
z2
内的正函数且有c
21
＞0，为未知参数b的估计值，并且由知对任意t＞0均有
[0156]
步骤3-3：根据以上控制器式(20)和(21)，得到如下定理：
[0157]
定理2：考虑存在全状态约束和系统不确定性的绳系组合体系统(3)；若假设1成立，则对于任意初始状态满足z1(0)∈ω
z1
和z2(0)∈ω
z2
，所设计的鲁棒自适应控制器式(20)和自适应律式(21)能保证系统实现以下控制目标：
[0158]
1).闭环系统的所有信号均有界，且系统各状态均不违反约束，即对任意t＞0均有且
[0159]
2)跟踪误差z1和z2能够实现渐近收敛，且分别能收敛到区域和内；
[0160]
步骤4：对闭环系统进行李雅普诺夫稳定性证明；
[0161]
步骤4-1：选取候选李雅普诺夫函数表达式为：
[0162][0163]
其中为自适应估计误差；
[0164]
将鲁棒自适应控制器式(20)和自适应律式(21)代入式(22)的导数中，得到：
[0165][0166]
步骤4-2：根据m-1
为对称正定矩阵特性，对于任意向量θ∈r3均有θ
t
m-1
θ＝a(t)θ
t
θ，其中a(t)为有界函数且满足a和均为未知常数；
[0167]
因此，根据引理1，式(23)改写为：
[0168][0169]
其中κ＝min{2c1,2ac
21
,λ}，对式(24)积分得到如下表达式(25)：
[0170][0171]
1)从式(25)能够得出v3(t)为有界函数，则闭环系统的状态z1、z2和均有界；根据系统初始状态满足z1(0)∈ω
z1
和z2(0)∈ω
z2
，则得到z1(t)∈ω
z1
和z2(t)∈ω
z2
对于任意t＞0均成立；根据式(1)和(8)得到绳系组合体系统实际位置和速度时刻满足且
[0172]
2)根据式(25)得到：
[0173]
[0174]
因此z1最终会收敛到区域内；同理，z2最终会收敛到区域中；因此，系统的稳定性得以证明。
[0175]
从图2中可以看出本发明方法能够保证系统面内角、面外角和绳长均约束在一定范围内，即图中上下两条约束边界之内。