Beruflich Dokumente
Kultur Dokumente
3 1
GENERACIÓN E
IMPLEMENTACIÓN DE
TRAYECTORIAS (ROBOT HÍBRIDO)
Diego Alejandro Martínez Loaiza – Código: 1802533
Correo: u1802533@unimilitar.edu.co
Luis Alejandro Angarita Espitia – Código: 1802401
Correo: u1802401@unimilitar.edu.co
punto final y obstáculos) mediante una imagen movimiento respecto a un sistema de coordenadas que
o software y cálculo del espacio de se toma como referencia. Para lograr esta
configuraciones. representación se usan las matrices de transformación
- Integrar el manipulador y robot móvil
previamente desarrollados en un único robot homogénea 4x4, la cual incluye las operaciones de
híbrido, con preferencia haciendo uso de una traslación y la orientación. [3]
fuente de alimentación independiente y
comando por comunicación inalámbrica. Cinemática Inversa Robots—
- Implementar un sistema para la digitalización El objetivo de la cinemática inversa de un robot es
del espacio de trabajo (robot, punto inicial, encontrar los valores que deben adoptar las
objetos a recolectar, obstáculos) mediante una coordenadas de las articulaciones del robot para que su
imagen o software, así como su extremo se posiciones y oriente según una determinada
correspondiente post-procesamiento y cálculo
del espacio de configuraciones. localización espacial. Esta solución matemática no es
- Diseñar e implementar una interfaz gráfica sistemática, depende de la configuración del robot y no
para el comando del robot híbrido, siempre existen soluciones en forma cerrada. [4]
permitiéndole recolectar y traer de regreso al
punto inicial todos los objetos que Matriz Jacobiana—
correspondan al color indicado por el usuario. La cinemática directa e inversa son las posiciones del
brazo robot mientras que la matriz Jacobiana nos
III. MARCO TEÓRICO permite conocer las velocidades del efector final
(Jacobiana Inversa) o extremo del robot a partir de las
Robot—
velocidades de las articulaciones (Jacobiana Directa).
Según la RAE, es una máquina automática
programable capaz de realizar determinadas tareas de
forma autónoma. Se compone de tres partes
principales:
- Sensores
- Sistema de Control
- Actuadores [1]
Figura 1. Esquemático Matriz Jacobiana
Robot Antropomórfico –
Algunas veces llamado también manipulador de codo. Por medio de derivadas parciales con respecto al
Consiste en dos articulaciones tipo “hombre” (una para tiempo se obtiene la matriz Jacobiana que es de
girar sobre un eje vertical y otra para elevarse a la dimensión 6 × n donde n son los grados de libertad del
articulación de elevación del hombro) y dos o tres manipulador, para el caso de estudio n = 3.
articulaciones de muñeca en el extremo del
manipulador. Esta matriz es útil para:
- Encontrar y analizar configuraciones
Su principal característica es que está conformado por singulares.
cuerpo, brazo, muñeca y efector final que generalmente - Encontrar y analizar la redundancia.
tiene una pinza o un gripper. - Relación entre las velocidades de las
Este tipo de robots se utilizan principalmente en la articulaciones y del extremo del robot.
industria, donde es necesario el uso de máquinas para - Relación entre las fuerzas del extremo del robot
no poner en riesgo al personal. Se encargan de tareas y de los pares de torsión en las articulaciones,
pesadas y repetitivas. [2] es decir estudiar la estática del robot.
Ilustración 1. Trayectorias
Campos potenciales
El método de campos potenciales es una de las técnicas
más populares en la generación de trayectorias para
robots móviles, por ser una forma práctica de
solucionar este problema. Entre los primeros
desarrollos, existe el presentado por Khatib O., que
propone que los obstáculos y el robot tengan una carga
eléctrica del mismo signo, con la finalidad de generar
Ecuación 1. Ecuaciones de Velocidad con matriz
una repulsión, mientras que la meta tiene asociada una
jacobiana [5]
carga eléctrica de signo opuesto, para atraer el robot al
punto destino. La propuesta presentada por Khatib O.,
Algoritmos de trayectoria
se denominó FIRAS (sigla en francés que se traduce al
Convencionalmente el problema de generación de
inglés como The Force Involving and Artificial
trayectorias para un robot móvil indica que dado un
Repulsion from the Surface Function). En modo
robot y un ambiente, se puede determinar una
convencional, los potenciales atractivos y repulsivos se
trayectoria entre dos puntos específicos si el robot está
generan de forma separada y el potencial total del
libre de colisiones y si satisface cierto criterio de
espacio de trabajo se obtiene como la suma de aquellos.
desempeño. Una primera clasificación de los métodos
Otra propuesta con este mismo enfoque, fue
para planear de movimientos de robots móviles, es
desarrollada por Krogh B. A. y es llamada GPF
dinámica o estática. En el caso dinámico, no se tiene
(Generalized Potential Field). Para generar la
información completa del espacio de trabajo y los
trayectoria con estos potenciales, sólo se requiere
obstáculos se consideran móviles. Para el caso estático,
calcular los gradientes; sin embargo, los campos
se tiene conocimiento completo del espacio de trabajo
potenciales pueden ser no convexos, presentando
y los obstáculos no se mueven. De los métodos para
mínimos locales que dejaría estancado al robot en un
planear trayectorias, se tiene en un primer lugar, los
punto diferente al objetivo. Otra desventaja es la
basados en grafos entre los cuales se distinguen: grafos
estimación de los parámetros del campo potencial para
de visibilidad, diagramas de Voronoi, modelado del
lograr una adecuada evasión de obstáculos. [7]
espacio libre, y descomposición en celdas. Otro tipo de
Modificaciones al planteamiento original de campos
métodos empleados para la planeación de trayectorias
potenciales se realizan, considerando las anteriores
emplea un enfoque estocástico que da lugar al
limitaciones; Volpe y Khosla, proponen las funciones
algoritmo de planeación aleatoria de trayectorias
potenciales super-cuadráticas (Super-quadric Artificial
(Randomized Path Planner RPP), al algoritmo de
Potential Functions), donde se emplea un amplio
mapas probabilísticos (Probabilistic Road Map Method
conjunto de formas desde rectángulos hasta elipses que
PRM), y al algoritmo de árboles de exploración rápida
están descritos por fórmulas super-cuadráticas. Una
(Rapidly Exploring Random Tree RRT). Enfoques
propuesta basada en la solución de la ecuación de
adicionales para planear trayectorias utilizan métodos
Laplace para transferencia de calor, es desarrollada de
heurísticos de optimización como algoritmos
forma separada por Connolly, y adicionalmente por
genéticos, colonias de hormigas, quimiotaxis
Kim y Khosla; este método se implementa mediante
funciones potenciales armónicas (Harmonic Potential
ROBÓTICA – LABORATORIO 3.1 – 3.2 – 3.3 4
IV. PROCEDIMIENTO
MANIPULADOR
Ecuaciones:
Matrices de Transformación:
cos(𝜃1 ) 0 𝑠𝑒𝑛(𝜃1 ) 0
𝐴10 =[ 𝑠𝑒𝑛(𝜃1) 0 − cos(𝜃1 ) 0 ]
0 1 0 10.5
0 0 0 1
Matriz 1. Matriz de Transformación Punto 1 visto desde 0
encuentra el efector final y así lograr realizar motores DC con reductor y dos ruedas de tipo castor
cualquier tipo de movimiento con el manipulador. ya que son omnidireccionales y permiten que el carro
se mueva libremente por el espacio. Estos aspectos
También se debe hablar de cinemática inversa ya que fueron incluidos en el modelado y en la
ella es necesaria para aplicar el algoritmo del implementación del dispositivo con la interfaz.
jacobiano que permite trazar una trayectoria deseada
en el espacio, objetivo que es fundamental para ubicar
correctamente las cajas en el lugar donde se
almacenan y luego apilarlas en un lugar en específico.
ROBOT MÓVIL
Para el robot móvil, se utilizó el algoritmo de campos
potenciales para definir la trayectoria correcta que
debe realizar el robot para no chocar con los
obstáculos ni con las paredes. Este método se
implementa pensando en una gráfica 3D en donde se Figura 3. Interfaz presentada para implementación
quiere realizar una trayectoria de una esfera sabiendo en Robotino y en trayectoria
que hay algunas montañas en su trayectoria.
ROBOT HÍBRIDO
Como es de esperarse, la esfera sigue su trayectoria
por los lugares en donde no se presentan estas
montañas, y entre más alta sea la montaña más lejos
pasará la esfera. Esto se desea lograr con este método,
que se plasme matemáticamente esta gráfica 3D y que
en los lugares donde hay obstáculos se presenten
montañas que hagan que el objeto esquive para llegar
a la meta. Se puede programar el grado de repulsión
y de aceptación de cada obstáculo así que de acuerdo
a estos parámetros, el algoritmo permitirá trazar una
trayectoria coherente en el espacio de trabajo, función
que se debe ver plasmada también en la Figura 4. Robot Híbrido físico
implementación.
de
http://www.biobiochile.cl/noticias/2016/02/16/que-
es-un-robot-como-funciona.shtml
[2] SlidesShare. Robots Móviles y Antropomórficos.
Recuperado el día 19 de marzo de 2018 de
https://es.slideshare.net/LuisAguilarCruz/robots-
mviles-y-antropomrficos.
[3] Grupo de investigación NBIO. España. (2012).
Cinemática de Robots. Recuperado el día 19 de
marzo de 2018 de
http://nbio.umh.es/files/2012/04/practica2.pdf.
[4] Universidad Politécnica de Madrid. España.
(2013). Cinemática Inversa. Recuperado el día 19 de
marzo de 2018 de
Figura 6. Llantas con motor y llantas tipo castor.
http://www.elai.upm.es/moodle/pluginfile.php/27
98/mod_resource/content/2/Tema%205-
V. CONCLUSIONES %20CinematicaInversa.p
- Para el manipulador, el cálculo del jacobiano [5] Universidad Politécnica de Valencia (España).
permite llevar las cajas a los puntos con una gran Matriz jacobiana. Recuperado el día 8 de mayo del
precisión. 2018 de
- Se tiene la versatilidad de que para el https://riunet.upv.es/bitstream/handle/10251/79512/
manipulador, teniendo o los ángulos o el VERA%20-
desplazamiento en los tres ejes, se pueden %20Control%20de%20trayectoria%20de%20la%20
conocer las otras variables gracias a las simulaci%C3%B3n%20de%20un%20brazo%20robo
estrategias matemáticas usadas que son t%20de%205%20grados%20de%20libertad%2C%2
relacionadas a la estructura del manipulador. 0control....pdf?sequence=1&isAllow
- Para la robótica móvil, el planteamiento del [6] H. E. Espitia Cuchango y J. I. Sofrony
modelado y de los ángulos de importancia es Esmeral, «ALGORITMO PARA PLANEAR
fundamental para saber de qué manera se TRAYECTORIAS DE ROBOTS MÓVILES,
orientará el dispositivo de acuerdo a las ruedas EMPLEANDO CAMPOS POTENCIALES Y
que tiene. ENJAMBRES DE PARTÍCULAS ACTIVAS
- El algoritmo de campos potenciales es eficiente BROWNIANAS,» CIENCIA E INGENIERÍA
para obtener una ruta coherente en el espacio de NEOGRANADINA, Bogotá, 2012.
trabajo ya que se puede programar el grado de
repulsividad que tiene el dispositivo con cada [7] K. Dongchan, K. Hayoung y K. Huh, «Local
uno de los obstáculos, generando un mejor trajectory planning and control for
control. autonomous vehicles using the adaptive
- Es importante el control realizado a las llantas ya potential field,» de 2017 IEEE Conference on
que de este se puede orientar y trasladar Control Technology and Applications (CCTA),
coherentemente el robot móvil para que la Mauna Lani, HI, USA, 2017.
implementación represente verdaderamente lo [8] S. T, H. G y M.-M. K, «Trajectory equilibrium
que la simulación realiza. state detection and avoidance algorithm for
- Se logró realizar la trayectoria del robot móvil y multi-autonomous potential field mobile
además se logró agregar una secuencia para robots,» de Electronics Letters ( Volume: 43,
recoger cajas y llevarlas al su compartimiento. Issue: 15, July 19 2007 ), 2007.
[9] L. Hongguang y Y. Yong, «Ship's trajectory
VI. REFERENCIAS planning for collision avoidance at sea based
[1] Biobiochile (2016). ¿Qué es un robot? ¿Cómo on modified artificial potential field,» de 2017
funciona? Recuperado el día 19 de marzo del 2018 2nd International Conference on Robotics and
ROBÓTICA – LABORATORIO 3.1 – 3.2 – 3.3 8