A Hybrid State/Disturbance Observer-Based Feedback Control of Robot with Multiple Constraints

Abstract

Controlling the manipulator is a big challenge due to its hysteresis, deadzone, saturation, and the disturbances of actuators. This study proposes a hybrid state/disturbance observer-based multiple-constraint control mechanism to address this difficulty. It first proposes a hybrid state/disturbance observer to simultaneously estimate the unmeasurable states and external disturbances. Based on this, a barrier Lyapunov function is proposed and implemented to handle output saturation constraints, and a back-stepping control method is developed to provide sufficient control performance under multiple constraints. Furthermore, the stability of the proposed controller is analyzed and proved. Finally, simulations and experiments are carried out on a 2-DOF and 6-DOF robot, respectively. The results show that the proposed control method can effectively achieve the desired control performance. Compared with several commonly used control methods and intelligent control methods, the proposed method shows superiority. Experiments on a 6-DOF robot verify that the proposed method has good tracking performance for all joints and does not violate constraints.

1. Introduction

Robots have been widely used on many occasions and have worked in single-task environments and in complex tasks [1]. For example, the manipulator needs to not only grasp, carry, and stack, but also to cooperate with other machines to finish complex operations. This manipulator usually has strongly nonlinear features, such as hysteresis, input deadzone, output saturation, and a nonlinear load, as well as many unmeasurable physical states and disturbances, including friction, clearance, noise, etc. Ignoring these constraints may lead to an undesirable performance, such as a high steady-state error, poor transient response, and large overshoot [2]. In addition, a violation of constraints during operation may result in performance degradation, hazards, or system damage. Therefore, it is necessary to consider the input and output constraints of the robot system at the same time.

Many control methods have been designed for the input deadzone control, and most of this research is based on the deadzone function with assumed parameters. In general, the parameter of a deadzone function is difficult to obtain, which leads to common controllers is difficult to implement. There has been several studies conducted which aim to solve the problem of nonlinear systems with input deadzone [3]. For example, Wang et al. proposed a control method for a special nonlinear system with symmetrical deadzone [4] in which the parameters of deadzone function are unknown and the neural network is used to solve the deadzone effect. In paper [5], an adaptive neural network controller was proposed for single-master–multiple-slaves teleoperation with consideration to time delays and input deadzone uncertainties. Wu et al. [6] proposed a study on the observer-based controller for nonlinear systems with unmodeled dynamics and actuator deadzone. Tong et al. [7] employed neural networks to approximate the unknown nonlinear uncertainties. Hu et al. [8] presented an integrated direct/indirect adaptive robust control mehtod for a class of nonlinear systems, preceded by unknown nonsymmetric, nonequal slope deadzone nonlinearity. Sang et al. [9] presented a new adaptive iterative learning control approach with deadzone to address the problem of bounded noise. Wang et al. [10] proposed a nonlinear controller to overcome deadzone nonlinearities, which are unavoidable in many physical systems due to the imperfections of system components. The proposed control employs an ideal linear model of the system and a model controller to generate an ideal reference output. Although these methods have obtained many successful applications, they are basically designed for one or two kinds of nonlinearity and they do not consider controller design problems in the case of multiple nonlinear constraints. In addition, these methods require all physical states to be measurable and consider less external uncertainty, leading to poor control performance on many occasions.

To handle output saturation constraints, many techniques have been developed [11,12]. Yan et al. [13] introduced a nonlinear smooth function to tackle the saturation input nonlinearity, with a disturbance observer compensating for the unknown time-varying disturbances. In [14], an adaptive fuzzy output-feedback control was developed for a class of output-constrained and uncertain nonlinear systems with input saturation and unmeasured states using a log-type BLF and an auxiliary system incorporating the virtual control variable. Bu et al. [15] proposed a novel DDC algorithm, constructed using saturated output data, and output saturation causes the convergence rate of DDC systems to slow down. Xing et al. [16] proposed an observer-based adaptive control for uncertain nonlinear systems with input saturation and output constraints. Han et al. [17] proposed a dynamic parallel distributed compensator to design a dynamic output-feedback controller to ensure the finite time boundary and dissipate the singular uncertain time-varying-delay fuzzy systems, subject to actuator saturation and output constraints.

In recent years, the potential barrier Lyapunov function has attracted more and more attention and has become an effective tool for the control design of constrained nonlinear uncertain systems. The control law is derived directly from Lyapunov stability analysis. It has been successfully applied in the tracking control of a robotic manipulator [18] and in handling the full-state constraint control of a nonlinear system [19]. Thus, there are many types of BLF that have been proposed to cope with constraints, such as the log-type BLF [19], integral-type BLF [20], and tan-type barrier Lyapunov function (BLF) [19]. However, at the beginning of control, BLF-based controllers usually require specified time-varying constraints to achieve effective and stable control [18]. In addition, when the constraint variable is infinitely close to the predefined boundary, in order to meet the constraint conditions, the output of the BLF-based controller tends to be infinite, which leads to the paradox of output saturation. Therefore, in order to deal with constraints, BLF-based controllers should meet feasibility conditions [21], that is, the constraint variables should always be kept within the predefined boundaries. Parameters should also be designed appropriately because if the constraint is too small, it may be impractical. A lot of research has been conducted in [21,22] to eliminate strict feasibility conditions. In these works, the time derivative of the universal barrier function is regarded as an auxiliary system, and then incorporated into the control system [23].

On the basis of previous research, an adaptive output-feedback control method for manipulator systems with multiple constraints has been developed. A hybrid-state observer has been designed to estimate unmeasured states and disturbances in order to overcome the output constraint and input deadzone. An adaptive controller has been developed by combining back-stepping and BLF technology. It was proved that the proposed control method can ensure that all signals in the closed-loop system are bounded, simultaneously avoiding input and output constraints. The main contributions of the proposed control scheme are as follows: (i) the input deadzone and output constraints are solved using a BLF and auxiliary observer, respectively; (ii) the unmeasured state and disturbance are estimated by designing a hybrid state observer; and (iii) the designed system has a closed loop and stability.

2. Problem Description

The dynamic of a robot can be described as follows,

$$M(q)\ddot{q}+C(q,\dot{q})\dot{q}+G(q)=\tau +{\tau }_d$$

(1)

where $q\in R^n$ is the vector of joint displacements, $\tau \in R^n$ is the vector of joint torques supplied by the actuators, $M(q)\in R^n$ is the inertia matrix, $C(q,\dot{q})\in R^n$ is the Coriolis and centrifugal matrix, and $G(q)\in R^n$ is the gravitational force. ${\tau }_d$ is the uncertainty, including unmodeled dynamics and external disturbances. The inertia matrix $M(q)$ is symmetric and positive definite, and the matrix $\dot{M}-2C(q,\dot{q})$ is skew-symmetric.

Considering parameter uncertainty, we define the accurate dynamic parameters are

$$\begin{array}{l}M(q)=M(q)+\Delta M(q)\\ C(q,\dot{q})=C(q,\dot{q})+\Delta C(q,\dot{q})\\ G(q)=G(q)+\Delta G(q)\end{array}$$

(2)

where $M(q)$, $C(q,\dot{q})$ and $G(q)$ are the nominal parameter of the manipulator, and $\Delta M(q)$, $\Delta C(q,\dot{q})$, and $\Delta G(q)$ are the parameter uncertainty. The total unknown disturbance is defined as

$$d={\tau }_d-\Delta M(q)\ddot{q}-\Delta C(q,\dot{q})\dot{q}-\Delta G(q)$$

(3)

Usually, the disturbance d is bounded and continuous and satisfies $\left|{\dot{d}}_i\right|\le d_{iM},i=1,2,3$, where $d_{iM}$ is the positive constant.

Then, the model of the manipulator can be rewritten as:

$$M(q)\ddot{q}+C(q,\dot{q})\dot{q}+G(q)=\tau +d$$

(4)

Letting $x_1=q$, $x_2=\dot{q}$, $x_3={\dot{x}}_2=\ddot{q}$, the model (4) may be rewritten as:

$$\{\begin{array}{l}y=x_1\\ x_2={\dot{x}}_1\\ x_3=M^{-1}(q)\left[u(\tau )-G(q)-C(q,\dot{q})\dot{q}\right]+M^{-1}(q)d\end{array}$$

(5)

Letting the desirable trajectory be $x_d(t)$, the actual output trajectory $x(t)$ is

$$\begin{array}{l}{x}_d(t)={[x_{d1}(t),x_{d2}(t),\cdot \cdot \cdot ,x_{dn}(t)]}^T\\ x(t)={[x_1(t),x_2(t),\cdots ,x_n(t)]}^T\end{array}$$

(6)

All the signals are bounded and we have $-k_{c1}\le x(t)\le k_{c1}$, where $k_{c1}=[k_{c11},k_{c11},\cdot \cdot \cdot ,k_{c11}{]}^T$ is a positive constant vector. In this model, the position of the manipulator can be measured, but the joint speed and acceleration cannot be measured directly. To achieve accurate control of this manipulator, it is necessary to estimate these unknown states.

For the manipulator, the actual inputs and outputs have various types of nonlinear constraints, such as output saturation, input deadzone, and hysteresis. $S=[S_1\cdots S_n]$ is the torque vector of the motor, and its output saturation may be represented as [24]:

$$S\left(\tau \right)=\{\begin{array}{l}u\left({\tau }_{i\max }\right)\hspace{1em}\mathrm{if} {\tau }_i>{\tau }_{i\max }\\ g_{rk}\left({\tau }_k\right)\hspace{1em} \mathrm{if} 0\le {\tau }_k\le {\tau }_{i\max }\\ g_{lk}\left({\tau }_i\right)\hspace{1em}\hspace{1em}\mathrm{if} -{\tau }_{k\min }\le {\tau }_i\le 0\\ u\left(-{\tau }_{i\min }\right) \mathrm{if} {\tau }_i\le -{\tau }_{i\min }\end{array}$$

(7)

where $u\left({\tau }_i\right)\max$ and $u\left({\tau }_i\right)\min$ are the maximum and minimum of the input signals, respectively, and $g_{lk}$ and $g_{rk}$ are the nonlinear smooth continuous functions.

The input deadzone of the joint actuator may be represented as [25]:

$$U({\tau }_i)=\{\begin{array}{l}{D}_r({\tau }_i-b_r),{\tau }_i\ge b_r\\ 0,\hspace{1em}\hspace{1em}\hspace{1em} b_l<{\tau }_i<b_r\\ D_l(b_l-{\tau }_i),{\tau }_i\le b_l\end{array},i=1,2,\cdots ,n$$

(8)

where ${\tau }_i$ is the input, $b_l$ and $b_r$ are the boundaries, and $D_r\left(\tau \right)$ and $D_l$ are the deadzone function.

The hysteresis nonlinearity may be represented as [26]:

$$\frac{d{\varphi }_i({\tau }_i)}{dt}=h_{ai}|\frac{d{\tau }_i}{dt}|\left[h_{ai}{\tau }_i-{\varphi }_i({\tau }_i)\right]+h_{bi}\frac{d{\tau }_i}{dt}$$

(9)

$\varphi (\tau )=H_a{\tau }_i+H_{b}d({\tau }_i),i=1,2,\cdots ,n$

here

$$\begin{array}{l}{H}_a=diag\{h_{a1},\cdots ,h_{an}\}>0,\\ H_b=diag\{h_{b1},\cdots ,h_{bn}\}>0,\\ d(\tau )={[d_1({\tau }_1),d_2({\tau }_3),\cdots ,d_n({\tau }_n)]}^T\le d^{*}\end{array}$$

(10)

Obviously, this manipulator exists with unknown dynamics and an external disturbance. Moreover, some states cannot be measured directly, and many nonlinear constraints exist. Collecting all of this together, it is difficult to achieve accurate control of this manipulator.

3. Design of Controller

In order to achieve accurate control of the manipulator with multiple constraints, disturbances, and some unmeasurable states, a hybrid state/disturbance observer-based multiple-constraint control method is developed here. A hybrid state/disturbance observer is proposed to simultaneously estimate unmeasurable states and external disturbances. On this basis, a multiple-constraint control strategy is developed to achieve satisfactory control performance under multiple constraints. Moreover, the stability of the developed controller is analyzed and proved.

3.1. Hybrid State/Disturbance Observer

For the manipulator system (5), only the output state $x_1$ can be measured, while the other state $x_2,x_3$ cannot be measured directly. To obtain the states and unknown disturbance of the manipulator system, a hybrid state/disturbance observer system is designed as follows:

$$\begin{array}{l}{\dot{\widehat{x}}}_1=l_1{\left|{\widehat{x}}_1-y\right|}^{\frac{2}{3}}\mathrm{sgn}({\widehat{x}}_1-y)+{\widehat{x}}_2-{\widehat{d}}_1\\ {\dot{\widehat{x}}}_2=l_2{\left|{\widehat{x}}_2-{\dot{x}}_1\right|}^{\frac{1}{2}}\mathrm{sgn}({\widehat{x}}_2-{\dot{x}}_1)+{\widehat{x}}_3-{\widehat{d}}_2\\ {\dot{\widehat{x}}}_3=l_3\mathrm{sgn}({\widehat{x}}_3-{\dot{x}}_2)-{\widehat{d}}_3\end{array}$$

(11)

where ${\widehat{x}}_i$ is the estimation of $x_i$ and ${\widehat{d}}_i$ is the estimation of disturbance $d_i$.

(a)

Solving the hybrid observer

In order to find the solution of this hybrid observer, a two-step solving algorithm is developed: (1) robustly estimate the states under the given disturbance, roughly estimated according to expert experience or experiment; and (2) estimate the disturbance under the given states.

Usually, the initial disturbance can be roughly estimated according to expert experience or experiment, set as ${\widehat{d}}_1$.

Moreover, the disturbance is often bounded and has ${\tilde{d}}_1=\left|d_1-{\widehat{d}}_1\right|\le \xi$, in which $\xi$ is the estimation error of the disturbance $d_i$.

When the parameters $l_i$ and the symmetric and positive definite matrices $P$ and $Q$ are properly chosen, the following inequality can be satisfied:

$$A^{T}P+PA\le -Q,A=\left(\begin{array}{ccc}-l_1& & \\ ⋮& I_{i-1}& \\ -l_i& \cdots & 0\end{array}\right),i=1,2,3$$

(12)

According to (3), $\left|{\dot{d}}_i\right|\le d_{iM}$ and the following inequality will be held in finite time,

$$\begin{array}{l}\left|{\widehat{x}}_{i+1}-x_{i+1}\right|\\ =\left|l_i{\left|{\widehat{x}}_i-{\dot{x}}_{i-1}\right|}^{\frac{3-i}{3-i+1}}\mathrm{sgn}({\widehat{x}}_i-{\dot{x}}_{i-1})+{\widehat{x}}_{i+1}-{\widehat{d}}_i-x_{i+1}\right|\\ \le \left|l_i{\left|{\widehat{x}}_i-{\dot{x}}_{i-1}\right|}^{\frac{3-i}{3-i+1}}\mathrm{sgn}({\widehat{x}}_i-{\dot{x}}_{i-1})-{\widehat{d}}_i+\epsilon \right|\\ \le \left|l_i{\left|{\widehat{x}}_i-{\dot{x}}_{i-1}\right|}^{\frac{3-i}{3-i+1}}\epsilon +\epsilon \right|+\left|{\widehat{d}}_i\right|\\ \le \left|l_i{\left|{\widehat{x}}_i-{\dot{x}}_{i-1}\right|}^{\frac{3-i}{3-i+1}}\epsilon +\epsilon \right|+d_{iM},i=2,3\end{array}$$

(13)

According to the inequality (13), in the presence of a bounded noise, the state error of the system is bounded.

In order to accurately estimate the disturbance, the following linear disturbance model [27] is used,

$$\{\begin{array}{l}\dot{W}=SW+E{\mathrm{d}}^{(r)}\\ \mathrm{d}=LW\end{array}$$

(14)

where ${\mathrm{d}}^{(r)}$ denotes the $r^{th}$ derivatives of $\mathrm{d}$ and $S\in R^{2r\times 2r}$. The matrices $S$, $E$, and $L$ have the following forms.

$$S=\left[\begin{array}{cc}{O}_{(2r-2)\times 2}& I_{2r-2}\\ O_{2\times 2}& O_{2\times (2r-2)}\end{array}\right]E=\left[\begin{array}{c}{O}_{(2r-2)\times 2}\\ I_2\end{array}\right]L=\left[\begin{array}{cc}{I}_2& O_{2\times (2r-2)}\end{array}\right]$$

(15)

Combining (5) and (14), an extended system is obtained as,

$$\{\begin{array}{l}{\dot{x}}_2=f+LW\\ \dot{W}=SW+E{d}^{(r)}\end{array}$$

(16)

where $f=M_0{}^{-1}(q)\left[\tau -G_0(q)-C_0(q,\dot{q})\dot{q}\right]$. An auxiliary variable is introduced as follows:

$$O=\left[\begin{array}{c}{O}_1\\ O_2\end{array}\right]=\left[\begin{array}{c}{x}_2\\ p(x_2)+W\end{array}\right]$$

(17)

where $p(s)=s^r+q_1{s}^{r-1}+\cdots +q_{r-1}s+q_r=0$ is a polynomial vector, which is designed as shown in [25].

By differentiating Equation (17), and with consideration of Equations (10), (15) and (17), one has

$$\dot{O}=\left[\begin{array}{c}{\dot{O}}_1\\ {\dot{O}}_2\end{array}\right]=\left[\begin{array}{c}f+L(O_2+P(O_1))\\ (S-\frac{\partial P(O_1)}{\partial O_1}L)O_2+(SP(O_1)-\frac{\partial P(O_1)}{\partial O_1}(f+LP(O_1))+E{\mathrm{d}}^{(r)}\end{array}\right]$$

(18)

From (18) and (14), the disturbance observer is designed as

$$\{\begin{array}{l}{\dot{\widehat{O}}}_2=(S-(\partial P(O_1)/\partial O_1)L)O_2+(SP(O_1)-(\partial P(O_1)/\partial O_1)(f+LP(O_1))\\ \widehat{\mathrm{W}}={\widehat{O}}_2{+\mathrm{P}(\mathrm{O}}_1)\\ \widehat{d}=L\widehat{W}\end{array}$$

(19)

where $f=M^{-1}(q)\left[\tau -G(q)-C(q,\dot{q})\dot{q}\right]$.

According to (19), it is easy to obtain the disturbance. Obviously, when the initial estimation of the disturbance is accurate, using (12) and (13), it is easy to obtain the states, upon which it can effectively estimate the disturbance using (19). When the initial estimation of the disturbance is inaccurate, it uses an iterative process to obtain the states and disturbance:

Step (1): first, robustly estimate the states under the initial disturbance, which is roughly estimated according to expert experience or experiment;

Step (2): then, estimate the disturbance under the given states;

Step (3): use the estimated disturbance to replace the initial disturbance and repeat step (1), (2), and (3) until the satisfactory states and the disturbance is obtained.

(b)

Performance analysis of the hybrid observer

The estimation errors are defined as

$${\tilde{x}}_1={\widehat{x}}_1-y,{\tilde{x}}_2={\widehat{x}}_2-{\dot{x}}_1,{\tilde{x}}_3={\widehat{x}}_3-{\dot{x}}_2,\tilde{d}=\widehat{d}-d$$

(20)

According to Equation (20), the disturbance error $\tilde{d}$ may be represented as

$$\tilde{d}=\widehat{d}-d=L(W-\widehat{W})$$

(21)

From (21), one has

$$\begin{array}{l}\dot{\tilde{d}}=\widehat{d}-d=L(\dot{W}-\dot{\widehat{W}})=SW+E{d}^{(r)}-(S-\frac{\partial P(O_1)}{\partial O_1}L)O_2\\ -(SP(O_1)-\frac{\partial P(O_1)}{\partial O_1}(f+LP(O_1))-\dot{P}(O_1)\\ \hspace{1em}=(S-\frac{\partial P(O_1)}{\partial O_1}L)e+E{d}^{(r)}\end{array}$$

(22)

According to (10), (11), (13), and (22), the error system of the hybrid observer is the following,

$$\begin{array}{l}\dot{\tilde{x}}=A\tilde{x}+f+\tilde{d},\tilde{y}={\tilde{x}}_1\\ f=M^{-1}(q)\left[\tau -G(q)-C(q,\dot{q})\dot{q}\right]\end{array}$$

(23)

where $\tilde{x}={[\begin{array}{ccc}{\tilde{x}}_1& {\tilde{x}}_2& {\tilde{x}}_3\end{array}]}^T$, $\tilde{d}={[\begin{array}{ccc}{\tilde{d}}_1& {\tilde{d}}_2& {\tilde{d}}_3\end{array}]}^T=L(W-\widehat{W})$.

From (11) and (23), one has

$$\begin{array}{l}{\dot{\tilde{x}}}_1=l_1{\left|{\tilde{x}}_1\right|}^{\frac{2}{3}}sign({\tilde{x}}_1)+{\tilde{x}}_2-{\widehat{d}}_1\\ {\dot{\tilde{x}}}_2=l_2{\left|{\tilde{x}}_2\right|}^{\frac{1}{2}}sign({\tilde{x}}_2)+{\tilde{x}}_3-{\widehat{d}}_2\\ {\dot{\tilde{x}}}_3=l_{3}sign({\tilde{x}}_3)-{\widehat{d}}_3\\ \tilde{d}=Asign({\tilde{x}}_{i+1}-{\tilde{\dot{x}}}_i)+M^{-1}(q)\left[\tau -G(q)-C(q,\dot{q})\dot{q}\right]-\widehat{d} \end{array}$$

(24)

Theorem 1. 

Using the designed hybrid observer (11) and the three-step solving algorithm, the state estimation error$\tilde{x}$and the disturbance estimation error$\tilde{d}$converge to the expected value in finite time, which ensures that$\tilde{x}$and$\tilde{d}$are bounded, guaranteeing$x_i(i=1,2,3)$will not escape to infinity before the finite time convergence of the hybrid observer error. As such, it can effectively estimate the states and disturbance.

Proof. 

See Appendix A. □

3.2. Design of Feedback Controller

In order to achieve the well-tracking performance of the manipulator under multiple constraints, a multiple-constraint control strategy with consideration of the integrated barrier Lyapunov function method and the back-stepping algorithm is developed here, as shown in Figure 1. The tracking error is defined as $e={[e_1,\cdots ,e_n]}^T=x_1-x_d=\left[x_{11}-x_{d1},\cdots ,x_{1n}-x_{dn}\right]$, where $x_1=\left[x_{11},x_{12},\cdot \cdot \cdot ,x_{1n}\right]$ is the actual trajectory and $x_d$ is the desired trajectory. The back-stepping algorithm defines

$$z={[z_1,\cdots ,z_n]}^T=x_2-\alpha$$

(25)

where $\alpha$ denotes the virtual control variable.

The derivative of (25) is

$$\dot{z}={\dot{x}}_2-\dot{\alpha }$$

(26)

$x_0$ is a small positive constant, which satisfies

$$\{\begin{array}{l}\left|x_{1i}\right|\le k_{c1i}\le k_{ai},i=1,2,\cdot \cdot \cdot ,n\\ \left|x_{di}\right|\le k_{c1i}\le k_{ai},i=1,2,\cdot \cdot \cdot ,n\end{array}$$

(27)

where $k_{ai}=k_{c1i}+x_0$.

The following two-step strategy is developed to design the controller.

Step 1: For the multi-link manipulator, construct the following Lyapunov function,

$$V_1={\displaystyle \sum _{i=1}^n{\displaystyle {\int }_0^{e_i}\frac{\sigma k_{ai}^2}{k_{ai}^2-{(\sigma +x_{di})}^2}d\sigma }}$$

(28)

where $\sigma$ is a modification value.

Differentiating (28) yields

$${\dot{V}}_1={\displaystyle \sum _{i=1}^n\frac{k_{ai}^2({\widehat{z}}_i+{\alpha }_i)}{k_{ai}^2-x_{1i}^2}}-{\displaystyle \sum _{i=1}^n{e}_i{\rho }_i}{\dot{x}}_{di}$$

(29)

here,

$$\begin{array}{l}{\rho }_i(e_{1i},x_{di})={\displaystyle {\int }_0^1\frac{k_{ai}^2}{k_{ai}^2-{(\beta e_i+x_{di})}^2}}d\beta \\ =\frac{k_{ai}}{2e_{1i}}\ln \frac{(k_{ai}+e_i+x_{di})(k_{ai}-x_{di})}{(k_{ai}-e_i-x_{di})(k_{ai}+x_{di})}\end{array}$$

(30)

${\rho }_i(e_{1i},x_{di})$ is well defined and bounded around the neighborhood of $e_{1i}=0$.

Using L’Hopital’s rule, one has

$$\begin{array}{l}\underset{e_{1i}\to 0}{\lim }{\rho }_i(e_{1i},x_{di})=\underset{e_{1i}\to 0}{\lim }\frac{k_{ai}}{2e_{1i}}\ln \frac{(k_{ai}+e_i+x_{di})(k_{ai}-x_{di})}{(k_{ai}-e_i-x_{di})(k_{ai}+x_{di})}\\ =\frac{k_{ai}^2}{k_{ai}^2-x_{di}^2}\end{array}$$

(31)

Design virtual control variable ${\alpha }_i$ as follows,

$${\alpha }_i=(-k_{1i}{e}_{1i}+\frac{(k_{ai}^2-x_{1i}^2){\dot{x}}_{di}{\rho }_i}{k_{ai}^2}),i=1,2,\cdots ,n$$

(32)

where $k_{ai}$ is the positive control gain.

Combining (29) with (30), one has

$${\dot{V}}_1=-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_{1i}^2}{k_{ai}^2-x_{1i}^2}}+{\displaystyle \sum _{i=1}^n\frac{k_{ai}^2{e}_{1i}{\widehat{z}}_i}{k_{ai}^2-x_{1i}^2}}$$

(33)

Step 2: Establish the second Lyapunov function as follows

$$V_2=V_1+\frac{1}{2}{z}_{}^{T}M(x_1)z$$

(34)

Differentiating $V_2$ yields,

$${\dot{V}}_2={\dot{V}}_1+z_{}^{T}M(x_1)\dot{z}+z_{}^T\frac{1}{2}\dot{M}(x_1)\dot{z}$$

(35)

Substituting (5) and (25) into (35), we have

$$\begin{array}{l}{\dot{V}}_2={\dot{V}}_1+z_{}^T\left[M(x_1)({\dot{x}}_2-\dot{\alpha })+\frac{1}{2}\dot{M}(x_1)\dot{\widehat{z}}\right]\\ ={\dot{V}}_1+z_{}^T[\tau -d-C(x_1,x_2)\alpha +G(x_1)-M(x_1)\dot{\alpha })\\ \hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em}\hspace{1em} +\frac{1}{2}(\dot{M}(x_1)-2C(x_1,x_2))e_2]\end{array}$$

(36)

Substituting (32) and (34) into (35) and (36) is simplified as

$$\begin{array}{l}{\dot{V}}_2=-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}+{\displaystyle \sum _{i=1}^n\frac{k_{ai}^2{e}_i{z}_i}{k_{ai}^2-x_{1i}^2}}\\ +z^T\left[\tau -G(x_1)+C(x_1,x_2)\alpha +M(x_1)\dot{\alpha }-\widehat{d}\right]\end{array}$$

(37)

In order to make ${\dot{V}}_2<0$, considering the hysteresis (9) and input saturation (7), the torque control law is designed as follows,

$$\tau =-{\displaystyle \sum _{i=1}^n\frac{k_{ai}^2{e}_i{z}_i}{k_{ai}^2-x_{1i}^2}}-Kz+G(x_1)+C(x_1,x_2)\alpha +M(x_1)\dot{\alpha }+\widehat{d}$$

(38)

where $K=diag(k_1,k_2)$ is a positive gain matrix, and it must satisfy

$$\min \left\{2{\lambda }_{\min }(K)/{\lambda }_{\max }(M(x_1))\right\}>0$$

(39)

where ${\lambda }_{\min }(•)$ and ${\lambda }_{\max }(•)$ denotes the maximum and minimum eigenvalue of $(•)$.

Then, considering the input deadzone, and by combining the input constraint (8) and the control law (39), the final control law is designed as follows,

$$\begin{array}{l}u(\tau )=-Kz-{\displaystyle \sum _{i=1}^n\frac{k_{ai}^2{e}_i{z}_i}{k_{ai}^2-x_{1i}^2}}\\ \hspace{1em}\hspace{1em}\hspace{1em}+H_a^{}\left[G_0(x_1)+C_0(x_1,x_2){\alpha }_1+M_0(x_1){\dot{\alpha }}_1\right]+H_b^{}\widehat{d}\end{array}$$

(40)

Therefore, the control law can deal with all constraints, including hysteresis, output saturation, and input deadzone.

Theorem 2. 

Considering the manipulator system (5) with an unknown disturbance, input deadzone, and output saturation, and given feedback control laws (38) and (40), the closed-loop system is semi-globally stable.

Proof. 

Substituting (38) into (37) yields

$${\dot{V}}_2=-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}-z^{T}K\widehat{z}$$

(41)

Define $\widehat{z}=\tilde{z}+z$ and substitute it into (41)

$${\dot{V}}_2=-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}-z^{T}Kz-z^{T}K\tilde{z}$$

(42)

While

$$\begin{array}{l}-z^{T}K\tilde{z}\le \frac{1}{2}{z}^T\tilde{z}+\frac{1}{2}{\left(K\tilde{z}\right)}^T\left(K\tilde{z}\right)\\ -z^T\tilde{z}\le \frac{1}{2}{z}^T\tilde{z}+\frac{1}{2}{\tilde{z}}^T\tilde{z}\end{array}$$

(43)

From (42) and (43), one has

$$\begin{array}{l}{\dot{V}}_2=-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}-z^{T}Kz-z^T\tilde{z}-z^{T}K\tilde{z}\\ \hspace{1em} \le -{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}+\frac{1}{2}{z}^T\tilde{z}+\frac{1}{2}{\left(K\tilde{z}\right)}^T\left(K\tilde{z}\right)-\frac{1}{2}{z}^T\tilde{z}+\frac{1}{2}{\tilde{z}}^T\tilde{z}\\ \hspace{1em} =-{\displaystyle \sum _{i=1}^n\frac{k_{1i}{k}_{ai}^2{e}_i^2}{k_{ai}^2-x_{1i}^2}}-z^{T}Kz\le -V_2\rho \end{array}$$

(44)

Because

$$\rho =\min \left\{{\min }_{a\le i\le n}(k_i)\right\}=\min \left\{2{\lambda }_{\min }(k_2)/{\lambda }_{\max }(M)\right\}>0.$$

(45)

one has ${\dot{V}}_2<0$ according to (44) and (45). This indicates that the system tends to be stable in a small spectrum. □

4. Case Studies and Experiment

In this section, we simulated the proposed algorithm and validated the proposed control algorithm on a robot platform consisting of a six-degree-of-freedom (DOF) robot (JAKA ZU-7s), DC power, and an embedded DSP control system, as depicted in Figure 1. We carried out the simulation and experiment on a 2-DOF and 6-DOF robot platform, respectively. The dynamic model of the 2-DOF robot and its parameters are shown in Equation (46) and

Table 1. Parameters of 2-DOF robot.

Parameters	Value	Parameters	Value
$m_1$	1.950 kg	$l_1$	303.5 mm
$m_2$	1.835 kg	$l_2$	208 mm

. The parameters of the 6-DOF robot are shown in

Table 2. D-H Parameters of 6-DOF JAKA robot.

Link i	${\mathit{a}}_{\mathit{i}\mathbf{-}\mathbf{1}} \mathbf{\left(}\mathbf{mm}\mathbf{\right)}$	${\mathit{\alpha }}_{\mathit{i}\mathbf{-}\mathbf{1}} \mathbf{(}\mathbf{°}\mathbf{)}$	${\mathit{d}}_{\mathit{i}} \mathbf{\left(}\mathbf{mm}\mathbf{\right)}$	${\mathit{q}}_{\mathit{i}}$
1	0	0	143.4	$q_1$
2	0	90.0	0	$q_2$
3	360.0	0	0	$q_3$
4	303.5	0	−115.0	$q_4$
5	0	90.0	113.5	$q_5$
6	0	−90.0	107.0	$q_6$

. The accurate dynamic model of the 6-DOF robot was obtained by parameter identification.

For the 2-DOF manipulator, the inertia matrix $M(q)$, the Coriolis and centrifugal matrix $C(q,\dot{q})$, and the gravity matrix $G(q)$ are as follows

$$\begin{array}{l}M(q)=\left[\begin{array}{l}{M}_{11}{M}_{12}\\ M_{21}{M}_{22}\end{array}\right],M_{11}=m_1{l}_1^2+m_1(l_1^2+l_2^2+2l_1{l}_2{\cos (q}_2\left)\right)\\ M_{12}{=m}_2(l_2^2+l_1{l}_2{\cos (q}_2)),M_{21}{=m}_2(l_2^2+l_1{l}_2{\cos (q}_2)) ,M_{22}{=m}_2{l}_2^2\\ C(q,\dot{q})=\left[\begin{array}{l}{-m}_2{l}_1{l}_2^{}{\dot{q}}_2{\sin (q}_2{) -m}_2{l}_1{l}_2^{}{(\dot{q}}_1+{\dot{q}}_2{\left)\sin \right(q}_2)\\ {-m}_2{l}_1{l}_2^{}{\dot{q}}_1{\sin (q}_2) 0\end{array}\right]\\ G(q)=\left[\begin{array}{l}(m_1{l}_2+m_2{l}_1)g\cos (q_1)+m_2{l}_2{\mathrm{gcos}(q}_1{+q}_2)\\ m_2{l}_2{\mathrm{gcos}(q}_1{+q}_2)\end{array}\right]\end{array}$$

(46)

The initial position is $q_0=\left[0 , 0\right]$ and ${\dot{q}}_0=\left[0 , 0\right]$. The unknown dynamics and external disturbance are defined as follows:

(1)

Unknown unmodeled dynamics

$$\begin{array}{l}\Delta M(q)=0.2M(q)\\ \Delta C(q,\dot{q})=0.2C(q,\dot{q})\\ \Delta G(q)=0.2G(q)\end{array}$$

(47)

(2)

Unknown external disturbance term

$${\tau }_{\mathrm{d}}=\left[\begin{array}{l}10(1-\exp (-0.28\cdot \mathrm{t}\left)\right)\left(\sin \right(0.5\cdot \mathrm{pi}\cdot \mathrm{t}\left)\right) \\ 10(1-\exp (-0.28\cdot \mathrm{t}\left)\right)\left(\cos \right(0.5\cdot \mathrm{pi}\cdot \mathrm{t}\left)\right)\end{array}\right]$$

(48)

Thus, the total disturbance is shown below,

$$d={\tau }_d-\Delta M(q)\ddot{q}-\Delta C(q,\dot{q})\dot{q}-\Delta G(q)$$

(49)

The input dead time and the output saturation are described as follows: $b_r=2.5$, $b_l=-4.5$, respectively, with

$$U({\tau }_i)=\{\begin{array}{c}{D}_r(\tau )=2(\tau -b_r)(\sin (\tau )+1)\\ D_l(\tau )={(\tau -b_l)}^3\end{array}$$

(50)

4.1. Control Performance

The desired trajectory and its velocity and acceleration are given as follows

$$\begin{array}{l}\left[\begin{array}{c}q3\\ q4\end{array}\right]=\left[\begin{array}{l}\sin (0.5t)+2\cdot \cos (t)\\ 2\cdot \cos (0.5t)\end{array}\right]\\ \left[\begin{array}{c}dq3\\ dq4\end{array}\right]=\left[\begin{array}{l}0.5\cos (0.5t)-2\sin (t)\\ -\sin (0.5t)\end{array}\right]\\ \left[\begin{array}{c}ddq3\\ ddq4\end{array}\right]=\left[\begin{array}{l}-0.25\sin (0.5t)-2\cdot \cos (t)\\ -\sin (0.5t)\end{array}\right]\end{array}$$

(51)

Then, the proposed control method is used to control this manipulator with input nonlinearity, output saturation, and external disturbance states to track the reference trajectory.

The hybrid state/disturbance observer is the following,

$$\begin{array}{l}{\dot{\widehat{x}}}_1=-l_1{\left|{\widehat{x}}_1-y\right|}^{\frac{2}{3}}\mathrm{sgn}({\widehat{x}}_1-y)+{\widehat{x}}_2\cdot v_1+d_1\\ {\dot{\widehat{x}}}_2=-l_3{\left|{\widehat{x}}_1-y\right|}^{\frac{1}{2}}\mathrm{sgn}({\widehat{x}}_2-{\dot{x}}_1)+d_2\\ {\dot{\widehat{x}}}_3=-l_3\mathrm{sgn}({\widehat{x}}_3-{\dot{x}}_2)+d_3\end{array}$$

(52)

where $l_1=10$, $l_2=15$, and $l_3=15$. The initial disturbance is set as $d_1=0$, and the parameters of the disturbance observer are decided as follows

$$\begin{array}{l}\begin{array}{ccc}S=\left[\begin{array}{cc}{O}_2& I_2\\ O_2& O_2\end{array}\right]& E=\left[\begin{array}{c}{O}_2\\ I_2\end{array}\right]& L=\left[\begin{array}{cc}{I}_2& O_2\end{array}\right]\end{array}\\ \begin{array}{ccc}l=\left[\begin{array}{c}40\\ 0\\ 400\\ 0\end{array} \begin{array}{c}0\\ 40\\ 0\\ 400\end{array}\right]& p=\left[\begin{array}{c}40x_2\\ 400x_2\end{array} \right]& \end{array}\end{array}$$

(53)

The control gains are decided as $k_{a1}=k_{a2}=100$ and $K=diag[k_1,k_2]=diag\left[5,5\right]$.

Using the designed observer, the estimated state $x_2$, $x_3$ and its observation error are shown in Figure 2a–d, respectively. Figure 3 show the disturbance estimation and its estimation error, respectively. From these figures, the unmeasurable state value of each joint and the disturbance can be accurately estimated.

Using this designed controller, the control torque is shown in Figure 4, the desired trajectory and the practical trajectory are shown in Figure 5, and their difference is shown in Figure 6. From these figures, it can be seen that the control torque is smooth without a sudden change, it does not violate output constraints, and the proposed method can effectively achieve the tracking of this manipulator, even if there are input nonlinearity, output saturation, external disturbances, and unmeasurable states.

Further, a comparison between the proposed method and three commonly used control methods, i.e., the neural network adaptive control [25], robust adaptive control [26], and fuzzy adaptive control [27], is carried out. The trajectory track and tracking error under the different control methods are shown in Figure 7, Figure 8, and

Table 3. Performance comparison.

Methods	Mean Absolute Error (Degree)
	Joint 3 (q3)	Joint 4 (q4)
Proposed Control	0.0114	0.0087
NN Adaptive Control	0.2144	2.1308
Robust Adaptive Control	1.5823	0.3331
Fuzzy Adaptive Control	0.1680	0.0281

, respectively. From these figures, it can be seen that the proposed control method has a smaller relative tracking error and deviation angle than the other ones. This is because the proposed method considers input nonlinearity, output saturation, and external disturbances together, while the other methods do not. Although these common methods have excellent performance without constraints, they cannot deal with these constraints when there are input deadzones and output saturation constraints. Compared with the methods proposed in this paper, the trajectory-tracking control accuracy is relatively lower.

4.2. Experiment

To further validate the proposed method, an experiment based on the JAKA robot platform experiment was conducted. The layout of the robot manipulator is shown in Figure 1. The type of manipulator is a collaborative ultralight robot, JAKA zu7s. The position model controls the joints in Cartesian space, while the velocity model and torque model control the joints in angular space. The signals are sent to the DSP controller through a USB port by MATLAB R2018b and by compiling the program. The execution frequency and sampling frequency of the controller are 100 Hz and 20 Hz, respectively. The following is the reference input trajectory

$$\left[\begin{array}{c}q1\\ q2\\ q3\\ q4\\ q5\\ q6\end{array}\right]=\left[\begin{array}{c}4\sin (\frac{\pi }{2}t)+3\cos (\pi t)\\ 3\cos (\frac{\pi }{2}t)+0.2\sin (t)\\ 4\sin (\frac{\pi }{2}t)+2\cos (\pi t)\\ 3\cos (\frac{\pi }{2}t)\\ \sin (\frac{\pi }{5}t)+2\cos (\frac{2}{5}\pi t)\\ 2\cos (\frac{\pi }{5}t)\end{array}\right]$$

(54)

The parameters of the deadzone are defined as b_r = 5, b_l = −5, h_r = 15, and h_l = −10. The experimental results are shown in Figure 9, which shows that all joints have good tracking performance, and the proposed constraints are guaranteed by the experimental setup. For all joints, the average tracking error is within 0.01 degree, and the trajectories converge within the constraint range. Thus, the proposed method can realize highly precious tracking control.

5. Conclusions

A hybrid state/disturbance observer-based multiple-constraint control method for a manipulator is developed and evaluated in this study. The proposed hybrid state/disturbance observer can accurately estimate unmeasurable states and external disturbances. Combining back-stepping and BLF approaches, we propose an adaptive controller that can achieve tracking performance in the presence of several constraints and unknown disturbances. Simulations on a 2-DOF robot proved that the proposed strategy is effective. In comparison to several commonly employed intelligent control approaches, its control performance is superior. Experiments on a 6-DOF robot showed that all joints have good tracking performance and do not violate constraints. Future research will focus on the tracking control of underactuated systems with deferred constraints.