Analysis and Synthesis of Global Nonlinear Controller for Robot Manipulators
The regulation problem for robot manipulators using gravitational force compensation or precompensation has been solved locally while global asymptotical stability (or global stability) has been demonstrated using other methodologies. A solution to the global nonlinear regulation problem for -degrees-of-freedom (-DOF) robot manipulators, affected by external disturbances, is presented. We showed that the Hamilton-Jacobi-Isaacs (HJI) inequality, inherited in the solution of the control problem, is satisfied by defining a strict Lyapunov function. The performance issues of the nonlinear regulator are illustrated in experimental and simulation studies made for a 3-DOF rigid links robot manipulator.
Industrial systems currently in use, including robotic systems, can be subject to uncertain environments and be mainly affected by friction, external disturbances, backlash, input dead zone, and noise. Moreover, imprecision in the knowledge of the parameters of the model of the robot and actuators used to compensate nonlinearities as part of model-based controllers also affects the performance of mechanical systems. As a result of such uncertainties and disturbances, poor motion repeatability, imprecisions, and weak exactness are reflected in the tasks for which robots were programmed. For example, chained robots are the typical systems affected by not only the abovementioned nonidealities but also positioning error, due to the gap between the actuator and the link that often exists, which occurs when the measured angular position, used for feedback, is provided from an encoder mounted at the actuator while the nonmeasurable angular position of the link is required to be driven to a desired point.
Syntheses of controllers ensuring global asymptotical stability (GAS) for nonperturbed robots have been widely proposed and reported in the literature (see, e.g., [1–3]) and the state-of-the-art of such systems is out of the scope of this paper. On the other hand, robust controllers for robots operating under uncertain conditions have been also investigated and reported concluding GAS as well. Several methodologies successfully solve the problems affecting robots but each nonlinearity was treated separately. For example, adaptive control was used to drive the trajectories of the closed-loop system to the desired point in spite of uncertain knowledge of the parameters of the robot. Variable structure control [4, 5] has been used to deal with parametric uncertainties and matched external disturbances rejection while finite-time stability is also concluded. Passivity based control, LQR, and , among others, have been used for robust control and interesting material of additional robust controllers for robots can be found in .
control has long been recognized not only for attenuating the effects of a class of matched and unmatched disturbances, including noise, but also for ensuring robust performance possessing the capability to reduce the effects due to uncertainties (see, e.g., [7–12]). Despite the fact that global solution of nonlinear control has been already addressed (see, e.g., van der Schaft , Isidori and Astolfi , and Orlov and Aguilar ), the main drawback of the practical implementation of global controllers for certain nonlinear systems has been the difficulty to solve the HJI inequality since the design procedure results in an infinite-dimensional problem [13, 14]. Indeed, while GAS for the position regulation problem for robot manipulators using gravitational force compensation or precompensation coupled with other control approaches has been demonstrated (see, e.g., [2, 6]), for the controller such problem has been solved locally .
For nonlinear systems, the difficulty of dealing with partial differential equations can be circumvented by solving algebraic or differential Riccati equations considering the linearized model of the plant around an equilibrium point turning out to be a local solution of the nonlinear control problem (see, e.g., [15–18]). While dealing with the latter, the HJI equation may be numerically solved where relevant contributions to the matter can be found in the literature. For example, Aliyu  addressed the solution of the HJI equation for a general class of affine nonlinear systems, where a computational procedure to find a symmetric solution to the HJI equation has been developed. A numerical method to solve the HJI equation proposed by Ferreira et al.  consists in reducing the HJI equation to an infinite sequence of linear partial differential equations where the solutions can be obtained by the Galerkin approximation method. Linear and nonlinear matrix inequalities, given in Boyd et al. , and their numerical techniques have been also applied to solve the nonlinear control [22, 23]. For additional material and brief survey of numerical solutions for the nonlinear control problem, the reader is referred to [24, 25].
The main contribution of this paper is in addressing the global solution to the nonlinear regulation problem for a class of fully actuated and revolute joint robot manipulators avoiding the numerical solution of partial differential equations. The main idea is to introduce a positive definite function and define necessary and sufficient conditions to guarantee that the HJI inequality is negative definite. The positive definite function was taken from , proven to be a strict Lyapunov function. The developed controller consists of a gravitational compensator, a proportional-derivative part, and a disturbance attenuator, tested experimentally in an industrial robot, showing considerable performance with respect to a controller without the disturbance attenuator.
The rest of the paper is organized as follows. In Section 2, the Euler-Lagrange model for robot manipulators with rotational joints and rigid links and some instrumental properties are described. In Section 3, a background of the solution to the global state feedback nonlinear control problem for affine nonlinear systems is provided. In Section 4, the control objective and synthesis of the global nonlinear regulator along with the verification of the HJI inequality via strict Lyapunov function are explained. Simulations and experiments results made for a 3-DOF industrial robot are presented in Section 5. Finally, we give conclusions in Section 6.
2. Dynamic Model of Rigid Links Robot Manipulators and Useful Properties
The dynamic equation of -DOF robots with revolute joints and rigid links can be written as Euler-Lagrange equations; that is, where is the vector of joint displacements, is the vector of joint velocities, is the vector of applied torques, is the time, is the symmetric positive definite inertia matrix, is the centrifugal and Coriolis forces matrix, is the vector of gravitational torques, is the disturbance vector, and represents the friction torques vector governed byHere, the matrix is assumed diagonal and positive definite where the main diagonal includes the constant coefficients of the Coulomb friction of each joint. Both the angular positions and velocities are available measurements for feedback. The following properties, taken from [2, 3], are valid for robots having only revolute joints.
Property 1. The inertia matrix is symmetric and positive definite for all . The matrix exists and is positive definite as well.
Property 2. The centrifugal and Coriolis matrix and the time derivative of the inertia matrix satisfy that skew-symmetry property as follows:for all .
Property 3. There exists a positive constant such that for all we have
3. Background on Global Nonlinear Control for Autonomous Systems
The present study focuses on autonomous nonlinear systems of the form where is the state vector, is the control input, is the unknown disturbance vector, is the unknown output to be controlled, is the only available measurement on the system, , and are vectors and matrices functions of appropriate dimensions.
For the underlying system, the following assumptions are made throughout.
Assumption 1. The functions , , , , , , are smooth.
, , and .
Assumption 3. We haveAssumption 1 guarantees the well-posedness of the above dynamic system, under integrable exogenous inputs. Assumption 2 ensures that the origin is an equilibrium point of the nondriven and disturbance-free dynamic systems (5). Assumption 3 is a simplifying assumption inherited from the standard control problem (see, e.g., [12, 27, 28]).
A state feedback controlleris said to be a globally admissible controller under the available measurement if the closed-loop system (5), (7) is globally asymptotically stable when . System (5) has -gain less than if the response resulting from for initial state satisfiesfor all and all piecewise continuous functions .
3.1. Global State-Space Solution
The result, given below, globally solves the control problem for nonlinear autonomous systems (5).
Hypothesis 1 (see ). There exist a positive definite function and a smooth positive definite function , locally defined in the neighborhood of the origin , which solves the Hamilton-Jacobi-Isaacs inequalitywithUnder Hypothesis 1, a solution of the control problem stated above is as follows.
Theorem 4 (see ). Let Hypothesis 1 be satisfied. Then the state feedbackglobally asymptotically stabilizes the disturbance-free system (5) and makes the -gain of the closed-loop system less than .
4. Global Nonlinear Regulator for Robot Manipulators
The nonlinear regulation problem can be established as follows: given a desired constant ending vector position , the control objective for the regulator under study consists in making the system globally asymptotically stable and ensuring thatfor arbitrary initial condition in spite of the presence of external disturbances.
Proposition 5. The stabilizing controller of the formwhere is the position error vector, , and and are symmetric positive definite matrices, imposes the manipulator motion around , when .
The controller to be constructed consists of the gravitational torque ) and friction torque () compensators, a proportional-differential part that imposes the desired stability properties on the disturbance-free system motion, and a disturbance attenuator , internally stabilizing the closed-loop system around the desired position.
The state-space representation of the closed-loop system (1), (14), in terms of the errors , is given byWe confine our design objective to a position regulation, where the output to be controlled is given bywith a positive weight coefficient , where is the hyperbolic tangent vector. Here, . The position and velocities are available for feedback; that is,and these measurements are corrupted by the vector .
Theorem 6. Let Hypothesis 1 be satisfied with the following positive definite function :which is positive definite for all and radially unbounded ifand the time derivative of along the trajectories of system (18) is negative definite ifholds ( and are defined as the largest and smaller eigenvalues, resp.), where is a sufficiently small constant. Then, the state feedbackglobally asymptotically stabilizes the disturbance-free system (18), (19), (24) and makes the -gain of the closed-loop system less than .
Proof. To better explain the analysis, we split the HJI inequality (9) in two parts; that is,whereFor we have thatFrom Hypothesis 1, is a positive definite function chosen, a priori, asDeveloping , we haveHere, . Consider the following well-known inequalities for a vectorial tangent and secant hyperbolic functions: (i),(ii),(iii),(iv),
for any and . With these inequalities and using Properties 1–3, provided in Section 2, we can obtainThe latter bound can be rewritten in the following form:whereApplying the theorem of Silvester to , we have thatChoosing and satisfying the above bounds, then will be a positive definite matrix, and consequently will be a negative definite function.
Let us develop . For the proposed Lyapunov function we have thatHence,The latter bound can be compactly expressed asThus, choosing and , the matrix will be positive semidefinite and consequently will be a negative semidefinite function.
Finally, the Hamilton-Jacobi-Isaacs inequality will be a negative definite function if . The proof is completed.
The positive definite function (21), proven in  to be a strict Lyapunov function to conclude GAS for a disturbance-free robot, was crucial to prove that the Hamilton-Jacobi-Isaacs inequality is negative definite globally in contrast to the standard positive definite function , , where only asymptotic stability in a neighborhood of the origin can be concluded .
5. Application to a 3-DOF Industrial Robot
5.1. Experimental Setup
Experimental setup involves a robot manipulator (see Figure 1) manufactured by AMATROL. The base of the mechanical robot has a horizontal revolute joint (), whereas two links have vertical revolute joints and . The remaining degrees-of-freedom correspond to the end effector orientation. Nominal parameters of mechanical manipulator are summarized in Table 1. Worm gear set, helicon gear set, and roller chain are used for torque transmission to joints , , and , respectively; there is a DC gear motor for each joint with a reduction ratio of 19.7 : 1 for and , and 127.8 : 1 for . These gears are the main source of friction. The PCI multifunction I/O board model 626 from Sensoray Co., Inc. , is employed for the real time control system and it consists of four analog outputs (13-bit resolution), 20 digital I/O channels with edge detection, and interrupt capability. The controllers are implemented using MATLAB/SIMULINK running on a Pentium PC. Position measurements of each joint of the robot are obtained using the channels of quadrature encoders available on all DC gear motors which are connected to the I/O card, programmed to provide the encoder signal processing each millisecond. The resolutions of encoders are rad, rad, and rad for , and , respectively. Linear power amplifiers are installed in each servomotor which applies a variable torque to each joint. These amplifiers accept control inputs from D/A converter in the range of V. Evidence of presence of Coulomb friction and backlash has been reported in .
5.2. Experimental Results
The robot manipulator was required to move in the space from the origin (the references for each joint are shown in Figure 1) to the desired positions , , and , chosen deliberately to be far from the origin. The initial velocity was set to zero for the experiment. We achieved the control goal by implementing the global regulators (11) and (14) with the weight parameters , , and on the 3-DOF manipulator. The gains of the linear part in (14) were set toAs predicted, Figure 2(a) shows convergence of the trajectories to the desired position and Figure 2(b) shows the control inputs for the disturbances-free system. In contrast to the nonlinear controller for robot position regulation presented in , initial conditions have been prespecified relatively far from the desired positions noticing that the control objective is evidently achieved.
5.3. Simulation Results
Since experimental robot is not easy to be externally perturbed, simulation results, run in MATLAB/SIMULINK, are presented to provide evidence of robustness. The dynamic model of the experimental robot is given in the Appendix. We used the same initial conditions, desired position, and gains and parameters of the controller provided in the latter subsection.
Simulations were performed affecting the model with harmonic functions as external disturbances; that is, Figure 3, which illustrates angular positions and control inputs, corroborates disturbance attenuation of the closed-loop system. For the sake of comparison, the disturbance attenuator was set to zero. The angular positions in Figure 4 show underdamped position responses whose overshoot is larger than the position responses using the proposed global regulator (Figure 3(a)). On the other hand, the applied torque, in Figure 4(b), made it evident that the closed-loop system with regulator needs less energy to stabilize the trajectories to the desired position and attenuate external disturbances.
We presented a global solution of the nonlinear regulation problem, where the HJI inequality was satisfied verifying a strict Lyapunov function proposed in . The key to guarantee that the HJI inequality was negative definite was proposing a bounded control objective () and a sufficiently small parameter . Experimental results, made for a 3-DOF robot manipulator with friction, verify the results.
The equation of motion of the experimental manipulator governed by (1) was specified by applying the Euler-Lagrange formulation , wherewherewherewith , , , and ; and finallyThe typical constant parameters, , , , and , , and their upper bounds are given in Tables 1 and 2, respectively.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
Carlos Alberto Chavez Guzmán would like to thank Programa para el Desarrollo Profesional Docente, Universidad Autónoma de Baja California, and the Program of High Quality scholarship for doctor studies.
S. Arimoto, Control Theory of Non-Linear Mechanical Systems: A Passivity-Based and Circuit-Theoretic Approach, Oxford University Press, London, UK, 1996.
R. Kelly, V. Santibanez, and A. Loria, Control of Robot Manipulators in Joint Space, Springer, London, UK, 2005.
M. Spong and M. Vidyasagar, Robot Dynamics and Control, John Wiley & Sons, New York, NY, USA, 1989.
V. Utkin, J. Guldner, and J. Shi, Sliding Modes in Electromechanical Systems, Taylor & Francis, London, UK, 1999.
W. Chung, L.-C. Fu, and S.-H. Hsu, “Motion control,” in Handbook of Robotics, B. Siciliano and O. Khatib, Eds., pp. 133–159, Springer, London, UK, 2008.View at: Google Scholar
J. Helton and M. James, Extending H∞ Control to Nonlinear Systems—Control of Nonlinear Systems to Achieve Performance Objectives, SIAM, Philadelphia, Pa, USA, 1999.
Y. V. Orlov and L. T. Aguilar, Advanced H∞ Control: Towards Nonsmooth Theory and Applications, Birkhäuser, New York, NY, USA, 2014.
M. Krstic and H. Deng, Stabilization of Nonlinear Uncertain Systems, Communications and Control Engineering, Springer, London, UK, 1998.View at: MathSciNet
S. Boyd, L. El Ghaoui, E. Feron, and V. Balakrishnan, Linear Matrix Inequalities in System and Control Theory, Studies in Applied Mathematics, SIAM, Philadelphia, Pa, USA, 1994.
M. D. S. Aliyu, Nonlinear H∞ Control, Hamiltonian Systems, and Hamilton Jacobi Equations, CRC Press, Boca Raton, Fla, USA, 2011.
T. Basar and P. Bernhard, H∞-Optimal Control and Related Minimax Design Problems: A Dynamic Game Approach, Birkhäuser, Boston, Mass, USA, 2nd edition, 1995.View at: MathSciNet
Sensoray Model 626, Sensoray Co., Inc., Tigard, Ore, USA, January 2004, http://www.sensoray.com/downloads/man_626_1.0.5.pdf.