Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora...

22
Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de trayectorias para robots móviles. Una revisión básica

Transcript of Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora...

Page 1: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Semana de la Electrónica

Facultad de Ciencias de la Electrónica BUAP

Dr. Daniel Mocencahua Mora

Alfonso M. Cuesta Hernández

Métodos de planificación de trayectorias para robots móviles.

Una revisión básica

Page 2: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Introducción

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 3: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Motivación

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Control: toma puntos de consigna y hace que el sistema los siga minimizando el error.

¿Cómo generar estos puntos de consigna, tomando en cuenta?...

Restricciones del medio

Restricciones cinemáticas y

dinámicas del robot

Gasto de tiempo (¿tiempo real?)

Page 4: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.
Page 5: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Definiciones básicas

• Espacio de trabajo Espacio de representación del entorno físico en donde se desenvuelve el robot.

Espacio de trabajo y Espacio de configuraciones

Ejemplo: Robot de tres grados de libertad =

,0 dondeYX

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

• Espacio de configuraciones Espacio donde cada posición y orientación del robot es representada de acuerdo a los parámetros de configuración del mismo.

Page 6: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Definiciones básicasProblema básico de la planificación de trayectorias

Sea A la representación de un robot que se mueve en un espacio euclidiano bi o tridimensional W. Sea B una colección de objetos rígidos llamados obstáculos, distribuidos en W y fijos para A.

Dada una configuración inicial, qi, y una posición final, qf, el problema de la planificación de trayectorias consiste en determinar si existe una secuencia continua de configuraciones que comienza en qi y que termina en qf, que evita colisionar con cualquier obstáculo; y en tal caso describir dicha secuencia

W

A

B

S

G

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 7: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Contenido

1. Motivación.2. Definiciones básicas.3. Revisión de los métodos de planificación de

trayectorias.i. Mapas de camino.ii. Campos de potencial.iii. Descomposición por celdas.

4. Una aplicación de los métodos.5. Conclusiones.

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 8: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Mapas de camino

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Capturar la conectividad del espacio de trabajo del robot en una red de curvas.

Con el mapa generado, la planificación se reduce a la concatenación de segmentos en el

mapa, entre una configuración inicial y una final

Page 9: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Grafo de visibilidad

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

•Uno de los primeros métodos de planificación.

•Aplica a espacios de trabajo con obstáculos poligonales.

•El grafo de visibilidad es un grafo no dirigido cuyos nodos son las configuraciones inicial y final, así como los vértices de los polígonos

Page 10: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Mapas de Voronoi

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

•Consiste en encontrar una función de Clibre en un subconjunto unidimensional de sí mismo, tal que la restricción de esta función a este subconjunto resulta en su mapa de identidad.

•El diagrama de Voronoi es un conjunto de todas las configuraciones cuya distancia mínima con los obstáculos se obtiene con al menos dos puntos en el borde de alguno de ellos.

•Se tiende a maximizar el espacio entre la trayectoria y los obstáculos

Page 11: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Campos de potencial

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

•Los obstáculos y las configuraciones final e inicial forman un campo de potencial.

•El robot se comporta como una partícula moviéndose en este campo.

•Los obstáculos tienen el mismo “potencial” que el robot y éste es repelido cuando se acerca demasiado.

•La configuración final tiene un “potencial” contrario y el robot es atraído hacia ella.

Page 12: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Descomposición por celdas

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

•Descomponer el espacio libre en una colección de subregiones poligonales que no se traslapan llamadas celdas.

•A partir de la colección de celdas se extrae su relación de adyacencia, reflejada en el grafo de conectividad.

•Del grafo de conectividad se buscan trayectorias bajo criterios dados como una secuencia de celdas.

Page 13: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Una aplicación de los métodos

Page 14: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Espacio de trabajo

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 15: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Estimación de la envoltura convexa

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 16: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Ensanchamiento de los obstáculos (10 pixeles)

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 17: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Descomposición exacta en celdas verticales

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 18: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Grafo de conectividad

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 19: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Generación de trayectorias

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 20: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Trayectorias

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 21: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Conclusiones

Facultad de Ciencias de la Electrónica. BUAP Alfonso M. Cuesta Hernández Dr. Daniel Mocencahua Mora

Page 22: Semana de la Electrónica Facultad de Ciencias de la Electrónica BUAP Dr. Daniel Mocencahua Mora Alfonso M. Cuesta Hernández Métodos de planificación de.

Información de contacto.

Dr. Daniel Mocencahua Mora.

Edificio 181, cubículo 221, CU

e-mail: [email protected]

Alfonso Cuesta Hernández.

e-mail: [email protected]