RESUMEN
En el presente artculo se presenta la sntesis, anlisis y simulacin de un robot capaz de lograr los movimientos de
abduccin y aduccin horizontal del topo para efectuar las tareas de bsqueda y rescate mediante remocin de escombros.
Se propone sintetizar un arreglo de 10 eslabones y 2 grados de libertad con el fin de lograr las trayectorias de barrido para
cubrir con ciertas dimensiones de claro. Adems, se detallan estrategias cinemticas que simplifican el control de las juntas
activas. Dicho mecanismo es capaz de modificar en tiempo real la trayectoria por medio del ajuste de extensin de los
brazos del robot. La investigacin es sostenida por la simulacin cinemtica y las pruebas experimentales realizadas al
prototipo en una primera etapa, en donde se incluyen los brazos del robot topo excavador.
Palabras Clave: Robot rescatista, Mecanismos, 10 eslabones, Topo
ABSTRACT
In this article the synthesis, analysis and simulation of a robot able for achieving the movements of abduction and
horizontal adduction Mole to perform search and rescue tasks through debris removal is presented. It is proposed to
synthesize an array of 10 links and 2 degrees of freedom in order to achieve sweeping paths to cover certain dimensions
curve. Additionally, kinematic simplify control strategies of active joints are detailed. This mechanism is able to modify
in real time the trajectory by adjusting extension of the robot arms. Research is supported by the kinematic simulation and
experimental prototype tests conducted in a first stage, where robot arms mole excavator included.
Keywords: Rescue Robot, Mechanisms 10 links, Mole.
1. Introduccin
De acuerdo a [1], el desastre natural con ms vctimas
mortales en el mundo son los terremotos. Segn reportes de
United States Geological Surveys [2], entre 2000 y 2012
murieron 525,607 personas alrededor del mundo debido a
sismos con valores mayores a 4.5 en la escala Rankin.
Histricamente, el auge de los robot USAR (Urban Search
2. Anlisis de movimientos
Accin peristltica
Movimiento de agitacin
Inyeccin de aire
Aspirado
Movimiento de perforacin
Movimiento de paleado.
Dientes de cincel
ascensor cabeza y humerales
excavacin de rotacin.
Los excavadores de rascado pasan sus pies bajo la tierra y
hacia atrs. Los excavadores de dientes de cincel usan sus
dientes para desalojar la tierra desde el frente del tnel y
luego usan sus extremidades para empujarla hacia atrs.
La accin de excavacin del topo es afectada por la rotacin
del humero. El bceps y trceps son ms dbiles que los que
3. Sntesis de mecanismo
(3.2)
(3.3)
(3.4)
(3.5)
(3.6)
(3.7)
ab
l6 m6
l1 m1
l 2 m2
l3 m3
l 4 m4
Esto gracias a que el principal objetivo de dichos
mecanismos es la transmisin de movimiento, ayudndonos
a reducir el tamao del mecanismo en cuanto a altura
respecta. Por tal motivo se propone una sntesis de funcin
con:
(3.1)
f ( x) x
gdl = 2gdl
Tabla 1- puntos de inters para sntesis de funcin
Dnde:
: es el nmero de eslabones
1 : es el nmero de juntas de un grado de libertad
2 : es el nmero de juntas de dos grados de libertad
Se debe destacar que tanto el diagrama cinemtico auxiliar
como la red topolgica son nicamente para un brazo del
mecanismo. Como consecuencia de esto, el nmero de
grados de libertad total es de 4 (2 para cada brazo del robot).
()
25
25
50
50
75
75
k1 cos 25 k 2 cos 25 k 3 1
k1 cos 50 k 2 cos 50 k 3 1
k1 cos 75 k 2 cos 75 k 3 1
l1 = l3 = m1 = m3 = 60 mm
l2 = l4 = m 2 = m 4 = 40 mm
El alcance mximo del mecanismo estar dado por: 2 1
Conociendo el ngulo y las longitudes de los eslabones se
puede expresar la posicin del punto P mediante la
siguiente expresin:
2
2
2
x = l5 cos( ) + (l5 cos2 ( ) - (l5 - l6 ))
2
2
Y el ngulo de inclinacin ser:
1
2
l6 cos ' = x 2 - x1
0.785 rad
4. Cinemtica especifica
rp = (-a1sen1 - l 6 sen )i +
(5.2)
(a1cos1 - l 6 cos )j
(5.3)
a cos + l6 cos = x1
2
a sin - l6 sin = 0
2
Los datos conocidos (por dimensiones deseadas del robot)
son:
x1 = 120 mm
5. Simulacin cinemtica
La simulacin numrica del mecanismo fue desarrollada
en cdigo de MATLAB. En las Figuras 6 8 se pueden
contemplar la simulacin de la evolucin de la cinemtica
articular de los brazos del mecanismo de barrido, de acuerdo
a las expresiones obtenidos en el anlisis realizado.
x 2 - x1 = 100 mm
' = 15
Resolviendo las ecuaciones anteriores con los parmetros de
entrada resulta:
a = 144.2 mm 145 mm
= 80
80
60
40
20
0
-20
-40
-60
-80
l6 = 103.53 mm 105 mm
100
5
6
Tiempo [seg]
10
1*
16
2*
14
1*
12
1*
*
*
2*
10
8
2*
6
4
2
0
-2
5
6
Tiempo [seg]
10
50
rp*
40
X: 7.5
Y: 39.71
10
30
rp* [mm/s]
2
15
20
10
0
0
-5
5
6
Tiempo [seg]
10
-10
5
6
Tiempo [s]
10
rp*
35
30
X: 7.5
Y: 32.42
25
rp** [mm/s 2]
20
15
10
5
0
1 inicial
1 final
2 inicial
2 final
10
85
85
85
-65
85
-65
-10
85
44
-10
44
44
10
44
10
-5
-10
5
6
Tiempo [s]
10
Pathline de rp
200
y [mm]
150
100
50
0
50
100
150
200
x [mm]
250
300
350
6. Fabricacin y ensamble
Por medio de un software CAD se concibi el diseo
mecnico del robot de rescate y la integracin de los
subsistemas del mismo. En la Figura 14 se muestra el
modelo virtual del robot de rescate, as como sus partes:
1 final
2 inicial
2 final
35
85
35
-65
85
120
-65
-30
120
44
-30
44
44
35
44
35
7. Pruebas experimentales
Para comprobar que el mecanismo construido cumple con
los movimientos deseados, se llevaron a cabo pruebas
experimentales. La prueba consisti en llevar al mecanismo
hasta la posicin de la secuencia de la Tabla 2. La Figura 16
muestra una comparativa entre el mecanismo simulado y las
posiciones reales alcanzadas por cada brazo.
8. Conclusiones
En el presente trabajo se concluy que es posible disear un
mecanismo capaz de generar las trayectorias del topo
mediante el acoplamiento de varias cadenas cinemticas
cerradas.
El agregar dos paralelogramos ayud a incrementar y
modificar el alcance de la tijera en longitud y apertura, y as
de esta manera realizar un barrido diferente dependiendo de
la situacin en la que se encuentre el robot.
Mediante las pruebas experimentales se verific que el
prototipo construido se comporta como se requera, lo cual
indica que el desarrollo de trabajo fue adecuado.
A futuro se tiene considerado la inclusin de un anlisis
dinmico para tener los requerimientos dinmicos que se
requieren para la tarea a realizar.
Agradecimientos
Agradecemos al maestro de la materia de sntesis y
cinemtica de mecanismos (Dr. Hugo Medelln) por su
apoyo y nimo para llevar a cabo este trabajo.
Al Centro de Investigacin y Estudios de Posgrado (CIEP)
de la facultad de ingeniera de la Universidad Autnoma de
San Luis Potos por los recursos proporcionados para la
realizacin del trabajo.
REFERENCIAS
[1] Satoshi Tadocoro, Rescue Robotics, DDT Project on
Robots and Systems for Urban Search and Rescue,
Springer-Verlag London Limited (2009).
[2] USGS. (2012). Earthquake Facts and Statistics Graphs.
13 de enero de 2016, de U.S. Department of the Interior |
U.S.
Geological
Survey
Sitio
web:
http://earthquake.usgs.gov/earthquakes/eqarchives/year/
graphs.php
[3] Bruno Siciliano, Oussama Khatib, Handbook of
Robotics, Springer-Verlag Berlin Heidelberg (2008).
[4] Petr P. Gambaryan, Jean-Pierre Gasc, Sabine Renous,
Cinefluorographical study of the burrowing movements
in the common mole, Talpa europaea (Lypotyphla,
Talpidae), Russian Journal of Theriology (2002).
[5] Takashi Kobayashi, Hideyuki Tshukagoshi, Shunsuke
Honda, Ato Kitagawa, Burrowing rescue robot referring
to a moles shoveling motion, Proceedings of the 8th
JFPS International Symposium on Fluid Power,
OKINAWA 2011 (2011).
[6] S. M. Moon, S. W. Hwang, S. M. Yoon, J. HUH, D.
Hong, Bio-Inspired Burrowing Mechanism For
Underground Locomotion Control, Automation And
Robotics In Construction And Mining. International
Symposium. 30th 2013 (2013).
[7] Robert C. Richardson, Arjun Nagendran, Robin Scott,
The sweep-extend mechanism: A 10-bar mechanism to
perform biologically inspired burrowing motions,
Journal of Mechatronics, Elsevier (2010).
[8] Robert C. Richardson, Robin G. Scott; A Novel USAR
Digging Mechanism, Proceedings of the 2006 IEEE/RSJ
International Conference on Intelligent Robots and
System, Octubre 9 - 15, Beijing, China; 2006, pp. 3498
3503.
[9] Robert C. Richardson, Arjun Nagendran, Robin Scott.
The sweep-extend mechanism: A 10-bar mechanism to
perform biologically inspired burrowing motions.
ELSEVIER. 13 March 2011: 1-4.