jueves, 28 de febrero de 2019
jueves, 23 de febrero de 2012
ROBOT AUTONOMO TODO TERRENO “PUN/HP”
Diego Alexander Sarango Torres
dasarango@utpl.edu.ec
Esteban Andrés
Gutiérrez Novillo
eagutierrez@utpl.edu.ec
Presentamos la construcción de un “Robot Autónomo” que cuenta con un sistema electrónico
detallado minuciosamente y la presencia de un microcontrolador Atmel AVR. Tras muchos análisis matemáticos y de diseño electrónico se decidió
como se va a llevar acabo la
construcción del prototipo, lo cual se aplicara en este diseño electrónico un
microcontrolador programable. Por ello el “Robot Autónomo Todo
Terreno” se ha desarrollado con base a la búsqueda del equilibrio perfecto de
la con el hardware y software del prototipo, de tal modo que logramos acoplar
nuestros diseños de la mejor manera para tener así funcionamiento deseado y
exitoso del prototipo.
Nuestro prototipo es enfocado para la
evasión de obstáculos, es decir el robot
evita chocar con paredes o objetos que los sensores detectan, los mismos que
son “Sensores de Ultrasonido”, además el esqueleto del prototipo se a diseñado
para que sea un (Todo terreno) de movilizarse
por caminos y terrenos que son de gran dificultad para prototipos de su mismo peso,
diseño y densidad.
Þ ESPECIFICACIONES BÁSICAS DEL CHASIS
En la construcción de esqueleto del prototipo hemos
utilizado el material aluminio, el
motivo es por ser un material resistente, ligero y optimo para la implementación
en robótica.
Vista lateral del esqueleto, como
podemos ver el material del prototipo, nos permite estabilidad, que el robot se
mantenga firme, distribución casi perfecta de todo el peso del prototipo.
Þ ESTABILIDAD DEL PROTOTIPO
Nuestro prototipo cuenta con un peso aproximado
de 8 libras ,
con su centro de masa distribuido de manera optima para que el prototipo
funcione sin imperfecciones al momento de estar en marcha, como ya se describió
anteriormente, el sistema de amortiguación nos ayuda a la
distribución del peso durante su funcionamiento.
Þ ESTRUCCURA DE HARDWARE
El
prototipo se diseñó de forma modular, compuesto por cinco subsistemas
fundamentales
• Subsistema de
procesamiento de la información. Basado en el
microcontrolador Atmega 32 que se
encarga de comandar todas las acciones del robot, tales como procesar la
información proveniente de los sensores, enviar órdenes a los motores en
respuesta a la ejecución de un algoritmo de control, o por órdenes enviadas
desde un Pc a través de un. Este microcontrolador posee módulos especiales, e
instrucciones para la ejecución de algoritmos basados en lógica difusa, lo que
facilita el desarrollo y aplicación de técnicas de inteligencia computacional
para el control de la plataforma. Es importante resaltar que el
microcontrolador cuenta con un gran número de puertos libres de expansión, lo
que facilita la adaptación de nuevos dispositivos en el robot.
• Subsistema de
sensores.
Está
compuesto sensores de ultrasonido, las pruebas iníciales se las realizo con los
sensores de fin de carrera.
• Subsistema de comunicación.
Permite la interacción con el robot a través del puerto
USB del Pc gracias al dispositivo para
programar el microcontrolador.
• Subsistema actuador.
Las ruedas del robot son accionadas, cada
una, por un Servomotor (TRUCADO) acoplado al sistema, tales motores nos garantiza
un excelente torque y velocidad para el prototipo La potencia eléctrica
suministrada a por pulsos digitales 0 – 1.
Se diseñó para permitir que el robot operara
con una autonomía de aproximadamente tres horas, en pleno funcionamiento o conectado a
una fuente externa
Þ MATERIALES:
Þ Llantas de caucho.
Þ Servomotores HS-311.
Þ Puente H L293.
Þ Microcontrolador Atmel 64. (TRUCADOS).
Þ Resistencias 220 ohm,1700 ohm.
Þ 1 Regulador de voltaje
5V.
Þ 1 Cristal de 8 Mhz.
Þ Capacitores de 22 pF.
Þ Chasis de aluminio.
Þ Tornillos y pernos de 2 pulgadas .
Þ Socalos de 20 x 20 y
7x7.
Þ Baterías de 7.1 V.
Þ 1 Baquelita.
Þ LOCOMOCIÓN Y
MOVIMIENTO DEL PROTOTIPO (Sensor de
ultrasonido)
La locomoción del prototipo dependen de la configuración
de los sensores tanto en la lógica como físicamente en la figura podemos
apreciar la configuración de los sensores y como van a funcionar para lograr el
funcionamiento deseado en el prototipo el cual se encuentra alineado en un
rango de 90º en el cual se deja un rango
de 40º entre los sensores, el motivo de esta configuración es que existiría
conflicto entre sensores si se encuentran ambos en la misma zona de escaneo.
Þ ROBOT
AUTONOMO “PUN/HP”:
El sistema de sensores usados en
el prototipo son sensores de ultrasonido, cuyos dispositivos fusionan a un
voltaje de 5 V y opera generalmente
desde los rangos
·
Características generales de los Sensores de Ultrasonido
Ultrasonido
hace referencia a las frecuencias arriba de 20KHz (limite de sonido audible).
Altas
frecuencias tienen longitudes de onda cortas lo que hace al reflejarse en
objetos esta pueda ser leída. Desafortunadamente frecuencias muy altas son
difíciles de generar y leer.
La
generación y lectura de ultrasonido se hace a través de dos unidades
piezoeléctricas en donde una de ellas es el emisor y la otra el receptor de
ondas de presión ultrasónicas.
Para
esto, la unidad emisora debe excitarse con una señal adecuada en amplitud y
frecuencia. La unidad receptora translucir
todas aquellas ondas de presión ultrasónicas de 40KHz que lleguen a
excitarla.
El ultrasonido es aplicado comúnmente en detectores de movimiento,
medidores de distancia, diagnostico médico, limpieza, pruebas no destructivas
(para detectar imperfecciones en materiales etc.
La distancia es calculada leyendo el tiempo que
tarda en regresar una onda ultrasónica reflejada. Idealmente el obstáculo debe
tener una sección transversal grande y no absorber el ultrasonido. El método
más utilizado para la determinación de la distancia es enviar trenes de pulsos
de 40 KHz con periodos muy cortos. El tiempo transcurrido entre el
comienzo de la emisión y el comienzo de la recepción será proporcional a la
distancia recorrida por las ondas ultrasónicas.
El
sistema de circuito impreso consta
básicamente de tres partes:
•
El sistema sensores.
•
La Tarjeta
controladora que genera los pulsos necesarios para mover los servomotores y
recibe las señales analógicas provenientes del sensor de ultrasonido.
•
El circuito de control que contiene el microcontrolador que es el cerebro del
sistema.
Este módulo prototipo detecta los
posibles caminos por donde puede pasar el móvil según los obstáculos
encontrados.
Un camino posible debe de cumplir:
• Que el objeto este a más de 30 cm de distancia respecto al móvil, para que
el móvil pueda variar su dilección
• Que el ancho del camino posible debe ser mayor al ancho del móvil, que
es de 1 metro
de ancho aproximadamente.
Þ DISEÑO ELECTRONICO:
El diseño del prototipo esta
basado en 2 circuitos para los sensores y el circuito central en el que se encuentra el microcontrolador,
el diseño de navegación.
Como
podemos observar el diseño del circuito consta de un amplificador,
transistor 2N3904, potenciómetro de 5k y potenciómetro de 100k, y el lote de
resistencias, el objetivo de este diseño es calibrar y regular el sensor, es
decir aumentar y disminuir al alcance de emisión y recepción de los sensores
depende como se desee.
En la figura anterior podemos observar el diseño
central de este prototipo, cuenta con el microcontrolador Atmega 32, puente H,
regulador de voltaje ,el cristal , los capacitores y el lote de resistencias ,
además consta de conectores para los servomotores .
La salida de los sensores van al microcontrolador,
el motivo es registrar los datos enviados por los sensores y que el
microcontrolador los procese de acuerdo al algoritmo de programación que este cuente.
La simulación de este sistema se encuentra en la
lámina 1 de la zona de anexos, en el que podemos encontrar el esquema mas
detallado del sistema.
ÞALGORITMO DE CONTROL
El algoritmo de control se encuentra realizado en el
programa Codevision Avr, el programa se basa en lenguaje de programación en C , además contamos con la ayuda de un
programador de microcontroladores y su software
“progisp”.
Elección
del mejor Camino
El
uso de las interrupciones que cuenta el Atmega 32 son de suma importancia en
este prototipo ya que de ellos depende la orden del microcontrolador hacia los
sensores, en este caso utilizamos las dos interrupciones externas que cuenta
dispositivo. Una
vez que ya se tiene todos caminos libres de obstáculos ahora hay que elegir el
mejor camino. El
mejor camino es aquel que genere el menor cambio en la dirección del móvil es
decir el que este mas próximo al centro del área de detección. En
el caso de de que no exista un camino libre de obstáculos, el móvil se detendrá
y empezar a retroceder hasta hallar un camino libre.
Þ RESULTADOS
Conforme
se fueron construyendo las diferentes etapas del proyecto con diversos diseños,
pruebas y averías que tuvimos en el transcurso de que se fueron probando, en la figura muestra el prototipo ya terminado con los sensores ubicados de
acuerdo al ángulo y dirección de
funcionamiento especificado.
miércoles, 22 de febrero de 2012
ROBOT ARAÑA CON PIC 16F628A
En el diseño de nuestro proyecto debemos tomar en cuenta la libertad del diseño del circuito, del chasis e incluso podemos mejorando nuestro diseño como ustedes lo deseen.
LISTA DE COMPONENTES
3 - Potenciómetros 1k.
4 - Resistencias de 10k.
3 - Resistencias de 1k.
3 - Resistencias de 220 ohmios.
1 - Regulador de voltaje 78m05.
1 - Cristal de 4mhz.
1 - PIC 16F6284A
1 - Integrado lm324n.
3 – Leds.
3 - Fotoceldas.
3 - Servo-motores.
4 - Pilas AA.
1 - Pila de 9V.
2 - Capacitores Cerámicos 33pf (33 pico faradios).
1 - Capacitor Cerámico de 104f (104 faradios).
Para la construcción del chasis debemos escoger el materia mas apropiado, ya que debemos ver que no sea muy pesado lo que complicaría el trabajo de los motores. Hemos escogido una hoja de ALUMINIO de peso ligero y por la facilidad de maniobrar y darle forma, además por ser más económico.
En nuestro diseño del circuito existen 3 potenciómetros de 1 K , su funcionamiento consta de la regulación de la cantidad de luz que va a receptar la luz.
Aquí podemos sacar en conclusión que para los 3 LDR’s tenemos 8 posibles combinaciones que nos darán los diferentes estados que serán procesados por el microcrontolador, esta tabla se muestra en la siguiente imagen.
De esta manera queda el diseño de nuestro prototipo fina como podemos ver con un poco de estética y imaginación se vera mas vistoso y además de su presentación
Si pueden apreciar el punto que esta a la derecha del prototipo, se trata de un láser, esta ves usaremos un láser para enfocar en las fotoceldas por ser un as de luz mas potente y concentrado para el perfecto funcionamiento del prototipo y además si queremos enfocar dos o tres sensores a la vez usaremos dos o tres láser a la ves por lo que solo podemos enfocar un sensor con un láser, cabe recalcar que no solo funciona con luz laser , lo podemos hacer con una lámpara manual e incluso llega a funcionar con la luz del ambiente.
LISTA DE COMPONENTES
3 - Potenciómetros 1k.
4 - Resistencias de 10k.
3 - Resistencias de 1k.
3 - Resistencias de 220 ohmios.
1 - Regulador de voltaje 78m05.
1 - Cristal de 4mhz.
1 - PIC 16F6284A
1 - Integrado lm324n.
3 – Leds.
3 - Fotoceldas.
3 - Servo-motores.
4 - Pilas AA.
1 - Pila de 9V.
2 - Capacitores Cerámicos 33pf (33 pico faradios).
1 - Capacitor Cerámico de 104f (104 faradios).
Para la construcción del chasis debemos escoger el materia mas apropiado, ya que debemos ver que no sea muy pesado lo que complicaría el trabajo de los motores. Hemos escogido una hoja de ALUMINIO de peso ligero y por la facilidad de maniobrar y darle forma, además por ser más económico.
EL DISEÑO Y ENSAMBLAJE DEL CIRCUITO
El circuito del prototipo no consta de partes, componentes demasiados complejos, debemos tomar en cuenta el cuidado y la precaución al momento de diseñar y armar nuestro circuito para evitar contratiempos y evitando la quema y avería de los diversos dispositivos electrónicos
SIMULACION CON PROTEUS 7.6
El esquema del circuito del nuestro prototipo es de la siguiente manera como lo podemos apreciar en el recuadro siguiente.
En esta parte esta detallada cada sección de todo el conjunto, la parte Analógica que se encarga de enviar la señal al microcontrolador (Control digital) su fuente de alimentación y regulación, y finalmente la parte de potencia que son los servomotores. Se explica cada una de ellas para que entiendan como funciona cada parte del circuito.
Comenzando con la parte analógica vemos en el costado izquierdo superior que tenemos 3 LDR’s que son los que receptan la luz. Al aplicarle luz a la foto resistencia su valor disminuye ingresando por la entrada negativa del operacional un valor que se compara por el de la resistencia variable de 1k Ohm cuando este valor es igual a la salida del operacional tenemos un alto (3,3V. aproximadamente) y cuando no existe luz este valor de voltaje es diferente por el cual la salida de ese operacional es de 0 Voltios.
A la salida de cada operacional se conecta diodos LED que se encargan de dar a conocer el estado de las entradas y así poder verificar y ajustar con las resistencias variables de 1k ohm, estas resistencias nos permite variar la sensibilidad a la luz que queremos que funcione nuestro robot, si se encuentra encendido algún led es por que esta llegando luz de alguna fuente del ambiente, para dejarlo apagado solo se tiene que ajustar la resistencia de 1k ohm hasta que se apague.
Debemos mencionar que estos indicadores deben estar apagados en un comienzo para así al aplicarles luz comience a funcionar el robot según la dirección del rayo de luz. Aquí podemos sacar en conclusión que para los 3 LDR’s tenemos 8 posibles combinaciones que nos darán los diferentes estados que serán procesados por el microcrontolador. Ya sabemos que el 0 corresponde a un 0 lógico y los 3,3V. Un 1 lógico por lo que tenemos que armar una tabla con todas las posibles combinaciones y su respectivo movimiento que llevara a cabo finalmente. En la parte de control digital se toman estos valores y según nuestra tabla, se le enviaran las señales al servo que corresponda para hacer un movimiento en particular.
Como ya sabemos el servo tiene una movilidad de 180° y funciona con lo que se conoce como modulación por ancho de pulsos o PWM. En otras palabras este servo que es d la marca HS-311 de Radio control, funciona a 50Hz, o sea en un segundo le son enviados 50 pulsos, y con un simple calculo se puede dividir 1/50 y nos dará 20miliseg el ancho de pulso se utilizara para el trabajo del movimiento de este, este esta trabajando en este pequeño intervalo, podemos poner en un ángulo a nuestro antojo el servomotor y que se quede allí hasta que cambiemos ese pulso por otro. Para 0° tenemos que tener un pulso de 0,2 mili segundos y el resto un pulso bajo hasta los 20 milisegundos, esto repetidamente 50 veces nos da los 50 Hz y por consecuencia el servo en la posición 0° como se muestra en la figura. Para 90° tenemos que aplicar un pulso de 1,5 mili segundos y el resto en pulso bajo hasta los 20 milisegundos, esto repetidamente por 50 Hz nos dará la posición 90°, también mostrado en la figura. Y para 180 ° tenemos que aplicar un pulso de 2,2 mili segundos y el resto en pulso bajo hasta los 20 milisegundos, esto repetidamente por50 Hz nos dará la posición 180°. Para este caso en particular se uso como centro 90° y se calcularon matemáticamente los pulsos para 66,5° y 112,5° que serán los 3 ángulos usados para que camine nuestra araña.
Para su alimentación de voltaje lo realizamos con un regulador de voltaje a 5V y 9 V debido al ingreso de diversos tipos de voltajes para las alimentaciones de las secciones de nuestro circuito, como podemos detallar en el siguiente esquema de alimentación.
PROGRAMACION DE NUESTRO PROTOTIPO CODIGO EN MICROCODE
ENCENDIDO Y APAGADO DE UN LED
DIAGRAMA DE CONEXION
El diseño del circuito se lo a realizado en proteus 7.6 como podemos observar se a elegido el microcontrolador 16F628A adicionando un resistor que se conecta a la salida del puerto No 6 del microcontrolador o puerto B0 y finalmente se conecta el Led como se ve en el cuadro.
CODIGO DEL PROYECTO
El codigo del proyecto se lo realizo en MicroCode Studio
led VAR portb.0
loco:
HIGH led
pause 1000
low led
pause 1000
GOTO loco
end
Suscribirse a:
Entradas (Atom)