Robust Adaptive PID Control of Robot Manipulator with Bounded Disturbances

To solve the strong nonlinearity and coupling problems in robot manipulator control, two novel robust adaptive PID control schemes are proposed in this paper with known or unknown upper bound of the external disturbances. Invoking the two proposed controllers, the unknown bounded external disturbances can be compensated and the global asymptotical stability with respect to the manipulator positions and velocities is able to be guaranteed. As compared with the existing adaptive PD control methods, the designed control laws can enlarge the tolerable external disturbances, enhance the accuracy in finite-time trajectory tracking control, and improve the dynamic performance of the manipulator systems.The stability and convergence properties of the closedloop system are analytically proved using Lyapunov stability theory and Barbalat’s lemma. Simulations are performed for a planner manipulator with two rotary degrees of freedom to illustrate the viability and the advantages of the proposed controllers.


Introduction
Robot manipulators play an important part in modern industry by providing lower production cost, enhanced precision, quality, productivity, and efficiency.The control of rigid robot manipulators faces significant difficulties such as highly nonlinear, coupled, and time-varying behaviors.Moreover, there always exist uncertainties in the system's dynamic model, such as the external disturbances and parameter uncertainty, to name a few, which cause unstable performance of the robot manipulator systems.
Since linear control methods are not suitable for strong coupled, nonlinear, and time-varying rigid robot manipulator systems, many nonlinear control schemes based on conventional PID control theory have been proposed to improve the control performance.In [1], the global asymptotic stability of a class of nonlinear PD-type controllers for position and motion control of robot manipulators is analyzed, and a global regulator constrained to deliver torques within prescribed limits of the actuator's capabilities is proposed.This class of controllers, when rule-based or gain scheduling approaches are used, can get high performance control systems.However, it has been shown that although the PD controller is robust with respect to uncertainties on inertial parameters and the global asymptotic stability is guaranteed, uncertainties on the gravity parameters may lead to undesired steady-state errors [2].A PID control scheme can eliminate the steady-state errors, but it can only ensure local asymptotic stability.Moreover, to guarantee the stability, the gain matrices must satisfy complicated inequalities [3].In [4], a new variable structure PID control scheme is designed for robot manipulators.Even through the global asymptotic stability of the controlled robot systems is analyzed, the bounds of system parameter matrices need to be known in the controller design.
To further enhance the tracking performance of robot manipulator systems in presence of parametric uncertainties, significant efforts have been made to seek advanced control strategies.Robust and adaptive control schemes of robot manipulators have been the active research topics for many years.Robust control laws are used for external disturbances, unstructured dynamics, and other sources of uncertainties.Leitmann [5] and Corless and Leitmann [6] present a popular approach utilized for designing robust controller for robot manipulators.In an early application of the Corless-Leitmann approach to robot manipulators [7], a simple robust nonlinear control law is derived for -link robot manipulators using the well-known Lyapunov based theory of guaranteed stability of uncertain systems.The uncertainty bounds needed to derive the control law and to prove that uniform ultimate boundedness of the tracking errors only depends on the inertia parameters of the robot.Some other robust control methods developed based on [5,6] are given in [8,9].However, disturbances and unmodeled dynamics are not considered in the algorithms in [7][8][9].In [10], Spong's method [7] is extended in such a manner that the control law is robust not only to uncertain inertia parameters but also to unmodeled dynamics and disturbances.Another improvement to the Spong's methodology [7] is suggested in [11].A drawback of a single robust control is that it cannot estimate the uncertainties and disturbances online, which limits the adaptability of the controller to the changed uncertain parameters.Adaptive algorithm provides an effective way to solve this problem; however, most adaptive controls, like most parameter adaptive methods, may exhibit poor robustness to unstructured dynamics and external disturbances.Some related results can be seen in [12][13][14][15].To resolve this, a combination of robust control and adaptive algorithm is investigated in a number of literature sources.In [16], adaptive controllers are designed for robot manipulator systems that yield robust trajectory in spite of the unwanted effects of the external disturbances and fast maneuvering of the manipulator.The convergence rate is improved and the transient oscillation is reduced considerably.In [17], an adaptive control law for continuous-time direct adaptive control of robot manipulator is presented.The algorithm is suitable for swift adaptation to rapidly changing system parameters.And the uniform global asymptotic stability with respect to the manipulator positions and velocities is guaranteed for unknown constant parameters.In [18], a decentralized adaptive robust controller is investigated for trajectory tracking of robot manipulator systems.A disturbance observer (DOB) is introduced in each local controller to compensate for the low-passed coupled uncertainties, and an adaptive sliding mode control term is employed to handle the fast-changing components of the uncertainties beyond the pass band of the DOB.For some other results on robust and adaptive control the reader can refer to [19][20][21][22].
Furthermore, other control algorithms such as fuzzy logic, neural networks, and PD control have been adopted to combine with robust and adaptive control to cope with the problems in robot manipulators control.In [23], a robust adaptive compensation scheme is presented for compensation of asymmetric deadzone, dynamic friction, and uncertainty in the direct-drive robot manipulator.The estimation laws of deadzone and friction are proposed to offset both deadzone of joint input torque and friction.A model-free recurrent wavelet cerebellar model articulation controller (RWCMAC) to mimic the ideal control law is employed to overcome some shortcomings of the traditional model-based adaptive controller.In [24], a novel robust decentralized control of electrically driven robot manipulator by adaptive fuzzy estimation and compensation uncertainty is proposed.The controller is designed via voltage control strategy.A fuzzy system is used to estimate and compensate uncertainty.In [25,26], two adaptive PD control methods are investigated for trajectory tracking control of robot manipulators with known and unknown upper bound of the external disturbances, respectively.Both of the controllers are composed by a nonlinear PD feedback control law and an adaptive algorithm.The PD feedback control law can avoid large initial torque due to the large initial position error, and the adaptive algorithm can make good dynamic performance for the robot manipulator systems.However, the PD feedback control is rarely used in practical control systems.That is because the pure differential element cannot be realized in practice.Moreover, the differential action is very sensitive to system noise; as a result, if the PD control is adopted, any disturbances in each system's element would result in big fluctuation in systems output.Hence, the PD control is indeed of no benefit for the improvement of the system dynamic performance.
In the present study two new robust adaptive PID controllers are introduced for an  degree-of-freedom robot manipulator systems with known or unknown upper bound of the external disturbances based on [1,25,26].The designed controllers are composited by PID control and robust adaptive approach to cope with the external disturbances and unknown constant parameters that can arise.As regards the innovation of this study, an integration element is embedded in both PD control and robust adaptive algorithm based on the existing adaptive PD control laws [25,26].With the adoption of the proposed controllers, the tolerable external disturbances are enlarged, and also the dynamic performance of the manipulator systems is improved and the finite-time tracking control accuracy is enhanced in contrast to those obtained with the usage of the adaptive PD controllers [25,26].By choosing adequate Lyapunov candidate functions and utilizing Barbalat's lemma, the system's closed-loop stability is proven.Some numerical results are also presented in order to demonstrate the control systems performance.
This paper is organized as follows.The nonlinear dynamics of rigid robot manipulator and some useful properties of dynamic systems are introduced in Section 2. In Section 3, three necessary assumptions for control laws development and systems stability analysis are given, and two robust adaptive PID controllers are designed for trajectory tracking control of robot manipulator with known or unknown upper bound of the external disturbances, respectively.The numerical verification of the controllers and the discussion are presented in Section 4. A short conclusion is given in Section 5.

Dynamic Model of Robot Manipulator and Some Properties
2.1.Dynamic Model.Generally, the dynamics of an  degree of freedom (-DOF) rigid link robot manipulator with rotary joints can be expressed as [27]  () q +  (, q ) q +  () +  = , where () ∈   is the vector of joint angles, () ∈  × is the inertia matrix of the manipulator, (, q ) ∈  × is the matrix of Coriolis and centripetal forces, the vector of gravity factor,  ∈   is the vector of input torque, and  ∈   is the vector of all external disturbances.
Figure 1 presents the conceptual model of an -DOF rigid robot manipulator.Assume that the manipulator is mounted on a fixed base, so the dynamic coupling between the manipulator and the base is neglected.

Dynamic System
Properties.The dynamic systems given by (1) exhibit the following properties that are utilized in the subsequent control laws development and stability analysis [27].

Robust Adaptive PID Control of Robot Manipulator
Firstly, the following assumptions are imposed for the manipulator systems.
(C1) The desired trajectory   and the time derivatives q and q are available and bounded signals.(C2) The external disturbances vector  is bounded, and it is confined within the following limit: where  1 ,  2 ,  3 , and  4 are positive constants,  =  −   and ė = q − q  are the position tracking error and the velocity tracking error, respectively, is existent and bounded in .Here we introduce two variables  and   ; meanwhile let where the parameter  is a positive constant.

Robust Adaptive PID Controller Design with Known Upper
Bound of the External Disturbances.For the robot manipulator systems (1), if the upper bound of the external disturbances signals  is known, motivated by [1,25], the controller which makes the position and the velocity tracking errors asymptotically converge to zero can be designed as follows: where P is the estimate value of .Take the parameter estimation law of P as The gain matrices are given by where   ,   ,   ( = 1, 2, . . ., ) are all positive constants and   =   , Φ ∈  × is a positive definite and symmetric matrix.
The framework of the proposed control scheme is shown in Figure 2.

Proof. Considering the Lyapunov function candidate,
with P = P − .
From property (B1) one obtains With the positive definite and symmetric matrices   ,   ,   , and Φ, one gets Therefore, one obtains Using ( 6) and ( 7) leads to Considering Substituting ( 16) and ( 17) into ( 15) yields With property (B2) one obtains Note that and one gets Thus, one obtains Note that the following equalities and inequalities hold Hence, one gets Now considering the term of   ( − ), here the assumption (C2) has been used.Note that Defining With   =   > 0 and   > 0 one obtains Finally, one gets From the proof and analysis above we know that the function V is negative and vanishes if and only if () = 0; thus the position tracking error goes to zero as time goes to infinity; namely, lim  → ∞ () = 0.

Robust Adaptive PID Controller Design with Unknown
Upper Bound of the External Disturbances.On the other hand, if the upper bound of the external disturbances signals  is unknown, inspired by [1,26], the controller which ensures the global asymptotical stability of the manipulator positions and velocities can be designed as follows: The framework of the proposed control scheme is shown in Figure 3.

Proof. Consider the following Lyapunov function:
Based on the controller stability analysis with known upper bound of the external disturbances in Section 3.1, according to (24) one gets Substituting (32) and ( 34) into (36) yields Take into account that the following equalities and inequalities hold: here the assumption (C2) and ( 33) have been used.Therefore, one obtains From the definitions of ( 33) and (34), it can be easily verified that b > 0 and  2 > 0 as  > 0, and  → 0 as  → ∞.Thus the condition V < 0 is satisfied.According to the Lyapunov stability theory and Barbalat's lemma (see (30)), the convergence of  and ė to zero is guaranteed, and also the boundedness of the parameter vector P is obtained.

Simulation Experiments and Discussion
In order to illustrate the performance of the proposed robust adaptive PID controllers, simulation results are given by means of MATLAB/SIMULINK.A comparison between the adaptive PD controllers in [25,26] and the robust adaptive PID controllers derived in this study is carried out.The simulation model is a two-degree-of-freedom planar rigid manipulator with rotary joints.According to (1), its dynamic equation can be described as follows [30]: where At first, linearize (40) and give the parameter matrices Ψ and .

Mathematical Problems in Engineering
According to (5) the following equality holds:
The MATLAB/SIMULINK framework is shown in Figure 4.
In order to show the advantage of the proposed control laws, two simulations are conducted, one with adaptive PD control and the other with robust adaptive PID control.The simulation results are presented in Figures 5-16.

Simulation Results with Known Upper Bound of the
External Disturbances.Adopting the control law described in Section 3.1 to simulate the tracking effects of robot manipulator, the simulation results can be seen from Figures 5, 6, 7, 8, 9, and 10.

Discussion
These figures indicate that the robust adaptive PID control schemes can compensate the unknown bounded external disturbances and guarantee the manipulator systems to track the desired position and velocity trajectories accurately with quite small tracking errors in finite time.The adaptive algorithm can effectively estimate the unknown constant vector  which describes the mass characteristics of robot manipulator.
In comparison with the adaptive PD controllers proposed in [25,26], the robust adaptive PID controllers can provide better control performance.The main reason lies in the incorporation of an integral action within both PD control and robust adaptive algorithm based on the adaptive PD control laws [25,26].Concerning the PID control term in the robust adaptive PID controllers, it exhibits the superiority in contrast to the PD one in the adaptive PD controllers [25,26].In the case of PD control, the differential element only plays a part in dynamic process, and it has no effect on steadystate process, although the steady-state errors can be smaller by increasing the proportional gain matrix; yet, too large proportional gain may cause the system to be unstable.In addition, from a practical point of view, the pure differential element cannot be realized in practice; furthermore, the differential action is very sensitive to system noise; as a result, any disturbances in each system's element would result in big fluctuation in systems output.Hence, the adoption of PD control is indeed of no benefit for the improvement of system dynamic performance.While the PID control includes an integral element which can raise the indiscrimination degree of the system, so it can enhance the stead-state performance of the closed-loop system.Apart from that, the PID control can also provide one negative real zero, which contributes to improve the dynamic performance of robot manipulator systems.In terms of the adaptation algorithm in this work, different from the one in [25,26], an integral element acts on the estimation law Ṗ via the variable  (see ( 3) and ( 10)).In this case, note that continuously accumulated position errors under the action of integration element result in a bigger value of Ṗ than that in [25,26], which implies that the estimated rate of the estimate vector P is increased.As a consequence, the dynamic performance and the finite-time estimation accuracy of the estimate vector P are improved with comparison to those in [25,26].In addition to these, note that assumption (C2) provides a bigger upper bound of the external disturbances than the one which is defined as ‖‖ ≤  1 +  2 ‖‖ +  3 ‖ ė ‖ in [25,26].Because when the two upper bound inequalities of the external disturbances signals  in [25,26] and this study hold the same parameter values of  1 ,  2 , and  3 , an arbitrary positive constant  4 together with the nonzero accumulated position errors in assumption (C2) can lead to a bigger upper bound value for the external disturbances signals .However, the enlarged external disturbances can be compensated by the enhanced robust term  (see (3), ( 9), (32), and ( 33)).Therefore, greater external disturbances are allowed for this study than the ones tolerated in [25,26].Hence, the proposed robust adaptive PID control laws could show their advantages with appropriate control gains in contrast to the adaptive PD ones [25,26].However, it should emphasize that the proposed robust adaptive PID controllers can only enhance the finite-time tracking accuracy in contrast to the existing adaptive PD ones [25,26], because the global asymptotical stability with  respect to the manipulator positions and velocities can also be achieved by using the adaptive PD control laws [25,26], which implies that () → 0 and ė () → 0 as  → ∞ can be guaranteed.Nevertheless, the dynamic performance of the closed-loop system can be improved in the whole process by adopting the robust adaptive PID control laws.In fact, the control procedure is always the finite-time process in  practical control systems; hence the study of the finite-time control performance improvement of robot manipulator in this work is of practical significance.Simulation results verify the advantages of the proposed control schemes.The experimental curves show that the robust adaptive PID controllers provide higher accuracy in finite-time position and velocity tracking control than those provided by the adaptive PD ones [25,26].Moreover, the robust adaptive PID controllers result in better dynamic performance of the manipulator systems.By observing the experimental figures, it can be verified that the proposed control laws can ensure a faster convergence rate and smaller  overshoot of the system states tracking to the desired trajectories when compared with the adaptive PD controllers [25,26].In terms of the control input, the robust adaptive PID controllers lead to less chattering effect, which is beneficial to prolong the service life of robot manipulator.For the unknown constant vector , the designed controllers in  this study ensure higher finite-time estimation accuracy and significantly lower overshoot.
From the above analysis, the investigation of this work presents more effective control methods for robot manipulator operation under unknown bounded external disturbances.Remark.Both the adaptive PD control laws in [25,26] and the robust adaptive PID control laws in this study can make the position and the velocity tracking errors of the manipulator systems asymptotically converge to zero, which means () → 0 and ė () → 0 as  → ∞.Therefore, when the control gains chosen for simulation in [25,26] and this paper simultaneously result in rapid convergence of the manipulator positions and velocities, the advantage of the robust adaptive PID controllers will be tiny with comparison to the adaptive PD controllers [25,26].
Nevertheless, it is necessary to emphasize that the proposed controllers are unavailable under manipulator actuators fault.However, actuators fault may occur due to infrequent maintenance or limited life cycle, which could cause several damages to the operators and products.In [31], an adaptive variable structure control scheme is proposed for underactuated mechanical manipulators.Reference [32] investigates the basic data-driven methods for process monitoring and fault diagnosis.And [33] discusses two online schemes for an integrated design of fault-tolerant control systems.Based on these current researches, our future work will focus on the fault diagnosis and fault-tolerant control of robot manipulators in case of actuators fault.

Conclusion
This paper describes the design and simulation implementation of two new robust adaptive PID controllers for the trajectory tracking control of rigid robot manipulator with known or unknown upper bound of the external disturbances.The main feature of this design is that it combines PID control law with robust adaptive algorithm.The adaptive algorithm is utilized to estimate the unknown constant vector  online, while the robust term and the PID control are used to cope with the unknown bounded external disturbances, adaptive approximation errors, and trajectory tracking errors.
The convergence and stability properties of the closedloop system are guaranteed.In addition, the tolerable external disturbances are enlarged; besides, the dynamic performance of the manipulator systems is improved and the finite-time tracking control accuracy is enhanced by adopting the proposed control schemes in contrast to those achieved through applying the existing adaptive PD control laws [25,26].The control techniques have been finally simulated for a planner manipulator model with two rotary degrees of freedom in MATLAB/SIMULINK toolbox.Simulation results show the advantages of the designed controllers and verify that the proposed strategies are able to cope with both the external disturbances, that can typically arise in practical control, and uncertain constant parameters in system dynamics.
The limitation of the proposed control schemes lies in the requirement of   =   , which in fact constrains the flexibility of the controllers.Currently we are working on the extension of the proposed methods to remove this constraint.Future work will investigate the fault diagnosis and faulttolerant control of robot manipulator systems with actuators fault.

Figure 1 :
Figure 1: The frames assignment of an -DOF rigid robot manipulator.

Figure 2 :
Figure 2: Framework of control law with known upper bound of the disturbances.

Figure 3 :
Figure 3: Framework of control law with unknown upper bound of the disturbances.
Bound of the External Disturbances.Choosing  1 =  2 = 40 and utilizing the control scheme represented in Section 3.2 to express the tracking capability of robot manipulator, the simulation results are shown in Figures 11, 12, 13, 14, 15, and 16.

Figure 6 :
Figure 6: Position and velocity trajectory tracking errors of link 1.

Figure 7 :
Figure 7: Position and velocity trajectory tracking of link 2.

Figure 8 :
Figure 8: Position and velocity trajectory tracking errors of link 2.

Figure 11 :
Figure 11: Position and velocity trajectory tracking of link 1.

Figure 12 :
Figure 12: Position and velocity trajectory tracking errors of link 1.

Figure 13 :
Figure 13: Position and velocity trajectory tracking of link 2.

Figure 14 :
Figure 14: Position and velocity trajectory tracking errors of link 2.