Modelado y Simulacion - Robot 2 Grados de Libertad
Modelado y Simulacion - Robot 2 Grados de Libertad
Modelado y Simulacion - Robot 2 Grados de Libertad
org
Modelado y simulacin de un robot rgido de dos
grados de libertad
H. M. Maldonado-Del Toro
1
, R. Silva-Ortigoza
1
, E. R. Ramos-Silvestre
1
,
V. M. Hernndez-Guzmn
2
y J. C. Rivera-Daz
3
1
CIDETEC-IPN, Departamento de Posgrado, rea de Mecatrnica,
Unidad Profesional Adolfo Lpez Mateos, C.P. 07700, Mxico, D. F., Mxico.
2
Universidad Autnoma de Quertaro, Facultad de Ingeniera, C.P. 76150,
Quertaro, Mxico.
3
Centro Nacional de Actualizacin Docente, C.P. 13420, Mxico, D. F., Mxico.
E-mail: [email protected]
(Recibido el 26 de Agosto de 2010; aceptado el 22 de Marzo de 2011)
Resumen
En este trabajo se presenta la deduccin del modelo dinmico de un robot rgido de dos grados de libertad, mediante el
formulismo de Euler-Lagrange, con la finalidad de hacer ms comprensible su deduccin. Posteriormente, se realizan
las simulaciones numricas del modelo obtenido, mediante la ayuda del software Matlab
-Simulink
, con la intencin
de analizar el movimiento de los eslabones del robot. Para esto, en el modelo se introducen diferentes parmetros de
entrada (torques). Adems, este anlisis permitir la construccin de un robot rgido para aplicaciones didcticas y el
desarrollo de investigaciones en el rea de los robots rgidos.
Palabras clave: Modelado matemtico, simulacin.
Abstract
In this paper we obtain the dynamic model of two degrees of freedom rigid robot using the Euler-Lagrange equations.
We perform several numerical simulations with this model using Matlab
-Simulink
, SolidWorks
,
Mechanical Desktop
-Simulink
, Simnon,
etc. As por ejemplo en [8], se describe y evala el software
WinMechLab que sirve para simular y controlar
mecanismos. En [9], se presenta el modelo dinmico y
cinemtico de un robot paralelo de tres grados de libertad
as como las simulaciones numricas de enlaces rgidos
versus enlaces flexibles de dicho robot mediante el software
AutoFlex mdulo de ADAMS. En [10], se presenta la
simulacin numrica de la cinemtica que involucra a un
brazo robtico de seis grados de libertad empleando el
software ADAMS.
De esta manera el objetivo de este trabajo es deducir el
modelo dinmico de un robot rgido de dos grados de
libertad, y posteriormente realizar las simulaciones
numricas del modelo obtenido, para analizar el movimiento
de este ante diferentes valores de entradas al sistema. Lo
primero se consigue con la ayuda del mtodo de Euler-
Lagrange, y lo segundo con el empleo del software
Matlab
-Simulink
-Simulink
+ + +
(15)
( )
| |
1 1 2 1 1 2 2 1 2
1
,
sin( ) sin( ).
c c
L q q
ml m l g q m l g q q
q
c
= + +
c
(16)
Mientras que para el eslabn 2 se tiene que,
( )
| |
2 2
2 2 1 2 2 2 2 1 2 2 1
2
2 1 2
,
cos( )
,
c c c
L q q
m l q m l q m l l q q
q
I q q
c
= + +
c
+ +
(17)
H. M. Maldonado-Del Toro, R. Silva-Ortigoza, E. R. Ramos-Silvestre, V. M. Hernndez-Guzmn y J. C. Rivera-Daz
Lat. Am. J. Phys. Educ. Vol.5, No. 1, March 2011 324 http://www.lajpe.org
( )
| |
2 2
2 2 1 2 2 2 2 1 2 2 1
2
2 1 2 2 1 2 2 1 2
,
cos( )
sin( ) ,
c c c
c
L q q d
m l q m l q m l l q q
dt q
m l l q q q I q q
c (
= + +
(
c
+ +
(18)
( )
2
2 1 2 2 1 1 2
2
2 2 1 2
,
sin( )
sin( ).
c
c
L q q
m l l q q q q
q
m l g q q
c
( = +
c
+
(19)
Finalmente, las ecuaciones de movimiento para el sistema
mostrado en la Figura 1, tras haber empleado el mtodo de
Euler-Lagrange, quedan determinadas por,
| |
| |
2 2 2
1 1 1 2 1 2 2 2 1 2 2 1
2
2 2 2 1 2 2 2 2 1 2 2 1 2
2
2 1 2 2 2 1 1 2 1 2
1 1 2 1 1 2 2 1 2
2 cos( )
cos( ) 2 sin( )
sin( )
sin( ) sin( ),
c c c
c c c
c
c c
ml m l m l m l l q q
m l m l l q q m l l q q q
m l l q q I q I q q
ml m l g q m l g q q
t ( = + + +
( + +
+ + +
+ + + +
(20)
| |
2 2
2 2 2 1 2 2 2 2 1 2 2 1 2 1 2
2
2 1 2 2 1 2 2 1 2
cos( )
sin( ) sin( ).
c c c
c c
m l q m l q m l l q q I q q
m l l q q m l g q q
t = + + + +
+ + +
(21)
El modelo del sistema (20)-(21) puede escribirse en la
forma general,
( ) ( , ) ( ). M q q C q q q g q t = + +
(22)
O bien,
1 11 12 1
2 21 22 2
11 12 1 1
21 22 2 2
( ) ( )
( ) ( )
( , ) ( , ) ( )
,
( , ) ( , ) ( )
M q M q q
M q M q q
C q q C q q q g q
C q q C q q q g q
t
t
( ( (
=
( ( (
( ( (
+ +
( ( (
(23)
donde:
( )
( )
| |
2 2 2
11 1 1 2 1 2 2 2 1 2 2 1 2
2
12 2 2 2 1 2 2 2
2
21 2 2 2 1 2 2 2
2
22 2 2 2
11 2 1 2 2 2
12 2 1 2 2 1 2
21 2
2 cos( ) ,
cos( ) ,
( ) cos( ) ,
( ) ,
( , ) sin( ) ,
( , ) sin( ) ,
( , )
c c c
c c
c c
c
c
c
M q ml m l m l m l l q I I
M q m l m l l q I
M q m l m l l q I
M q m l I
C q q m l l q q
C q q m l l q q q
C q q m l
= + + + + +
= + +
= + +
= +
=
= +
=
| |
1 2 2 1
22
1 1 1 2 1 1 2 2 1 2
2 2 2 1 2
sin( ) ,
( , ) 0,
( ) sin( ) sin( ),
( ) sin( ),
c
c c
c
l q q
C q q
g q ml m l g q m l g q q
g q m l g q q
=
= + + +
= +
(24)
III. SIMULACIN
En esta seccin se realizan las simulaciones del modelo
dinmico obtenido en la seccin anterior, para ello se
emplea el software Matlab
-Simulink
. Para simular el
modelo del robot rgido la Ec. (23) se reescribe como un
sistema de ecuaciones diferenciales de primer orden, tras
realizar operaciones bsicas con las matrices involucradas se
obtiene lo siguiente,
22 2 12 3 1
21 2 11 3 2 1
( ) ( )
1
,
( ) ( )
M q M q q
M q M q q
A A ( (
=
( (
A + A A
(25)
donde,
1 11 22 12 21
2 1 11 1 12 2 1
3 2 21 1 22 2 2
( ) ( ) ( ) ( ),
( , ) ( , ) ( ),
( , ) ( , ) ( ).
M q M q M q M q
C q q q C q q q g q
C q q q C q q q g q
t
t
A =
A =
A =
(26)
Realizando el siguiente cambio de variables,
1 1
2 1
3 2
4 2
,
,
,
,
x q
x q
x q
x q
=
=
=
=
(27)
el modelo dinmico reescrito como (25), finalmente obtiene
la siguiente representacin,
1 2
22 5 12 6
2
4
3 4
21 5 11 6
4
4
,
,
,
,
x x
M M
x
x x
M M
x
=
A A
=
A
=
A + A
=
A
(28)
donde,
4 11 22 12 21
5 1 11 2 12 4 1
6 2 21 2 22 4 2
,
,
,
M M M M
C x C x g
C x C x g
t
t
A =
A =
A =
(29)
con las expresiones (24) ahora definidas por,
| |
2 2 2
11 1 1 2 1 2 2 2 1 2 3 1 2
2
12 2 2 2 1 2 3 2
2
21 2 2 2 1 2 3 2
2
22 2 2 2
11 2 1 2 3 4
12 2 1 2 3 2 4
21 2 1 2 3 2
22
1 1 1
2 cos( ) ,
cos( ) ,
cos( ) ,
,
sin( ) ,
sin( ) ,
sin( ) ,
0,
c c c
c c
c c
c
c
c
c
c
M ml m l m l m l l x I I
M m l m l l x I
M m l m l l x I
M m l I
C m l l x x
C m l l x x x
C m l l x x
C
g ml
= + + + + +
= + +
= + +
= +
=
= +
=
=
= + | |
2 1 1 2 2 1 3
2 2 2 1 3
sin( ) sin( ),
sin( ),
c
c
m l g x m l g x x
g m l g x x
+ +
= +
(30)
Modelado y simulacin de un robot rgido de dos grados de libertad
Lat. Am. J. Phys. Educ. Vol.5, No. 1, March 2011 325 http://www.lajpe.org
De esta manera, una vez que se tiene el modelo dinmico
del robot rgido representado en la forma (28) se procede a
realizar las simulaciones numricas. Es conveniente
mencionar que como resultado de simular (28) se
encuentran las posiciones de los eslabones, es decir,
1
q
y
2
q
, as como las velocidades,
1
q
y
2
q
. Estos a su vez no son
representativos en el plano X-Y, motivo por el cual se
recurre a las relaciones que gobiernan a la cinemtica del
robot rgido. Es claro de la Figura 1 que el modelo
cinemtico del sistema asociado al punto (x,y) est dado por:
( ) ( )
( ) ( )
1 1 2 1 2
1 1 2 1 2
sin sin ,
cos cos ,
x l q l q q
y l q l q q
= + +
= + +
(31)
el cual queda completamente determinado con la
introduccin de las coordenadas articulares
1
q
y
2
q
,
obtenidas de simular el modelo dinmico (28).
Para realizar las simulaciones se consideraron los
parmetros mostrados en la Tabla I. Mientras que en la
Figura 2 se presenta el diagrama a bloques desarrollado en
Matlab
-Simulink
-Simulink
.
FIGURA 3. Posicin inicial del robot rgido.
H. M. Maldonado-Del Toro, R. Silva-Ortigoza, E. R. Ramos-Silvestre, V. M. Hernndez-Guzmn y J. C. Rivera-Daz
Lat. Am. J. Phys. Educ. Vol.5, No. 1, March 2011 326 http://www.lajpe.org
FIGURA 4. Resultados de la simulacin 1 para valores de
1
= 0
N-m y
2
= 0.15 N-m.
b) Simulacin 2: Para esta simulacin se imponen los
valores de torque siguientes:
1
= 1.3 N-m y
2
= 0 N-m. En
esta simulacin se genera una elipse de radio mayor que en
la anterior simulacin, debido a que ahora el movimiento es
realizado por el eslabn 1 en el plano X-Y, lo anterior se
muestra en la Figura 5.
FIGURA 5. Resultados de la simulacin 2 para valores de
1
= 1.3
N-m y
2
= 0 N-m.
c) Simulacin 3: Para esta simulacin se imponen valores
diferentes de cero a ambos torques, es decir,
1
= 1.6 N-m y
2
= 0.8 N-m. Segn se observa en la Figura 6, ambos
eslabones se mueven en el plano X-Y generando un
movimiento elptico, es decir se genera una elipse de radio
mayor (debido al eslabn 1) formada por elipses de radio
menor (debido al eslabn 2).
d) Simulacin 4: Aqu, se aplican valores de torques
distintos de cero con sentido contrario, es decir
1
= 1.6 N-m
y
2
= -0.3 N-m. De acuerdo a la Figura 7, en el plano X-Y
para el eslabn 1 se genera una trayectoria similar a la
mencionada en la simulacin 3, mientras que para el eslabn
2 el sentido de giro, respecto a la simulacin 3, cambia de
sentido.
FIGURA 6. Resultados de la simulacin 3 para valores de
1
= 1.6
N y
2
= 0.8 N.
FIGURA 7. Resultados de la simulacin 4 para valores de
1
= 1.6
N-m y
2
= -0.3 N-m.
IV. CONCLUSIONES
En este artculo se dedujo el modelo dinmico de un robot
rgido de dos grados de libertad mediante el formalismo de
Euler-Lagrange, y como se pudo observar el procedimiento
de su deduccin a pesar de ser laborioso resulta sencillo de
comprender, en comparacin a las deducciones presentadas
en la literatura asociada a esta clase de sistemas mecnicos.
Por otro lado, con la finalidad de comprender de mejor
manera el movimiento de los eslabones del sistema
modelado, se desarrollo un programa en Matlab
-
Simulink