Beruflich Dokumente
Kultur Dokumente
Fernando Reyes-Cortes
F C. E. \ Posgrado en Automatizacion
Autonomous University of Puebla
Puebla, MEXICO
lepable@ece.buap.mx
F C. E. \ Posgrado en Automatizacion
Autonomous University of Puebla
Puebla, MEXICO
freyes @ ece. buap. mx
Industrial robots are basically positioning and handling devices. A useful robot is one that is able to control its
movement and the forces it applies to its environment. To
control requires the knowledge of a mathematical model
and of some sort of experience to act on the model. The
mathematical model is obtained from the basic physical laws
governing the robot's dynamics [1].
We begin our development with the general Lagrange equation of motion [1], [5], [6], [7], [8]. Consider then Lagrange's
equations for a conservative system as given by:
d [L(q,0 1_ - L(q,
T-f(T,q)
(1)
3536
(2)
M(q)f
(3)
where q, q, C R xl are vectors of joint displacements,
velocities and acceleration respectively, M(q) C RX"T is
the symmetric positive definite manipulator inertial matrix,
C(q,q) c R"X' is the matrix of Centripetal and Coriolis
torques and g(q) C RXx 1 is the vector of gravitational torques
obtained as the gradient of the robot potential energy.
Inverse kinematics is one of the functions basic to robot manipulator control systems. Cartesian position and orientation
x of the end-effector is described as a function f of the joint
variable q [13]:
x f (q).
(4)
(5)
f-(x),
x=
J(q)q,
(6)
J(q) - 1 x
d&H (q, P) =
dt
TABLE I
JOINT COORDINATED TO CARTESIAN
W =F
(8)
equations:
aI(q, q)
OU(q)
M(q)-1p =
&7H(q, p) +
Oq
where
(12)
J(q) T
(13)
where:
[a7H(q, p)]
(10)
=
W = dH (q, p) _TT
(1 1)
dt
Expressing that the increase in energy of the system is equal
to the supplied work (conservation of energy). When forces
act on a mechanism, work (in the technical sense) is done if
the mechanism moves through a displacement [15]. Work
is defined as a force acting through a distance and is a
scalar with units of energy. Since work has units of energy
it must be the same measured in any set of generalized
coordinates. Specifically, we can equate the work done in
Cartesian terms with the work done in joint space terms [15].
In the multidimensional case, work is the dot product of a
vector force or torque and a vector displacement [15].
M(x)
M(q)C,
p)T
O11p
::
p=
+(1 H (q
Cartesian Coordinated
J(q)-4jJ(q)
4 =:: J(q) - 1 vc _ J(q) -1 j(q) J(q) - 1-xca:::= J(q) q + J(q) q
::
(&((q, ) T)
Oq
(7)
After some operations we can relate the Joint space with the
Cartesian space, obtaining the table I.
Joint Coordinated
(9)
C(x, x)
g(x)
Tx
(15)
(17)
(18)
3537
(19)
satisfies [14]:
&g(x)
Ox
<
l1(k ,f~) _
f(D)Tkpf
(x)
2
(25)
V(x, x)
2TM(X)
2
(kx x).
(26)
V ,x = 0
(27)
V x, xv4 0
and to do the derivation of the Lyapunov equation [20] we
obtain,
V(.
TJ2I_
) _
TM(X)i + i 1(l
)tr2
&l(kp,d~)T
x
'(k,
(28)
(29)
V(x, x) < O,
V(x, x)
(21)
g(x) _ &l(x)
Ox
(20)
(30)
(22)
< 0.
,Tx
(31)
d [2 _ [
dt [JH
[M(x)-
3538
V(x,x) =T
T2
) +
(33)
'
2)
The first term of V(x, xr) is a positive definite function with
respect to x because M(x) is a positive definite matrix. The
second one of Lyapunov function candidate (33) is a positive
definite function with respect to position error x, because Kp
is a positive definite matrix. Therefore V(x, xr) is a globally
positive definite and radially unbounded function.
1//n(cosh(dxv
x
xM(X) +
kXX
(x)
V(x,
AXX~
2
+
(~
-V l-n(cos~h(xn)
VI n(cosh( ))
14n(cosh(dx2))
(34)
which is a globally negative semidefinite function and therefore we conclude stability of the equilibrium point. In order to
prove asymptotic stability we exploit the autonomous nature
of closed-loop (32) to apply the LaSalle Invariance Principle:
(36)
T] T
0}
V(x xV)
(37)
JT [K,3
=TM(x)y
~//ln(cosh(xl )) l
1/n(cosh(d;i)) 1
1Vn(cosh(dn2)))
0 c R2T.
(41)
[
tanh
1
lln(c~osh(-;~))
B. Cartesian f9 Controller
Tx
(38)
V(,fPz)=- TKV
sinh(x ) 1-tanh2(xl)
sinh(2) 21-tanh (x2)
sinh(n) a1- tanh2 ()
dt
(40)
V ln(c~osh(-;xn))
In the region:
(4
V(x, x) < 0.
1T
))
1/ln(cosh(dx2))
<0
-((42)
which is a globally negative semidefinite function and therefore we conclude stability of the equilibrium point. In order to
prove asymptotic stability we exploit the autonomous nature
of closed-loop (39) to apply the LaSalle Invariance Principle:
3539
V(x,fx) < 0.
(43)
In the region
{[
CR
[T
V(xii,x) = 0}
T]
(44)
R2T.
A. Experimental Results
To support our theoretical developments, this section presents
an experimental comparison of two position controllers on
Cartesian Coordinates on three degrees of freedom Cartesian
robot manipulator. To investigate the performance among
controllers, they have been classified as TPD for the simple
PD controller and Tp represent our propose controller, both
on Cartesian space. The experimental comparison consists
in finding which is the better performance among evaluated
controllers by using the scalar-valued 2 norm. A smaller
2 represents lesser position error and thus is the better
2 [X] =
2dt
(45)
to
3540
A smaller 2 represents lesser position error and it indicates the best performance of the evaluated controller.
[In]
V. CONCLUSION
In this paper we have described an experimental equipment
for testing cartesian robot controllers with open architecture
which allows the programming of a general class of cartesian
robot controllers. The goal of the test system is to support
the research as well as to develop new cartesian control
algorithms for robot manipulators. Our theoretical results are
the propose of cartesian controllers. We have shown global
asymptotic stability for Lyapounov functions. Experiments on
cartesian robot manipulator have been carried out to show the
stability and performance for the cartesian controllers.
07
X'2
0.6
0.5
0A4
0.3
0,2
0.10
[Dergee.s]
0.5 n
(D 0403-
0
C
02-
M0.20-
0.216
0.123
T
TPD
Cartesian Controllers
Fig. 4. Performance Index.
The overall results are summarized in Figure 4 which includes the performance indexes for the analyzed controllers.
3541
[14] A. Loria and R. Ortega, "Force/Position Regulation for Robot Manipulators with Unmeasurable Velocities and Uncertain Gravity", Automatica, 36(6), 1996, 939-943.
[20] R. Kelly, and V. Santivanez, "A class of global regulators with bounded
actions for robot manipulators", Proceedings of the 35th Conference
on Decision and Control, Kobe, Japan, 1996, 3382-3387.
[25] B. De Jager and J. Banens, Experimental evaluations of robot controllers, Proceedings of the 33rd Conference on Decision and Control.
Lake Buena Vista, Fl, USA, 1994, 363-368.
[10] F. Reyes and C. Campuzano, "PD-Type Controller with Nonlinear Proporcional Gain for Robot Manipulators", XX Congreso Internacional
Acade'mico de Ingenieria Electr6nica, Puebla, M6xico, 1998, 357-360.
3542