PID Based on Attractive Ellipsoid Method for Dynamic Uncertain and External Disturbances Rejection in Mechanical Systems

This paper presents a stability analysis for LNDS (Lagrangian nonlinear dynamical systems) with dynamic uncertain using a PID controller with external disturbances rejection based on attractive ellipsoid methods, since the PID-CT (proportional integral derivative computed torque) compensator has been used for the nonlinear trajectory tracking of an LNDS, when there are external perturbations and system uncertainties. The global system convergence of the trivial solution has not been proved. In this sense, we propose an approach to find the gains of the nonlinear PID-CT controller to guarantee the boundedness of the trivial solution by means of the concept of the UUB (uniform-ultimately bounded) stability. In order to show the effectiveness of the methodology proposed, we applied it in a real 2-DoF robot system.


Introduction
The mathematical model for many physical (mechanical and electrical) systems is described by a set of nonlinear ordinary differential equations.Commonly, these mathematical models are described by a trajectory optimization procedure or by Lagrangian (Euler-Lagrange) dynamic equations [1,2].The main control problem for these systems involves some concepts of stability such as asymptotic, exponential, and uniform stability, among many others (see, e.g., [3][4][5]).Moreover, the high precision position and velocity control in Lagrangian systems are a fundamental and important control problem.In practice, the problem of tracking a reference trajectory where external disturbances, parameter uncertainties, or dynamical uncertainties are present has received relatively less attention in the literature.Traditionally, the methods to stabilize the Lagrangian systems are based on conventional PD (proportional derivative), PD+ (PD with gravity compensation), PID (proportional integral derivative), and PID-CT compensators.It is well known that a PD controller can guarantee only asymptotic stability of Lagrangian systems in the regulation case.For the control theory viewpoint, it is well known that the steady-state error can be dissipated by introducing an integral compensator to the PD control or PID compensator.Nevertheless, in order to remove steadystate error caused by external disturbances, uncertainties, and noise, the integrator gain has to be increased.Nowadays, in industrial applications industrial linear PIDs are still used; however under certain circumstances, the stability of the closed-loop system with traditional PID is not guaranteed (from theoretical viewpoint).Thus, a high number of authors have been studying the global asymptotic stability around the origin of conventional compensators using the LNDS and the LaSalle's invariant principle theorem [3,4,6,7].However, when the LNDS has unknown bounded external perturbations, the traditional analysis does not have a good efficiency.Besides, the transient performance and stability problems in the integrator theory analysis are also difficult to deal with for industrial linear PID controller.In order to ensure asymptotic stability of the PID controller, a traditional method is to modify the linear PID into a nonlinear one.
Nonetheless, it is well known that in many theoretical and practical applications the PID compensator, under satisfactory gain tuning, provides a workable trajectory enforcement.Moreover, from a certain point of view, the PID compensator, without full system description, achieves some robustness properties [6,[8][9][10].Based on the above assumptions and after an exhaustive research in the area of classical closedloop controllers for LNDS we are inevitability addressed to the next question: under which conditions the classical PID is workable?Unfortunately, this is an open question because the classical PID compensator in presence of strong nonlinearities (like LNDS, tribology effects, external perturbations, or dynamic uncertainties) involves difficulties in dynamical analysis (see, e.g., [11,12]).Even more, the qualitative operation of PID closed-loop solution of LNDS plays an important role in many engineering practical applications such as mechanical and power systems [7,12,13].Although, for the classical linear PID, it is easy to prove asymptotic stability [11], it is not the case for the nonlinear system (this is the case for control analysis of LNDS or the Geometrical viewpoint (see [14, chapters 10-11] and [15])).So, in [14,15] the authors established exponential stability only for the velocity error and feedforward compensator for LNDS, but this analysis does not tell us what happend with the external perturbations.In this work, we intend to define UUB-stability (for all system states) on the class of perturbed LNDS.Although PID control has been used in industrial robots for a long time, there is few explicit stability analysis on it.A wide variety of authors ensure asymptotic stability, but they do not take into account a robust analysis.
Nowadays, the development of high-performance robust control as well as its physical implementation is one of the main problems in the control theory, because in the experimental applications, we require a workable instrument to design compensators, which are able to operate successfully under consideration of external perturbations (see, e.g., [16][17][18]).This paper deals with the trajectory tracking control problem for LNDS, applied for a two-degree-offreedom (DoF) benchmark robotic manipulator.Here, we consider the PID-CT for LNDS with unknown but bounded external perturbations.This kind of perturbation belongs to the class of nonlinear functions so called quasi-Lipschitz functions.This class of functions permits to consider strong nonlinearities, like tribology effects and relay effects (such as the case when a robot task is to take an object from one point to another, which induces a switch on the parameters, e.g., mass and length to the center of mass).Even more, we suggest a robust analysis for a class of LNDS with bounded disturbances.Thus, in this paper we give an analysis of UUB-stability for LNDS with unknown but bounded external perturbations from a class of quasi-Lipschitz functions.
The outline of this paper is as follows.In Section 2, we present a basic definitions and the problem formulation.Next section presents the main contribution of this work, based on the robust analysis of PID-CT compensator for Lagrangian systems.In Section 4, we obtain numerical results which define a two-link manipulator trajectory track.Finally, we present the conclusions.

Basic Definitions and Problem Formulation
In this section, we introduce the mathematical and LNDS mechanical tools needed for the remainder of this work.

Lagrangian Dynamics
2.1.1.Lagrangian Classical Model.The dynamic equation for mechanical or electrical systems can be obtained via the Newton's or Kirchhoff 's laws approach, for -DoF system or like in this case from the Lagrangian.These equations are obtained by the Lagrangian equation (for mechanical viewpoint).The general equation for the robot manipulator is given as where the position coordinates  ∈ R  with their associated velocities q and accelerations q are controlled by the vector  ∈ R  of driving forces.The Coriolis (centripetal) forces are C(, q ) q ∈ R  , and the gravitational forces are denoted by () ∈ R  .The dynamics (1) presents some interesting properties which will be useful in establishing the stability control analysis (see the Appendix).

Lagrangian Equations in First ODE Form.
Observe that the general Lagrangian equation ( 1) can be represented in the first-order extended system as follows: where  ∈  ⊆ R 2 ,  ∈ R  is the control input, and  0 ⊆  are the initial conditions.From Lagrangian formulation under basic change of variables ⊺ , one has the mathematical model as

The Uncertain External Perturbation.
The external perturbations, affecting the system dynamics, are supposed to be bounded.By including this expression on the LNDS, we have where the external perturbations have the following property: for positive scalars 0 <  1 ,  2 < ∞.Even more, it is admitted to have an unknown nonlinearity from a given class so-called quasi-Lipschitz functions [19].Then, the nonlinearities  : R  → R  are from the C class of quasi-Lipschitz functions.
A vector function  1 : R  → R  is said to be from the class Notice that (i) the growth rate of  1 (, ) as ‖‖ → ∞ is not faster than linear; This class of nonlinear functions may include discontinuous and hysteresis functions as well.Here, the perturbation (, ) under dynamics ẋ 2 has the following property: which implies that  1 (, ) ≤  1  1 +  1  2 ‖‖ 2 .The scalar,  1 , is given by the bounded property of the inertia matrix (see the Appendix).Finally, the Lagrangian equations in Cauchy form (2) in presence of external perturbations (4) have the following form: In this work, we allow the external perturbations  1 (⋅) from a C class of quasi-Lipschitz functions.Now, our control objective is to stabilize (8) by using the PID-CT compensator.

PID-CT Configuration.
In this work, the structure of the proposed control action  is as follows: with the gain matrices 0 < as dynamics error, where   1 and   2 are the deviation position and velocity, respectively, and (⋅) := ∫ ⊺  0 (⋅).In the classical robotics control strategies, the control action ( 9) is known as PID-CT compensator and it is well known that it has robustness properties.

Problem Formulation.
In this section, we explain the problem formulation, which states that all system trajectories arrive to a neighborhood of a desired trajectory.This is by the following facts: When it is present noise in the position measurements (e.g., where the velocity and acceleration are estimated, by definition, from position measurement); possible change or switch in the system parameters, the time varying or like relay change on the parameters; external disturbances, the link contact with the external environment; dynamic uncertainties, Maxwell-slip friction model, Stribeck effect in sliding, frictional lag, varying break-away forces, stick-slip behavior, and among others tribology effects.For this reason, in this work, we approximate the error tracking path of the nonlinear system (8) to an AE (attractive ellipsoid).
Definition 2 (attractive ellipsoid).One says that the ellipsoid (with the center in the origin and with the corresponding ellipsoidal matrix P) is attractive for some dynamic system if for any of its trajectories {} ≥0 the following property holds: Remark that all trajectories {} ≥0 of a dynamic system remain bounded, if for this system there exists an attractive ellipsoid E(0, P).The existence of an AE is the generalization of the UUB-property (uniform-ultimately boundedness) discussed in [5].Our main goal is to design a robust feedback based on PID compensator; moreover, the compensator rejects disturbances without loss of tracking trajectories paths.

On the UUB-Stability of the PID-CT for LNDS
The robustness of the PID compensators on dynamical systems is a classical topic in control theory.Here, we present a stability sketch from LNDS in closed-loop with PID-CT.It is well known that the kinetic energy plays an important role for stability analysis for LNDS.In this paper, we use the energy function based on kinetic energy as follows: where the matrix P = P ⊺ ∈ R 3×3 is a positive definite matrix and its structure is defined by  ×  matrix subblocks as follows: , where P 11 , P 12 , P 22 ∈ R × .

(13)
The following theorem presents the analysis for global stability of the PID-CT of system (8) under the specific energetic function (12).( The proof of all statements is given in the Appendix. Remark 4. From Schur's complement it is easy to see that a necessary condition for the linear matrix inequality solution ( 14) provides positive definite matrix P for some P 12 + P 12 < −P 22 , P 11 <  1 /, and A < K  .
Notice that the extended trajectories () converge to an invariant ellipsoid E(0, P) centered on the origin with ellipsoidal matrix P. In other words, () → E(0, P) as  → ∞.This ellipsoid is approached with the exponential rate exp(−) fulfilling with Moreover, notice that the selection of matrix P implies a family of possible ellipsoidal matrix configurations and may be selected in order to minimize the energy function (12).In further works, we will study this case from an optimization point of view [19].
Remark 5.It is well-known that the concept of an energetic function was rigorously formalized by means of the Lyapunov stability theory as well as the notion of a positive invariant set.Here, we just notice that the set of solutions (K  , K  , K  , and W) is given by Theorem 3, such that (15) holds, and the storage function ( 12) is not obligatory monotonically nonincreasing.That means that () is not a Lyapunov function for the considered system at least for this timeinterval.
Below, we suggest the construction of a Lyapunov-Like function whose derivative on the trajectories of the considered controlled system is strictly negative outside of an ellipsoid.Which implies that any trajectory that begins outside the ellipsoid (15), this returns asymptotically within the ellipsoid.In other words, UUB-stability is guaranteed if the ellipsoid is an attractive region.The above is set to the next result.Theorem 6 (on the attractively of the ellipsoid).Under the assumption of Theorem 3, the function is a Lyapunov function, and then the following property is globally satisfied, which exactly means that the set { ∈ R 3 : (()) = 0} is a positive invariant region.
Notice that the results of Theorem 6 involve the so-called UUB-property on the solution of the system trajectories (see [5]), satisfying the problem statement ( 15), so we may conclude that the PID-CT compensator, for a nonlinear system (8), is robust under external perturbations.

Experimental Validation
In order to show the contribution of the results obtained in this paper, we obtain the PID-CT gain matrices under two approaches.The first one is given by classical Ziegler-Nichols method (popular technique for tuning controllers that use PID actions [11,12]), while the second one is given by LMI solution (14) introduced in this paper (see Theorem 3).The system to be controlled is a benchmark classical system (the second-link vertical planar robot shown in Figure 1, whose dynamics are given in the literature; see [7]).The model of the motion dynamics is a set of 2 rigid bodies connected and described by a set of generalized coordinates  ∈ R 2 .The derivation of the motion equations is given by ( 1) and by applying the methods of the Lagrange theory, involving explicit expressions of kinetic energy and potential energy, where we obtained the standard general equation (1).For this robot study case the position, velocity, acceleration, and control input (, q , q , and , resp.)belong in R 2 .Under the change of variable ), the nonlinear system described in the first-order Cauchy form (2) is given as follows: Now the parameters of this manipulator (given in the international system of units) are and  5 =  2  2 , with the total mass of link-1  1 = 0.5 kg, the total mass of link-2  2 = 0.25 kg, the moment of inertia of link-1 I 1 = 0.004 Kg ⋅ m 2 , the moment of inertia of link-2 I 2 = 0.005 Kg ⋅ m 2 , the distance to center of mass of link-1  1 = 0.275 m, the distance to center of mass of link-2  2 = 0.1 m, the length of link-1  1 = 0.4 m, the length of link-2  2 = 0.2 m, and the acceleration of gravity constant  = 9.81 m/seg 2 .The distance to center of mass is defined by  1 and  2 , respectively.Here, we consider that the dynamics are given by  where the friction vector forces include a low (the term low friction is defined when the friction coefficients belongs in the set (0, 1)) Coulomb and Viscose friction, F  () ∈ R  .The initial condition and the control objective are the same as those we present in the previous control shape.Notice that the dissipative vector forces F  () belong in the class of quasi-Lipschitz functions; see Definition 1.For the external disturbances rejection, we introduce a disturbance at time  = 10 seconds.The perturbation structure is as follows: where the function ( −   ) is the characteristic function at time   [20].This considered disturbance is because, from the experimental point of view, it introduces a significant deviation than the switched parameter value.For example, if there exist a change of some link mass, it implies a change on the center of mass of each link.Then, the LNDS with dissipative forces (20) can be rewrite as the perturbed form (8).Here  1 (, ) belongs in the quasi-Lipscitz nonlinear functions (6) with and the constants  1 = 0.023 and  2 = 0.26.The control process is given by regulation of the desired reference, and this one is given by the Heaviside step function given by the following equation: The gain matrices given by method of Zingler-Nichols (to obtain the control gain via Zingler-Nichols method, we take into account the linearization of the first-order mathematical model (2) around the center of the area of the desired trajectory tracking) are In order to obtain the PID-CT gain matrices, we used the MATLAB Toolbox SeDuMi to solve the corresponding constrained LMI problem (14); see for example [21].Finally, we obtain the gain matrices as follows: Figure 2 depicts the evolution of steady-state errors x. Figure 4 depicts the control signals  1 and  2 for both actuators.Finally, Figure 3 shows how after the induced perturbation the conventional linear PID (red solid line) cannot reject the perturbation, while on the other hand, for the case where the gains were tuned by the proposed methodology (blue solid line), the controller is able to reject the perturbation and to track the desired trajectory.
Clearly, the robust PID control can successfully compensate the uncertainties such as friction, gravity, and other uncertainties of the robot.

Concluding Remarks
An analysis of global UUB-stability for Lagrangian systems has been presented in this paper.In order to perform the robust stability analysis, we used like-passivity injection based on the dynamical properties of the system and in the characteristics of the quasi-Lipschitz functions.Theoretical robust analysis stability of PID-CT compensator under external but bounded perturbations has been done successfully.Experimental validation was conducted by perturbations between the robotic arm positions  1 and  2 .Here, we have defined a methodology to obtain the K  , K  , and K  gains matrices of the PID-CT compensator.Even more, we used an storage function based on the trajectory error in order to guarantee the asymptotic convergence.A comparison between the Ziegler Nichols algorithm and the algorithm proposed showed that it has a better performance in order to reject external disturbances and dynamic uncertainties.Additionally, the maximal overshot of the closed-loop system is given by the ultimate bound of the stability analysis; this is because once the trajectory arrives to the ellipsoid, this remains there.Thus, the main result of this contribution opens the door for the study of output feedback compensators for LNDS.Even more with this result, we will study the case when the dynamical system has not external perturbation and dynamic uncertain, waiting to probe exponential stability (see expression (16)).

Theorem 3 ( 12 +
on the energy function of the PID-CT).If the tuning of the control gain matrices K  , K  , and K  of the control action(9), under given matrix P and positive scalars , , is such that the following LMI constraint holds: P 11 P 22 + P 12 + P⊺  12

Figure 2 :
Figure 2: Error signals x, for ,  = 1, 2 of the trajectory tracking.The subindexes  and  are the position and velocity.

Figure 3 :
Figure 3: Control signals, for first and second link (two algorithms).

Figure 4 :
Figure 4: Trajectory on work space, comparison between the Ziegler-Nichols method and the Robust PID method.
) moreover, for the control point of view, we implement a regulation point-to-point at the work space.The first point to go is at P  1 = 0.34 and P  1 = 0.3 meters at time interval  ∈ [0,  P 1 ) seconds, the second follows a trajectory P  2 = 0.3 + .04cos(), P  2 = 0.3 + .04sin() with  = 4 for time interval  ∈ [ P 1 , 50), P  3 = 0.3, respectively, and in the time  = 25 seconds, we induce an external perturbation () with a duration of 0.5 s.The initial conditions of the system for both control examples are