浙江大学学报(工学版), 2022, 56(6): 1175-1180 doi: 10.3785/j.issn.1008-973X.2022.06.015

智能机器人

基于模糊补偿的连续型空间机械臂预定时间控制

丁萌,, 顾秀涛, 郑先杰, 郭毓,

南京理工大学 自动化学院,江苏 南京 210094

Predefined-time control of continuum space manipulator based on fuzzy compensation

DING Meng,, GU Xiu-tao, ZHENG Xian-jie, GUO Yu,

School of Automation, Nanjing University of Science and Technology, Nanjing 210094, China

通讯作者: 郭毓,女,教授. orcid.org/0000-0002-8591-4703. E-mail: guoyu@njust.edu.cn

收稿日期: 2022-03-15  

基金资助: 国家自然科学基金资助项目(61973167);中国航天科技集团公司第八研究院产学研合作基金资助项目(SAST2020−062);江苏高校优势学科建设工程资助项目;江苏省研究生科研与实践创新计划项目(KYCX22_0455)

Received: 2022-03-15  

Fund supported: 国家自然科学基金资助项目(61973167);中国航天科技集团公司第八研究院产学研合作基金资助项目(SAST2020−062);江苏高校优势学科建设工程资助项目;江苏省研究生科研与实践创新计划项目(KYCX22_0455)

作者简介 About authors

丁萌(1996—),女,博士生,从事机器人控制方向的研究.orcid.org/0000-0003-4175-5736.E-mail:824355614@qq.com , E-mail:824355614@qq.com

摘要

针对多节线驱连续型空间机械臂系统,在考虑存在外界时变干扰与参数不确定的情况下,提出基于模糊补偿的预定时间姿态控制方法. 设计模糊估计器估计系统切换增益,补偿未知有界总干扰. 基于预定时间稳定性理论,结合滑模控制,提出预定时间控制方法,使机械臂系统在预先设定时间内到达稳定状态. 与基于有限时间理论的控制方法相比,所提基于预定时间控制方法的稳定时间与系统初始状态无关,可以根据实际系统需求预先设置,并且所提方法在系统收敛速度与精度上具有更优的控制性能. 基于Lyapunov稳定性理论证明闭环系统的稳定性. 仿真结果表明,所提控制方法使系统姿态角误差快速收敛,并且预定时间稳定.

关键词: 线缆驱动 ; 连续型机械臂 ; 空间机械臂 ; 预定时间控制 ; 模糊控制

Abstract

For the multi-segment cable-driven continuum space manipulator system, a predefined-time attitude control method based on fuzzy compensation was proposed, considering the external time-varying disturbances and parameter uncertainties. A fuzzy estimator was designed to estimate the system switching gain and compensate the unknown bounded total disturbance. Based on the theory of predefined time stability, a sliding mode-based predefined-time control method was presented to make the manipulator system reach the stable state within a predefined time. Compared with the control method based on the finite-time theory, the settling time of the proposed control method was independent of the initial state of the system and was preset according to the actual system requirements. Furthermore, the proposed method had better control performance in terms of convergence rate and accuracy. Based on Lyapunov stability theory, the stability of the closed-loop system was proved. Simulation results show that the proposed control method can make the system attitude angle error converge fast and the predefined time stable.

Keywords: cable-driven ; continuum manipulator ; space manipulator ; predefined-time control ; fuzzy control

PDF (1183KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

丁萌, 顾秀涛, 郑先杰, 郭毓. 基于模糊补偿的连续型空间机械臂预定时间控制. 浙江大学学报(工学版)[J], 2022, 56(6): 1175-1180 doi:10.3785/j.issn.1008-973X.2022.06.015

DING Meng, GU Xiu-tao, ZHENG Xian-jie, GUO Yu. Predefined-time control of continuum space manipulator based on fuzzy compensation. Journal of Zhejiang University(Engineering Science)[J], 2022, 56(6): 1175-1180 doi:10.3785/j.issn.1008-973X.2022.06.015

空间自主在轨服务已成为航天器运行可靠、延长使用寿命的重要保障. 传统刚性空间机器人自由度有限,在受限环境中无法高效完成太阳帆板展开、飞行器舱内检测、空间站维护与检修等 [ 1] 典型在轨服务与维修任务. 连续型机械臂作为新型仿生机械臂,能够连续弯曲运动,具有高度灵活性,适用于复杂狭小的非结构化环境,成为当前空间机器人研究的新领域 [ 2- 5] .

连续型机械臂依靠柔性结构进行弯曲运动,此柔性结构易引发振动,属于高度复杂的非线性系统. Ivanescu等 [ 6] 将连续型机械臂分解为解耦控制系统,以曲率及曲率梯度作为控制参数,采用滑模变结构控制方法研究机械臂的形态. Alqumsan等 [ 7] 针对Cosserat杆模型设计了基于滑模的鲁棒控制器,同时考虑控制饱和输入以避免张力剧烈变化.在考虑系统存在不匹配不确定性的情况下,该团队利用多面滑模控制方法设计了鲁棒控制器,使机械臂到达目标位姿 [ 8] . Qi等 [ 9] 设计的基于模糊控制器的智能控制方法,完成了轨迹跟踪任务,使机械臂系统具有良好的稳定性与抗干扰能力. Piltan等 [ 10] 为了提高手术机器人的可靠性与故障容错精度,提出基于自适应模糊观测器的反馈线性控制方法. 由于系统高度复杂,智能控制器须调节、训练大量参数,导致该方法难以满足快速轨迹跟踪的要求.尽管上述基于滑模控制方法的连续型机械臂系统具有较强鲁棒性能与抗扰能力,但它们的系统是渐进稳定的,对这类系统的快速收敛、精准控制的动态性能有了更高的要求,因此,现有方法难以同时满足抗干扰与快速精确跟踪的控制要求.

与非有限时间控制方法相比,有限、固定时间控制方法具有更优的收敛性能以及更好的鲁棒和抗扰动性能,在航天器的快速姿态机动与振动抑制问题中有较好的应用 [ 11- 12] . 有限时间控制方法的稳定时间是与系统初始状态有关的无界函数,固定时间控制方法的稳定时间与系统参数有关,且无法直接建立控制参数与稳定时间的数学表达式,为此Sánchez-Torres等 [ 13] 提出预定时间控制方法,将稳定时间作为控制参数,该参数可根据系统设计需求提前设置,并被认作为固定稳定时间的最小上界. Wang等 [ 14] 已将预定时间稳定性理论应用于刚性航天器的姿态机动问题中,确保姿态跟踪误差和角速度在预先设定的时间内收敛到零.

为了提高线驱连续型空间机械臂系统的姿态收敛和抗扰动性能,本研究在存在外界时变干扰与系统参数不确定性的情况下,设计模糊估计器估计并补偿上界未知的干扰,再基于滑模变结构方法设计预定时间控制器. 基于Lyapunov稳定理论证明线驱连续型机械臂系统误差能在设定时间内达到预定时间稳定,并给出仿真结果验证算法的有效性.

1. 多节线驱连续型机械臂的动力学模型

本研究的对象为多节线驱连续型空间机械臂,如 图1所示为2节机械臂示意图. 机械臂每节长度相等,每节由3根线缆驱动中心弹性杆弯曲变形,等距分布的间隔盘为机械臂保持弯曲形态提供刚度支撑.

图 1

图 1   2节线驱动连续型机械臂示意图

Fig.1   Schematic diagram of two-section cable-driven continuum manipulator


图2所示,对第 $ n $节机械臂的弯曲几何模型进行刚体等效简化. 划分机械臂的某一刚性间隔盘与其相邻连接的中心弹性杆,记为 $ k $单元,同时将单元上的中心弹性杆等效为轻质连杆,设定间隔盘的中心点为 k单元的质心点. 基于常曲率假设,第 $ n $节机械臂弯曲平面坐标系 ${{{O}}_{\gamma_{n}}}{{ - }}{{{X}}_{\gamma_{n}}}{{{Y}}_{\gamma_{n}}}{{{Z}}_{\gamma_{n}}}$为由基坐标系 ${{{O}}_{n - 1}}{{ - }}{{{X}}_{n - }}_1{{{Y}}_{n - }}_1 {{{Z}}_{n - }}_1$$ {{{Z}}_{n - 1}} $轴旋转角度 $ {\gamma _n} $所得, $ {\beta _n} $为机械臂末端弯曲角度, N节连续型机械臂姿态角 ${\boldsymbol{\phi}} = \left[{\beta }_{1},{\gamma }_{1},{\beta }_{2},\right.$ ${ \left.{\gamma }_{2},\cdots,{\beta }_{N},{\gamma }_{N}\right]}^{\rm{T}}$. 依据拉格朗日第二类方程建立该机械臂的动力学模型,其动能 $ E $的表达式为

图 2

图 2   第 n节机械臂几何模型

Fig.2   Section n geometric model of manipulator


$ {E_{n,k}} = \frac{1}{2}{m_{n,k}}{{\boldsymbol{v}}^{\text{T}}_{n,k,0}}{{\boldsymbol{v}}_{n,k,0}} = \\ \frac{1}{2}{m_{n,k}}\left( {{{\left(\frac{{{\text{d}}{x_{n,k}}}}{{{\text{d}}t}}\right)}^2} + {{\left(\frac{{{\text{d}}{y_{n,k}}}}{{{\text{d}}t}}\right)}^2} + {{\left(\frac{{{\text{d}}{\text{z}_{n,k}}}}{{{\text{d}}t}}\right)}^2}} \right) , $

$ {m_{n,k}} = {m_0} + {m_{\text{p}}} + 3 (N - n + 1) {m_{\text{c}}} , $

$ E = \sum\limits_{n = 1}^N {\sum\limits_{k = 1}^K {{E_{n,k}}} } = \frac{1}{2}{{\mathbf{\dot {\boldsymbol{\phi}} }}^{\text{T}}}{{\boldsymbol{M}\dot {\boldsymbol{\phi}}}} . $

式中: $ {E_{n,k}} $为第 k单元的动能; ${{\boldsymbol{v}}_{n,k,0}} $为第 k个单元的质心速度, ${{\boldsymbol{v}}_{n,k,0}} = {\left[ {{{{\text{d}}{x_{n,k}}}}/{{{\text{d}}t}},}\,{{{{\text{d}}{y_{n,k}}}}/{{{\text{d}}t}},\,}\right.}$ ${\left.{{{{\text{d}}{\text{z}_{n,k}}}}/{{{\text{d}}t}},\,}0 \right]^{\rm{T}}}$${m_{n,k}}$为第 n节机械臂上第 k单元的总质量; $ {m_0} $$ {m_{\text{p}}} $$ {m_{\text{c}}} $分别为各单元的中心弹性杆、间隔盘和驱动线缆的质量; $ E $为整个多节线驱连续型机械臂上的动能; ${{\boldsymbol{M}}} $为正定矩阵, ${{\boldsymbol{M}}} \in {{\mathbf{R}}^{2N \times 2N}}$.

考虑到连续型空间机械臂处于微重力环境,忽略其重力势能影响,其弹性势能为

$\begin{split} E_{{\rm{p}}_,n} = &\int_0^l {\dfrac{{{E_1}I{}_1}}{2} {{\left(\dfrac{{{\beta _n}}}{l}\right)}^2}{\text{d}}s} + 3(N - n + 1)\int_0^l {\dfrac{{{E_2}I{}_2}}{2}{{\left(\dfrac{{{\beta _n}}}{l}\right)}^2}{\text{d}}s} =\\ & \dfrac{{{E_1}I{}_1}}{{2l}}{\beta _n}^2 + 3(N - n + 1)\dfrac{{{E_2}I{}_2}}{{2l}}{\beta _n}^2 , \end{split} $

$ {E_{\rm{p}}} = \sum\limits_{n = 1}^N {E_{{\rm{p}}_,n}} . $

式中: $E_{{\rm{p}}_,n}$为第 n节上的弹性势能, $ {E_1} $$ {E_2} $分别为弹性杆和驱动线缆的弹性模量, $ {I_1} $$ {I_2} $分别为弹性杆和驱动线缆的惯性矩, l为第 n节弹性杆长度.

多节线驱连续型机械臂的广义力 ${\boldsymbol{Q}}$表示为

$ {\boldsymbol{Q}} = {\boldsymbol{J}}_{{\text{X }}}^{^{\text{T}}}{\boldsymbol{w}} + {\boldsymbol{J}}_{{\text{L }}}^{^{\text{T}}}{\boldsymbol{u}} . $

式中: ${{\boldsymbol{J}}_{{\text{X }}}}$为机械臂任务空间与关节空间速度的雅可比矩阵; ${{\boldsymbol{J}}_{{\text{L }}}}$为机械臂驱动空间与关节空间速度的雅可比矩阵; $\boldsymbol{w}=\left[\boldsymbol{f}^{\mathrm{T}}, \boldsymbol{m}^{\mathrm{T}}\right]^{\mathrm{T}}$,其中 f m 分别为机械臂末端施加的外力与外力动量; u 为机械臂驱动线缆施加的驱动力, ${\boldsymbol{u}}={\left[{u}_{11},\;{u}_{12},\;{u}_{13},\right.}$ $\;{\left.\cdots ,\;{u}_{N1},\;{u}_{N2},\;{u}_{N3}\right]}^{\text{T}}$.

将动能、势能以及广义力表达式(1)~(6)代入拉格朗日第二类方程,得到多节线驱连续型机械臂的动力学方程为

$ {\boldsymbol{M}{\ddot {\boldsymbol{\phi}} }} + {\boldsymbol{\dot M}{\dot {\boldsymbol{\phi}} }} - \frac{{\partial E}}{{\partial {\mathbf{{\boldsymbol{\phi}} }}}} + \frac{{\partial {E_{\rm{p}}}}}{{\partial {\mathbf{{\boldsymbol{\phi}} }}}} = {\boldsymbol{J}}_{{\text{X }}}^{^{\text{T}}}{\boldsymbol{w}} + {\boldsymbol{J}}_{{\text{L }}}^{^{\text{T}}}{\boldsymbol{u}} . $

结合式(7),考虑存在外界时变干扰与系统参数不确定性 ${{\boldsymbol{d}}} {\text{(}}t{\text{)}}$,在末端未施加外力的情况下,多节线驱连续型空间机械臂动力学模型表示为

$ {\boldsymbol{M}{\ddot {\boldsymbol{\phi}} }} + {\boldsymbol{C}{\dot {\boldsymbol{\phi}} }} + {\boldsymbol{D}{{\boldsymbol{\phi}} }} + {\boldsymbol{d}}(t) = {\boldsymbol{J}}_{{\text{L }}}^{^{\text{T}}}{\boldsymbol{u}} . $

式中: ${{\boldsymbol{M}}} \in {{\mathbf{R}}^{2N \times 2N}}$为机械臂的惯性矩阵, ${{\boldsymbol{C}}} \in {{\mathbf{R}}^{2N \times 2N}}$为科里奥利力和向心力矩阵, ${{\boldsymbol{D}}} \in {{\mathbf{R}}^{2N \times 2N}}$为广义刚度矩阵.

2. 基于模糊补偿的连续型空间机械臂预定时间控制

针对存在外界未知扰动的多节线驱连续型机械臂系统,设计基于模糊补偿的预定时间控制方法,研究机械臂的快速姿态稳定与抗扰问题.

2.1. 控制目标

定义机械臂系统的姿态角误差 ${\boldsymbol{e}} = {\mathbf{{\boldsymbol{\phi}} }} - {{\mathbf{{\boldsymbol{\phi}} }}_{\text{d}}}$,姿态角速度误差 ${\boldsymbol{\dot e}} = {\mathbf{\dot {\boldsymbol{\phi}} }} - {{\mathbf{\dot {\boldsymbol{\phi}} }}_{\text{d}}}$,针对连续型空间机械臂系统动力学模型式(8)的总扰动 ${{\boldsymbol{d}}} {\text{(}}t{\text{)}}$,进行如下假设.

假设1 多节线驱连续型机械臂系统受到的总干扰力矩有界但界值未知,即 ${{\boldsymbol{d}}} {\text{(}}t{\text{)}}$满足 $\left\| {{\boldsymbol{d}}(t)} \right\| \leqslant {{{d}}_{\text{H}}}$,其中 $ {d_{\text{H}}} \gt 0 $且为未知常数.

控制目标:针对多节线驱连续型机械臂系统式(8),在假设1的条件下,设计基于模糊补偿的预定时间控制律 u ,使得线驱机械臂姿态角 $ {\mathbf{{\boldsymbol{\phi}} }} $能在用户预先设定时间 ${T_{\rm{c}}}$内稳定到达给定期望角度 $ {{\mathbf{{\boldsymbol{\phi}} }}_{\text{d}}} $,即 $\mathop {\lim }\limits_{t \to {T_{\rm{c}}}} {\mathbf{{\boldsymbol{\phi}} }}(t) = {{\mathbf{{\boldsymbol{\phi}} }}_{\text{d}}}$.

2.2. 控制律设计

定义1  对于非线性自治系统:

$ {\boldsymbol{\dot x}} = {\boldsymbol{f}}({\boldsymbol{x}}),\;{\boldsymbol{x}}(0) = {{\boldsymbol{x}}_0},\;{\boldsymbol{f}}(0) = {\boldsymbol{0}},\;{\boldsymbol{x}} \in {{\bf{R}}^n} . $

式中: x 为系统状态, ${\boldsymbol{f}}:{{\mathbf{R}}^n} \to {{\mathbf{R}}^n}$是非线性连续函数. 对任意选取的时间常数 ${T_{\text{c}}} \in {{\bf{R}}_ + }$ ( ${{\bf{R}}_ + }$表示正实数),系统式(9)在任意初始状态 ${{\boldsymbol{x}}_0}$下的解能在时间 $ {T_{\text{c}}} $内到达平衡点,即 $ \forall t \gt {T_{\text{c}}} $${\boldsymbol{x}}(t,{{\boldsymbol{x}}_0}) = {0}$$ {T_{\text{c}}} $为系统调节时间,则系统式(9)满足预定时间稳定 [ 15] .

引理1  对于非线性自治系统式(9),假设存在连续径向无界函数 ${{V}}{\text{(}}{\boldsymbol{x}}{\text{)}}:{{\mathbf{R}}^n} \to {{\mathbf{R}}_ + } \cup \left\{ 0 \right\}$${{V}}(0) = {{0}}$

$ {{\dot V}}({\boldsymbol{x}}) \leqslant - \frac{1}{{p{T_{\text{c}}}}}\exp\; \left( {{{{V}}^p}({\boldsymbol{x}})} \right){{{V}}^{1 - p}}({\boldsymbol{x}}),\;\forall {\boldsymbol{x}} \ne {{\boldsymbol{0}}} . $

式中: $ p \in (0,1.0] $. 当式(10)满足不等式成立时,称该系统弱预定时间稳定,其中 $ {T_{\text{c}}} $为弱预定时间.当式(10)满足等式成立时,称该系统为强预定时间稳定,此时 $ {T_{\text{c}}} $为强预定时间 [ 15] ,且对于任意初始状态 ${\boldsymbol{x}}({t_0}) \ne {\boldsymbol{0}}$,当 $ t \geqslant {T_{\text{c}}} $时,系统状态 ${\boldsymbol{x}}(t) = {\boldsymbol{0}}$.

选取滑模面:

$ {\boldsymbol{s}} = {\boldsymbol{\dot e}} + {{\boldsymbol{\psi}} _1} . $

式中: ${{{{\boldsymbol{\psi}} _1} = \left({{{m_1}{q_1}{T_{{\text{c}}1}}}}\right)}^{-1}}\exp\; \left( {{{\left\| {\boldsymbol{e}} \right\|}^{{m_1}{q_1}}}} \right){{\boldsymbol{e}}}/{{{{\left\| {\boldsymbol{e}} \right\|}^{{m_1}{q_1}}}}}$$ {m_1} $$ {q_1} $为常数,且 $ {m_1} \geqslant 1 $$ 0 \lt {q_1} \lt {{{m_1^{-1}}}} $$ {T_{{\text{c}}1}} $为预先定义的系统误差状态到达滑模面后的稳定时间. 将式(11)对时间求导得

$ \left.\begin{array}{c} \dot{\boldsymbol{s}}=\ddot{\boldsymbol{e}}+\dfrac{\partial {\boldsymbol{\psi}}_{1}}{\partial \boldsymbol{e}} \dot{\boldsymbol{e}}, \\ \dfrac{\partial {\boldsymbol{\psi}}_{1}}{\partial \boldsymbol{e}} = \dfrac{\exp\; \left(\|\boldsymbol{e}\|^{m_{1} q_{1}}\right)}{m_{1} q_{1} T_{\mathrm{c} 1}} \left(m_{1} q_{1} \dfrac{\boldsymbol{e} \boldsymbol{e}^{\mathrm{T}}}{\|\boldsymbol{e}\|^{2}} + \left(\boldsymbol{I}_{n} - m_{1} q_{1} \dfrac{\boldsymbol{e e}^{\mathrm{T}}}{\|\boldsymbol{e}\|^{2}}\right) \dfrac{1}{\|\boldsymbol{e}\|^{m_{1} q_{1}}}\right). \end{array} \right\}$

式中: ${{\boldsymbol{I}}_n}$n维单位矩阵.

设计预定时间控制律为

$ {\boldsymbol{u}} = - {\boldsymbol{J}}_{{\text{L }}}^{{\text{T + }}}{\boldsymbol{M}}\left( { - {{\boldsymbol{M}}^{ - 1}}({\boldsymbol{C}{\boldsymbol{\dot{\phi}} }} + {\boldsymbol{D}{{\boldsymbol{\phi}} }}) - {{{\mathbf{\ddot {\boldsymbol{\phi}} }}}_{\rm{d}}}} { + \frac{{\partial {{\boldsymbol{\psi}} _1}}}{{\partial {\boldsymbol{e}}}}{\boldsymbol{\dot e}} + {{\boldsymbol{\psi}}_ 2} + k{\text{sign}}\;({\mathbf {{\bf{s}}}})} \right) . $

式中: ${\boldsymbol{J}}_{{\text{L }}}^{{\text{T+ }}}$为矩阵 ${\boldsymbol{J}}_{{\text{L }}}^{\text{T}}$的广义逆; $k $用于补偿未知有界干扰项, $k = \hat k + \varepsilon ,$其中 $ \hat k $为干扰项的估计值, $ \varepsilon \gt 0 $${{\boldsymbol{\psi}} _2} = \left({{{m_2}{q_2}{T_{{\text{c}}2}}}}\right)^{-1}\exp \;\left( {{{\left\| {\boldsymbol{s}} \right\|}^{{m_2}{q_2}}}} \right){{\boldsymbol{s}}}/{{{{\left\| {\boldsymbol{s}} \right\|}^{{m_2}{q_2}}}}}$$ {m_2} $$ {q_2} $均为常数,且 $ {m_2} \geqslant 1 $$0 \lt {q_2} \lt {{{m_2}}}^{-1}$$ {T_{{\text{c}}2}} $为预先定义的系统误差状态到达滑模面的时间.

定理1  对于多节线驱连续型空间机械臂系统式(8),在存在外界时变干扰和参数不确定性时,在假设1的条件下,采用预定时间控制律式(13),机械臂系统姿态角误差 e 将在预定时间 $ {T_{\text{c}}} $内收敛至原点,即 $ \mathop {\lim }\limits_{t \to {T_{\text{c}}}} ({\boldsymbol{\phi}} - {{\boldsymbol{\phi}} _{\text{d}}}(t)) = {\mathbf{0}} $.

证明:在系统误差状态未到达滑模面阶段,选取Lyapunov函数:

$ {{{V}}_1} = {\left\| {\boldsymbol{s}} \right\|^{{m_2}}} . $

将式(14)对时间求导,并将式(12)、(13)代入,整理得到

$ \begin{split} \dot{{V}}_{1}= \;&m_{2}\|\boldsymbol{s}\|^{m_{2}-2} \boldsymbol{s}{ }^{\mathrm{T}} \dot{\boldsymbol{s}}=m_{2}\|\boldsymbol{s}\|^{m_{2}-2} \boldsymbol{s}^{\mathrm{T}}\left(\ddot{{\boldsymbol{\phi}}}-\ddot{{\boldsymbol{\phi}}}_{\mathrm{d}}+\dfrac{\partial {\boldsymbol{\psi}}_{1}}{\partial \boldsymbol{e}} \dot{\boldsymbol{e}}\right)= \\ &m_{2}\|\boldsymbol{s}\|^{m_{2}-2} \boldsymbol{s}^{\mathrm{T}}\Bigg(\boldsymbol{M}^{-1}\left(\boldsymbol{J}_{\mathrm{L} }^{\mathrm{T}} \boldsymbol{u}-\boldsymbol{C} {\boldsymbol{\dot{\phi}}}-\boldsymbol{D} {\boldsymbol{\phi}}-\boldsymbol{d}(t)\right)-\ddot{{\boldsymbol{\phi}}}_{\mathrm{d}}+\Bigg. \\ &\Bigg.\dfrac{\partial {\boldsymbol{\psi}}_{1}}{\partial {\boldsymbol{e}}} \dot{\boldsymbol{e}}\Bigg)=m_{2}\|\boldsymbol{s}\|^{m_{2}-2} {\boldsymbol{s}}^{ {\rm{T}}}\left(-\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}} \exp\; \left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\times\right. \\ &\left.\dfrac{\boldsymbol{s}}{\|\boldsymbol{s}\|^{m_{2} q_{2}}} - k \operatorname{sign}\;({\boldsymbol{s}}) + \boldsymbol{d}(t)\right) = m_{2}\|\boldsymbol{s}\|^{m_{2}-2}\left( -\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}}\times\right. \\ &\Bigg.\exp\; \left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\|\boldsymbol{s}\|^{2-m_{2} q_{2}}-k {\boldsymbol{s}}^{\mathrm{T}} \operatorname{sign}\;({\boldsymbol{s}})+{\boldsymbol{s}}^{\mathrm{T}} {\boldsymbol{d}}(t)\Bigg) \leqslant \\ &m_{2}\|\boldsymbol{s}\|^{m_{2}-2}\left(-\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}} \exp\; \left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\|\boldsymbol{s}\|^{2-m_{2} q_{2}}-\right. \\ &\Bigg.k\left\|\boldsymbol{s}^{\mathrm{T}}\right\|+\left\|\boldsymbol{s}^{\mathrm{T}} \boldsymbol{d}(t)\right\|\Bigg).\\[-18pt] \end{split}$

依据Cauchy-Schwarz不等式,进一步得到

$ \begin{split} \dot{{V}}_{1} \leqslant \;& m_{2}\|\boldsymbol{s}\|^{m_{2}-2}\left(-\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}} \exp\; \left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\|\boldsymbol{s}\|^{2-m_{2} q_{2}}-\right. \\ &\Bigg.k\left\|\boldsymbol{s}^{\mathrm{T}}\right\|+\left\|\boldsymbol{s}^{\mathrm{T}}\right\|\|\boldsymbol{d}(t)\|\Bigg)=m_{2}\|\boldsymbol{s}\|^{m_{2}-2}\left(-\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}}\times\right. \\ &\Bigg.\exp \;\left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\|\boldsymbol{s}\|^{2-m_{2} q_{2}}+\left\|\boldsymbol{s}^{\mathrm{T}}\right\|(-k+\|\boldsymbol{d}(t)\|)\Bigg) \leqslant \\ &m_{2}\|\boldsymbol{s}\|^{m_{2}-2}\left(-\dfrac{1}{m_{2} q_{2} T_{\mathrm{c} 2}} \exp \;\left(\|\boldsymbol{s}\|^{m_{2} q_{2}}\right)\|\boldsymbol{s}\|^{2-m_{2} q_{2}}\right)= \\ &-\dfrac{1}{q_{2} T_{\mathrm{c} 2}} \exp\; \left({V}_{1}^{q_{2}}\right) {V}_{1}^{1-q_{2}}.\\[-17pt] \end{split}$

根据引理1,系统误差状态将在 $ {T_{{\text{c2}}}} $时间内到达滑模面.

当系统误差状态到达滑模面时,有 ${\boldsymbol{s}} = {\boldsymbol{0}}$,即 ${\boldsymbol{\dot e}} = - {{\boldsymbol{\psi}} _1}$,选取Lyapunov函数:

$ {{{V}}_2} = {\left\| {\boldsymbol{e}} \right\|^{{m_1}}} . $

${{\textit{V}}_2}$对时间进行求导,并将 ${\boldsymbol{\dot e}} = - {{\boldsymbol{\psi}} _1}$代入其中,得

$\begin{split} {{{\dot V}}_2} =& {m_1}{\left\| {\boldsymbol{e}} \right\|^{{m_1} - 2}}{{\boldsymbol{e}}^{\text{T}}}{\boldsymbol{\dot e}} = \\ & - {m_1}{\left\| {\boldsymbol{e}} \right\|^{{m_1} - 2}}{{\boldsymbol{e}}^{\text{T}}}\dfrac{1}{{{m_1}{q_1}{T_{{\text{c1}}}}}}\exp\; \left( {{{\left\| {\boldsymbol{e}} \right\|}^{{m_1}{q_1}}}} \right)\dfrac{{\boldsymbol{e}}}{{{{\left\| {\boldsymbol{e}} \right\|}^{{m_1}{q_1}}}}} = \\ & - \dfrac{1}{{{q_1}{T_{{\text{c1}}}}}}\exp\; \left( {{{\left\| {\boldsymbol{e}} \right\|}^{{m_1}{q_1}}}} \right){\left\| {\boldsymbol{e}} \right\|^{{m_1} - {m_1}{q_1}}} = \\ &- \dfrac{1}{{{q_1}{T_{{\text{c1}}}}}}\exp\; ({\textit{V}}\;_2^{{q_1}}){\textit{V}}_2^{1 - {q_1}} .\\[-17pt] \end{split}$

根据引理1,系统误差状态将在 $ {T_{{\text{c1}}}} $时间内收敛到0.

综上所述,该连续型空间机械臂系统姿态角能在用户预先设定时间 $ {T_{\text{c}}} = {T_{{\text{c1}}}} + {T_{{\text{c2}}}} $内稳定到达给定期望角度.

由预定时间控制律式(13)可知,切换增益 k易引发抖振,考虑到模糊系统具有万能逼近特性 [ 16] ,采用模糊规则估计切换增益,补偿未知有界干扰项,消除抖振.

滑模存在的条件为 ${{{ {\mathit{\dot{V}}}_1}}} \leqslant {\rm{0}}$,切换增益 k须足以消除未知干扰的影响,因此当 ${{\boldsymbol{s}}^{\text{T}}}{\boldsymbol{\dot s}} \gt 0$时, k应增大,当 ${{\boldsymbol{s}}^{\text{T}}}{\boldsymbol{\dot s}} \leqslant 0$时, k应减小. 此时,模糊规则设计为1)当 ${{\boldsymbol{s}}^{\text{T}}}{\boldsymbol{\dot s}}$为负大值(NB)或负中值(NM)时,输出量 $ \Delta k $也为NB或NM;2)当 ${{\boldsymbol{s}}^{\text{T}}}{\boldsymbol{\dot s}}$为零值(ZO)时,输出量 $ \Delta k $也为ZO;3)当 ${{\boldsymbol{s}}^{\text{T}}}{\boldsymbol{\dot s}}$为正大值(PB)或正中值(PM)时,输出量 $ \Delta k $也为PB或PM. 切换增益 k的上界估计

$ \hat k(t) = K\int_0^t {\Delta k} {\rm{d}}t . $

式中: K为由经验值确定的比例系数.

控制参数的选取依据如下. 1) 用户预先设定的时间 $ {T_{\text{c}}} $应根据任务需求和实际物理约束合理选取;2) 合理调节参数 $ {m_1}{q_1}、{m_2}{q_2} \in (0,1.0) $,使实际物理系统满足所需收敛时间和控制力矩要求. 一般情况下,参数值越小,收敛效果越好.

3. 数值仿真与结果分析

对2节线驱连续型空间机械臂系统进行仿真,研究系统在基于模糊补偿的预定时间控制方法下的姿态稳定性能,并对比基于非奇异终端滑模(nonsingular terminal sliding mode control,NTSMC)的有限时间控制方法 [ 11] . 假设期望姿态角 ${{\boldsymbol{\phi}} _{\text{d}}} = {\left[{{{\phi}} _{\text{d1}}},{{{\phi}} _{\text{d2}}},{{{\phi}} _{\text{d3}}},{{{\phi}} _{\text{d4}}}\right]^{\text{T}}} = {\left[ {{0.8},{0.6},{0.8},{0.6} } \right]^{\text{T}}}$rad,初始姿态角 ${\boldsymbol{\phi}}_{0}=$ $\Big[0.15,0,0.15,0\Big]^{\mathrm{T}}{\rm{rad}}$,干扰为 $\boldsymbol{d}=\Big[0.001\sin\;(0.5 t),$ $0.001\sin \;(0.5 t), 0.0 0 1\sin\;(0.5 t), 0.001 \sin \;(0.5 \mathit{t})\Big]^{\mathrm{T}}$.图3~ 6所示分别为在基于预定时间控制的2组设定收敛时间 ${T_{\text{c}}} = 4\;{\rm{s}}$ $({T_{{\text{c1}}}} = 3\;{\rm{s}},{T_{{\text{c2}}}} = 1\;{\rm{s}})、$ ${T_c} = 11\;{\rm{s}}$ $({T_{{\text{c1}}}} = 8\;{\rm{s}}, {T_{{\text{c2}}}} = 3\;{\rm{s}})$ 情况下,姿态响应与误差曲线图以及基于NTSMC有限时间控制的仿真曲线. 图中, $\; {\beta _1} $$ {\gamma _1} $$ \;{\beta _2} $$ {\gamma _2} $为机械臂姿态角,姿态角误差 ${\boldsymbol{e}} = {[{e_1}{\rm{,}}{{{e}}_2},{e_3},{e_4}]^{\rm{T}}}$,其中 e 1, e 2, e 3, e 4为对应各姿态角误差.当 ${T_{\text{c}}} = 4\;{\rm{s}}$时,控制参数设置为 $ {m_1}{q_1} = 0.5 $$ {m_2}{q_2} = 0.38 $;当 T c = 11 s时,控制参数设置为 ${m_1}{q_1} = 0.25$$ {m_2}{q_2} = 0.25 $.图34可知,在预定时间控制方法下,系统姿态角均能在设定时间内到达期望角度,预先设定的收敛时间越长,其姿态角实际收敛速度越慢. 在基于NTSMC的有限时间控制方法下,系统姿态角的收敛速度则相比较慢. 由 图56可知,各姿态角误差均稳定在−4×10 −3~3×10 −3 rad,预先设定的收敛时间越短,姿态角误差的收敛精度将越高. 如 图7所示为对未知干扰 ${{\boldsymbol{d}}} {\text{(}}t{\text{)}}$上界的估计图.

图 3

图 3   不同控制策略下的第1节机械臂姿态响应曲线

Fig.3   Attitude response curves of section 1 manipulator under different control strategies


图 4

图 4   不同控制策略下的第2节机械臂姿态响应曲线

Fig.4   Attitude response curves of section 2 manipulator under different control strategies


图 5

图 5   不同控制策略下的第1节机械臂姿态误差曲线

Fig.5   Attitude error curves of section 1 manipulator under different control strategies


图 6

图 6   不同控制策略下的第2节机械臂姿态误差曲线

Fig.6   Attitude error curves of section 2 manipulator under different control strategies


图 7

图 7   未知干扰上界估计曲线

Fig.7   Estimation curve of unknow disturbance upper bound


虽然姿态角在不同设定时间内均能有效收敛,但两者的控制性能是不同的. 定义控制能量消耗指标

$ {E_{\rm{c}}} = \sum\limits_{i = 1}^{n^{\prime}} {\int_0^T {{{\left| {{\tau _i}} \right|}^2}} } {\text{d}}t . $

式中: $ {\tau _i} $为第 i个控制力矩, $n^{\prime} $为系统控制力矩个数, T为施加力矩的结束时间.

经计算,当 ${T_{\text{c}}} = 4\;{\rm{s}}$时,控制器所消耗能量为1.25×10 3 J,当 ${T_{\text{c}}} = 11\;{\rm{s}}$时,控制器所消耗能量为3.74×10 3 J,当选用基于NTSMC有限时间控制方法时,控制器所消耗能量为5.23×10 3 J. 因此基于预定时间收敛的控制器所需能量较少,且预先设定的收敛时间越短,消耗的控制能量越大,系统的快收敛速率与高收敛精度伴随着更大的控制能量消耗.在实际应用时,为了减小控制电机损耗,不妨牺牲控制性能,以达到节能的效果.

4. 结 语

本研究针对受外界时变干扰且具有参数不确定性的多节线驱连续型空间机械臂系统的姿态稳定控制问题,设计了基于模糊补偿的预定时间控制器,使机械臂系统能够在预先设定的时间范围内到达稳定状态,且稳定时间与系统初始状态无关. 所设计的模糊估计器较好地抑制了总干扰对机械臂系统的不利影响. 本研究所提控制方法可以满足机械臂系统的快速收敛与较高精度控制要求,更贴合实际应用需求. 在工程应用中,为了高效运行被控系统,常需要在线调节控制参数以满足实际需求与应用,如何自适应调节系统控制参数是下一步计划开展的研究.

参考文献

MOGHADDAM B M, CHHABRA R

On the guidance, navigation and control of in-orbit space robotic missions: a survey and prospective vision

[J]. Acta Astronautica, 2021, 184: 70- 100

DOI:10.1016/j.actaastro.2021.03.029      [本文引用: 1]

OUYANG X, MENG D, WANG X, et al

Hybrid rigid-continuum dual-arm space robots: modeling, coupling analysis, and coordinated motion planning

[J]. Aerospace Science and Technology, 2021, 116: 106861

DOI:10.1016/j.ast.2021.106861      [本文引用: 1]

PALMER D, AXINTE D

Active uncoiling and feeding of a continuum arm robot

[J]. Robotics and Computer Integrated Manufacturing, 2019, 56: 107- 116

DOI:10.1016/j.rcim.2018.09.003     

TONAPI M M, GODAGE I S, WALKER I D. Next generation rope-like robot for in-space inspection [C]// 2014 IEEE Aerospace Conference. Big Sky: IEEE, 2014: 1-13.

JIANG D, CAI Z, PENG H, et al

Coordinated control based on reinforcement learning for dual-arm continuum manipulators in space capture missions

[J]. Journal of Aerospace Engineering, 2021, 34 (6): 4021087

DOI:10.1061/(ASCE)AS.1943-5525.0001335      [本文引用: 1]

IVANESCU M, POPESCU D, POPESCU N

A decoupled sliding mode control for a continuum arm

[J]. Advanced Robotics, 2015, 29 (13): 831- 845

DOI:10.1080/01691864.2015.1035323      [本文引用: 1]

ALQUMSAN A A, KHOO S, NORTON M

Robust control of continuum robots using Cosserat rod theory

[J]. Mechanism and Machine Theory, 2019, 131: 48- 61

DOI:10.1016/j.mechmachtheory.2018.09.011      [本文引用: 1]

ALQUMSAN A A, KHOO S, NORTON M

Multi-surface sliding mode control of continuum robots with mismatched uncertainties

[J]. Meccanica, 2019, 54: 2307- 2316

DOI:10.1007/s11012-019-01072-6      [本文引用: 1]

QI P, LIU C, ATAKA A, et al

Kinematic control of continuum manipulators using a fuzzy model-based approach

[J]. IEEE Transactions on Industrial Electronics, 2016, 63 (8): 5022- 5035

DOI:10.1109/TIE.2016.2554078      [本文引用: 1]

PILTAN F, KIM C H, KIM J

Adaptive fuzzy-based fault-tolerant control of a continuum robotic system for maxillary sinus surgery

[J]. Applied Sciences, 2019, 9 (12): 2490

DOI:10.3390/app9122490      [本文引用: 1]

ZHONG C, GUO Y, YU Z, et al

Finite-time attitude control for flexible spacecraft with unknown bounded disturbance

[J]. Transactions of the Institute of Measurement and Control, 2016, 38 (2): 240- 249

DOI:10.1177/0142331214566223      [本文引用: 2]

JIANG B, HU Q, FRISWELL M I

Fixed-time attitude control for rigid spacecraft with actuator saturation and faults

[J]. IEEE Transactions on Control Systems Technology, 2016, 24 (5): 1892- 1898

DOI:10.1109/TCST.2016.2519838      [本文引用: 1]

SÁNCHEZ-TORRES J D, DEFOORT M, MUÑOZ-VÁZQUEZ A J. A second order sliding mode controller with predefined-time convergence [C]// 15th International Conference on Electrical Engineering, Computing Science and Automatic Control. Mexico City: IEEE, 2018: 1-4.

[本文引用: 1]

WANG F, MIAO Y, LI C, et al

Attitude control of rigid spacecraft with predefined-time stability

[J]. Journal of the Franklin Institute, 2020, 357 (7): 4212- 4221

DOI:10.1016/j.jfranklin.2020.01.001      [本文引用: 1]

SÁNCHEZ-TORRES J D, GÓMEZ-GUTIÉRREZ D, LÓPEZ E, et al

A class of predefined-time stable dynamical systems

[J]. IMA Journal of Mathematical Control and Information, 2018, 35: i1- i29

DOI:10.1093/imamci/dnx004      [本文引用: 2]

王坚强

模糊多准则决策方法研究综述

[J]. 控制与决策, 2008, 6 (23): 601- 606

[本文引用: 1]

WANG Jian-qiang

Overview on fuzzy multi-criteria decision-making approach

[J]. Control and Decision, 2008, 6 (23): 601- 606

[本文引用: 1]

/