摘要
针对存在不确定参数和外部扰动的刚性空间机器人, 本文设计了一个新型的低抖振预设性能固定时间终端滑模控制方法. 借助拉格朗日法建立刚性空间机器人的动力学模型, 结合模型不确定项及外部扰动项得到系统的混合不确定项. 为了保证空间机器人的稳态和瞬态跟踪性能, 根据跟踪误差与固定时间预设性能函数构建了系统的误差转换函数. 借助误差转换函数, 设计了一个固定时间终端滑模面, 并据此提出一个新型的低抖振预设性能固定时间终端滑模控制器. 根据Lyapunov稳定性理论, 证明了该控制器可确保空间机器人跟踪误差全局固定时间收敛, 且收敛时间与系统初始状态无关. 数值仿真结果验证了所提出控制器的有效性和优越性.
Abstract
A novel low-chattering fixed-time terminal sliding mode control method with prescribed performance is designed for rigid space robot subjected to uncertain parameter and external disturbance. The dynamic model of rigid space robot is established by using the Lagrangian method, and the mixed uncertainty term of the system is obtained by combining the model uncertainty term with external disturbance term. In order to ensure the steady-state and transient tracking performance of the space robot, an error transformation function of the system is constructed based on the tracking error and the fixed-time prescribed performance function. By utilizing the error transformation function, a fixed-time terminal sliding mode surface is designed, and based on which a new type of low-chattering fixed-time terminal sliding mode controller with prescribed performance is proposed. According to the Lyapunov stability theory, it has been proven that the proposed controller can ensure global fixed-time convergence of the tracking error for the space robot, and the convergence time is independent from the initial state of the system. The numerical simulation results verified the effectiveness and superiority of the presented controller.
1 引言
随着航天技术的发展,空间机器人在空间站建造与维护、空间资源探测等任务中发挥着日益广泛的作用. 然而,太空环境复杂多变,空间机器人不可避免地承受离子射流、太阳风暴等因素干扰,并且系统自身存在固有的参数不确定、建模误差等问题,从而为系统精确控制带来较大挑战 [1-2] . 为在有限时间或固定时间内实现空间机器人的快速高精度控制,相关学者进行了积极的探讨与研究.
近年来,部分学者针对各类机械臂系统提出了有限时间控制方法,并取得了有效的控制效果 [3-6] . 然而,有限时间控制高度依赖系统的初始状态,这意味着当系统的初始误差过大或未知时,系统难以或无法在有限时间内完成既定任务. 为解决这一难题,Polyakov [7] 提出了固定时间收敛的概念,它能保证系统在任意初始状态下都能在固定时间内收敛,且收敛时间只与控制参数有关. 基于此,针对空间机器人在阻抗环境中的作业问题,文献 [8] 结合深度学习与传统控制器提出了一种新型分数阶固定时间滑模控制器. 针对存在外部干扰的柔性空间机器人,文献 [9] 结合反演法提出了一种基于固定时间收敛的阻抗控制方法,解决了反演控制方法中的“微分项膨胀”问题. 文献 [10] 引入了一种新型低抖振全局非奇异固定时间终端滑模控制策略,显著提升双臂空间机器人末端执行器的跟踪精度. 针对存在外部干扰的空间机器人,文献 [11] 结合反演法与加幂积分法提出了一种新的固定时间跟踪控制方法,保证了跟踪误差固定时间内收敛至原点的邻域内. 针对输出约束下空间机械臂的控制问题,文献 [12] 提出了一种固定时间自适应神经网络容错控制方法,确保了系统输出在预设范围之内.
然而,上述研究仅侧重于维持系统的稳态性能,而忽略了系统的瞬态性能. 为此,Bechlioulis等 [13] 率先使用预设性能函数来约束系统的收敛误差和最小收敛速度. 随后,预设性能控制被广泛应用于各种类型的非线性系统中. 针对参数不确定的空间机械臂,文献 [14] 和文献 [15] 分别提出了一种预设性能自适应控制器和预设性能鲁棒控制器,保证了跟踪误差的渐近收敛. 针对存在输入约束的不确定空间机器人,文献 [16] 和文献 [17] 分别结合反演法、自适应学习法设计了一种预设性能跟踪控制器,保证了跟踪误差的最终一致有界收敛. 针对空间机械臂动力学捕获系统和航天器姿控系统,文献 [18-19] 借助扰动观测器,提出了两种不同的预设性能有限时间控制器. 针对存在输入饱和的不确定空间机械臂,文献 [20] 结合神经网络提出了一种固定时间抗饱和滑模控制方案,但其控制器结构复杂且会消耗较多的星载计算资源. 由此可知,目前关于空间机器人预设性能固定时间控制的相关研究鲜见报道.
基于以上分析,针对存在不确定参数和外部扰动的刚性空间机器人,本文借助误差转换法设计了一种预设性能固定时间终端滑模控制器,所提方法的主要创新点如下:
1)结合固定时间预设性能函数与误差转换法,将空间机器人的轨迹跟踪控制问题转化为转换误差的预设边界控制问题,保证了系统跟踪误差的稳态和瞬态性能;
2)将非线性光滑函数引入至固定时间终端滑模面及固定时间预设性能控制器,并把不连续的符号函数被替换为连续的饱和函数,保证了控制器的全程连续性,从而消除了控制力矩的抖振问题.
2 问题陈述和准备工作
2.1 动力学建模
漂浮基空间机器人统结构如图1所示,其主要由漂浮式载体(基座)B0、机械臂B1和B2及若干传感器、执行机构等组成. 为了节省空间燃料,仅对载体姿态进行控制. 建立系统的惯性坐标系 OXY 和各分体 Bi(i = 0,1,2)的主轴连体基(Oi ,xi). Oci 为分体Bi 的质心; O1,O2分别为联结B0与B1、B1与B2的关节转动铰中心; 分体 Bi 的质量和转动惯量分别为 mi 和Ji ; O0 与O1之间的距离为d0; 机械臂Bj 的长度为 dj ; θ0为载体姿态角; θ1和θ2为刚性臂杆的转动角.
图1漂浮基空间机器人系统
Fig.1Diagram of space manipulator system
空间机器人为无根多体系统,满足动量守恒关系. 借助拉格朗日法,可推导出如下系统动力学方程:
(1)
其中:为系统对称、正定质量矩阵; 为包含科氏力、离心力的向量; 为关节力矩; 为一个未知但有界的外部扰动.
位置误差e ∈ 3和速度误差 ∈ 表示为
(2)
其中qd,为期望跟踪角位置和速度的向量.
所期望的误差性能可以表示为 [13]
(3)
其中: ρi(t)为待设计的预设性能函数,和可以分别记为
(4)
(5)
其中:是向量e 的第i 个元素,ei(0)是关节i的初始关节角位置误差.
2.2 引理与定义
考虑如下非线性连续系统:
(6)
其中:表示系统状态; 向量为系统可调参数,且
定义 1 如果系统(6)全局渐近稳定,且其任意解x(t,x0)均可在有限时间内达到平衡点,即∀t >被称为稳定时间函数,则系统(6)的原点是全局有限时间稳定的 [21] .
定义 2 如果系统(6)的原点是全局有限时间稳定的且稳定时间函数有界,即那么系统(6)的原点是全局固定时间稳定的 [7] .
定义 3 对于任意的 r >0及向量 y = [y1 · · · yn] T,定义向量Sigr(y)为
(7)
其中为符号函数.
引理 1 对于非线性系统(6),如果存在一个正定连续函数和正常数α,β >0,0 <p <1和q >1,满足,ξ ∈ U\ {0},则系统(6)是全局固定时间稳定的,且稳定时间T的上界为 [7]
(8)
引理 2 对于一个正常数 α 和连续可微变量x,以下方程成立 [22] :
(9)
(10)
引理 3 对于常数和一个正常数p,以下不等式成立 [23] :
(11)
(12)
引理 4 系统(1)中的动力学矩阵 D(q),H(q,)可以表示为 [24]
(13)
其中:为模型参数的已知部分,表示系统的不确定部分.
引理 5 由于空间机器人机体的物理限制,矩阵满足以下有界条件 [24] :
(14)
(15)
其中Mm,MM和HM为已知正常数.
引理 6 对于反对称矩阵有 [25]
(16)
引理 7 结合式(1)和式(13),系统的集总不确定项ρ(t)包括外部扰动和自身不确定项,并可写为
(17)
系统的集总不确定项ρ(t)满足以下有界条件 [26] :
(18)
其中为一个已知上界.
3 控制器设计
3.1 固定时间预设性能函数设计
根据预设性能表达式(3),跟踪误差e(t)要求收敛至一个预先确定的任意小的区域内. 这意味着收敛速度不小于预设值,即最大超调量小于预先分配的常数. 满足预设性能要求的关键是借助固定时间预设性能函数使系统的控制性能满足式(3)的要求.
定义 4 如果连续函数为正数且呈下降趋势; 则ρ可被定义为预设性能函数 [13] .
为保证预设性能函数ρ是固定时间稳定的,将其设计为
(19)
其中:为正常数; 常数Ti为ρi(t)从最大初始误差ρ0i收敛到最大允许的稳态误差ρ∞i所需的最大收敛时间; 为预先设定的最小收敛速率.
引理 8 所提出的固定时间预设性能函数(19)满足 [22] :
1)ρi(t)是一个单调递减且连续有界的正函数,且
2)
注意到固定时间预设性能函数(19)不能直接用于设计控制器,需要进行误差转换来建立其与跟踪误差之间的联系. 转换函数ζ(x)设计为 [27]
(20)
引理 9 ζ(x)是一个连续的严格递增函数,且满足 [22]:
1)
2)ε1i是一个转换误差,且其与误差ei存在如下关系:
(21)
根据引理 9可知,存在通过逆变换用ε1i代替跟踪误差ei以确保系统性能满足式(3). ζ(x)的逆函数为
(22)
由引理9可知ζ −1(x)为连续函数,且存在双射映射
根据式(21),ζ(ε1i)和转换后的误差ε1i可写为
(23)
将ε1i对时间t求导,可得
(24)
其中αi和βi表示为
(25)
用ν(x)表示ζ −1(x)对x的导数,即
(26)
根据式(24)可知,向量及其导数可以记为
(27)
其中:为半正定对角矩阵,为正定对角矩阵.
引理 10 式(25)中参数αi和βi分别满足αi >0 和 [22]
3.2 固定时间终端滑模设计
首先,将非线性连续函数s p(x)设计为

(28)
其中: p和δ为两个满足0 <p <1和0 <δ ≤ 1的正常数; l1,l2和l3是关于p和δ的3个常数,可以用以下等式来表示:
(29)
(30)
(31)
根据引理2,s p(x)对x的导数为

(32)
另一个非线性函数s q(x)设计为
(33)
其中q为一个正常数,s q(x)对x的导数为
(34)
为了简化滑动面和控制器的设计与分析,将下列向量和矩阵定义为
(35)
(36)
(37)
(38)
基于向量和设计的固定时间终端滑模曲面为
(39)
其中: 向量 ε1 和ε2 定义在式(23)(27)中,K1,K2 ∈为正定对角矩阵.
3.3 预设性能固定时间终端滑模控制器设计
基于所提出的固定时间滑动面,设计了一种预设性能固定时间终端滑模控制器(preset performance fixed time sliding mode control,PPFTSMC),即
(40)
其中:
(41)
(42)
(43)
其中: K0 ∈ 为正定对称矩阵,r >1和k >0为正常数.
由于符号函数sgn s是不连续的,故易引发控制力矩抖振. 为了解决这个问题,可把上述控制方案中的符号函数sgn s替换为如下连续的饱和函数sat s:
(44)
其中s0是一个很小的正常数.
定理 1 针对参数不确定且存在外部扰动的空间机器人系统(1),设计式(40)–(43)所示的PPFTSMC 控制器,以下两点结论成立:
1)变换后的误差ε1i在设定时间T内全局收敛于一个任意小集合然后指数收敛至原点. 设定时间 Tmax 的上界包括趋近时间Tr和滑动时间Ts,并且三者之间的关系可以表示为
(45)
(46)
(47)
2)位置跟踪误差ei可以保持在式(3)所示的预设边界内,并在Ti时间内收敛到式(19)所示的预设稳定区域
4 稳定性分析
步骤 1 在趋近阶段,定义Lyapunov函数为
(48)
将V1对时间t求导,可得
(49)
考虑到式(18)和式(40),式(49)可以表示为
(50)
根据引理3,式(50)可以表示为
(51)
由于可以取为
(52)
故V1可以表示为
(53)
结合式(53),式(51)可以写为
(54)
如引理1所述,当r >1时,滑模面s可以全局收敛于零,趋近时间Tr以式(46)为界.
步骤 2 当滑模面到达s = 0时,则跟踪误差ei 进入滑动阶段,式(39)可写为
(55)
由于s p(ε1i)是关于ε1i的分段函数,因此有两种情况需要讨论.
情况 1 如果|ε1i | >δ,则式(55)可以表示为
(56)
定义Lyapunov函数为
(57)
将V2对时间t求导,可得
(58)
通过引理10,式(58)可以表示为
(59)
通过引理 1,在滑动阶段,转换误差 ε1i 可以在式(47)所示的固定时间Ts内收敛到任意小集合Rδ.
情况 2 如果则式(55)可以表示为
(60)
将V2对时间t求导,并将式(29)–(31)代至式(60),得
(61)
其中
(62)
当故式(62)可以表示为
(63)
根据Lyapunov稳定性理论,当|ε1i | <δ 时,转换误差ε1i将指数收敛于零. 即定理1中的结论1)证毕.
基于上述分析并考虑引理 8,可得 ζ(ε1i)∈(,). 根据引理9可知,当t >Ti 时,ρi(t)= ρ∞i . 结合式(21),当t >Ti 时,跟踪误差ei满足以下有界条件:
(64)
当t <Ti时,跟踪误差范围可表示为式(3),即定理1中的结论2)证毕.
5 数值仿真
为验证所设计的PPFTSMC 方法的有效性,以图1所示的漂浮基两杆空间机器人为例进行数值仿真. 系统物理参数为 m0 = 40 kg,m1 = 3 kg,m2 = 3 kg,d0 = 1.5 m,d1 = 3 m,d2 = 3 m,J0 = 34 kg · m2,J1 = 1 kg · m2,J2 = 1 kg · m2 . 系统的期望轨迹和扰动分别设计为qd =[0.3 0.6 0.9]T (rad),ρ= 0.01 × [sin t cos t sin t] T(N · m),对比算法选择为有限时间稳定的非奇异快速终端滑模控制方法(nonsingular fast terminal sliding mode control,NSFTSMC)[6] . 本文控制器控制参数为q = 1.05,p = 0.5, r = 2,k = 1,s0 = 0.05,= 6.08,K0,K1,K2 = 0.1I3.
针对不同初始状态设计如下两种算例: 1)q(0)= [0.1 0.8 0.75]T(rad); 2)q(0)= [−0.15 1.05 0.45]T (rad),两种算例的仿真结果如图2–3所示. 其中: 图2表示在两种算例下控制方法的轨迹跟踪曲线; 图3则表示在两种算例下控制方法的控制输入曲线.
由图2可知,在算例1中,运用本文所提出的PPFTSMC方法,载体姿态和臂杆关节均可在1 s左右实现对期望轨迹的跟踪控制; 而NSFTSMC方法则分别需要(2.1,2,2)s左右. 在算例2中,运用PPFTSMC方法,系统依然可在1 s左右实现期望轨迹的跟踪控制; 而NSFTSMC方法则分别需要(2.4,2.6,2.4)s左右. 进一步观察可知,在初始误差增大后,NSFTSMC方法的跟踪耗时均延长,而PPFTSMC方法的跟踪耗时并没有发生明显变化,这是由于本文所提控制器具有固定时间稳定特性. 由图3可知,在两种不同的初始状态下,PPFTSMC 方法在力矩抖振的抑制方面明显优于 NSFTSMC方法,这是由于本文所提控制器采用了连续的饱和函数. 通过对比可以看出,本文所提PPFTSMC方法的控效果更好.
图2轨迹跟踪曲线
Fig.2Trajectory tracking curves
图3控制输入曲线
Fig.3Control input curves
6 总结
本文针对参数不确定且存在外部扰动的自由漂浮刚性空间机器人,设计了一种预设性能固定时间终端滑模控制器. 基于拉格朗日法建立空间机器人的刚体动力学模型,结合预设性能算法与固定时间理论设计了一种具有预设性能的固定时间终端滑模控制器. 该控制器可以保证系统的跟踪误差收敛至一个预先确定的任意小的区域内,然后指数收敛至原点,同时对最小收敛速率和最大超调量进行约束使其满足预设值,保证了跟踪误差的瞬态性能. 经过适当的矢量和矩阵推广运算,所提出控制器可应用于三维空间机器人的运动控制. 由于该方法兼具高精度、快收敛、强鲁棒等特性,故其在复杂太空环境中具有较大的工程应用潜力.