Documente Academic
Documente Profesional
Documente Cultură
I. INTRODUCTION
Most industrial robots are equipped with gearboxes,
harmonic drives and chain or belts, which may introduce
undesirable elastic deformations in the robot joints.
These elastic coupling introduce one additional degree of
freedom at each joint so that it requires 2n generalized
coordinates to describe the configuration of a n-link
robot manipulator [9].
A common approach to address the basic pointto-point regulation problem is by using proportional plus
derivative (PD) controllers with gravity compensation
[3,7,12]. The regulation problem without velocity measurements has been addressed in [3,8,10]. Recently in [9]
it has been shown that the controller in [12] belongs to
the class of energy shaping controllers, and the energy
shaping methodology is extended to include the formulation when only position (but no velocity) is available for
measurement. The extension is based on class of reduced-order observers introduced in [4].
On the other hand, a variety of formulations have
been used to solve the control problem in presence of
unavoidable uncertain gravity torques [1,8,12]. In [1] a
PD control action with an iterative scheme to learn (unknown) gravity torques is proposed. An essential tool in
the design and stability analysis of iterative schemes is
the contraction mapping theorem. Recently, this apManuscript received March 21, 2001; revised July 13, 2001;
accepted January 30, 2002.
Jose Alvarez-Ramirez is with Universidad Autonoma Metropolitana Iztapalapa, Division de Ciencias Basicas e Ingenieria, Apartado Postal 55-534, Mexico D.F. 09340, MEXICO.
Ilse Cervantes is with Seccion de Estudios de Posgrado e
Investigacion ESIME-Culhuacan, Av. Santa Ana 1000, Col.
San Francisco Culhuacan, Mexico D.F., 04430 MEXICO.
proach has been extended to electrically-driven elastic-joints [2]. The proposed iterative scheme involves
discrete-time computations of the on-line estimated
gravity torques and guarantees practically stability (i.e.,
every system response converges to an arbitrarily small
neighborhood of the equilibrium point).
Sufficient conditions for the stability (i.e., globally,
ultimately bounded signals) of the controlled robotic
system with PD control and estimated gravitational
torques, are provided in [8,12]. Global convergence of
controlled trajectories to a unique equilibrium point is
proven. However, due to the presence of uncertain stiffness parameters and gravitational torques, a steady-state
is present in the controlled system. Departing from linear
control theory arguments, a easy solution to remove
steady-state offset is to add a linear integral action on the
feedback law. In virtually all present day robotic applications, PD actions are used together with a classical integral action on the link position to compensate the uncertainty of the system and to ensure that the equilibrium
position coincides with the desired one. There are many
reasons for that, including their long history of proven
operation, the fact that they are well understood by many
industrial operational, technical and maintenance individuals. In spite of its proven robust functioning capability in industrial applications, the PID control of elastic
joint robot manipulators still lacks of understanding and
systematization in the sense of modern control approaches. The systematization is required to simplify the
construction, the tuning and the maintenance of the control schemes; and the understanding issue is important to
assess the basic capabilities and limitations in control
designs intended for high performance with adequate
robustness levels and safety margins. This motivates and
justifies the present work, where some of the aforementioned issues are studied.
J. Alvarez-Ramirez and I. Cervantes: PID Regulation of Robot Manipulators with Elastic Joints
II. PRELIMINARIES
dominate over the gravity torques in the sense that stiffness matrix K satisfies:
min ( K ) > k g
(3)
Property 3 is crucial for the solvability of the position control problem (see [10]) In fact, Property 3 establishes that the robotic system is able to reach the desired
position for a given payload.
Model (1) and Properties (1)-(3) define the class of
elastic-joint robotic systems under consideration. The
class of PD controllers with classical integral action (PID
control, in short) is given as follows. Let q1,d n be a
desired link position. Consider a continuous dissipative
function f( q 2 ) C2 such that [9]
f (q 2 ) = 0 if q 2 = 0 n
q 2T f (q 2 ) > 0 for all q 2 0 n
(4)
By assuming elasticity modeled as a linear torsional spring and the angular contribution of the kinetic
energy of each rotor due only to its rotation, the simplified dynamic model of a n-degree-of-freedom robot manipulator with flexible joints and gravity torques are
given by [11]:
Jq2 + K ( q 2 q1 ) =
33
(2)
D( (0) = 0 n
where
q 2, d = q1, d + K 1 g (q1, d ) n
(5)
is the estimated rotor position corresponding to the desired link position q1,d n , K is the estimate of K, and
g (q1,d) is an estimate of the gravitational torques at the
desired link position. The PID control law is given in
terms of (( q 2, d q2) as
= D( (q 2, d q 2 ) f (q 2 ) + g (q1, d )
t
+ K I 0 [q1, d q1 ( )]d
(6)
1
(q 2, d q 2 ) T KP( q 2, d
2
q2) and f ( q 2 ) = KD q 2 , where Kp and KD are positive-definite matrices, the controller (6) becomes a classical linear PID controller
Remark 1. If ( (q 2, d q 2 ) =
= K P ( q 2, d q 2 ) K D q 2 + g ( q1, d )
t
+ K I 0 [q1, d q1 ( )]d
(7)
34
def
f (q 2 ) + g (q1, d ) + I
(9)
For a given I n , the equilibrium position ( q1 , q 2 )T
2n of (9) are defined by
= ( q1 , q 2 ; I )
= D( (q 2,d q 2 ) f ( q 2 ) + g (q1,d ) + I
(8)
def
g ( q1 ) K ( q 2 q1 )
K (q q ) D( (q q ) g (q ) = 0 (10)
2
1
2, d
2
1, d
I
def
I / q I is a positive-definite matrix
J. Alvarez-Ramirez and I. Cervantes: PID Regulation of Robot Manipulators with Elastic Joints
1
1
q1 M (q1 )q1 + q 2 Jq 2 + U T (q1 , q 2 )
2
2
where
U T ( q1 , q 2 ) =
1
(q d ,1 q1 ) T K (q d ,1 q1 ) + G (q1 ) G (q d ,1 )
2
+ g (q1, d ) T (q d ,1 q1 )
L
is a negative semidefinite function. Thereand so V(12)
fore, by invoking the LaSalles invariance principle, asymptotic, hence exponential stability of the linear system
(12) is demonstrated.
(q d ,1 q1 ) T K (q d ,2 q 2 ) + ( (q 2, d q 2 )
x = f ( x, z I )
1
+ (q d ,2 q 2 ) T K (q d ,2 q 2 )
2
z I = K I (q1,d x1 )
and #(q2) the potential function of stiffness torques. Notice that UT(q1,d, q2,d) = 0. The time derivative of V along
the trajectories of system (9) satisfies that
V q 2T f (q 2 )
1 T
[q 2 D( (q 2, d q 2 )q 2 + q1T Dg (q1 )q1
2
+(q 2 q1 ) T K (q 2 q1 )]
35
(13)
with f(x, zI) = (f1(x, zI)T, f2(x, zI)T, f3(x, zI)T, f4(x, zI)T)T
4n , where
f 1 ( x, z I ) = x 2
f 2 ( x, z I ) = M ( x1 ) 1{C ( x1 , x 2 ) x 2 g ( x1 ) + K ( x 3 x1 )}
f 3 ( x, z I ) = x 4
f 4 ( x, z I ) = J 1{ K ( x 3 x1 ) + T PID ( x, z I )}
(14)
(15)
As in [5], let us shift the origin to the equilibrium point.
First, define the constant input I,d n corresponding
to the desired position q1,d n as follows:
q1, d = 1 ( I , d )
(16)
(17)
K I D a ( z I + I , d ) E1[ a ( I , d ) a ( z I + I , d ) x ]
z I = K I E1[ a ( I , d ) a ( z I + I , d ) x ]
where E1
def
(18)
diag[In n,0n n, 0 n n, 0 n n] 4 n 4 n .
36
= f ( + a ( I + I , d ), I + I , d )
K I D a ( I + I , d ) E1[ a ( I , d ) a ( I + I , d ) ]
I = K I E1[ a ( I , d ) a ( I + I , d ) ]
(19)
(20)
I = K I E1[ a ( I , d ) a ( I + I , d )]
(21)
I = K I [ 1 ( I , d ) 1 ( I + I , d )]
(22)
(23)
J. Alvarez-Ramirez and I. Cervantes: PID Regulation of Robot Manipulators with Elastic Joints
37
0.62
0.76 + 0.51cos( q 2 )
7.6sin(q1 ) + 063sin(q1 + q 2 )
G ( q) = g
0.63sin(q1 + q 2 )
0.51sin(q 2 )q 2
C (q, q ) =
0.51sin(q 2 ) q 1
38
the system about the desired equilibrium even in presence of uncertain gravitational and elastic torques.
V. CONCLUSIONS
This paper is devoted to study the stability of robot
manipulators with flexible joints under a class of linear
PID control. It is proved that asymptotic stability of the
desired position can be achieved, even if the gravitational and elastic forces are unknown. Specifically, it is
proved that a PD action on the joint error and an integral
action on the link error suffice to assure asymptotic stability of any desired position on a compact set. It is
shown that for given derivative and proportional gains
satisfying certain conditions, the size of the guaranteed
basin of attraction grows as the integral gain is reduced.
REFERENCES
1. Ailon, A., Output Controllers Basen on Iterative
Schemes for Set-point Regulation of Uncertain Elastic-joint Robot Models, Automatica, Vol. 32, pp.
1455-1461 (1976).
2. Ailon, A., R. Lozano and M.I. Gil, Iterative Regulation of an Electrically Driven Elastic-joint Robot
with Model Uncertainty, IEEE Trans. Rob. Autom.,
Vol. 16, pp. 863-869 (2000).
3. Ailon, A. and R. Ortega, An Observed-based
Set-point Controller for Robot Manipulators with
Flexible Joints, Syst. Contr. Lett., Vol. 21, pp.
329-335 (1993).
4. Arimoto, S., V. Parra-Vega and T. Naniwa, A Class
of Linear Velocity Observers for Nonlinear Mechanical System, in Proc 1st Asian Contr. Conf., Vol
2, pp. 633-636, Tokyo, Japan (1994).
5. Desoer, C. and C-A. Lin, Tracking and Disturbance
Rejection of MIMO Nonlinear System with PI Controller, IEEE Trans. Automat. Contr., Vol. AC-30,
pp. 861-867 (1985).
6. Hoppensteadt, F., Asymptotic Stability of Singular
Perturbation Problems. II: Problems Having Matched
Asymptotic Expansion Solutions. J. Diff. Equat.,
Vol. 15, pp. 510-521 (1974).
7. Kelly, R., Comments on Adaptive PD Controller
for Robot manipulator, IEEE Trans. Rob. Autom.,
Vol. 9, pp. 117-119 (1993).
8. Kelly, R., R. Ortega, A. Ailon and A. Loria, Global
Regulation of Flexible Joint Robots Using Approximate Differentiation, IEEE Trans. Automat.