ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …
Transcript of ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …
![Page 1: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/1.jpg)
ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO
PROGRAMABLE
Juan Sebastián Díaz Rueda
Xavier Orlando Rodríguez Q.
![Page 2: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/2.jpg)
OBJETIVO GENERAL
►Diseñar, construir e implementar un prototipo de robot móvil que funcione en dos etapas, en la primera que tenga la capacidad de identificar y aprender una trayectoria entre dos puntos dados en una superficie plana, para posteriormente en la segunda etapa de su funcionamiento recorrer la trayectoria aprendida.
![Page 3: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/3.jpg)
Objetivo específico Nº 1
►Realizar el diseño mecánico del robot móvil, seleccionando la configuración adecuada según los movimientos y trayectorias que deberá seguir el robot
![Page 4: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/4.jpg)
Nº 1: Configuración diferencial
►Dos ruedas de tracción opuestas
►Rueda libre (Tres apoyos)
►Movimientos
-Avance línea recta
-Giro sobre eje
![Page 5: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/5.jpg)
Nº 1: Motores de tracción
► Encoder
► Requerimiento torque
► Consumo
► Chumacera
► Buje de acople a rueda
► Rodamiento
![Page 6: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/6.jpg)
Objetivo específico Nº 2
►Construir el robot y dimensionarlo para que pueda operar en superficies pequeñas, a la vez que tenga el espacio suficiente para albergar los elementos mecánicos, además de los dispositivos y el montaje electrónico propios de su funcionamiento.
![Page 7: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/7.jpg)
Nº 2: Dimensiones
► Ancho (22cm)
-Tarjeta de desarrollo con FPGA
-Disposición motores (Diferencial)
► Largo (24cm)
-Tarjeta de desarrollo con FPGA
-Sensor obstáculos
► Alto (19cm)
-Baterías -Tarjetas impresas
-Sensor -Ruedas
![Page 8: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/8.jpg)
Nº 2: Distribución
►Equilibrio de carga
►Simetría
►Espacio libre
-Baterías
-Módulo sensor
![Page 9: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/9.jpg)
Objetivo específico Nº 3
►Seleccionar e implementar uno o varios sensores para detectar y esquivar los obstáculos que se encuentren entre los dos puntos a recorrer por parte del robot.
![Page 10: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/10.jpg)
Nº 3: Sensor ultrasónico
►Un sensor
►Módulo integrado-Señal 40KHz-Amplificación señal
► Evitar errores
► Emisor y receptor con cable blindado
Parlante
Micrófono
Led
12VDCSeñal de
salida
MODULO
Potenciómetro de calibración
![Page 11: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/11.jpg)
Nº 3: Sensor ultrasónico
► Salida como interrupción
►Amplitud 12V
► Entrada FPGA a 3.3V
►Divisor de voltaje
1.1k
2.9k
Entra
da F
PG
A0 –
3.3
V
Señal d
e se
nso
r0 –
12 V
![Page 12: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/12.jpg)
Nº 3: Zona de detección
►Angulo de 180º centrado frente al robot
Angulo = 0ºPaso = 0
Angulo = 90ºPaso = 24
Angulo = 180ºPaso = 48
Final de carrera
Sensor
Eje motor
![Page 13: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/13.jpg)
Nº 3: Motor paso a paso
► Secuencia de medio paso
►Resolución de 3.75º por paso
► 48 pasos para 180º
► Tiempo de 25ms entre cada paso
► Periodo de 2.4s
![Page 14: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/14.jpg)
Objetivo específico Nº 4
►Implementar el lenguaje VHDL en dispositivos lógicos programables, hardware en el cual se lleve a cabo el proceso de control del robot, según las directrices establecidas para tal fin.
![Page 15: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/15.jpg)
Nº 4: VHDL, unidad de diseño
►Entidad: Bloque elemental, declaración de entradas y salidas
►Arquitectura: Estructura que describe el funcionamiento de la entidad
![Page 16: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/16.jpg)
Nº 4: VHDL, Entidad
![Page 17: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/17.jpg)
Nº 4: VHDL, Arquitectura
![Page 18: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/18.jpg)
Nº 4: Subrutina, secuencias
![Page 19: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/19.jpg)
Nº 4: Subrutina, retardo
![Page 20: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/20.jpg)
Nº 4: FPGA, tarjeta de desarrolloAlimentación
Conector J1
Conector J2
Conector J4
ConectorDAC
Botones usuario Pantalla LCD
![Page 21: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/21.jpg)
Nº 4: Controlador de velocidad
►Controlador proporcional
►Medición de la velocidad a través de encoder
► Salida a driver de motor por conversor digital-análogo de 12 bits
►Algoritmo de selección de “set point”
![Page 22: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/22.jpg)
Nº 4: Controlador de velocidad
►Algoritmo de selección de “set point” INICIO
SP=5
Vm<=4.5
SP= Vm
Espera
Vm>4.5
si
no
si
no
Velocidad de motor 2
disminuye.
Velocidad de motor 2
aumenta nuevamente.
![Page 23: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/23.jpg)
Objetivo específico Nº 5
►Aplicar el concepto de redes neuronales para la concepción de la estrategia de control y el aprendizaje de la trayectoria.
![Page 24: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/24.jpg)
Nº 5: Memoria trayectoria
►Posición inicial X=0, Y=0, ángulo de 90º
►Puntos de memoria:
-En avance recto, cada 5cm
-Cada punto de giro
![Page 25: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/25.jpg)
Nº 5: Referencia alrededor del robot
►Angulo de dirección del punto destino
►Vector de 96 posiciones que funciona como mapa de obstáculos
![Page 26: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/26.jpg)
Nº 5: Búsqueda de trayectoria
►Primera condición: Trayectoria en línea recta
►Cuando no se puede lo anterior se utiliza neurona artificial (Modelo hebbiana)
![Page 27: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/27.jpg)
Nº 5: Neurona hebbiana
0:1
0:1
.
siI
siIy
xwbI
i
d
n
iI
i
n
id
i
ifn
x
i
iOBSIx
ifn
x
i
iOBSDx
1
15
1
1
15
1
)(*1
)4(
)()3(
)(*1
)2(
)()1(
![Page 28: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/28.jpg)
Nº 5: Punto destino
►Comparar punto memorizado con punto destino
►Si el robot pasa por un mismo punto mas de dos veces, se aborta la búsqueda
![Page 29: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/29.jpg)
Interfaz usuario
►Botones y pantalla LCD
![Page 30: ROBOT MOVIL CONTROLDADO POR DISPOSITIVO LOGICO …](https://reader035.fdocument.pub/reader035/viewer/2022071109/62caa70415d88e78013c07fd/html5/thumbnails/30.jpg)
CONCLUSIONES
► La implementación de FPGA programado mediante lenguaje VHDL ofrece la gran ventaja de controlar el robot móvil de forma paralela
► Funcionamiento en paralelo dificulta las secuencias serie
►Configuración diferencial óptima para robots pequeños