Professional Documents
Culture Documents
Resumen
Se presenta un simulador en 3D desarrollado para el control de un brazo robot angular de cuatro
grados de libertad. El simulador tiene la finalidad de apoyar el aprendizaje de estudiantesnde
ingeniera en tpicos de robtica. La interfaz grfica del simulador fue implementada en
MATLAB. El modelo en 3D del brazo robot fue elaborado mediante el toolbox de realidad virtual
de MATLAB, empleando V-Realm Builder. La interfaz grfica incorpora la cinemtica directa e
inversa para el posicionamiento del brazo robot. El simulador puede operar solo o conectarse al
brazo robot, tanto de forma almbrica como inalmbrica mediante mdulos XBee. Los modos de
operacin disponibles para el usuario son: manual, programacin, automtico y calibracin. La
creacin de ambientes virtuales para el aprendizaje representa sin duda una herramienta
poderosa, sobre todo cuando no es posible que un grupo de estudiantes tenga acceso a un
equipo o mquina al mismo tiempo. Adems, esto permite que los estudiantes adquieran
competencias en el manejo de sistemas muy parecidos a los que encontrarn en su entorno
laboral.
Palabras clave: brazo robot, simulador 3D, MATLAB, realidad virtual, V-Realm Builder
Introduccin
La era de los robots industriales inici en 1947, cuando se desarroll el primer telemanipulador,
con el objetivo de manipular elementos radiactivos sin riegos para el operador. Desde entonces
se han investigado y desarrollado diferentes tipos de robots para aplicaciones especficas, como
Publicacin # 12
RIDE
La construccin y el control del brazo robot fueron realizados mediante la elaboracin de otra
tesis de licenciatura (Vera, 2013). El material empleado para la manufactura de los elementos
del brazo robot fue una placa de Aluminio de
Publicacin # 12
RIDE
, con dimensiones de
En la figura 1 se presenta una fotografa del brazo robot construido, para su control se emplea
una tarjeta electrnica de diseo propio, la cual es controlada mediante un microcontrolador
PIC18F4550. El microcontrolador se encarga de generar, por software, las seales PWM
necesarias para controlar el ngulo de rotacin de cada uno de los servomotores. La tarjeta
electrnica se encuentra dentro de la base del brazo robot y esta cuenta con un puerto de
comunicacin serial que emplea el protocolo RS-232. La comunicacin se puede realizar tanto de
forma almbrica, mediante una conexin DB9 colocada en una cara lateral de la base del brazo
robot, como de forma inalmbrica utilizando un mdulo XBee en el interior de la base y otro
conectado a la PC.
Publicacin # 12
RIDE
Base
Brazo
Antebrazo
Mueca
Pinza
(seg/60)
0.16
0.16
0.16
0.12
0.13
1501MG
1501MG
1501MG
HD-1160A
1711MG
15.5
15.5
15.5
2
3
160
160
160
160
180
1400
1400
1400
680
1400
Cinemtica directa
Es necesario conocer el modelo cinemtico del brazo robot para poder desarrollar la interfaz
grfica del simulador 3D, para que este describa de manera fiel en todo momento los
movimientos y el posicionamiento espacial del extremo final del brazo robot.
En esta seccin se presenta el anlisis cinemtico directo del brazo robot, mediante el cual al
introducir los valores de los ngulos de la base, brazo, antebrazo y mueca, se obtiene la
posicin espacial del extremo final del brazo robot.
El algoritmo de Denavit-Hartenberg es ampliamente utilizado para obtener el modelo cinemtico
directo de un brazo robot. Dicho algoritmo es un mtodo matricial que permite establecer
sistemas de coordenadas para cada eslabn del brazo robot. As, mediante transformaciones de
rotacin y traslacin se pueden conocer las coordenadas cartesianas
de la
herramienta, referido a un sistema de coordenadas fijo con base en los ngulos de todos los
elementos del brazo robot. Explicaciones amplias sobre el algoritmo de Denavit-Hartenberg se
encuentran en diversas fuentes, como (Spong & Vidyasagar, 1989), (Craig, 2006), (Appin
Knowledge Solutions, 2007) y (Reyes, 2012).
Entonces, para el brazo robot antropomrfico de cuatro gados de libertad presentado en este
artculo, el problema cinemtico directo se reduce a encontrar la matriz de transformacin
homognea
En la figura 2 se presenta un esquema que muestra la vista superior del brazo robot, en la que se
indican las distancias
. La distancia horizontal
es la que
Publicacin # 12
RIDE
En la figura 3 se presenta otro esquema que muestra la vista lateral del brazo robot, donde se
indican
los
parmetros
,
,
y
directo. La distancia vertical desde el origen de coordenadas hasta la base del brazo robot es ,
la distancia vertical desde la base hasta el centro de la articulacin del brazo es
longitud efectiva del brazo,
la mueca o herramienta,
es la longitud efectiva de
es el ngulo de rotacin del antebrazo con respecto del eje longitudinal del brazo y
ngulo de rotacin de la mueca con respecto del eje longitudinal del antebrazo.
Publicacin # 12
es la
RIDE
es el
Publicacin # 12
RIDE
de la localizacin espacial del extremo final del brazo robot, respectivamente. A continuacin se
presentan las ecuaciones que permiten calcular los valores de tales coordenadas:
Cinemtica inversa
Publicacin # 12
RIDE
La cinemtica inversa permite obtener los ngulos de rotacin de los elementos del brazo robot
a partir de las coordenadas cartesianas
obtener las ecuaciones que permitan calcular los ngulos requeridos, en este artculo se emplea
el mtodo geomtrico. En la figura 4 se presenta otro esquema de la vista superior del brazo
robot, donde se indican los parmetros
del brazo robot es
y la suma de
,
,
coordenadas hasta el extremo final del brazo robot, la cual ser llamada Mdulo.
El ngulo de la base
se calcula como:
Figura 4. Vista superior del brazo robot con parmetros para cinemtica inversa.
En la figura 5 se muestra otra vista lateral del brazo robot, donde se indican otros parmetros
necesarios que permitirn establecer las ecuaciones para el clculo de los ngulos
. En
Publicacin # 12
RIDE
es:
El valor de
es:
se calcula como:
Figura 5. Vista lateral del brazo robot con parmetros para cinemtica inversa.
El valor de
se calcula como:
Publicacin # 12
RIDE
El valor de
es:
El valor de
es:
El valor de
es:
es:
es:
es:
Publicacin # 12
RIDE
complejas sin que se tenga un conocimiento profundo del lenguaje VRML. En la figura 6 se
presenta el modelo en 3D del brazo robot.
Publicacin # 12
RIDE
Publicacin # 12
RIDE
la herramienta del brazo robot. Adems, dentro de este grupo tambin se encuentra el
cabeceo o pitch de la herramienta y un botn con la leyenda Aceptar. Cuando el usuario
modifique alguno o algunos de los ngulos de giro de los elementos del brazo robot,
automticamente se calcularn y desplegarn las coordenadas cartesianas resultantes, as como
el ngulo de cabeceo de la herramienta. En la figura 9 se presenta con ms detalle una imagen
del grupo de datos mencionado.
vez modificados los valores, el usuario presiona el botn Aceptar e inmediatamente la interfaz
de usuario ejecuta las ecuaciones obtenidas a partir del anlisis cinemtico inverso para calcular
los correspondientes ngulos de rotacin de los elementos del brazo robot.
Los ngulos calculados son desplegados en dos zonas de la interfaz grfica de usuario. Una de las
zonas se encuentra en la parte superior derecha de la interfaz de usuario, la cual muestra los
ngulos de rotacin de la base, brazo, antebrazo y mueca del brazo robot. Adems, en este
grupo de datos tambin se encuentra un botn con la leyenda Aceptar. En la figura 10 se
observa con detalle a este conjunto de datos.
Publicacin # 12
RIDE
brazo robot, dentro de sus lmites de giro. Cuando el usuario presiona el botn Aceptar, la
interfaz de usuario ejecuta las ecuaciones obtenidas a partir del anlisis cinemtico directo para
calcular las correspondientes coordenadas cartesianas del extremo final del brazo robot.
La otra zona en la que se muestran tambin los ngulos de rotacin de los elementos del brazo
robot se encuentra en la parte derecha de la interfaz de usuario. A este conjunto de datos se le
llama Control manual, tal como se muestra en la figura 11.
Figura 11. Diferente opcin para modificar la posicin del brazo robot.
En la figura 11 se observa que para mover cualquiera de los elementos del brazo robot se tienen
dos opciones, una es modificando el valor del ngulo del elemento mediante el Slider; la otra
opcin es presionar un botn para incrementar o disminuir el valor de dicho ngulo. Cuando el
usuario emplea cualquiera de las dos opciones, automticamente se actualizan los ngulos
correspondientes del conjunto de datos mostrado en la figura 10 y se calculan y muestran los
valores de las coordenadas cartesianas del extremo final del brazo robot en el conjunto de datos
mostrado en la figura 9.
En la parte central de la interfaz grfica se encuentra el simulador 3D y se incorporan las
opciones de visualizacin del modelo del brazo robot, las cuales son: Frontal, Superior e
Isomtrica. En la figura 12 se muestra esta zona de la interfaz grfica.
Publicacin # 12
RIDE
Publicacin # 12
RIDE
Figura 14. Modos de operacin del simulador de la interfaz de usuario del brazo robot.
El modo de operacin Automtico se elige una vez que el usuario haya programado alguna
rutina de trabajo para el brazo robot. Cuando el usuario presiona esta opcin, se habilita la zona
llamada Control programado, la cual se encuentra en la parte inferior derecha de la interfaz de
usuario, ver figura 15. Esta zona cuenta con cuatro botones, los cuales hacen que el brazo robot
ejecute de manera automtica una rutina previamente programada por el usuario.
Publicacin # 12
RIDE
a)
b)
c)
Publicacin # 12
RIDE
Por ltimo se tiene el modo Calibracin, el cual se emplea nicamente cuando es necesario
cambiar alguno de los servomotores o cuando se haya desensamblado algn elemento del brazo
robot. Este modo permite al usuario conocer los valores necesarios de la seal PWM para que el
servomotor se posicione en un ngulo de 0, 90 y 180, ver figura 18.
De esta manera, el usuario puede establecer los valores adecuados de la ecuacin que permite
calcular el valor de PWM requerido para posicionar al servomotor a cualquier ngulo deseado
dentro de su intervalo de operacin.
Conclusiones
Las pruebas realizadas al simulador del brazo robot resultaron exitosas, tanto para el caso de la
cinemtica directa como la cinemtica inversa. As mismo, las animaciones de los movimientos
del simulador del brazo robot estn bien sincronizadas con su contraparte real. Los cuatro
modos de operacin del brazo robot tambin fueron revisados exhaustivamente y funcionan
correctamente. El uso del simulador permitir a los estudiantes de ingeniera de nuestra
Facultad entender con mayor facilidad los principios tericos bsicos para el control y
posicionamiento del brazo robot antropomrfico. La capacidad del simulador para trabajar sin
estar conectado al brazo robot real favorece el aprendizaje en el aula, al mismo tiempo que les
permitir a los estudiantes interactuar y practicar con un software cuyas funciones son similares
a las que encontrarn en un software profesional para el control de robots industriales.
Publicacin # 12
RIDE
Bibligrafa
Appin Knowledge Solutions. (2007). Robotics. Hingham: Infinity Science Press LLC.
Craig, J. (2006). Robtica, 3a. Edicin. Mxico: Pearson Educacin.
Gonzlez, G. (Mayo de 2011). Diseo de un brazo robtico manipulador de piezas por medio del
software de elementos finitos Ansys. Tesis de licenciatura. Camerino Z. Mendoza, Veracruz,
Mxico: Universidad Veracruzana.
Humusoft and The MathWorks. (Octubre de 2004). Virtual Reality Toolbox For Use with MATLAB
and Simulink, User's Guide, Version 4. Natick, Massachusetts, USA.
Marchand, P., & Holland, T. (2003). Graphics and GUIs with MATLAB, 3rd ed. USA: Chapman &
Hall, CRC.
Reyes, F. (2012). MATLAB Aplicado a Robtica y Mecatrnica. Mxico: Alfaomega Grupo Editor,
S.A. de C.V.
Spong, M., & Vidyasagar, M. (1989). Robot dynamics and control. New York: John Wiley & Sons,
Inc.
Vera, R. (9 de Septiembre de 2013). Construccin y control de un brazo robtico manipulador de
piezas. Tesis de licenciatura. Camerino Z. Mendoza, Veracruz, Mxico: Universidad Veracruzana.
Y. L. Gu, E. (2013). A Journey from Robot to Digital Human, Mathematical Principles and
Applications with MATLAB Programming. New York: Springer-Verlag Berlin Heidelberg.
Publicacin # 12
RIDE