Академический Документы
Профессиональный Документы
Культура Документы
RESUMEN
Uno de los principales problemas en el control de robots manipuladores es el lograr que el efector final llegue a
una posicin deseada. Para la mayora de las metodologas de control, es necesario conocer el modelo dinmico del
robot para realizar el diseo del controlador.
En ste trabajo se desarrolla el proceso de modelado de un robot manipulador, teniendo por objeto de estudio el
robot SCORBOT ER-V+. El modelado cinemtico directo se realiza por medio del algoritmo de Denavit-Hartenberg,
el modelo cinemtico inverso se obtiene por mtodos geomtricos y el modelo dinmico se obtiene por medio de la
metodologa de Euler-Lagrange.
Los modelos cinemticos obtenidos son validados por comparacin de los resultados que se obtienen con los
resultados de una referencia externa, utilizando un conjunto de coordenadas. El modelo dinmico se valida por la
comparacin con datos recabados durante el movimiento del robot, comparando los pares articulares que se
requiriere que entreguen los motores para seguir una trayectoria preseleccionada.
Los resultados muestran que se obtiene un modelo dinmico que presenta un comportamiento muy cercano al
comportamiento del sistema real. As como es posible observar el procedimiento de modelado de un robot de 3
grados de libertad.
Cdigo 1317
INTRODUCCIN
El control de robots manipuladores es un rea madura dentro del control de sistemas dinmicos, sin embargo son
pocos los documentos que nos muestran como desarrollar el modelo dinmico de un robot de ms de dos grados de
libertad (gdl). En el presente documento se desarrolla el modelado cinemtico y dinmico de los primeros tres gdl del
robot SCORBOT ER-V+, los cuales son los encargados de posicionar al efector final.
Al comienzo se presenta el robot SCORBOT ER-V+. Enseguida se describe el modelado cinemtico directo e
inverso. Despus se presenta el procedimiento de modelado dinmico del robot. A continuacin se presentan los
resultados de la validacin de los modelos cinemticos y dinmicos. Para terminar se realiza un anlisis del costo
computacional de la implementacin de los modelos. Finalmente, se resume y presenta las conclusiones de este
trabajo.
ROBOT SCORBOT ER-V+
En la figura 1-A se presenta al robot SCORBOT ER-V+. Este robot se encuentra en el laboratorio de Mecatrnica
del Centro Nacional de Investigacin y Desarrollo Tecnolgico (CENIDET).
Los parmetros estructurales del robot SCORBOT ER-V+, de los se cuenta con su valor se enlistan a
continuacin:
1.
2.
3.
4.
5.
6.
2
Momento de inercia del eslabn 1: I1 0.04624 kgm
2
Momento de inercia del eslabn 2: I 2 0.02595 kgm
2
Momento de inercia del eslabn 3: I 3 0.03616 kgm
i i 1, 2,3 : Angulo de giro de la i-sima articulacin.
Los parmetros se obtuvieron en [1] por medio de modelado en el programa de diseo mecnico PROENGINEERING, los parmetros obtenidos por este procedimiento son las masas y longitudes de los elementos.
Los valores de la ubicacin del centro de masa y los momentos de inercia de los eslabones se obtienen de [2].
MODELO CINEMTICO
Modelado Cinemtico Directo
Para desarrollar el modelo cinemtico directo, se sigue el algoritmo de Denavit-Hartenberg (DH). Como se
observa en [3]. La figura 1-B muestra el diagrama de bloques cinemticos.
De la figura 1-B y el algoritmo de DH se obtiene la tabla 1 que muestra los parmetros DH del robot.
di
ai
1
2
3
l1 (0.364 m)
0
0
l2 (0.22 m)
90
0
0
l3 (0.22 m)
Con los parmetros de la tabla anterior se obtiene la matriz de transformacin de cada uno de los elementos de la
cadena cinemtica. Por simplicidad Ci Cosi y Si Seni .
C1 0 S1 0
S 0 C 0
1
0
A1 1
0 1 0 l1
0 0 0 1
C2 S 2 0 l2C2
S
C2 0 l2 S2
1
A2 2
0
0 1
0
0 0
1
0
C3
S
2
A3 3
0
S3
C3
0
0
0 l3C3
0 l3 S3
1 0
0 1
(1)
(2)
(3)
Con las matrices anteriores, se puede obtener la matriz de transformacin homognea de la cadena cinemtica
completa.
C1C2 3
SC
T 1 2 3
S2 3
C1 S 2 3
S1 S2 3
C2 3
0
S1 l3C1C2 3 l2 C1C2
C1 l3 S1C2 3 l2 S1C2
0
l3 S 2 3 l2 S 2 l1
0
1
(4)
La ltima columna de la matriz T de la Ec. (4), corresponde a las ecuaciones de la posicin del efector final.
px l3C1C2 C3 l3C1 S 2 S3 l2C1C2
p y l3 S1C2 C3 l3 S1 S 2 S3 l2 S1C2
(5)
(6)
pz l3 S2 C3 l3C2 S3 l2 S2 l1
(7)
Las Ec. (5), (6) y (7) forman el modelo cinemtico directo del robot SCORBOT ER-V+.
Modelo Cinemtico Inverso
Las ecuaciones que conforman el modelo cinemtico inverso, se obtienen de las relaciones geomtricas existentes
en la figura 2.
a) Esquema superior
b) Esquema lateral
Px
1 arctg
arccos
Px2 Py2
Pz
2 arctg
1 cos 2
r 2 Pz2 l22 l32
3
, cos3
cos3
2l2 l3
3 arctg
(8)
(9)
(10)
MODELO DINMICO
El modelo dinmico del robot manipulador se obtiene por medio de las ecuaciones de Euler-Lagrange [4], como
primer paso se deben obtener las energas cinticas de los eslabones del robot manipulador. En un robot manipulador
la energa cintica se encuentra conformada por suma de la energa cintica traslacional y la energa cintica
rotacional.
K i q, q&
1
1 &2
mi v 2 I i&
2
2
(11)
Enseguida, se obtienen las energas potenciales de los eslabones del robot manipulador.
U i q mi gh
(12)
Como tercer paso se obtiene el Lagrangiano del sistema. El cual se encuentra determinado por la diferencia entre
la energa cintica total1 y la energa potencial total2.
L q, q& K q, q& U q
1
(13)
La energa cintica total de un robot manipulador esta determinada por la suma de las energas cinticas de cada uno
de sus eslabones.
2
La energa potencial total de un robot manipulador esta determinada por la suma de las energas potenciales de cada
uno de sus eslabones.
Enseguida, se desarrolla la siguiente ecuacin para cada una de las coordenadas articulares.
d L
L
dt &
i
i
(14)
A continuacin se detalla el desarrollo del modelo dinmico del robot SCORBOT ER-V+ por medio de las
ecuaciones de Euler-Lagrange. Como primer paso se obtienen las energas cinticas de cada uno de los eslabones.
Como el primer eslabn, solamente rota alrededor del eje z, nicamente cuenta con energa cintica rotacional.
1
2
K1 &, I1&
1
2
(15)
Para los siguientes eslabones las ecuaciones de sus energas cinticas son las siguientes:
1
2
2
2
&2 1 I &2 &2
K 2 &, m2 lc 2 2&
2 lc 2 cos 21
2
1
2
2
2
(16)
1
1
2
2
2 && 1
2
&2 1 m l 2 cos2 &2
K 3 &, m3lc 32&
m3lc 32&
m3l2 2&
2
3 m3 lc 3 2 3
2 m3l 2lc 3 cos 2 cos 2 3 1
3 c3
2
3
1
2
2
2
2
1
2
& & & 1 I &2 & & 2
m3l2 2 cos 2 2 &
1 m3 l2 lc 3 cos 3 2 2 3
3
1
2
3
2
2
1
1
1
2 &2
2 &2
2 && 1
2 &2
2
2
&
K 4 , m f l3 2 m f l3 3 m f l3 2 3 m f l2 2 m f l2 l3 cos 2 cos 2 3 &
m f l3 2 cos 2 2 3 &
1
1
2
2
2
2
1
2
& & &
m f l2 2 cos 2 2 &
1 m f l2 l3 cos 3 2 2 3
2
(17)
(18)
Siguiendo con el proceso de modelado, se deben obtener las expresiones de las energas potenciales.
U1 m1 gh
(19)
U 2 m2 g h lc 2 sen 2
(20)
U 3 m3 g h l2 sen 2 lc 3 sen 2 3
(21)
U 4 m f g h l2 sen 2 l3 sen 2 3
(22)
2
2
2
2
1
1
2
2
& & &
m f l32 cos 2 2 3 &
m f l2 2 cos 2 2 &
1
1 m f l2 l3 cos 3 2 2 3 m1 gh m2 g h lc 2 sen 2
2
2
m3 g h l2 sen 2 lc 3 sen 2 3 m f g h l2 sen 2 l3 sen 2 3
(23)
Desarrollando la Ec. (14) para cada una de las articulaciones del robot manipulador se obtienen las Ec. (24), (25) y
(26).
2
2
2
& I &
& &
&
&
&
&&
&&
I1&
1
2 1 I 31 m2 lc 2 cos 21 2m2 lc 2 cos 2 sen 21 2 2 m3 l2 lc 3 m f l2 l3 sen 2 cos 2 3 1 2
& &
&
&
2 m3l2 lc 3 m f l2 l3 cos 2 sen 2 3 &
1 2 3 2 m3l2 lc 3 m f l2 l3 cos 2 cos 2 3 1
(24)
2
2
2
& &
&
&
2 m3lc 3 m f l3 sen 2 3 cos 2 3 &
1 2 3 m3 lc 3 m f l3 cos 2 3 1
2
2
2
&
&
2 m3 m f l2 2 sen 2 cos 2&&
1 2 m3 m f l2 cos 2 1 1
2 c2
3 c3
3 2
f 3
f 2
3 c3
f 3
3 2 c3
3 2 c3
f 2 3
3 2 c3
f 2 3
3 2 c3
2 1
f 2 3
2
1
(25)
f 3
f 3
2 3
3 c3
3 c3
f 2 3
3 2 c3
2 c2
f 2 3
c2
2 2
3 2 c3
f 2 3
2&
2&
& m l 2&
&
&&
&
&
&&
&
&
m3lc 3 &
3
3 c 3 2 m3l2 lc 3 sen 3 2 3 m f l3 3 m f l3 2 m f l2 l3 sen 3 2 3 m f l2 l3 cos 3 2
2
2
2
&
&
&2
m3l2 lc 3 cos 2 sen 2 3 &
1 m3l 2 lc 3 cos 3 2 m3 lc 3 cos 2 3 sen 2 3 1 m f gl3 cos 2 3
&
&
&
m l l sen m gl
(26)
2
& &
&2
&2
m3l2 lc 3 sen 3 &
2 2 3 m f l2 l3 cos 2 sen 2 3 1 m f l3 cos 2 3 sen 2 3 1
f 2 3
c3
& &
&
cos 2 3 I 3 &
2
3
3
Las Ec. (24), (25) y (26) forman el modelo dinmico del robot manipulador SCORBOT ER-V+. El modelo
formado por las ecuaciones anteriores puede descomponerse en la siguiente forma:
& C ,&& g
M &
(27)
A continuacin se enlistan los elementos que componen a las matrices de la Ec. (27).
M 11 m2 lc 2 2 cos 2 2 2m3l2 lc3 cos 2 cos 2 3 m3lc3 2 m f l3 2 cos 2 2 3 m3 m f l2 2 cos 2 2
(28)
M 12 0
(29)
M 13 0
(30)
M 21 0
(31)
(32)
(33)
M 31 0
(34)
C11
(35)
M 33 m3lc3 m f l3 I 3
2
(36)
& &
, & m3l2 lc 3 m f l2l3 sen 2 cos 2 3 &
2 m3 l2 lc 3 m f l2 l3 cos 2 sen 2 3 2 3
C ,& m m l sen cos & m l l m l l sen cos & m l cos sen &
m l l m l l cos sen & m l m l sen cos &
C ,& m l l m l l cos sen & m l m l sen cos &
C ,& m l cos sen & m l l m l l cos sen & m m l cos sen &
m l m l cos sen & m l l m l l sen cos &
C , & m l l m l l sen &
2
2
&
&
&
m3lc 32 m f l32 sen 2 3 cos 2 3 &
2 3 m3 m f l2 sen 2 cos 2 2 m2 lc 2 cos 2 sen 2 2
2
12
2 1
3 2 c3
f 2 3
3 2 c3
f 2 3
3 c3
3 2 c3
f 2 3
2 c2
f 3
3 c3
f 3
3 c3
2 1
3 2 c3
f 2 3
f 3
(38)
(39)
2 c2
2 1
21
13
(37)
22
3 2 c3
f 2 3
3 2 c3
f 2 3
(40)
(41)
&
C23 ,& m3l2 lc3 m f l2 l3 sen 3 &
2 m3l2 lc 3 m f l2 l3 sen 3 3
(42)
&
C31 ,& m3l2 lc 3 m f l2l3 cos 2 sen 2 3 &
1 m3 lc 3 m f l3 cos 2 3 sen 2 3 1
2
C32
&
, & m3l2lc3 m f l2l3 sen 3 &
2 3
(43)
(44)
(45)
g1 0
(46)
(47)
g3 m3lc 3 m f l3 g cos 2 3
(48)
2
t
400
2
t
400
(49)
La figura 3 muestra la grfica de la diferencia entre los pares requeridos de cada uno de los modelos para seguir la
trayectoria seleccionada.
Como se ve, no existe diferencia entre la respuesta de los dos modelos.
Tao1,Nm
x 10
-15
Diferencia entre las respuestas de los modelos para el robot SCORBOT ER-V+
1
0
-1
-2
x 10
20
40
60
80
100
120
140
160
180
200
20
40
60
80
100
120
140
160
180
200
20
40
60
80
100
Tiempo (seg)
120
140
160
180
200
-15
Tao2,Nm
0
-5
-10
Tao3,Nm
0
x 10
-15
2
0
-2
En [6] se encuentran las formulas para calcular el nmero de operaciones requeridas para obtener el modelo
dinmico de un robot manipulador por la formulacin de Newton-Euler.
126n 99
106n 92
(50)
(51)
La Ec. (50) nos muestra el nmero de multiplicaciones y la Ec. (51) nos muestra el nmero de sumas que son
requeridas por la formulacin Newton-Euler.
Para la formulacin de Euler-Lagrange (iterativa) las frmulas son las siguientes:
32n 4 86n3 171n 2 53n 128
25n 4 66n3 129n 2 42n 96
(52)
(53)
Las Ec. (52) y (53) nos dan el nmero de multiplicaciones y sumas para obtener el modelo dinmico por medio
de la formulacin iterativa de Newton-Euler.
Como se ve por simple inspeccin de las Ec. (50) a (53), la formulacin de Newton-Euler es mucho ms eficiente.
Para nuestro modelo dinmico que utiliza la formulacin de Euler-Lagrange (cerrada) no se cuenta con una frmula
para determinar la cantidad de clculo. La tabla 2 nos muestra los clculos necesarios para obtener el modelo
dinmico del robot SCORBOT ER-V+.
Tabla 2. Operaciones para la evaluacin del modelo dinmico del robot SCORBOT ER-V +
Formulacin
Newton-Euler
Euler-Lagrange iterativa
Euler-Lagrange cerrada
Multiplicaciones
279
6484
303
Sumas
226
6498
101
Total
505
12982
404
Como se ve, a travs de los nmeros presentados en la tabla 2 el modelo dinmico obtenido por la formulacin
cerrada requiere un nmero menor de clculos.
SUMARIO Y CONCLUSIONES
En el presente documento se presenta el desarrollo del modelado cinemtico y modelado dinmico de los tres
primeros gdl del robot SCORBOT ER-V+. El modelo dinmico se obtuvo por la formulacin de Euler-Lagrange. Los
modelos obtenidos en el documento fueron validados por comparacin con trabajos de referencia.
El proceso de modelado cinemtico de la posicin es sencillo, lo ms complicado que se tiene que realizar es la
multiplicacin de las matrices de transformacin para cada eslabn. El modelado dinmico de un robot manipulador
por medio de la formulacin de Euler-Lagrange cerrada es un proceso sistemtico, sencillo de realizar y se obtiene
los mismos elementos que formulaciones iterativas.
Dependiendo de la estructura del robot manipulador la formulacin cerrada del modelo dinmico presenta un
menor costo computacional en comparacin con las formulaciones iterativas. Si se requiere saber con exactitud el
numero de clculos que se tienen que realizar para evaluar el modelo dinmico de un robot manipulador la
formulacin iterativa de Newton-Euler representa la opcin elegir, esto es, porque tiene un numero fijo de clculos a
realizar sin importar la estructura del robot manipulador, y porque el nmero de clculos es menor a la formulacin
de Euler-Lagrange iterativa.
AGRADECIMIENTOS
Al CENIDET por contar con sus instalaciones para este proyecto. A COSNET por el apoyo brindado a este
proyecto.
REFERENCIAS
1.
S. Abdala y R. eco. Caracterizacin de un robot manipulador articulado, Tesis de Maestra, Centro Nacional
de Investigacin y Desarrollo Tecnolgico, Cuernavaca, Morelos, Mxico, 2003.
2.
3.
4.
R. Kelly y V. Santibez, Control de Movimiento de Robots Manipuladores, Pearson Educacin, Espaa, 2003
5.
6.
J. J. Craig. Introduction to Robotics: Mechanics and Control. Pearson, Estados Unidos, 2006
UNIDADES Y NOMENCLATURA
mi
li
lci
Ii
i
di
ai
i
Ci
Si
i 1
T
px
py
pz
r
&
i
K i &,
Ui
L &,
&
&
&
&
&
C ,&
q t
n
M ij
Cij , &
elemento del i-simo rengln e i-sima columna de la matriz de fuerzas centrifugas y de coriolis
gi
(adimensional)
i-simo elemento del vector de pares gravitacionales (adimensional)