Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Dialnet ModeladoYSimulacionDeUnRobotRigidoDeDosGradosDeLib 3699889
Dialnet ModeladoYSimulacionDeUnRobotRigidoDeDosGradosDeLib 3699889
grados de libertad
H. M. Maldonado-Del Toro1, R. Silva-Ortigoza1, E. R. Ramos-Silvestre1,
V. M. Hernndez-Guzmn2 y J. C. Rivera-Daz3
1
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. This is done in order to study
robot response when different input signals are used as torques. These results will be used to construct a rigid robot
which will be employed for teaching and research in the field of rigid robot control.
Keywords: Mathematical modeling, simulation.
PACS: 07.07.Tw, 07.05.Dz, 45.40.Ln, 45.40.-f
ISSN 1870-9095
I. INTRODUCCIN
En el contexto actual la nocin de robtica implica una idea
preconcebida de una estructura mecnica, capaz de
adaptarse a diferentes acciones desarrolladas con alta
precisin. Actualmente, el desarrollo de un pas se mide por
ndice de poblacin de robots industriales versus mano de
obra [1]. Algunas aplicaciones de la robtica se pueden
encontrar en el ramo industrial, militar, educativo,
agricultor, exploracin espacial, entretenimiento, asistencia
mdica, seguridad, etc. Con la finalidad de facilitar las
actividades donde se pone en riesgo la integridad fsica de
las personas, as como explorar reas que resultaran
nocivas para el ser humano, y tambin para la ejecucin de
trabajos repetitivos de alta precisin los cuales podran
ocasionar lesiones en las personas.
Dentro de la robtica, en general una de las reas ms
estudiadas es el control de brazos robticos, dichos brazos
robticos se caracterizan por ser sistemas dinmicos de
mltiples entradas y mltiples salidas (conocidos como
sistemas multivariables) de tipo no lineal [2].
Lat. Am. J. Phys. Educ. Vol.5, No. 1, March 2011
321
http://www.lajpe.org
dt q
q
(1)
(2)
II. MODELADO
K (q, q) K1 (q, q) K2 (q, q),
(3)
y
U (q) U1 (q) U 2 (q).
322
(4)
http://www.lajpe.org
2 1
(5)
1 2 2 1 2 1
m1lc1q1 I1q1 m2l12 q12
2
2
2
1
2
2
m2lc 2 q1 2q1q2 q22 q12
2
m2l1lc 2 q12 q1q2 cos(q2 )
L ( q, q )
x1 lc1 sin q1 ,
1
2
I 2 q1 q2 m1lc1 g cos(q1 ) m2l1 g cos(q1 )
2
m2lc 2 g cos(q1 q2 ).
(6)
y1 lc1 cos q1 ,
d L(q, q) L(q, q)
1 ,
dt q1
q1
L q, q
m1lc21 m2l12 q1 m2lc22 q1 q2
q1
(8)
(14)
I1q1 I 2 q1 q2 ,
d L q, q
2
2
2
(9)
(15)
L q, q
m1lc1 m2l1 g sin(q1 ) m2lc 2 g sin(q1 q2 ). (16)
q1
K1 (q, q)
(13)
d L(q, q) L(q, q)
2,
dt q2
q2
(7)
y2 l1 cos q1 lc 2 cos q1 q1 ,
(12)
1 2 2 1 2
m1lc1q1 I1q1
2
2
1
1
K 2 (q, q) m2l121q12 m2lc22 q12 2q1q2 q22 q12
2
2
1
2
2
m2l1lc 2 q1 q1q2 cos(q2 ) I 2 q1 q2 .
2
(10)
L q, q
m2lc22 q1 m2lc22 q2 m2l1lc 2 cos(q2 )q1
q2
(17)
I 2 q1 q2 ,
323
http://www.lajpe.org
d L q, q
2
2
(18)
L q, q
m2l1lc 2 sin(q2 ) q12 q1q2
q2
(19)
m2lc 2 g sin(q1 q2 ).
donde,
1 M 11 (q) M 22 (q) M 12 (q ) M 21 (q ),
2 1 C11 (q, q)q1 C12 (q, q)q2 g1 (q),
x1 q1 ,
x2 q1 ,
x4 q2 ,
(22)
x2
O bien,
1 M 11 (q)
M (q)
2 21
C ( q, q )
11
C21 (q, q)
M 12 (q) q1
M 22 (q) q2
(27)
x3 q2 ,
(21)
M 22 5 M 12 6
,
4
(28)
x3 x4 ,
x4
(23)
C12 (q, q) q1 g1 (q )
,
C22 (q, q) q2 g 2 (q)
M 21 5 M 11 6
,
4
donde,
4 M 11M 22 M 12 M 21 ,
donde:
2
2 1
2
2 c2
6 2 C21 x2 C22 x4 g 2 ,
(29)
5 1 C11 x2 C12 x4 g1 ,
M 11 q m l m l m l 2m2l1lc 2 cos(q2 ) I1 I 2 ,
2
1 c1
(26)
(20)
(25)
M 22 m2lc22 I 2 ,
C22 (q, q) 0,
(30)
g 2 (q ) m2lc 2 g sin(q1 q2 ),
III. SIMULACIN
g 2 m2lc 2 g sin( x1 x3 ),
324
http://www.lajpe.org
(31)
y l1 cos q1 l2 cos q1 q2 ,
Significado
Masa del eslabn 1
Masa del eslabn 2
Momento de inercia del eslabn
1
Momento de inercia del eslabn
2
Longitud del eslabn 1
Longitud del eslabn 2
Longitud del centro de masa del
eslabn 1
Longitud del centro de masa del
eslabn 2
Valor medido
0.4272 kg
0.3442 kg
0.0036 kg m2
0.0021 kg m2
FIGURA 2. Diagrama a bloques del modelo dinmico y
cinemtico desarrollado en Matlab-Simulink.
0.1933 m
0.1458 m
0.0741 m
0.04849 m
325
http://www.lajpe.org
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 MatlabSimulink, por el conveniente de poder presentar el modelo
dinmico en un diagrama a bloques simple. Este software
permiti analizar el sistema en lazo abierto (este trmino se
emplea en el rea de control automtico para decir que un
sistema no est controlado). Para esto se impusieron
diferentes valores de torque para el eslabn 1 y el eslabn 2
respectivamente. Lo cual permiti observar la evolucin de
las trayectorias que se generan en el plano XY, esto ltimo
con la ayuda del modelo cinemtico asociado al punto (x, y).
326
http://www.lajpe.org
(2008).
<http://www.worldrobotics.org/downloads/2008_Pressinfo_
english.pdf>, consultado el 24 de marzo de 2011.
[2] Kuo, B., Sistemas de Control Automtico, (Prentice
Hall, Mxico, 1996).
[3] Barrientos, A., Penin, L. F., Balaguer, C. y Aracil, R.,
Fundamentos de Robtica, (McGraw-Hill/Interamericana,
Mxico, 2007).
[4] Kelly, R. y Santibez V., Control de Movimiento de
Robots Manipuladores, (Pearson Educacin, Madrid, 2003).
[5] Iigo-Madrigal, R. y Vidal-Iriarte, E., Robots
industriales manipuladores, (Alfaomega grupo editor S. A.
de C. V., Barcelona, 2004).
[6] Ollero, A., Robtica Manipuladores y robots mviles,
(Marcombo, Barcelona, 2001).
[7] Spong M. and Vidyasagar M., Robot dynamics and
control, (Jhon Wiley & sons, EEUU, 1989).
[8] Berghuis, H. and Nijmeijer, H., Global regulation of
robots using only position measurements, Systems &
Control Letters 21, 289-293 (1993).
[9] Rat, N. R. and Neagoe, M., Rigid vs. flexible links
dynamic analysis of a 3DOF parallel robot, 3rd IEEE
International Conference on Digital Ecosystems and
Technologies, 534-539 (2009).
[10] Guojun, W., Linhong, X., Fulun, H. and Zhang, X.,
Kinematics Simulation to Manipulator of Welding Robot
Based on ADAMS, Workshop on Intelligent Systems and
Applications International, 1-4 (2009).
[11] Gil-Rodrguez, M., Introduccin rpida a Matlab y
Simulink para ciencia e ingeniera, (Daz de Santos, S. A.,
Madrid, 2003).
[12] Karris, S., Introduction to Simulink with engineering
applications, (Orchard publications, EEUU, 2008).
AGRADECIMIENTOS
H. M. Maldonado-Del Toro agradece el apoyo econmico al
CONACYT y a la SIP-IPN, por el otorgamiento de las becas
respectivas para la realizacin de sus estudios de maestra.
R. Silva-Ortigoza agradece el soporte econmico recibido
de la SIP-IPN, del SNI, y de los programas EDI y COFAA
del IPN. E. R. Ramos-Silvestre agradece el soporte
econmico recibido mediante una beca de estudios de
maestra por parte de la Secretara de Relaciones Exteriores
de Mxico. V. M. Hernndez-Guzmn agradece el apoyo
recibido por el SNI y J. C. Rivera-Daz agradece el apoyo
otorgado por el CNAD. Finalmente, los autores agradecen
los comentarios de los revisores, pues han sido de gran
utilidad en la redaccin de esta versin mejorada.
REFERENCIAS
[1] Litzenberger, G., 2007: 6,5 million robots in operation
world-wide, International Federation of Robotics, 1-7
327
http://www.lajpe.org