1. Introduction
Space robots are systems with a certain topology that are articulated by multiple connecting links. They are widely used in space operations [Reference Doyle, Kubota, Picard, Sommer, Ueno, Visentin and Volpe1, Reference Li, Liu, Guo and Cai2] and play an important role in the construction process of the space station [Reference Wie, Hu and Singh3]. In recent years, with the increasing demand for space manipulation accuracy, high-precision control of space robots draws attention [Reference Giordano, Calzolari, De Stefano, Mishra, Ott and Albu-Schäffer4, Reference Ai, Zhu and Chen5]. As non-negligible factors affecting control accuracy, the topic of flexibilities in the base, link and joint on space robot becomes an important subject. The links of space robot are generally designed to be thin and long, which is prone to vibration when performing tasks, especially auxiliary docking or capture operations [Reference Singh and Schy6]. Space robot with movable link on the base is more maneuverable and with larger working range, compared to one with fixed link. However, the movable link is mounted on the slender base truss rail; thus, it is easily affected by external shocks such as drive torque or cosmic rays, leading to base vibration. In addition, space robot links are generally driven by lightweight harmonic flexible wheels mounted at the joints, gaining the advantages of being small size, light-weighted and with large transmission ratio at the price of out-of-sync problem between the space robot motor and the joint, resulting in joint vibration [Reference Liu, Yao and Guo7]. These flexible vibrations, once excited, can take a very long time to decay in the undamped space environment. In order to reduce the influence of the structural flexibility of the system, a “low-speed, slow-running” operation model is commonly used, but this operation model is time-consuming and laborious. Therefore, it is of great practical importance to study the influence of the flexibility of base, link and joint in the mathematical modeling and controller design for space robots.
For space robots with flexible base, links and joints, the non-completeness of dynamics and the strong coupling between rigid and flexible motions greatly increase the difficulty in dynamics analyzing and controller designing. Most researches on space robot address the flexibility problem by focusing on either the link [Reference Yang, Ge and Liu8] or the joint [Reference Hu, Dian, Guo, Li and Zhao9], while studies on base flexibility are mostly found in ground robot systems [Reference Bégin, Poon and Ian10, Reference Beck, Garofalo and Ott11]. Mori et al. [Reference Mori and Murakami12] presented an impedance and vibration suppression fusion control for a flexible-base manipulator, but it was not suitable for space weightlessness environment nor did it consider the effect of link flexibility. Yu [Reference Yu13] analyzed a flexible-link space robot considering the influence of base flexibility on system modeling and control, but the experimental implementation process of the flexible-link is not presented. Designing actual flexible arms is very important in fast and high-precision control situations and has received a lot of attention from scholars [Reference Korayem, Dehkordi and Mehrjooee14, Reference Korayem, Dehkordi, Mojarradi and Monfared15]. Aghajari et al. [Reference Aghajari, Dehkordi and Korayem16] proposed a kind of flexible-link that can achieve fast movements and precise positioning and has a wide range of applications in the field of space exploration. Zhang et al. [Reference Zhang, Liu and Cai17] studied the dynamics and control of a flexible-link space robot considering friction and joint flexibility. A trajectory tracking controller with friction compensation was designed, but base flexibility was not included. Xie et al. [Reference Xie, Yu and Chen18] proposed a dynamics model considering the flexibility in links and joints and used fuzzy sliding mode control to achieve joint trajectory tracking. For the fast subsystem, a velocity difference feedback control and a linear quadratic optimal control were designed to suppress the vibration of the flexible links and joints, respectively. Although the expected results were achieved, the fast subsystem vibration suppression algorithm composed of two algorithms was with complex structure and required large computational efforts. To the best of our knowledge, it is still an open topic to combine the three aspects (i.e. flexibilities of base, link and joint) regarding model building and controller designing. In order to improve the aerospace performance of flexible-base, flexible-link and flexible-joint (FBFLFJ) space robot in extreme environments, it is particularly important to control the motion vibration synchronization.
Space robots are costly from software and hardware development, especially in control algorithm design. The good controllers contribute to cost-saving and efficiency in practice [Reference Sands19, Reference Sands20]. The followings are three aspects to be considered. First, the power and torque of the drive motor are always limited on space robots; therefore, the input constraints should be considered to avoid control failure [Reference Jia and Shan21, Reference Q., Yuan and Sun22]. Second, output feedback based on position sensing is preferred when speed sensors are not available [Reference Mizumoto, Fujii and Mita23]. Third, repetitive learning control can be introduced to accommodate reoccurring errors in periodic tasks [Reference Yan, Cai, Li and Yang24, Reference Fedele25]. Liu et al. [Reference Liu, Guo, He and Hui26] proposed a control strategy for momentum constraint under external disturbances and input saturation. Zhang et al. [Reference Zhang and Liu27] proposed an output feedback predictive control strategy to achieve coordination and synchronous stabilization with output consistency. Califano et al. [Reference Califano, Bin, Macchelli and Melchiorri28] proposed exponentially stable repetitive learning algorithms and gave an explicit proof of fully localized asymptotic tracking and interference suppression. The abovementioned control algorithms are mainly designed for single working conditions, while in practice, the controller must take on all the three aspects.
Based on the above considerations, this paper establishes an FBFLFJ space robot dynamics model using the hypothetical modal method with Lagrange’s equation and decomposes the model according to the principle of mutual independence of dual time scales by using the singular perturbation method. Due to the three flexibilities being coupled with each other, it is very difficult to suppress the vibration at the same time. In this paper, the vibration of base and joint is decomposed in fast subsystem, and the vibration of link is decomposed in slow subsystem. Then, the vibrations of base and joint are suppressed with linear quadratic optimal controller, and the vibration of the link is suppressed by hybrid trajectory method based on the virtual force concept. Finally, considering the restricted drive torque, unmeasurable velocity information and uncertain model information of space robot, we propose an integrated sliding mode control with input restriction, output feedback and repetitive learning (ISMC-IOR). By using the class invariance theorem, the stability of the algorithm is proved, and the simulation analysis is performed to verify its effectiveness.
The rest of the paper is organized as follows: in Section 2, an FBFLFJ space robot is introduced, and its dynamic model is developed using the assumed mode method and Lagrange method. In Section 3, the FBFLFJ space robot is decomposed into fast and slow subsystems using the singular perturbation method, and its properties are introduced. In Section 4, the motion and vibration integrated control method is presented and its stability is investigated. In Section 5, experimental data from a computer simulation are presented. Section 6 gives the conclusion.
2. Dynamic model of an FBFLFJ space robot
The flexible-base flexible-link and flexible-joint (FBFLFJ) space robot system is shown in Figure 1. It consists of a free-floating flexible-base
$B_{0}$
, and flexible-link
$B_{1}$
and flexible-link
$B_{2}$
. The inertial coordinate system
$OXY$
and the local coordinate systems
$O_{i^{\prime}}X_{i^{\prime}}Y_{i^{\prime}}\!\left(i^{\prime}=0,\right.1,\left.2\right)$
of each split are established.
$O_{0}$
coincides with the base mass center
$O_{{C}0}$
, and
$O_{i}$
coincides with the joint hinge center connecting the split
$B_{i-\mathrm{1}}$
and
$B_{i}$
$\left(i=1,2\right)$
.
$q_{{b}}$
is the flexible deformation of the base,
$q_{0}$
is the base attitude angle,
$q_{i}$
is the relative angle of the link
$B_{i}$
and
$q_{{m}i}$
is the joint motor rotor angle
$\left(i=1,2\right)$
. When the base is not deformed, the distance between
$O_{{C}0}$
and
$O_{1}$
is
$l_{0}$
. The mass of the base is
$m_{0}$
, and the rotational inertia is
$J_{0}$
. The initial length of link
$B_{i}$
is
$l_{i}$
, the density is
$\rho _{i}$
and the motor rotor rotational inertia is
$J_{{m}i} \!\left(i=1,2\right)$
.
Figure 1. Structure diagram of the FBFLFJ space robot system.
According to the configuration and vibration characteristics of the FBFLFJ robot links, each link is simplified to a simply supported beam, as shown in Fig. 2, and analyzed by Euler-Bernoulli beam theory and hypothetical modal method. Taking its flexural stiffness
$\text{EI}_{i}$
as a constant value, the flexible deformation of the link
$B_{i}$
at
$x_{i}$
section at the moment
$t$
is
$v_{i}\!\left(x_{i},t\right)=\sum _{j=1}^{n_{i}}\phi _{ij}\!\left(x_{i}\right)\delta _{ij}(t),\left(0\leq x_{i}\right.\leq \left.l_{i}\right)$
, where
$x_{i}$
is any distance on the coordinate system
$X_{i}$
of the main axis of link
$B_{i}, \phi _{ij}$
and
$\delta _{ij}$
represent the j-order modal function and corresponding modal coordinates of link
$B_{i}$
, respectively. Taking the retained modal number as
$n_{i}=2$
, the equivalent stiffness factor of link
$B_{i}$
is
$k_{\unicode{x03B4} ij}=\text{EI}_{i}\int _{0}^{l_{i}}\!\left(\ddot{\phi }_{ij}^{2}\!\left(x_{i}\right)\right)\mathrm{d}x_{i},\left(i,j=\right.\left.1,2\right)$
.
Figure 2. Structure diagram of the flexible link.
According to the SPONG assumption [Reference Spong29], the flexible base and the flexible joints are assumed to be massless linear telescopic spring and linear torsional spring, respectively. The elasticity coefficients of base and joint are defined as
$k_{{b}}$
and
$k_{{m}i} \!\left(i=1,2\right)$
, respectively, and are taken as constant values. The flexible-joint structure is shown in Fig. 3.
Figure 3. Structure diagram of the flexible joint.
According to the geometric position relationship of the FBFLFJ space robot in the inertial coordinate system, we have
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{r}}_{0}=\left(x_{0},y_{0}\right)^{{T}}\\[4pt] \boldsymbol{{r}}_{1}=\boldsymbol{{r}}_{0}+\left(l_{0}+q_{{b}}\right)\boldsymbol{{e}}_{0}+x_{1}\boldsymbol{{e}}_{1}+v_{1}\!\left(x_{1},t\right)\boldsymbol{{c}}_{1}\\[4pt] \boldsymbol{{r}}_{2}=\boldsymbol{{r}}_{0}+\left(l_{0}+q_{{b}}\right)\boldsymbol{{e}}_{0}+l_{1}\boldsymbol{{e}}_{1}+x_{2}\boldsymbol{{e}}_{2}+v_{2}\!\left(x_{2},t\right)\boldsymbol{{c}}_{2} \end{array}\right. ,\end{equation}
where
$\boldsymbol{{r}}_{0}$
denotes the position vector of the base mass center in the inertial coordinate system, and
$\boldsymbol{{r}}_{i}$
denotes the vector of any point on the link
$B_{i}$
in the inertial coordinate system
$\left(i=1,2\right)$
.
$\left(x_{0},y_{0}\right)$
is the base center of mass coordinate.
$\boldsymbol{{e}}_{0}=\left[\begin{array}{l} \sin \!\left(q_{0}\right)\\[4pt] \cos \!\left(q_{0}\right) \end{array}\right]$
,
$\boldsymbol{{e}}_{1}=\left[\begin{array}{l} \sin \!\left(q_{0}+q_{1}\right)\\[4pt] \cos \!\left(q_{0}+q_{1}\right) \end{array}\right], \boldsymbol{{c}}_{1}=\left[\begin{array}{l} -\cos \!\left(q_{0}+q_{1}\right)\\[4pt] \sin \!\left(q_{0}+q_{1}\right) \end{array}\right], \boldsymbol{{e}}_{2}=\left[\begin{array}{l} \sin \!\left(q_{0}+q_{1}+q_{2}\right)\\[4pt] \cos \!\left(q_{0}+q_{1}+q_{2}\right) \end{array}\right]$
and
$\boldsymbol{{c}}_{2}=\left[\begin{array}{l} -\cos \!\left(q_{0}+q_{1}+q_{2}\right)\\[4pt] \sin \!\left(q_{0}+q_{1}+q_{2}\right) \end{array}\right]$
are the basis vectors.
According to the centroid theorem, we have
\begin{equation} m_{0}\boldsymbol{{r}}_{0}+\sum _{i=1}^{2}\int _{0}^{l_{i}}\rho _{i}\boldsymbol{{r}}_{i}\mathrm{d}x_{i}=M\boldsymbol{{r}}_{{C}} ,\end{equation}
where
$\boldsymbol{{r}}_{{C}}$
denotes the position vector of the total center of mass of the system in the inertial coordinate system, and the total mass of the system is
$M=m_{0}+\sum _{i=1}^{2}\rho _{i}l_{i}$
.
Let the initial momentum of the system be 0, then
$M\dot{\boldsymbol{{r}}}_{{C}}=0$
. Combining Eqs. (1) and (2), the total kinetic energy of the FBFLFJ space robot system can be obtained as
\begin{equation} T=\frac{1}{2}m_{0}\dot{\boldsymbol{{r}}}_{0}^{2}+\frac{1}{2}J_{0}\dot{q}_{0}^{2}+\sum _{i=1}^{2}\!\left(\frac{1}{2}\int _{0}^{l_{i}}\rho _{i}\dot{\boldsymbol{{r}}}_{i}^{2}\mathrm{d}x_{i}\right)+\sum _{i=1}^{2}\!\left(\frac{1}{2}J_{{m}i}\dot{q}_{{m}i}^{2}\right) .\end{equation}
Neglecting the effect of gravity, the total potential energy of the FBFJFL space robot system is
\begin{equation} V=\frac{1}{2}k_{{b}}q_{{b}}^{2}+\sum _{i=1}^{2}\!\left(\frac{\text{EI}_{i}}{2}\int _{0}^{l_{i}}\!\left(\frac{\partial ^{2}v_{i}\!\left(x_{i},t\right)}{\partial x_{\mathrm{i}}^{2}}\right)^{2}\mathrm{d}x_{i}\right)+\sum _{i=1}^{2}\!\left(\frac{1}{2}k_{{m}i}\!\left(q_{{m}i}-q_{i}\right)^{2}\right) .\end{equation}
Let
$L=T-V$
be the Lagrange function, and substitute Eqs. (3) and (4) into the Lagrange equation to obtain the FBFLFJ space robot dynamics model with uncontrolled base position and controlled attitude, as
\begin{equation} \left[\begin{array}{l@{\quad}l} \boldsymbol{{D}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }}\right) & \mathbf{0}\\[4pt] \mathbf{0} & \boldsymbol{{J}}_{{m}} \end{array}\right]\left[\begin{array}{l} \ddot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\\[4pt] \ddot{\boldsymbol{{q}}}_{{m}} \end{array}\right]+\left[\begin{array}{l@{\quad}l} \boldsymbol{{H}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\right) & \mathbf{0}\\[4pt] \mathbf{0} & \mathbf{0} \end{array}\right]\left[\begin{array}{l} \dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\\[4pt] \dot{\boldsymbol{{q}}}_{{m}} \end{array}\right]+\left[\begin{array}{l} \boldsymbol{\xi }_{{boj\unicode{x03B4} }}\\[4pt] \boldsymbol{{K}}_{{m}}\boldsymbol{\sigma } \end{array}\right]=\left[\begin{array}{l} \boldsymbol{\tau }_{{boj\unicode{x03B4} }}\\[4pt] \boldsymbol{\tau }_{{m}} \end{array}\right] ,\end{equation}
where
$\boldsymbol{{D}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }}\right)$
is the symmetric positive definite mass matrix, and
$\boldsymbol{{H}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\right)$
denotes the centrifugal force matrix. Here
$\boldsymbol{{q}}_{{boj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l} q_{{b}} & \boldsymbol{{q}}_{{oj\unicode{x03B4} }}^{{T}} \end{array}\right]^{{T}}, \boldsymbol{{q}}_{{oj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l} \boldsymbol{{q}}^{{T}} & \boldsymbol{\delta }^{{T}} \end{array}\right]^{{T}}, \boldsymbol{{q}}=\left[\begin{array}{l@{\quad}l} q_{0} & \boldsymbol{{q}}_{{j}}^{{T}} \end{array}\right]^{{T}}, \boldsymbol{{q}}_{{j}}=\left[\begin{array}{l@{\quad}l} q_{1} & q_{2} \end{array}\right]^{{T}},$
$ \boldsymbol{\delta }=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} \delta _{11} & \delta _{12} & \delta _{21} & \delta _{22} \end{array}\right]^{{T}}, \boldsymbol{{q}}_{{m}}=\left[\begin{array}{l@{\quad}l} q_{{m}1} & q_{{m2}} \end{array}\right]^{{T}}, \enspace \enspace \boldsymbol{{J}}_{{m}}=\mathrm{diag}\!\left(J_{{m}1},J_{{m2}}\right), \boldsymbol{{K}}_{\unicode{x03B4} }=\left.\mathrm{diag}\!\left(k_{\unicode{x03B4} 11},\right.k_{\unicode{x03B4} 12},k_{\unicode{x03B4} 21},k_{\unicode{x03B4} 22}\right),$
$\boldsymbol{{K}}_{{m}}=\mathrm{diag}\!\left(k_{{m}1},k_{{m2}}\right), \enspace \boldsymbol{\sigma }=\boldsymbol{{q}}_{{m}}-\boldsymbol{{q}}_{{j}}, \boldsymbol{\xi }_{{boj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} k_{{b}}q_{{b}} & 0 & -\left(\boldsymbol{\tau }\right)^{{T}} & \left(\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta }\right)^{{T}} \end{array}\right]^{{T}}, \boldsymbol{\tau }_{{boj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l@{\quad}l} 0 & \tau _{0} & \mathbf{0}^{{T}} \end{array}\right]^{{T}}$
.
$\boldsymbol{\tau }_{{m}}=$
$\left[\begin{array}{l@{\quad}l} \tau _{{m1}} & \tau _{{m2}} \end{array}\right]^{{T}}$
is the motor rotor control torque.
3. Model decomposition and properties of the FBFLFJ space robot
3.1. FBFLFJ space robot model singular perturbation decomposition
To facilitate the control analysis of the FBFLFJ space robot, the model is firstly decomposed and Eq. (5) is rewritten as
\begin{equation} \boldsymbol{{D}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }}\right)\ddot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}+\boldsymbol{{H}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\right)\dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}+\boldsymbol{\xi }_{{boj\unicode{x03B4} }}=\boldsymbol{\tau }_{{boj\unicode{x03B4} }} ,\end{equation}
\begin{equation} \boldsymbol{{J}}_{{m}}\ddot{\boldsymbol{{q}}}_{{m}}+\boldsymbol{\tau }=\boldsymbol{\tau }_{{m}} ,\end{equation}
\begin{equation} \boldsymbol{\tau }=\boldsymbol{{K}}_{{m}}\boldsymbol{\sigma } .\end{equation}
Rewrite the matrices
$\boldsymbol{{D}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }}\right)$
and
$\boldsymbol{{H}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{boj\unicode{x03B4} }}\right)$
from Eq. (6) as
$\left[\begin{array}{l@{\quad}l} \boldsymbol{{D}}_{{aa}} & \boldsymbol{{D}}_{{ab}}\\[4pt] \boldsymbol{{D}}_{{ba}} & \boldsymbol{{D}}_{{bb}} \end{array}\right]$
and
$\left[\begin{array}{l@{\quad}l} \boldsymbol{{H}}_{{aa}} & \boldsymbol{{H}}_{{ab}}\\[4pt] \boldsymbol{{H}}_{{ba}} & \boldsymbol{{H}}_{{bb}} \end{array}\right]$
, respectively, in which
$\boldsymbol{{D}}_{{aa}},\boldsymbol{{H}}_{{aa}}\in \mathrm{\mathbb{R}}^{1\times 1}, \boldsymbol{{D}}_{{ab}},\boldsymbol{{H}}_{{ab}}\in \mathrm{\mathbb{R}}^{1\times 7}, \boldsymbol{{D}}_{{ba}},\boldsymbol{{H}}_{{ba}}\in \mathrm{\mathbb{R}}^{7\times 1}, \boldsymbol{{D}}_{{bb}},\boldsymbol{{H}}_{{bb}}\in \mathrm{\mathbb{R}}^{7\times 7}$
.
$\boldsymbol{{D}}\!\left(\boldsymbol{{q}}_{{boj\unicode{x03B4} }}\right)$
is invertible and can be defined by
\begin{equation} \left[\begin{array}{l@{\quad}l} \boldsymbol{{N}}_{11} & \boldsymbol{{N}}_{12}\\[4pt] \boldsymbol{{N}}_{21} & \boldsymbol{{N}}_{22} \end{array}\right]=\left[\begin{array}{l@{\quad}l} \boldsymbol{{D}}_{{aa}} & \boldsymbol{{D}}_{{ab}}\\[4pt] \boldsymbol{{D}}_{{ba}} & \boldsymbol{{D}}_{{bb}} \end{array}\right]^{-1} ,\end{equation}
where
$\boldsymbol{{N}}_{11}\in \mathrm{\mathbb{R}}^{1\times 1}, \boldsymbol{{N}}_{12}\in \mathrm{\mathbb{R}}^{1\times 7}, \boldsymbol{{N}}_{21}\in \mathrm{\mathbb{R}}^{7\times 1}$
and
$\boldsymbol{{N}}_{22}\in \mathrm{\mathbb{R}}^{7\times 7}$
.
By substituting Eq. (9) into Eq. (6), we obtain
\begin{equation} \ddot{q}_{{b}}=-\boldsymbol{{N}}_{11}\!\left(\boldsymbol{{H}}_{{aa}}\dot{q}_{{b}}+\boldsymbol{{H}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+k_{{b}}q_{{b}}\right)-\boldsymbol{{N}}_{12}\!\left(\boldsymbol{{H}}_{{ba}}\dot{q}_{{b}}+\boldsymbol{{H}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)+\boldsymbol{{N}}_{12}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{\tau }\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] ,\end{equation}
\begin{equation} \ddot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}=-\boldsymbol{{N}}_{21}\!\left(\boldsymbol{{H}}_{{aa}}\dot{q}_{{b}}+\boldsymbol{{H}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+k_{{b}}q_{{b}}\right)-\boldsymbol{{N}}_{22}\!\left(\boldsymbol{{H}}_{{ba}}\dot{q}_{{b}}+\boldsymbol{{H}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)+\boldsymbol{{N}}_{22}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{\tau }\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] .\end{equation}
Now the singular perturbation decomposition is performed for the system: treat
$\boldsymbol{{q}}_{{oj\unicode{x03B4} }}$
as slow sub-variable, and treat
$q_{{b}}$
and
$\boldsymbol{\sigma }$
as fast sub-variables.
$\mu =1/\min \!\left(k_{{b}},k_{{m}1},k_{{m}2}\right)$
is defined as the singular perturbation factor, and
$t_{{f}}=t/\sqrt{\mu }$
is the fast time scale, where the equivalent stiffness coefficients of the base and the joints at this time scale are
$k_{{bf}}$
and
$\boldsymbol{{K}}_{{mf}}$
, respectively, and the flexible deformations are
$q_{{bf}}$
and
$\boldsymbol{\sigma }_{{f}}$
, respectively, where
$k_{{bf}}=\mu k_{{b}}, \boldsymbol{{K}}_{{mf}}=\mu \boldsymbol{{K}}_{{m}}, q_{{bf}}=q_{{b}}/\mu$
, and
$\boldsymbol{\sigma }_{\mathrm{f}}=\boldsymbol{\sigma }/\mu$
. The following relation exists
\begin{equation} k_{{b}}q_{{b}}=\frac{k_{{bf}}}{\mu }q_{{bf}}\mu =k_{{bf}}q_{{bf}} ,\end{equation}
\begin{equation} \boldsymbol{{K}}_{{m}}\boldsymbol{\sigma }=\frac{\boldsymbol{{K}}_{{mf}}}{\mu }\boldsymbol{\sigma }_{{f}}\mu =\boldsymbol{{K}}_{{mf}}\boldsymbol{\sigma }_{{f}} .\end{equation}
By substituting
$q_{{bf}}=q_{{b}}/\mu$
, Eqs. (12) and (13) into Eqs. (10) and (11), we get
\begin{equation} \mu \ddot{q}_{{bf}}=-\boldsymbol{{N}}_{11}\!\left(\boldsymbol{{H}}_{{aa}}\mu \dot{q}_{{bf}}+\boldsymbol{{H}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+k_{{bf}}q_{{bf}}\right)-\boldsymbol{{N}}_{12}\!\left(\boldsymbol{{H}}_{{ba}}\mu \dot{q}_{{bf}}+\boldsymbol{{H}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)+\boldsymbol{{N}}_{12}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{{K}}_{{mf}}\boldsymbol{\sigma }_{{f}}\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] ,\end{equation}
\begin{equation} \ddot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}=-\boldsymbol{{N}}_{21}\!\left(\boldsymbol{{H}}_{{aa}}\mu \dot{q}_{{bf}}+\boldsymbol{{H}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+k_{{bf}}q_{{bf}}\right)-\boldsymbol{{N}}_{22}\!\left(\boldsymbol{{H}}_{{ba}}\mu \dot{q}_{{bf}}+\boldsymbol{{H}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)+\boldsymbol{{N}}_{22}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{{K}}_{{mf}}\boldsymbol{\sigma }_{{f}}\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] .\end{equation}
Consider the case when
$\mu$
tends to 0,
$k_{{b}}$
and
$\boldsymbol{{K}}_{{m}}$
tend to infinity and
$q_{{b}}$
tends to 0, we can see that the joint rotation angle
$\boldsymbol{{q}}_{\mathrm{j}}=\left[\begin{array}{l@{\quad}l} \boldsymbol{{q}}_{1} & \boldsymbol{{q}}_{2} \end{array}\right]^{{T}}$
is approximately equal to the motor rotor rotation angle
$\boldsymbol{{q}}_{{m}}$
. Thus, when
$\mu =0$
, the robot can be considered as a rigid system. Let
$\mathbf{\Re }$
be an arbitrary variable and
$\overline{\mathbf{\Re }}$
denotes the new expression for
$\mathbf{\Re }$
as
$\mu$
tends to 0. To find the dynamics model of the slow subsystem, let
$\mu =0$
, from Eqs. (14) and (15) we have
\begin{equation} 0=-\overline{\boldsymbol{{N}}}_{11}\overline{\boldsymbol{{H}}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}-\overline{\boldsymbol{{N}}}_{11}k_{{bf}}\overline{q}_{{bf}}-\overline{\boldsymbol{{N}}}_{12}\overline{\boldsymbol{{H}}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+\overline{\boldsymbol{{N}}}_{12}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{{K}}_{{mf}}\overline{\boldsymbol{\sigma }}_{\mathrm{f}}\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] ,\end{equation}
\begin{equation} \ddot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}=-\overline{\boldsymbol{{N}}}_{21}\overline{\boldsymbol{{H}}}_{{ab}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}-\overline{\boldsymbol{{N}}}_{21}k_{{bf}}\overline{q}_{{bf}}-\overline{\boldsymbol{{N}}}_{22}\overline{\boldsymbol{{H}}}_{{bb}}\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+\overline{\boldsymbol{{N}}}_{22}\!\left[\begin{array}{l} \tau _{0}\\[4pt] \boldsymbol{{K}}_{{mf}}\overline{\boldsymbol{\sigma }}_{\mathrm{f}}\\[4pt] -\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta } \end{array}\right] .\end{equation}
The total controller of the drive motor with joint flexibility compensation is designed as
\begin{equation} \boldsymbol{\tau }_{{m}}=\left(\boldsymbol{{I}}+\boldsymbol{{K}}_{{c}}\right)\boldsymbol{\tau }_{{n}}-\boldsymbol{{K}}_{{c}}\boldsymbol{\tau } ,\end{equation}
where
$\boldsymbol{{I}}\in \mathbf{R}^{2\times 2}$
is the unit matrix,
$\boldsymbol{{K}}_{{c}}\in \mathbf{R}^{2\times 2}$
is the symmetric positive definite flexible compensation matrix and
$\boldsymbol{\tau }_{{n}}=\boldsymbol{\tau }_{{ns}}+\boldsymbol{\tau }_{{nf}}$
is the controller to be designed.
$\boldsymbol{\tau }_{{ns}}\in \mathbf{R}^{2\times 1}$
is the slow sub-controller, and
$\boldsymbol{\tau }_{{nf}}\in \mathbf{R}^{2\times 1}$
is the fast sub-controller.
By substituting controller
$\boldsymbol{\tau }_{{m}}, \boldsymbol{\sigma }_{{f}}=\boldsymbol{\sigma }/\mu$
and
$\mu =0$
into Eq. (7), we get
\begin{equation} \boldsymbol{{K}}_{{mf}}\overline{\boldsymbol{\sigma }}_{{f}}=\boldsymbol{\tau }_{{ns}}-\left(\boldsymbol{{I}}+\boldsymbol{{K}}_{c}\right)^{-1}\boldsymbol{{J}}_{{m}}\ddot{\boldsymbol{{q}}}_{\mathrm{j}} ,\end{equation}
By substituting Eqs. (16), (18) and (19) into Eq. (17), we have the dynamics model of the slow subsystem containing
$\boldsymbol{{q}}$
and
$\boldsymbol{\delta }$
as
\begin{equation} \boldsymbol{{R}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }}\right)\ddot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+\boldsymbol{{S}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}+\boldsymbol{\xi }_{{oj\unicode{x03B4} }}=\boldsymbol{\tau }_{{oj\unicode{x03B4} }} ,\end{equation}
where
$\boldsymbol{{R}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }}\right)=\overline{\boldsymbol{{D}}}_{{bb}}+\left[\begin{array}{l@{\quad}l@{\quad}l} 0 & \mathbf{0} & \mathbf{0}\\[4pt] \mathbf{0} & \left(\boldsymbol{{I}}+\boldsymbol{{K}}_{{c}}\right)^{-1}\boldsymbol{{J}}_{{m}} & \mathbf{0}\\[4pt] \mathbf{0} & \mathbf{0} & \mathbf{0} \end{array}\right], \boldsymbol{{S}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)=\overline{\boldsymbol{{H}}}_{{bb}}, \boldsymbol{\xi }_{{oj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l} \mathbf{0}^{{T}} & \left(\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta }\right)^{{T}} \end{array}\right]^{{T}}, $
$ \boldsymbol{\tau }_{{oj\unicode{x03B4} }}=\left[\begin{array}{l@{\quad}l} \left(\boldsymbol{\tau }_{{oj}}\right)^{{T}} & \mathbf{0}^{{T}} \end{array}\right]^{{T}}$
, and
$\boldsymbol{\tau }_{{oj}}=\left[\begin{array}{l@{\quad}l} \tau _{0} & \boldsymbol{\tau }_{{ns}}^{{T}} \end{array}\right]^{{T}}$
.
Denote the fast subsystem state variable as
$\boldsymbol{{q}}_{{f}}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} q_{{f}1} & q_{{f}2} & \boldsymbol{{q}}_{{f}3}^{{T}} & \boldsymbol{{q}}_{{f}4}^{{T}} \end{array}\right]^{{T}}$
, and we have
$q_{{f}1}=q_{{bf}}-\overline{q}_{{bf}}, q_{{f}2}=\sqrt{\mu }\dot{q}_{{bf}}, \boldsymbol{{q}}_{{f}3}=\boldsymbol{\sigma }_{{f}}-\overline{\boldsymbol{\sigma }}_{{f}}$
and
$\boldsymbol{{q}}_{{f}4}=\sqrt{\mu }\dot{\boldsymbol{\sigma }}_{{f}}$
.
$\boldsymbol{{q}}_{{f}}$
is derived with respect to
$t_{{f}}$
, and the dynamics model of the fast subsystem containing
$q_{{b}}$
and
$\boldsymbol{\sigma }$
is obtained by combining Eq. (14), controllers
$\boldsymbol{\tau }_{{m}}, \boldsymbol{\sigma }_{{f}}=\boldsymbol{\sigma }/\mu$
and Eq. (7), as
\begin{equation} \mathrm{d}\boldsymbol{{q}}_{{f}}/\mathrm{d}t_{{f}}=\boldsymbol{{A}}_{{f}}\boldsymbol{{q}}_{{f}}+\boldsymbol{{B}}_{{f}}\boldsymbol{\tau }_{{nf}} ,\end{equation}
where
$\boldsymbol{{A}}_{{f}}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} 0 & 1 & \mathbf{0} & \mathbf{0}\\[4pt] -\overline{\boldsymbol{{N}}}_{11}k_{{bf}} & 0 & \boldsymbol{{N}}_{12}^{\ast }\boldsymbol{{K}}_{{mf}} & \mathbf{0}\\[4pt] \mathbf{0} & \mathbf{0} & \mathbf{0} & \boldsymbol{{I}}\\[4pt] \mathbf{0} & \mathbf{0} & -\boldsymbol{{J}}_{{m}}^{-1}\!\left(\boldsymbol{{I}}+\boldsymbol{{K}}_{{c}}\right)\boldsymbol{{K}}_{{mf}} & \mathbf{0} \end{array}\right], \boldsymbol{{B}}_{{f}}=\left[\begin{array}{c} \mathbf{0}\\[4pt] \mathbf{0}\\[4pt] \mathbf{0}\\[4pt] \boldsymbol{{J}}_{{m}}^{-1}\!\left(\boldsymbol{{I}}+\boldsymbol{{K}}_{{c}}\right) \end{array}\right], \boldsymbol{{N}}_{12}^{\ast }$
is the row vector consisting of the elements of the second and third terms of
$\overline{\boldsymbol{{N}}}_{12}$
.
3.2. Dynamical model properties
From Eq. (20), it can be seen that the motion of the base and joints of the slow subsystem and the links vibration are coupled with each other. In order to control the base attitude and the joints, this section decouples the slow subsystem into a fully driven rigid subsystem and designs the control algorithm. Among them,
$\boldsymbol{{R}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }}\right)$
and
$\boldsymbol{{S}}\!\left(\boldsymbol{{q}}_{{oj\unicode{x03B4} }},\dot{\boldsymbol{{q}}}_{{oj\unicode{x03B4} }}\right)$
are written as
$\left[\begin{array}{l@{\quad}l} \boldsymbol{{R}}_{11} & \boldsymbol{{R}}_{12}\\[4pt] \boldsymbol{{R}}_{21} & \boldsymbol{{R}}_{22} \end{array}\right]$
and
$\left[\begin{array}{l@{\quad}l} \boldsymbol{{S}}_{11} & \boldsymbol{{S}}_{12}\\[4pt] \boldsymbol{{S}}_{21} & \boldsymbol{{S}}_{22} \end{array}\right]$
, respectively.
$\boldsymbol{{R}}_{11}, \boldsymbol{{S}}_{11}\in \mathrm{\mathbb{R}}^{3\times 3}, \boldsymbol{{R}}_{12}, \boldsymbol{{S}}_{12}\in \mathrm{\mathbb{R}}^{3\times 4}, \boldsymbol{{R}}_{21}, \boldsymbol{{S}}_{21}\in \mathrm{\mathbb{R}}^{4\times 3}$
, and
$\boldsymbol{{R}}_{22}, \boldsymbol{{S}}_{22}\in \mathrm{\mathbb{R}}^{4\times 4}$
. The fully driven rigid subsystem dynamic model is obtained from Eq. (20), as
\begin{equation} \boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\ddot{\boldsymbol{{q}}}+\boldsymbol{{C}}\!\left(\boldsymbol{\delta },\dot{\boldsymbol{\delta }},\boldsymbol{{q}}, \dot{\boldsymbol{{q}}}\right)\dot{\boldsymbol{{q}}}+\boldsymbol{\kappa }\!\left(\boldsymbol{\delta },\dot{\boldsymbol{\delta }},\boldsymbol{{q}},\dot{\boldsymbol{{q}}}\right)=\boldsymbol{\tau }_{{oj}} ,\end{equation}
where
$\boldsymbol{{M}}=\boldsymbol{{R}}_{11}-\boldsymbol{{R}}_{12}\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{R}}_{21}, \boldsymbol{{C}}=\boldsymbol{{S}}_{11}-\boldsymbol{{R}}_{12}\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{S}}_{21}$
, and
$\boldsymbol{\kappa }=\left(\boldsymbol{{S}}_{12}-\boldsymbol{{R}}_{12}\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{S}}_{22}\right)\dot{\boldsymbol{\delta }}-\boldsymbol{{R}}_{12}\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{K}}_{\unicode{x03B4} }\boldsymbol{\delta }$
is the system dynamics nonlinear term.
According to Kelly et al. [Reference Kelly, Santibanez and Loria30], Eq. (22) has several fundamental properties as follows:
Property 1. The inertia matrix
$\boldsymbol{{M}}\!\left(\boldsymbol{{x}}\right)$
is symmetric positive definite and satisfies the following inequalities:
\begin{equation} \lambda _{{m}}\!\left(\boldsymbol{{M}}\right)\left\| \boldsymbol{{y}}\right\| ^{2}\leq \boldsymbol{{y}}^{T}\boldsymbol{{M}}\!\left(\boldsymbol{{x}}\right)\boldsymbol{{y}}\leq \lambda _{{M}}\!\left(\boldsymbol{{M}}\right)\left\| \boldsymbol{{y}}\right\| ^{2}\forall \boldsymbol{{y}}\in \mathrm{\mathbb{R}}^{3\times 1} ,\end{equation}
where
$\lambda _{{m}}\!\left(\cdot \right)$
and
$\lambda _{{M}}\!\left(\cdot \right)$
represent the minimum and maximum eigenvalues of the matrix, respectively, and
$\left\| \cdot \right\|$
represents the 2-norm.
Property 2. The centrifugal-Coriolis matrix
$\boldsymbol{{C}}\in \mathrm{\mathbb{R}}^{3\times 3}$
satisfies the following relationship:
\begin{equation} \boldsymbol{{C}}\!\left(\boldsymbol{{x}},\boldsymbol{{y}}\right)\boldsymbol{{z}}=\boldsymbol{{C}}\!\left(\boldsymbol{{x}},\boldsymbol{{z}}\right)\boldsymbol{{y}}\forall \boldsymbol{{y}},\boldsymbol{{z}}\in \mathrm{\mathbb{R}}^{3\times 1} ,\end{equation}
\begin{equation} C_{{m}}\left\| \boldsymbol{{y}}\right\| \leq \left\| \boldsymbol{{C}}\!\left(\boldsymbol{{x}},\boldsymbol{{y}}\right)\right\| \leq C_{{M}}\left\| \boldsymbol{{y}}\right\| \forall \boldsymbol{{y}}\in \mathrm{\mathbb{R}}^{3\times 1} ,\end{equation}
where
$C_{{m}}$
and
$C_{{M}}$
are known positive constants.
Property 3. The matrix
$\dot{\boldsymbol{{M}}}\!\left(\boldsymbol{{x}}\right)-2\boldsymbol{{C}}\!\left(\boldsymbol{{x}},\dot{\boldsymbol{{x}}}\right)$
is skew-symmetric, which implies that
\begin{equation} \boldsymbol{{y}}^{{T}}\!\left[\dot{\boldsymbol{{M}}}\!\left(\boldsymbol{{x}}\right)-2\boldsymbol{{C}}\!\left(\boldsymbol{{x}},\dot{\boldsymbol{{x}}}\right)\right]\boldsymbol{{y}}=\mathbf{0}\forall \boldsymbol{{y}}\in \mathrm{\mathbb{R}}^{3\times 1} .\end{equation}
Property 4. There must exist known positive constants
$k_{{M}}, k_{{C}1}, k_{{C}2}, k_{{C3}}$
and
$k_{{C4}}$
for all
$\boldsymbol{{x}},\boldsymbol{{y}},\boldsymbol{{z}},\boldsymbol{{x}}_{1},\boldsymbol{{y}}_{1},\boldsymbol{{x}}_{2},\boldsymbol{{y}}_{2}\in \mathrm{\mathbb{R}}^{3\times 1}$
fulfilling
\begin{equation} \left\| \boldsymbol{{M}}\!\left(\boldsymbol{{x}}\right)\boldsymbol{{z}}-\boldsymbol{{M}}\!\left(\boldsymbol{{y}}\right)\boldsymbol{{z}}\right\| \leq k_{{M}}\left\| \textbf{Tanh}\!\left(\boldsymbol{{x}}-\boldsymbol{{y}}\right)\right\| \left\| \boldsymbol{{z}}\right\| ,\end{equation}
\begin{equation} \left\| \boldsymbol{{C}}\!\left(\boldsymbol{{x}}_{1},\boldsymbol{{y}}_{1}\right)\boldsymbol{{z}}-\boldsymbol{{C}}\!\left(\boldsymbol{{x}}_{2},\boldsymbol{{y}}_{2}\right)\boldsymbol{{z}}\right\| \leq k_{{C}1}\left\| \textbf{Tanh}\!\left(\boldsymbol{{y}}_{1}-\boldsymbol{{y}}_{2}\right)\right\| \left\| \boldsymbol{{z}}\right\| +k_{{C}2}\left\| \boldsymbol{{y}}_{1}\right\| \left\| \textbf{Tanh}\!\left(\boldsymbol{{x}}_{1}-\boldsymbol{{x}}_{2}\right)\right\| \left\| \boldsymbol{{z}}\right\| ,\end{equation}
\begin{equation} \left\| \boldsymbol{\kappa }\!\left(\boldsymbol{{x}}_{1},\boldsymbol{{y}}_{1}\right)-\boldsymbol{\kappa }\!\left(\boldsymbol{{x}}_{2},\boldsymbol{{y}}_{2}\right)\right\| \leq k_{{C3}}\left\| \boldsymbol{{y}}_{1}-\boldsymbol{{y}}_{2}\right\| +k_{{C4}}\left\| \boldsymbol{{y}}_{1}\right\| \left\| \textbf{Tanh}\!\left(\boldsymbol{{x}}_{1}-\boldsymbol{{x}}_{2}\right)\right\| ,\end{equation}
where
$k_{{M}}, k_{{C}1}, k_{{C}2}, k_{{C3}}$
and
$k_{\mathrm{C4}}$
are obtained according to Kelly.
$\boldsymbol{\xi }=\left[\begin{array}{l@{\quad}l@{\quad}l} \xi _{1} & \xi _{2} & \xi _{3} \end{array}\right]^{{T}}\in \mathrm{\mathbb{R}}^{3\times 1}$
, and
$\textbf{Tanh}\!\left(\boldsymbol{\xi }\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} \tanh \!\left(\xi _{1}\right) & \tanh \!\left(\xi _{2}\right) & \tanh \!\left(\xi _{3}\right) \end{array}\right]^{{T}}$
, where
$\boldsymbol{\xi }$
is an arbitrary vector.
4. ISMC-IOR
4.1. SMC-IOR base on desired trajectory
The continuous differentiable periodic expectation trajectory satisfies the bounded condition
\begin{equation} \left\| \dot{\boldsymbol{{q}}}_{{d}}\right\| \leq V_{{M}},\quad \textrm{and}\quad \left\| \ddot{\boldsymbol{{q}}}_{{d}}\right\| \leq A_{{M}} ,\end{equation}
where
$V_{{M}}$
and
$A_{{M}}$
are, respectively, the upper bound of the expected velocity and the acceleration norm.
For the convenience of analysis, define
$\boldsymbol{{N}}\in \mathbf{R}^{3\times 1}$
as
\begin{equation} \boldsymbol{{N}}\!\left(\boldsymbol{{q}},\dot{\boldsymbol{{q}}}\right)=\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\ddot{\boldsymbol{{q}}}_{{d}}+\boldsymbol{{C}}\!\left(\boldsymbol{\delta },\dot{\boldsymbol{\delta }},\boldsymbol{{q}}, \dot{\boldsymbol{{q}}}\right)\dot{\boldsymbol{{q}}}+\boldsymbol{\kappa }\!\left(\boldsymbol{\delta },\dot{\boldsymbol{\delta }},\boldsymbol{{q}},\dot{\boldsymbol{{q}}}\right) .\end{equation}
Let
$\boldsymbol{{N}}_{{d}}=\boldsymbol{{N}}\!\left(\boldsymbol{{q}}_{{d}},\dot{\boldsymbol{{q}}}_{{d}}\right)$
, where
$\boldsymbol{{N}}_{{d}}$
is a periodic function with period
$T$
. Expanded
$\boldsymbol{{N}}_{{d}}$
in Fourier series as
\begin{equation} \boldsymbol{{N}}_{{d}}=\overline{\boldsymbol{{a}}}_{0}+\sum _{k=1}^{\infty }\!\left[\overline{\boldsymbol{{a}}}_{{k}}\cos \!\left(k\omega t\right)+\overline{\boldsymbol{{b}}}_{{k}}\sin \!\left(k\omega t\right)\right]\enspace ,\end{equation}
where
$\omega =2\pi /T$
is the angular frequency.
$\overline{\boldsymbol{{a}}}_{0}, \overline{\boldsymbol{{a}}}_{{k}}$
and
$\overline{\boldsymbol{{b}}}_{{k}}$
are the unknown constant vectors.
Define the filtered tracking error
$\boldsymbol{\eta }=\dot{\boldsymbol{{e}}}+\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)$
, where
$\boldsymbol{{e}}=\boldsymbol{{q}}_{{d}}-\boldsymbol{{q}}$
is the trajectory tracking error and
$\boldsymbol{{v}}\in \mathbf{R}^{3\times 1}$
is the filter vector. For the rigid subsystem Eq. (22), design the algorithm of sliding mode control with input restriction, output feedback and repetitive learning based on the desired trajectory (SMC-IOR-D) as
\begin{equation} \boldsymbol{\tau }_{{oj}}=\boldsymbol{{K}}_{0}\textbf{Sgn}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\alpha \boldsymbol{{e}}_{{f}}\right)-\left(k^{\prime}+1\right)\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\textbf{Sat}\!\left(\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k}\right) ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \textbf{Tanh}\!\left(\boldsymbol{{v}}\right)=\boldsymbol{{p}}_{1}-\left(k^{\prime}+1\right)\boldsymbol{{e}}\\[4pt] \dot{\boldsymbol{{p}}}_{1}=-k^{\prime}\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)-\left(k^{\prime}+2\right)\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)-\alpha ^{-1}\boldsymbol{{e}}_{{f}}\\[4pt] \boldsymbol{{p}}_{1}\!\left(0\right)=\left(k^{\prime}+1\right)\boldsymbol{{e}}\!\left(0\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{e}}_{{f}}=\boldsymbol{{p}}_{2}+\alpha ^{-1}\!\left(\boldsymbol{{e}}-\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)\right)\\[4pt] \dot{\boldsymbol{{p}}}_{2}=\alpha ^{-1}\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)-\boldsymbol{{e}}_{{f}}\\[4pt] \boldsymbol{{p}}_{2}\!\left(\mathrm{0}\right)=\alpha ^{-1}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\!\left(0\right)\right)-\boldsymbol{{e}}\!\left(0\right)\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{z}}_{0}=\boldsymbol{{p}}_{0}+\boldsymbol{{Q}}_{0}\boldsymbol{{e}}\\[4pt] \dot{\boldsymbol{{p}}}_{0}=\boldsymbol{{Q}}_{0}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \dot{\boldsymbol{{z}}}_{k}=\boldsymbol{{p}}_{k}+\boldsymbol{{Q}}_{k}\boldsymbol{{e}}\\[4pt] \dot{\boldsymbol{{p}}}_{k}=\boldsymbol{{Q}}_{k}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)\right)-k^{2}\omega ^{2}\boldsymbol{{z}}_{k}\enspace \end{array}\right.k=1,\cdots N ,\end{equation}
where
$\boldsymbol{{K}}_{0}\in \mathrm{\mathbb{R}}^{3\times 3}$
is a constant diagonal matrix,
$\boldsymbol{{e}}_{{f}}\in \mathrm{\mathbb{R}}^{3\times 1}$
is a filter vector and
$\alpha$
and
$k^{\prime}$
are positive constants.
$\boldsymbol{{Q}}_{0},\boldsymbol{{Q}}_{k}\in \mathrm{\mathbb{R}}^{3\times 3}$
are constant positive definite diagonal matrices,
$\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k}\enspace \enspace$
is the repetitive learning controller (RC), and
$N$
is the number of harmonic oscillator terms.
$\textbf{Sgn}\!\left(\boldsymbol{\xi }\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} \mathrm{sgn}\!\left(\xi _{1}\right) & \mathrm{sgn}\!\left(\xi _{2}\right) & \mathrm{sgn}\!\left(\xi _{3}\right) \end{array}\right]^{{T}}$
,
$\textbf{Sat}\!\left(\boldsymbol{\xi }\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} \mathrm{sat}\!\left(\xi _{1}\right) & \mathrm{sat}\!\left(\xi _{2}\right) & \mathrm{sat}\!\left(\xi _{3}\right) \end{array}\right]^{{T}}$
,
$\boldsymbol{\xi }\in \mathrm{\mathbb{R}}^{3\times 1}$
is an arbitrary vector.
$\textbf{Sat}\!\left(\cdot \right)$
is a saturation function whose elements are as follows:
\begin{equation} \mathrm{sat}\!\left(\xi _{i^{\prime}}\right)=\left\{\begin{array}{l} \xi _{i^{\prime}},\quad\qquad \left| \xi _{i^{\prime}}\right| \leq \beta _{i^{\prime}}\\[5pt] \beta _{i^{\prime}}\mathrm{sgn}\!\left(\xi _{i^{\prime}}\right),\left| \xi _{i^{\prime}}\right| \gt \beta _{i^{\prime}} \end{array}\right. \, \forall \xi _{i^{\prime}}\in \mathrm{\mathbb{R}},i^{\prime}=1,2,3 ,\end{equation}
where
$\beta _{i^{\prime}}$
is the maximum threshold value of the saturation function.
Take the derivative of
$\boldsymbol{\eta }$
, left multiply both sides of the resultant equation by
$\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)$
and substituting
$\boldsymbol{{e}}=\boldsymbol{{q}}_{{d}}-\boldsymbol{{q}}$
, Eqs. (22), (31) and (34) into the right side of the equation, then we have
\begin{equation} \boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\dot{\boldsymbol{\eta }}=-k^{\prime}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta }-\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\left(\boldsymbol{{I}}_{3}-\textbf{Sec}\textbf{h}^{2}\!\left(\boldsymbol{{e}}\right)\right)\boldsymbol{\eta }+ {\tilde{{\boldsymbol{{N}}}}}+\boldsymbol{{N}}_{{d}}-\boldsymbol{\tau }_{{oj}}-\frac{1}{2}\dot{\boldsymbol{{M}}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta } ,\end{equation}
\begin{align} {\tilde{{\boldsymbol{{N}}}}} & =\boldsymbol{{N}}-\boldsymbol{{N}}_{{d}}-\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\left[\textbf{Sec}\textbf{h}^{2}\!\left(\boldsymbol{{e}}\right)\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\right.\right.\left.\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)\right)\left.+\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)-\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\alpha ^{-1}\boldsymbol{{e}}_{{f}}\right]\nonumber\\& +\frac{1}{2}\dot{\boldsymbol{{M}}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta } .\end{align}
Convert Eq. (40) into the normal form, and according to
$\boldsymbol{{e}}=\boldsymbol{{q}}_{{d}}-\boldsymbol{{q}}$
, Properties 1−4 and Eq. (30), it is obtained from the expression of
$\boldsymbol{\eta }$
that
\begin{equation} \left\| {\tilde{{\boldsymbol{{N}}}}}\right\| \leq 4\lambda _{{M1}}\left\| \boldsymbol{{z}}\right\| +\lambda _{{M2}}\left\| \boldsymbol{{z}}\right\| ^{2}=\left(4\lambda _{{M1}}+\lambda _{{M2}}\left\| \boldsymbol{{z}}\right\| \right)\left\| \boldsymbol{{z}}\right\| =\rho \!\left(\left\| \boldsymbol{{z}}\right\| \right)\left\| \boldsymbol{{z}}\right\| ,\end{equation}
where
$\lambda _{{M1}}=\max \!\left\{\wp _{1},\wp _{2},\wp _{3},\wp _{4}\right\}, \lambda _{{M2}}=8C_{{M}}, \boldsymbol{{z}}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} \textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{e}}\right) & \boldsymbol{{e}}_{{f}}^{{T}} & \textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{v}}\right) & \boldsymbol{\eta }^{{T}} \end{array}\right]^{{T}}$
.
$\wp _{1}=k_{{M}}A_{{M}}+$
$k_{{C}2}V_{{M}}^{2}+2C_{{M}}V_{{M}}+k_{{C4}}V_{{M}}+\lambda _{{M}}\!\left(\boldsymbol{{M}}\right)+k_{{C3}}, \wp _{2}=2C_{{M}}V_{{M}}+\frac{1}{2}\lambda _{{M}}\!\left(\dot{\boldsymbol{{M}}}\right)+k_{{C3}}, \wp _{3}=\frac{\lambda _{{M}}\left(\boldsymbol{{M}}\right)}{\alpha }, \wp _{4}=2C_{{M}}V_{{M}}+$
$\lambda _{{M}}\!\left(\boldsymbol{{M}}\right)+k_{{C3}}$
.
$\rho \!\left(\left\| \boldsymbol{{z}}\right\| \right)\in \mathrm{\mathbb{R}}$
is the positive definite invertible non-decreasing function.
Lemma 1.
Define the auxiliary intermediate variable
$L_{n}(t)\in \mathrm{\mathbb{R}}$
as shown below
\begin{equation} L_{n}(t)=\boldsymbol{\eta }^{{T}}\!\left[\boldsymbol{{f}}_{n}(t)-\boldsymbol{{K}}_{0}\textbf{sgn}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\alpha \boldsymbol{{e}}_{{f}}\right)\right] ,\end{equation}
If
$K_{0ii}$
satisfies sufficient
$K_{0ii}\gt \left\| \boldsymbol{{f}}_{n}(t)\right\| _{\infty }+\left\| \dot{\boldsymbol{{f}}}_{n}(t)\right\| _{\infty }$
, then
\begin{equation} \int _{0}^{t}L_{n}\!\left(\tau \right)\mathrm{d}\tau \leq \xi _{n} ,\end{equation}
where
$K_{0ii}$
denotes the i-th element on the diagonal of the diagonal matrix
$\boldsymbol{{K}}_{0}$
.
$\boldsymbol{{K}}_{0ii}=\left[\begin{array}{l@{\quad}l@{\quad}l} K_{011} & K_{022} & K_{033} \end{array}\right]^{{T}}, \boldsymbol{{f}}_{n}(t),\dot{\boldsymbol{{f}}}_{n}(t)\in \boldsymbol{{l}}_{\infty }$
, and
$\xi _{n}=\sum _{i=1}^{n}K_{0ii}\!\left| \tanh \!\left(e_{i}\!\left(0\right)\right)\right| -\textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{e}}\!\left(0\right)\right)\boldsymbol{{f}}_{n}\!\left(0\right), n=1,2$
.
Proof. See Appendix A.
Thus, the stability theorem for SMC-IOR-D is formulated as follows:
Theorem 1. When Eqs. (33)−(37) of SMC-IOR-D are under the input constraints from Eq. (44), if the controller parameters meet the sufficient conditions shown in Eqs. (45)−(48), the asymptotic stable trajectory tracking control of the FBFLFJ space robot can be realized
\begin{equation} K_{0ii}+k^{\prime}+\mathrm{2}+\beta _{i}\leq \tau _{{oj},i,\max } ,\end{equation}
\begin{equation} K_{0ii}\gt \max \!\left\{\left\| \boldsymbol{{f}}_{1}\left(t\right)\right\| _{\infty }+\left\| \dot{\boldsymbol{{f}}}_{1}(t)\right\| _{\infty },\left\| \boldsymbol{{f}}_{2}(t)\right\| _{\infty }+\left\| \dot{\boldsymbol{{f}}}_{2}(t)\right\| _{\infty }\right\} ,\end{equation}
\begin{equation} \alpha \gt 1.5 ,\end{equation}
\begin{equation} k^{\prime}=\left(k_{{n}}+1\right)/\lambda _{{m}}\!\left(\boldsymbol{{M}}\right) ,\end{equation}
\begin{equation} k_{n}\gt \frac{1}{4\lambda _{3}}\max \!\left\{\rho ^{2}\!\left(\sqrt{\lambda _{12}/\lambda _{11}}\left\| \boldsymbol{{y}}_{1}\!\left(0\right)\right\| \right),\rho ^{2}\!\left(\sqrt{\lambda _{22}/\lambda _{21}}\left\| \boldsymbol{{y}}_{2}\!\left(0\right)\right\| \right),\rho ^{2}\!\left(\left\| \boldsymbol{{z}}\!\left(0\right)\right\| \right)\right\} ,\end{equation}
where
$\lambda _{11}=0.5\min \!\left\{1, \lambda _{{m}}\!\left(\boldsymbol{{M}}\right)\right\}, \lambda _{12}=\max \!\left\{1, \frac{1}{2}\lambda _{{M}}\!\left(\boldsymbol{{M}}\right)\right\}, \lambda _{21}=\frac{1}{2}\min \!\left\{1,\lambda _{{m}}\!\left(\boldsymbol{{Q}}_{0}\right),\omega ^{2},\lambda _{{m}}\!\left(\boldsymbol{{M}}\right)\right\},$
$\lambda _{22}=\frac{1}{2}\max \!\left\{2,\lambda _{{M}}\!\left(\boldsymbol{{Q}}_{0}\right),N^{2}\omega ^{2},\lambda _{{M}}\!\left(\boldsymbol{{M}}\right)\right\}, \lambda _{3}=1-\frac{3}{2\alpha }, \boldsymbol{{f}}_{1}(t)\boldsymbol{=}\boldsymbol{{N}}_{{d}}-\boldsymbol{{B}}\cdot \textbf{sgn}\!\left(\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k}\right)$
, and
$\boldsymbol{{f}}_{2}(t)=\sum _{k=N+1}^{\infty }\left[\overline{\boldsymbol{{a}}}_{k}\cos \!\left(k\omega t\right)+\overline{\boldsymbol{{b}}}_{k}\sin \!\left(k\omega t\right)\right]$
.
Proof. See Appendix B.
4.2. SMC-IOR based on hybrid trajectory
The SMC-IOR-D in the previous section achieves asymptotic stable tracking of the base attitude and joint angle, but the vibration of the flexible link is not suppressed. In this section, we use the concept of virtual control force to modify the original desired trajectory and generate a hybrid trajectory
$\boldsymbol{{q}}_{{h}}$
that reflects both the flexible vibration of the link and the rigid motion of the system. Based on this, the sliding mode control with input restriction, output feedback and repetitive learning based on the hybrid trajectory (SMC-IOR-H) is designed to achieve the dual functions of motion tracking and simultaneous suppression of the links vibration. The virtual force
$\boldsymbol{{F}}\in \mathrm{\mathbb{R}}^{3\times 1}$
is introduced, and the error between the desired trajectory and the hybrid trajectory is
$\boldsymbol{{e}}_{{h}}=\boldsymbol{{q}}_{{d}}-\boldsymbol{{q}}_{{h}}$
, which is generated by the second-order command generator
$\ddot{\boldsymbol{{e}}}_{{h}}+\boldsymbol{{a}}\dot{\boldsymbol{{e}}}_{{h}}+\boldsymbol{{b}}\boldsymbol{{e}}_{{h}}=\boldsymbol{{F}}$
, where
$\boldsymbol{{a}}, \boldsymbol{{b}}\in \mathrm{\mathbb{R}}^{3\times 3}$
are the constant positive definite diagonal matrix.
The hybrid error is defined as
$\boldsymbol{{e}}_{{r}}=\boldsymbol{{q}}_{{h}}-\boldsymbol{{q}}$
, and the hybrid filter tracking error is defined as
$\boldsymbol{\eta }_{{r}}=\dot{\boldsymbol{{e}}}_{{r}}+\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)$
.
$\boldsymbol{{v}}_{{r}}$
and
$\boldsymbol{{e}}_{{fr}}$
are the hybrid filter vectors. Then, the SMC-IOR-H is obtained as follows:
\begin{equation} \left(\boldsymbol{\tau }_{{oj}}\right)_{{r}}=\boldsymbol{{K}}_{0}\textbf{Sgn}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)+\alpha \boldsymbol{{e}}_{{fr}}\right)-\left(k^{\prime}+1\right)\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)+\textbf{Sat}\!\left(\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0{r}}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k{r}}\right) ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)=\boldsymbol{{p}}_{1{r}}-\left(k^{\prime}+1\right)\boldsymbol{{e}}_{{r}}\\[4pt] \dot{\boldsymbol{{p}}}_{1{r}}=-k^{\prime}\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)-\left(k^{\prime}+2\right)\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)-\alpha ^{-1}\boldsymbol{{e}}_{{fr}}\\[4pt] \boldsymbol{{p}}_{1{r}}\!\left(0\right)=\left(k^{\prime}+1\right)\boldsymbol{{e}}_{{r}}\!\left(0\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{e}}_{{fr}}=\boldsymbol{{p}}_{2{r}}+\alpha ^{-1}\!\left(\boldsymbol{{e}}_{{r}}-\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)\right)\\[4pt] \dot{\boldsymbol{{p}}}_{2{r}}=\alpha ^{-1}\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)-\boldsymbol{{e}}_{{fr}}\\[4pt] \boldsymbol{{p}}_{2{r}}\!\left(\mathrm{0}\right)=\alpha ^{-1}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\!\left(0\right)\right)-\boldsymbol{{e}}_{{r}}\!\left(0\right)\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{z}}_{0{r}}=\boldsymbol{{p}}_{0{r}}+\boldsymbol{{Q}}_{0}\boldsymbol{{e}}_{{r}}\\[4pt] \dot{\boldsymbol{{p}}}_{0{r}}=\boldsymbol{{Q}}_{0}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)\right) \end{array}\right. ,\end{equation}
\begin{equation} \left\{\begin{array}{l} \dot{\boldsymbol{{z}}}_{k{r}}=\boldsymbol{{p}}_{k\mathrm{r}}+\boldsymbol{{Q}}_{k}\boldsymbol{{e}}_{{r}}\enspace \\[4pt] \dot{\boldsymbol{{p}}}_{k{r}}=\boldsymbol{{Q}}_{k}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}_{{r}}\right)+\textbf{Tanh}\!\left(\boldsymbol{{v}}_{{r}}\right)\right)-k^{2}\omega ^{2}\boldsymbol{{z}}_{k{r}}\enspace \end{array}\right.k=1,\cdots N .\end{equation}
Defining the state variable as
$\boldsymbol{{q}}_{{s}}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} \boldsymbol{\delta }^{{T}} & \boldsymbol{{e}}^{{T}} & \dot{\boldsymbol{\delta }}^{{T}} & \dot{\boldsymbol{{e}}}^{{T}} \end{array}\right]^{{T}}$
, the equation of state is obtained from Eqs. (49)–(53) and Eq. (22) as follows:
\begin{equation} \dot{\boldsymbol{{q}}}_{{s}}=\boldsymbol{{A}}_{{s}}\boldsymbol{{q}}_{{s}}+\boldsymbol{{B}}_{{s}}\boldsymbol{{F}}+\boldsymbol{{L}}_{{s}} ,\end{equation}
where
$\boldsymbol{{A}}_{{s}}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} \mathbf{0} & \mathbf{0} & \boldsymbol{{I}} & \mathbf{0}\\[4pt] \mathbf{0} & \mathbf{0} & \mathbf{0} & \boldsymbol{{I}}\\[4pt] -\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{K}}_{\unicode{x03B4} } & -\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{R}}_{21}\boldsymbol{{b}} & -\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{S}}_{22} & -\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{R}}_{21}\boldsymbol{{a}}\\[4pt] \mathbf{0} & -\boldsymbol{{b}} & \mathbf{0} & -\boldsymbol{{a}} \end{array}\right], \boldsymbol{{B}}_{{s}}=\left[\begin{array}{l} \mathbf{0}\\[4pt] \mathbf{0}\\[4pt] \boldsymbol{{R}}_{22}\boldsymbol{{R}}_{21}\\[4pt] \boldsymbol{{I}} \end{array}\right]$
, and
$\boldsymbol{{L}}_{{s}}=\left[\begin{array}{l} \mathbf{0}\\[4pt] \mathbf{0}\\[4pt] \boldsymbol{{R}}_{22}^{-1}\boldsymbol{{R}}_{21}\!\left(\boldsymbol{{G}}-\ddot{\boldsymbol{{q}}}_{{d}}\right)-\boldsymbol{{R}}_{22}^{-1}\boldsymbol{{S}}_{21}\dot{\boldsymbol{{q}}}\\[4pt] \boldsymbol{{G}} \end{array}\right]$
.
If
$\boldsymbol{{L}}_{{s}}$
satisfies the following conditions:
\begin{equation} \frac{\left\| \boldsymbol{{L}}_{{s}}(t)\right\| _{{E}}}{\left\| \boldsymbol{{q}}_{{s}}\right\| _{{E}}}\leq \frac{1}{2\left\| \boldsymbol{{N}}_{{s}}^{-1}\right\| _{{s}}\left\| \boldsymbol{{P}}_{{s}}\right\| _{{s}}}=\frac{\lambda _{\min }\left(\boldsymbol{{N}}_{{s}}\right)}{2\lambda _{\max }\left(\boldsymbol{{P}}_{{s}}\right)},\forall \boldsymbol{{q}}_{{s}}\in \mathbf{R}^{3\times 1} ,\end{equation}
then the virtual force
$\boldsymbol{{F}}$
is
\begin{equation} \boldsymbol{{F}}=-\boldsymbol{{R}}_{{s}}^{-1}\boldsymbol{{B}}_{{s}}^{{T}}\boldsymbol{{P}}_{{s}} \boldsymbol{{q}}_{{s}} .\end{equation}
In Eq. (56),
$\boldsymbol{{R}}_{{s}}\gt \mathbf{0}$
, and
$\boldsymbol{{P}}_{{s}}$
is the solution of Riccati equation
$\boldsymbol{{P}}_{{s}}\boldsymbol{{A}}_{{s}}+\boldsymbol{{A}}_{{s}}^{{T}}\boldsymbol{{P}}_{\mathrm{s}}-\boldsymbol{{P}}_{{s}}\boldsymbol{{B}}_{\mathrm{s}}\boldsymbol{{R}}_{{s}}^{-1}\boldsymbol{{B}}_{{s}}^{{T}}\boldsymbol{{P}}_{{s}}+\boldsymbol{{Q}}_{{s}}=\mathbf{0}$
. Constructing the Lyapunov function
$V\!\left(\boldsymbol{{q}}_{{s}}\right)=\boldsymbol{{q}}_{{s}}^{{T}}\boldsymbol{{P}}_{{s}} \boldsymbol{{q}}_{{s}}, V\!\left(\boldsymbol{{q}}_{{s}}\right)$
is derived and combining with Eqs. (55) and (56) yields
$\dot{V}\!\left(\boldsymbol{{q}}_{{s}}\right)\leq -\left(\boldsymbol{{q}}_{{s}}^{{T}}\boldsymbol{{N}}_{{s}}\boldsymbol{{q}}_{{s}}-\lambda _{\min }\left(\boldsymbol{{N}}_{{s}}\right)\left\| \boldsymbol{{q}}_{{s}}\right\| ^{2}\right)\leq 0$
, so the system is stable.
4.3. Multiple flexible suppression control based on linear quadratic optimal method
As analyzed above, the state equation
$\boldsymbol{{q}}_{{f}}$
at the fast time scale
$t_{{f}}$
is shown in Eq. (21). The performance index function is constructed as
\begin{equation} J_{{qf}}=0.5\int _{0}^{\infty }\left(\boldsymbol{{q}}_{{f}}^{{T}}\boldsymbol{{Q}}_{{f}}\boldsymbol{{q}}_{{f}}+\boldsymbol{\tau }_{{nf}}^{{T}}\boldsymbol{{R}}_{{f}}\boldsymbol{\tau }_{{nf}}\right)\mathrm{d}t_{{f}} .\end{equation}
In Eq. (57), symmetric matrix
$\boldsymbol{{Q}}_{{f}}\geq \mathbf{0}, \boldsymbol{{R}}_{{f}}\gt \mathbf{0}$
. The optimal control of the fast subsystem is designed as
\begin{equation} \boldsymbol{\tau }_{{nf}}=-\boldsymbol{{R}}_{{f}}^{-1}\boldsymbol{{B}}_{{f}}^{{T}}\boldsymbol{{P}}_{{f}}\boldsymbol{{q}}_{{f}} ,\end{equation}
where
$\boldsymbol{{P}}_{{f}}$
is the solution of the Riccati equation
$\boldsymbol{{P}}_{{f}}\boldsymbol{{A}}_{{f}}+\boldsymbol{{A}}_{{f}}^{{T}}\boldsymbol{{P}}_{{f}}-\boldsymbol{{P}}_{{f}}\boldsymbol{{B}}_{{f}}\boldsymbol{{R}}_{{f}}^{-1}\boldsymbol{{B}}_{{f}}^{{T}}\boldsymbol{{P}}_{{f}}+\boldsymbol{{Q}}_{{f}}=\mathbf{0}$
.
Then, ISMC-IOR is composed of SMC-IOR-H, virtual force Eq. (56), fast sub-controller Eq. (58) and motor general controller Eq. (18). The overall scheme of this controller is shown in flowchart Fig. 4, where the blue dashed area is the fast subsystem controller and the red dashed area is the slow subsystem controller. According to the above analysis, the implementation of the ISMC-IOR does not need the dynamic model information of space robot and the motion speed information of base and joint, and can meet the requirements of limited driving torque of FBFLFJ space robot.
Figure 4. Integrated sliding mode control with input restriction, output feedback and repetitive learning.
5. Simulation
Taking the FBFLFJ space robot shown in Fig. 1 as an example, the simulation is carried out. The size of the base is
$l_{0}=1.5\,\mathrm{m}$
, the mass of the base is
$m_{0}=40\,\mathrm{kg}$
, the inertia moment of the base is
$J_{0}=30\,\mathrm{kg}\cdot \mathrm{m}^{2}$
and the elastic coefficient of the base is
$k_{\mathrm{b}}=500\,\mathrm{N}/\mathrm{m}$
. The density of link
$B_{1}$
is
$\rho _{1}=3.5\,\mathrm{kg}/\mathrm{m}$
, the density of link
$B_{2}$
is
$\rho _{2}=1.1\,\mathrm{kg}/\mathrm{m}$
, the length of the link is
$l_{i}=1.5\,\mathrm{m}$
and the bending stiffness of the link is
$\text{EI}_{i}=100\,\mathrm{N}/\mathrm{m}^{2}$
. At joint
$i$
, the motor rotor rotational inertia is
$J_{{m}i}=0.1\,\mathrm{kg}\cdot \mathrm{m}^{2}$
and the joint elasticity coefficient is
$k_{{m}i}=50\,\mathrm{Nm}/\mathrm{rad}, i=1,2$
. Before the controller is turned on, the FBFLFJ space robot base and joints do not move, and the base, links and joints do not vibrate. Its initial configuration is
$q_{{b}}\!\left(0\right)= $
$0\, \mathrm{m}, \boldsymbol{{q}}\!\left(0\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} 1.1 & 0.7 & 1.4 \end{array}\right]^{{T}}\,\mathrm{rad}, \boldsymbol{\delta }\!\left(0\right)=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} 0 & 0 & 0 & 0 \end{array}\right]\,\mathrm{m}, \boldsymbol{{q}}_{{m}}\!\left(0\right)=\left[\begin{array}{l@{\quad}l} 0.7 & 1.4 \end{array}\right]^{{T}}\, \mathrm{rad}, \dot{q}_{{b}}\!\left(0\right)\ =\ 0 \,\mathrm{m}$
,
$\dot{\boldsymbol{{q}}}\!\left(0\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} 0 & 0 & 0 \end{array}\right]^{{T}}\,\mathrm{rad}, \dot{\boldsymbol{\delta }}\!\left(0\right)=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l} 0 & 0 & 0 & 0 \end{array}\right]\,\mathrm{m}, \dot{\boldsymbol{{q}}}_{{m}}\!\left(0\right)=\left[\begin{array}{l@{\quad}l} 0 & 0 \end{array}\right]^{{T}} \,\mathrm{rad}$
. Let 0 s be the simulation initial moment. At this time, turn on the controller so that the FBFLFJ robot base and joints track the following desired trajectory:
\begin{equation*} \boldsymbol{{q}}_{\textrm{d}} = \left[1 \quad 0.8 \quad 1.2 \right]^{{T}} \textrm{rad}. \end{equation*}
In order to illustrate the vibration suppression effect on the flexible vibration of the base, links and joints and motion control effect of the base and joints of the FBFLFJ space robot, ISMC-IOR is used to conduct a simulation study, where the controller parameters are
$\boldsymbol{{K}}_{0}=\mathrm{diag}\!\left(20,0.5,0.9\right), k^{\prime}=20, \alpha =5, \boldsymbol{{Q}}_{0} = $
$\mathrm{diag}\!\left(10,90,\right.\left.30\right), \boldsymbol{{Q}}_{k}=\mathrm{diag}\!\left(2,2,2\right), N=3, \boldsymbol{{a}}=\boldsymbol{{b}}=\mathrm{diag}\!\left(5, 5,5\right).$
The saturation function thresholds are
$\beta _{1}=20, \beta _{2}=\beta _{3}=40$
. The flexible vibration of the FBFLFJ space robot base, links and joints affects the system control accuracy. In order to verify the effect of flexible vibration on the system control accuracy, the flexible suppressors in ISMC-IOR, i.e., the fast sub-controller
$\boldsymbol{\tau }_{{nf}}$
and the SMC-IOR-H are turned off, and the ISMC-IOR without vibration suppression (ISMC-IOR-NV) consisting of the SMC-IOR-D and
$\boldsymbol{\tau }_{{m}}=\left(\boldsymbol{{I}}+\boldsymbol{{K}}_{{c}}\right)\boldsymbol{\tau }_{{ns}}-\boldsymbol{{K}}_{{c}}\boldsymbol{\tau }$
is used for simulation studies. For fairness, all control parameters remained unchanged. The control conditions are divided into ISMC-IOR-NV and ISMC-IOR.
Figure 5 shows the FBFLFJ space robot base attitude trajectory tracking under two control conditions, and Fig. 6 shows the FBFLFJ space robot joints trajectory tracking under two control conditions.
Figure 5. Trajectory tracking curve of the FBFLFJ space robot base attitude under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
As can be seen from Figs. 5(a) and 6(a), without the flexible vibration suppressor, although the base and joints can track the desired trajectory, they have an obvious vibration trend after stabilization. Among them, joint 1 showed vibration in 0.5–1.5 s, and after 20 s, both the base and the joints have different amplitudes of vibration. From Figs. 5(b) and 6(b), it can be seen that by turning on the flexible vibration suppressor and using ISMC-IOR for controlling, not only the base and joints can accurately track the desired trajectory, but also the vibration of the base and joints has been significantly suppressed.
Figure 7(a) and (b) shows the error convergence rate under ISMC-IOR-NV and ISMC-IOR control conditions, which are calculated by the formula
$\log \left\| \boldsymbol{{q}}-\boldsymbol{{q}}_{{d}}\right\|$
, and the unit is
$\log \!\left(\mathrm{rad}\right)$
. Therefore, the smaller the error convergence rate, the higher the control accuracy of the controller. Furthermore, to verify the high-precision characteristics of the repetitive learning controller in ISMC-IOR, the integrated sliding mode control for motion and vibration (ISMC) algorithm without repetitive learning controller is used to control the FBFLFJ space robot to track the desired trajectory
$\boldsymbol{{q}}_{{d}}$
. The slow sub-controller in ISMC is
$\left(\boldsymbol{\tau }_{{oj}}\right)_{\mathrm{r}}=\boldsymbol{{M}}\!\left(\ddot{\boldsymbol{{q}}}_{{h}}+\lambda _{1}\dot{\boldsymbol{{e}}}_{r}+\lambda _{2}\boldsymbol{{s}}_{r}\right)+\boldsymbol{{C}}\dot{\boldsymbol{{q}}}+\boldsymbol{\kappa }$
, where,
$\boldsymbol{{s}}_{r}=\dot{\boldsymbol{{e}}}_{r}+\lambda _{1}\boldsymbol{{e}}_{r}$
. The control parameters are
$\lambda _{1}=\lambda _{1}=1$
. The rest of the parameters are identical to those of ISMC-IOR. Figure 7(c) shows the error convergence rate under ISMC.
As can be seen from Fig. 7(a) and (b), the minimum error convergence rate is about −3.2 when the flexible vibration suppressor is turned off, while the minimum error convergence rate is about −4.7 when the flexible vibration suppressor is turned on, and the accuracy of ISMC-IOR control is significantly higher than that of ISMC-IOR-NV. It shows that the flexible vibration seriously affects the control accuracy of the system, and the ISMC-IOR proposed in this paper can improve the control quality of the system. In addition, it can be seen from Fig. 7(c) that the system error convergence rate mean value under ISMC is about −2.8, which is significantly lower than the error convergence rate mean value of −3.8 under ISMC-IOR, see Fig. 7(b); therefore, ISMC-IOR has higher control accuracy than ISMC in tracking repetitive signals, calibrating the effectiveness of the repetitive controller. In order to clarify the error convergence under the three control conditions, the error convergence values for the three control cases at any moment are analyzed according to Fig. 7, as shown in Table I.
As can be seen from Table I, the error convergence value of the system under ISMC-IOR control is the smallest, which proves the effectiveness of the controller proposed in this paper in high-precision tracking control.
In order to verify the effect of the control algorithm proposed in this paper on the flexible vibration suppression of the base and joints of the system, the following simulation analysis is conducted. Figure 8 shows the flexible vibration curves of the base under the two control conditions, and Figs. 9 and 10 show the flexible vibration curves of joint 1 and joint 2 under the two control conditions.
Figure 6. Trajectory tracking curve of the FBFLFJ space robot joints under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
As can be seen from Fig. 8, the amplitude of the base reached 0.1 m when turning on the controller. With ISMC-IOR-NV control, the amplitude of the base was maintained at 0.0014 m after 20–30 s, while with ISMC-IOR control, the amplitude of the base gradually decreased and was suppressed to within 0.0005 m at 30 s. The vibration frequency was also decreased. From Fig. 9(a), it can be seen that under the ISMC-IOR-NV control, the amplitude of joint 1 reached 3 rad at 2 s and maintained at 1 rad after 10 s. The amplitude of joint 2 reached 1.2 rad at 2 s and maintained at 1.8 rad after 10 s. From Fig. 9(b), it can be seen that under the ISMC-IOR control, the initial amplitude of the joint 1 is 1.2 rad, which is maintained within 0.17 rad after stabilization; the initial amplitude of the joint 2 is 0.6 rad, which is maintained at 0.1 rad after stabilization. Both of them are significantly suppressed compared to the ISMC-IOR-NV control. It shows that the flexible vibration suppressor proposed in this paper can effectively suppress the flexible vibration of the base and joints.
In order to analyze the vibration of the flexible links of the FBFLFJ space robot under the two control algorithms, the following simulations are performed. Among them, Fig. 10 shows the first two orders of modal vibration curves of the link
$B_{1}$
under two control conditions, and Fig. 11 shows the first two orders of modal vibration curves of the link
$B_{2}$
under two control conditions.
Table I. Tracking error convergence value under three control conditions.
Figure 7. Tracking error convergence rate of the FBFLFJ space robot under three control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR. (c) ISMC.
Figure 8. Flexible vibration curve of FBFLFJ space robot base under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
Figure 9. Flexible vibration curve of FBFLFJ space robot joints under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
Figure 10. Flexible vibration curve of FBFLFJ space robot link
$B_{1}$
under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
From Figs. 10(a) and 11(a), it can be seen that under ISMC-IOR-NV control, the 1st order modal coordinates of link
$B_{1}$
are maintained at 0.002 m at 20–30 s, and 0.001 m at 20–30 s for the 2nd order modal coordinates; the 1st order modal coordinates of link
$B_{2}$
are maintained at 0.012 m, and 0.017 m for the 2nd order modal coordinates. As shown in Figs. 10(b) and 11(b), under ISMC-IOR control, both the 1st and 2nd order modal coordinates of the link
$B_{1}$
are suppressed to within 0.001 m; the 1st order modal coordinates of the link
$B_{2}$
are suppressed to 0.0025 m and the 2nd order modal coordinates are suppressed to 0.001 m. Compared with the ISMC-IOR-NV control, the modal vibration of both links under ISMC-IOR control is effectively suppressed.
In order to quantitatively analyze the suppression effect of the controller proposed in this paper on the flexible vibration of the system, the vibration of all the flexible variables of the system with the flexible suppressor on and off is analyzed in combination with Figs. 10 and 11, as shown in Table II.
As can be seen in Table II, the ISMC-IOR proposed in this paper has the obvious function of suppressing the multiple flexible vibrations of the system. Compared with ISMC-IOR-NV, the vibration suppression performance of the base, joints and links of the FBFLFJ space robot controlled by ISMC-IOR can be improved by 50%, 85%, 94.44%, 44.44%, 37.50%, 80.77% and 94.12%, respectively.
In order to verify the torque limitation of the proposed algorithm, the driving torque required for ISMC-IOR control is analyzed and the simulation results are shown in Fig. 12. It can be seen that the maximum upper bound of the real-time moment is
$\left(\boldsymbol{\tau }_{{oj}}\right)_{{r}}=\left[\begin{array}{l@{\quad}l@{\quad}l} 50 & 60 & 40 \end{array}\right]^{{T}}$
. According to
$K_{0ii}+k^{\prime}+\mathrm{2}+\beta _{i}\leq \left(\tau _{{oj},i,\max }\right)_{{r}}$
, it is obtained that
$\left(\tau _{{oj},0,\max }\right)_{{r}}\geq 62, \left(\tau _{{oj},1,\max }\right)_{{r}}\geq 62.5, \left(\tau _{{oj},2,\max }\right)_{{r}}\geq 62.9$
. The moment in the simulation satisfies the constrained relation
$\left(\tau _{{oj},i}\right)_{{r}}\leq \left(\tau _{{oj},i,\max }\right)_{{r}}$
, where
$\left(\tau _{{oj},i}\right)_{{r}}$
is the element corresponding to vector
$\left(\boldsymbol{\tau }_{{oj}}\right)_{{r}}, i=1,2,3$
, so the moment constraint requirement is satisfied.
Table II. Vibrations of the FBFLFJ space robot base, joints and links at 20–30 s.
Figure 11. Flexible vibration curve of FBFLFJ space robot link
$B_{2}$
under two control conditions. (a) ISMC-IOR-NV. (b) ISMC-IOR.
6. Conclusions
(1) For the actuator saturated space robot affected by multiple flexible vibrations of base, links and joints, the modeling method of dynamic model of FBFLFJ space robot is analyzed. On this basis, a singular perturbation decomposition scheme of the model is proposed. Then, according to the rigid flexible subsystem, we propose an algorithm of integrated sliding mode control with input restriction, output feedback and repetitive learning.
Figure 12. Torques under ISMC-IOR.
(2) The simulation results show that the flexible vibration significantly affects the control accuracy of the system, and the rigid controller without suppressing the flexible vibration cannot control the FBFLFJ space robot system to perform the accurate tracking task. In contrast, the controller proposed in this paper can make the system track the desired trajectory with −3 orders of magnitude accuracy while suppressing the multiple flexible vibrations of the system base, links and joints 50%–80% and 37% performance improvement were achieved. The control algorithm enables the space robot system to work with limited input torque and can also deal with the lack of model information and speed information.
Authors’ contributions
All authors certify that they have participated sufficiently in the work to take public responsibility for the content, including participation in the concept, design, analysis, writing or revision of the manuscript. Furthermore, each author certifies that this material or similar material has not been and will not be submitted to any other publication.
Conceptualization, Xiaodong Fu; methodology, Xiaodong Fu and Haiping Ai; software, Xiaodong Fu and Li Chen; investigation, Xiaodong Fu and Haiping Ai; writing – original draft preparation, Xiaodong Fu; writing – review and editing, Xiaodong Fu and Haiping Ai; supervision, Haiping Ai and Li Chen; funding acquisition, Haiping Ai and Li Chen. All authors have read and agreed to the published version of the manuscript.
Financial support
This work was supported by the National Natural Science Foundation of China (No. 11372073), Fujian Provincial Industrial Robot Basic Components’ Technology Research Platform (No. 2014H21010011) and the Science and Technology Project of the Education Department of Jiangxi Province (Grant No. GJJ200864).
Conflicts of interest
The authors declare no conflict of interest.
Ethical considerations
None.
Appendix A: Proof of Lemma 1
Proof. Define the intermediate variable
$\boldsymbol{{s}}=\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\alpha \boldsymbol{{e}}_{{f}}$
, then
$\boldsymbol{\eta }=\boldsymbol{{s}}+\dot{\boldsymbol{{s}}}$
. Substitute
$\boldsymbol{\eta }$
into Eq. (42) and take the integral to obtain
\begin{align} \int _{0}^{t}L_{n}\!\left(\tau \right)\mathrm{d}\tau & \leq \int _{0}^{t}\!\left| \boldsymbol{{s}}\!\left(\tau \right)\right| ^{{T}}\!\left(\left| \boldsymbol{{f}}_{n}\!\left(\tau \right)\right| +\left| \frac{\mathrm{d}\!\left(\boldsymbol{{f}}_{n}\!\left(\tau \right)\right)}{\mathrm{d}\tau }\right| -\boldsymbol{{K}}_{0ii}\right)\mathrm{d}\tau \nonumber\\[5pt] &+ \sum _{i=1}^{n}\!\left| s_{i}(t)\right| \left(\left| f_{ni}(t)\right| -K_{0ii}\right)+\sum _{i=1}^{n}K_{0ii}\!\left| s_{i}\!\left(0\right)\right| -\boldsymbol{{s}}^{{T}}\!\left(0\right)\boldsymbol{{f}}_{n}\!\left(0\right) \end{align}
$\left| \mathbf{\Re }\right|$
represents a new expression after taking the absolute value of each element of vector or matrix
$\mathbf{\Re }$
. According to
$K_{0ii}\gt \left\| \boldsymbol{{f}}_{n}(t)\right\| _{\infty }+\left\| \dot{\boldsymbol{{f}}}_{n}(t)\right\| _{\infty }$
and
$\boldsymbol{{e}}_{{f}}\!\left(0\right)=\mathbf{0}$
, Eq. (59) satisfies
$\int _{0}^{t}L_{n}\!\left(\tau \right)\mathrm{d}\tau \leq \xi _{n}$
. Proof complete.
Appendix B: Proof of Theorem 1
Proof. Case I.
$\left| \left(Q_{0}z_{0}+\sum _{k=1}^{N}Q_{k}\dot{z}_{k}\right)_{i}\right| \gt \beta _{i}$
for all i.
Define auxiliary function
$P_{1}(t)=\xi _{1}-\int _{0}^{t}L_{1}\!\left(\tau \right)\mathrm{d}\tau$
and variable
$\int _{0}^{v_{i}}\tanh\, \tau \,\mathrm{sech^{2}}\,\tau \mathrm{d}\tau$
.
$P_{1}(t)\geq 0$
is obtained from Lemma 1 and Eq. (45), in combination with
$\int _{0}^{v_{i}}\tanh \, \tau \, \mathrm{sech^{2}}\,\tau \mathrm{d}\tau \geq 0$
, the Lyapunov function
$V_{1}$
is constructed as
\begin{equation} V_{1}=\sum _{i=1}^{3}\ln\! \left(\cosh e_{i}\right)+\sum _{i=1}^{3}\int _{0}^{v_{i}}\tanh \, \tau \, \mathrm{sech^{2}}\,\tau \mathrm{d}\tau +\frac{1}{2}\boldsymbol{{e}}_{{f}}^{{T}}\boldsymbol{{e}}_{{f}}+\frac{1}{2}\boldsymbol{\eta }^{{T}}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta }+P_{1}=\boldsymbol{{y}}_{1}^{{T}}\boldsymbol{{U}}_{1}\boldsymbol{{y}}_{1} ,\end{equation}
where
$\boldsymbol{{y}}_{1}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l@{\quad}l} \boldsymbol{{L}}\boldsymbol{{n}}^{{T}}\!\left(\boldsymbol{{e}}\right) &\!\!\! \boldsymbol{{F}}\boldsymbol{{n}}^{{T}}\!\left(\boldsymbol{{v}}\right) &\!\!\! \boldsymbol{{e}}_{{f}}^{{T}} &\!\!\! \boldsymbol{\eta }^{{T}} &\!\!\! \sqrt{P_{1}} \end{array}\right]^{{T}}, \boldsymbol{Ln}\!\left(\boldsymbol{{e}}\right)=\left[ \sqrt{\ln\! \left(\cosh e_{1}\right)} \quad\!\!\! \sqrt{\ln\! \left(\cosh e_{2}\right)}\right.$
$\left. \sqrt{\ln\! \left(\cosh e_{3}\right)} \right]^{{T}}$
, and
$\boldsymbol{{Fn}}\!\left(\boldsymbol{{v}}\right)=\left[\begin{array}{l@{\quad}l@{\quad}l} \sqrt{\int _{0}^{v_{1}}\tanh \,\tau \,\mathrm{sech^{2}}\,\tau \mathrm{d}\tau } & \sqrt{\int _{0}^{v_{2}}\tanh \,\tau \,\mathrm{sech^{2}}\,\tau \mathrm{d}\tau } & \sqrt{\int _{0}^{v_{3}}\tanh \,\tau \,\mathrm{sech^{2}}\,\tau \mathrm{d}\tau } \end{array}\right]^{{T}}$
.
According to the value of stability condition
$\lambda _{11}, \lambda _{12}$
and Eq. (60), we get
\begin{equation} \lambda _{11}\left\| \boldsymbol{{y}}_{1}\right\| ^{2}\leq V_{1}\!\left(t,\boldsymbol{{y}}_{1}\right)\leq \lambda _{12}\left\| \boldsymbol{{y}}_{1}\right\| ^{2} .\end{equation}
Derive from Eq. (60), and according to Eqs. (33)–(39), we have
\begin{equation} \dot{V}_{1}=\dot{V}_{{H}}+\dot{P}_{1}+\boldsymbol{\eta }^{{T}}\cdot \left[\boldsymbol{{N}}_{{d}}-\boldsymbol{{B}}\cdot \textbf{Sgn}\!\left(\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k}\right)-\boldsymbol{{K}}_{0}\textbf{sgn}\!\left(\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)+\alpha \boldsymbol{{e}}_{{f}}\right)\right] ,\end{equation}
\begin{align} \dot{V}_{{H}} = & -\textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{e}}\right)\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)-\textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{v}}\right)\cdot \textbf{Tanh}\!\left(\boldsymbol{{v}}\right)+\alpha ^{-1}\boldsymbol{{e}}_{{f}}^{T}\!\left(\boldsymbol{{I}}_{3}-\textbf{Sec}\textbf{h}^{2}\!\left(\boldsymbol{{e}}\right)\right)\left(\boldsymbol{\eta }-\textbf{Tanh}\!\left(\boldsymbol{{e}}\right)-\textbf{Tanh}\!\left(\boldsymbol{{v}}\right)\right)\nonumber\\[4pt] & -\boldsymbol{{e}}_{{f}}^{T}\boldsymbol{{e}}_{{f}}+\boldsymbol{\eta }^{{T}} {\tilde{{\boldsymbol{{N}}}}}-k^{\prime}\boldsymbol{\eta }^{{T}}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta }-\boldsymbol{\eta }^{{T}}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\left(\boldsymbol{{I}}_{3}-\textbf{Sec}\textbf{h}^{2}\!\left(\boldsymbol{{e}}\right)\right)\boldsymbol{\eta } .\end{align}
Substitute
$\boldsymbol{{f}}_{1}(t)$
and
$P_{1}(t)=\xi _{1}-\int _{0}^{t}L_{1}\!\left(\tau \right)\mathrm{d}\tau$
into Eq. (62) to get
$\dot{V}_{1}=\dot{V}_{{H}}$
. By substituting Eqs. (41), (46) and (47) into
$\dot{V}_{{H}}$
, and according to
$\lambda _{3}$
, we have
\begin{equation} \dot{V}_{{H}}\leq -\lambda _{3}\left\| \textbf{Tanh}\!\left(\boldsymbol{{e}}\right)\right\| ^{2}-\lambda _{3}\left\| \textbf{Tanh}\!\left(\boldsymbol{{v}}\right)\right\| ^{2}-\lambda _{3}\left\| \boldsymbol{{e}}_{{f}}\right\| ^{2}-\lambda _{3}\left\| \boldsymbol{\eta }\right\| ^{2}+\rho ^{2}\!\left(\left\| \boldsymbol{{z}}\right\| \right)\left\| \boldsymbol{{z}}\right\| ^{2}/\left(4k_{{n}}\right)=-\gamma \left\| \boldsymbol{{z}}\right\| ^{2} ,\end{equation}
where
$\gamma =\lambda _{3}-\dfrac{\rho ^{2}\!\left(\left\| \boldsymbol{{z}}\right\| \right)}{4k_{{n}}}$
. According to the stability condition Eq. (48), it can be seen that
$\gamma \left\| \boldsymbol{{z}}\right\| ^{2}$
is a continuous positive semidefinite function on the attraction domain
$\boldsymbol{{D}}=\left\{\boldsymbol{{y}}_{1}|\left\| \boldsymbol{{z}}\right\| \lt \rho ^{-1}\!\left(2\sqrt{\lambda _{3}k_{n}}\right)\right\}$
, and that there exists a domain of attraction
$\boldsymbol{{S}}_{1}\subset \boldsymbol{{D}}$
as
\begin{equation} \boldsymbol{{S}}_{1}=\left\{\boldsymbol{{y}}_{1}\in \boldsymbol{{D}}|\lambda _{12}\left\| \boldsymbol{{y}}_{1}\right\| ^{2}\lt \lambda _{12}\!\left[\rho ^{-1}\!\left(2\sqrt{\lambda _{3}k_{n}}\right)\right]\right\} .\end{equation}
According to the invariance-like theorem which is detailed in theorem 8.4 by Khalil [Reference Khalil31], it can be seen that
$\forall \boldsymbol{{y}}_{1}\!\left(0\right)\in \boldsymbol{{S}}_{1}$
. When,
$t\rightarrow \infty, \gamma \left\| \boldsymbol{{z}}\right\| ^{2}\rightarrow 0$
. Combined with the definition of vector
$\boldsymbol{{z}}$
and the expression of vector
$\boldsymbol{\eta }$
in Eq. (41), it can be seen that when
$t\rightarrow \infty, \boldsymbol{{e}}(t), \boldsymbol{{e}}_{{f}}(t), \boldsymbol{{v}}(t), \boldsymbol{\eta }(t),\dot{\boldsymbol{{e}}}(t)\rightarrow 0$
.
Case II.
$\left| \left(\boldsymbol{{Q}}_{0}\boldsymbol{{z}}_{0}+\sum _{k=1}^{N}\boldsymbol{{Q}}_{k}\dot{\boldsymbol{{z}}}_{k}\right)_{i}\right| \leq \beta _{i}$
for all i.
Introduce variable
$\tilde{{{\boldsymbol{{z}}}}}_{k}=\boldsymbol{{z}}_{k}-\boldsymbol{{z}}_{k}^{\ast }\left(k=1,\cdots N\right)\enspace \enspace$
, let
\begin{equation} \left\{\begin{array}{l} \boldsymbol{{z}}_{0}^{\ast }=\boldsymbol{{Q}}_{0}^{-1}\overline{\boldsymbol{{a}}}_{0}\\[4pt] \boldsymbol{{z}}_{k}^{\ast }=\left(k\omega \right)^{-1}\boldsymbol{{Q}}_{k}^{-1}\left[\overline{\boldsymbol{{a}}}_{k}\sin \!\left(k\omega t\right)-\overline{\boldsymbol{{b}}}_{k}\cos \!\left(k\omega t\right)\right] \end{array}\right. .\end{equation}
Since
$\ddot{\boldsymbol{{z}}}_{k}^{\ast }=-\!\left(k\omega \right)^{2}\boldsymbol{{z}}_{k}^{\ast }$
, the closed-loop system variables are as follows:
\begin{equation} \left\{\begin{array}{l} \dot{{\tilde{{\boldsymbol{{z}}}}}}_{0}=\boldsymbol{{Q}}_{0}\boldsymbol{\eta }\\[6pt] \ddot{{\tilde{{\boldsymbol{{z}}}}}}_{k}+k^{2}\omega ^{2}{\tilde{{\boldsymbol{{z}}}}}_{k}=\boldsymbol{{Q}}_{k}\boldsymbol{\eta }\enspace \enspace \enspace \enspace \enspace \enspace \enspace \left(k=1,\cdots N\right) \end{array}\right. .\end{equation}
Construct the Lyapunov function
$V_{2}$
as
\begin{align} V_{2} = & \sum _{i=1}^{3}\ln\! \left(\cosh e_{i}\right)+\sum _{i=1}^{3}\int _{0}^{v_{i}}\tanh \,\tau \,\mathrm{sech^{2}}\,\tau \mathrm{d}\tau +\frac{1}{2}\boldsymbol{{e}}_{{f}}^{{T}}\boldsymbol{{e}}_{{f}}+\frac{1}{2}\boldsymbol{\eta }^{{T}}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta }+P_{2}\nonumber\\[4pt]& +\frac{1}{2}\tilde{{{\boldsymbol{{z}}}}}_{0}^{T}\boldsymbol{{Q}}_{0}\tilde{{{\boldsymbol{{z}}}}}_{0}+\frac{1}{2}\sum _{k=1}^{N}\dot{\tilde{{{\boldsymbol{{z}}}}}}_{k}^{T}\dot{\tilde{{{\boldsymbol{{z}}}}}}_{k}+\frac{1}{2}\sum _{k=1}^{N}k^{2}\omega ^{2}\tilde{{{\boldsymbol{{z}}}}}_{k}^{T}\tilde{{{\boldsymbol{{z}}}}}_{k}=\boldsymbol{{y}}_{2}^{{T}}\boldsymbol{{U}}_{2}\boldsymbol{{y}}_{2}, \end{align}
where
$\boldsymbol{{y}}_{2}=\left[\begin{array}{l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l@{\quad}l} \boldsymbol{{L}}\boldsymbol{{n}}^{{T}}\!\left(\boldsymbol{{e}}\right) & \boldsymbol{{F}}\boldsymbol{{n}}^{{T}}\!\left(\boldsymbol{{v}}\right) & \boldsymbol{{e}}_{{f}}^{{T}} & \boldsymbol{\eta }^{{T}} & \sqrt{P_{2}} & \tilde{{{\boldsymbol{{z}}}}}_{0}^{{T}} & \tilde{{{\boldsymbol{{z}}}}}_{1}^{{T}} & \cdots & \tilde{{{\boldsymbol{{z}}}}}_{N}^{{T}} & \dot{\tilde{{{\boldsymbol{{z}}}}}}_{1}^{{T}} & \cdots & \dot{\tilde{{{\boldsymbol{{z}}}}}}_{N}^{{T}} \end{array}\right]^{\mathrm{T}}$
. According to the value of stability condition
$\lambda _{21}$
and
$\lambda _{22}$
, combined with Eq. (68) we have
\begin{equation} \lambda _{21}\left\| \boldsymbol{{y}}_{2}\right\| ^{2}\leq V_{2}\!\left(t,\boldsymbol{{y}}_{2}\right)\leq \lambda _{22}\left\| \boldsymbol{{y}}_{2}\right\| ^{2} .\end{equation}
Take the derivative of Eq. (68), substitute the right side of the resulting equation into Eqs. (34), (35), (39) and (67), and according to
$\boldsymbol{{f}}_{2}(t)$
and
$P_{2}(t)=\xi _{2}-\int _{0}^{t}L_{2}\!\left(\tau \right)\mathrm{d}\tau$
, we have
\begin{align} \dot{V}_{2} & = \textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{e}}\right)\cdot \dot{\boldsymbol{{e}}}+\textbf{Tan}\textbf{h}^{{T}}\!\left(\boldsymbol{{v}}\right)\textbf{Sec}\textbf{h}^{2}\!\left(\boldsymbol{{v}}\right)\dot{\boldsymbol{{v}}}+\boldsymbol{{e}}_{{f}}^{T}\dot{\boldsymbol{{e}}}_{{f}}+\frac{1}{2}\boldsymbol{\eta }^{{T}}\dot{\boldsymbol{{M}}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\boldsymbol{\eta }\nonumber\\[4pt]&+\boldsymbol{\eta }^{{T}}\boldsymbol{{M}}\!\left(\boldsymbol{\delta },\boldsymbol{{q}}\right)\dot{\boldsymbol{\eta }}+\dot{P}_{2}+\tilde{{{\boldsymbol{{z}}}}}_{0}^{T}\dot{\tilde{{{\boldsymbol{{z}}}}}}_{0}+\sum _{k=1}^{N}\dot{\tilde{{{\boldsymbol{{z}}}}}}_{k}^{T}\ddot{\tilde{{{\boldsymbol{{z}}}}}}_{k}+\sum _{k=1}^{N}k^{2}\omega ^{2}\tilde{{{\boldsymbol{{z}}}}}_{k}^{T}\dot{\tilde{{{\boldsymbol{{z}}}}}}_{k}=\dot{V}_{{H}} .\end{align}
According to Eqs. (63) and (64), we get
$\dot{V}_{{H}}\leq -\gamma \left\| \boldsymbol{{z}}\right\| ^{2}$
, and its continuous semi-positive definite on the domain of attraction
$\boldsymbol{{D}}$
, according to the stability condition Eq. (48), we get the domain of attraction
$\boldsymbol{{S}}_{2}\subset \boldsymbol{{D}}$
as
\begin{equation} \boldsymbol{{S}}_{2}=\left\{\boldsymbol{{y}}_{2}\in \boldsymbol{{D}}|\lambda _{22}\left\| \boldsymbol{{y}}_{2}\right\| ^{2}\lt \lambda _{22}\left[\rho ^{-1}\left(2\sqrt{\lambda _{3}k_{n}}\right)\right]\right\} .\end{equation}
Based on the invariance-like theorem,
$\forall \boldsymbol{{y}}_{2}\!\left(0\right)\in \boldsymbol{{S}}_{2}$
. When
$t\rightarrow \infty, \boldsymbol{{e}}(t), \boldsymbol{{e}}_{\mathrm{f}}(t), \boldsymbol{{v}}(t), \boldsymbol{\eta }(t),\dot{\boldsymbol{{e}}}(t)\rightarrow 0$
. Proof complete.
