Download Proyecto: Robot Araña Seguidora de Luz Autor: Antonio José

Document related concepts

Servomotor de modelismo wikipedia , lookup

Modulación por ancho de pulsos wikipedia , lookup

Transcript
1.1. Memoria Descriptiva
1.1.1. Objeto
El objeto de este proyecto es el de construir un robot araña controlado por un PIC16F84A.
1.1.2. Antecedentes
El diseño original no se llegó a realizar en circuito impreso, en este caso se ha realizado el
diseño del circuito impreso desde su creación con software hasta su construcción. Además
antes de realizar su ensamblado se realizó una simulación del circuito con el archivo de
programación del PIC.
Otro modificación incluida en el proyecto son los servomotores, se han utilizado unos
microservos, pero con una gran potencia, al ser más pequeños se han tenido que modificar las
posiciones de las patas.
1.1.3. Justificación
La finalidad de este circuito es didáctica con él se aprende a utilizar los microcontroladores PIC
y los servomotores. Los microcontroladores poseen un gran rendimiento y versatilidad. La
ventaja de los servomotores es su fuerza y que si se le está entregando señal adecuada
quedan en una posición fija (gran ventaja en comparación a los motores DC y Paso a Paso.)
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 1
1.1.4. Datos de partida
Los datos de partida de este proyecto es el siguiente circuito:
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 2
1.1.5. Análisis y Descripción del circuito
P1
P18
P6
P6
P7
P7
P8
P8
P18
P17
P17
SEÑAL ANALÓGICA
SERVOMOTORES
CONTROL DIGITAL
En este esquema esta detallada cada bloque 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.
BLOQUE 1. ALIMENTACIÓN
6V
BT1
BATERIA 6V
GND
0
BT2
BATERIA 9V
VOUT
3
5V
2
VIN
GND
U1
1
78M05/TO
0
Para mover los servos usaremos 4 pilas AA de 1,5V. cada una (BT1) y para la parte electrónica
analógica y digital una pila de 9V (BT2). que limitaremos a 5V. con un regulador de voltaje
78M05 (U1).
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
GND
6V
5V
GND
P1
ALIMENTACIÓN
B4
B3
5V
5V
6V
GND
B2
GND
B1
Página 3
BLOQUE 2. SEÑAL ANALÓGICA
VCC
VCC
P17
5V
4
LDR1
3
2
LM324
220 ohm
LED
11
R4
1k
D1
1
-
R1
U2A
R7
+
R8
10k
R.VARIABLE 1K
P18
VCC
4
LDR2
5
6
R5
1k
D2
7
-
LM324
220 ohm
LED
11
R2
U2B
R9
+
R.VARIABLE 1K
R10
10k
VCC
P1
4
LDR3
9
R6
1k
R3
U2C
D3
R11
+
8
-
220 ohm
LM324
LED
11
10
R.VARIABLE 1K
R12
10k
GND
A la izquierda del circuito tenemos las tres LDR (LDR1, LDR2 y LDR3) que nos da la posición
de la fuente de luz, esta señal se dirige a un circuito integrado LM324 (U2) que está
configurado como comparador de voltaje. El funcionamiento de la LDR junto con el comparador
es el siguiente: 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 (R1,
R2 y R3) 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 los diodos LED
(D1,D2 y D3) que se encargan de avisarnos el estado de las entradas y así poder verificar y
ajustar con las resistencias variables de 1k el valor de luz o mejor dicho la sensibilidad a la luz
que queremos que funcione nuestro robot, si se encuentra encendido algún led es porque está
llegando luz de alguna fuente del ambiente, para dejarlo apagado solo se tiene que ajustar la
resistencia de 1k hasta que se apague. 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.
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 4
En conclusión que para los tres LDR tenemos 8 posibles combinaciones que nos darán los
diferentes estados que serán procesados por el microcontrolador, esta tabla muestra los
posibles estados:
CONTROL CON LDR
Nº
LDR1
LDR2
LDR3
MOVIMIENTO
0
0
0
0
PARADO
1
0
0
1
IZQUIERDA
2
0
1
0
ADELANTE
3
0
1
1
IZQUIERDA
4
1
0
0
DERECHA
5
1
0
1
PARADO
6
1
1
0
DERECHA
7
1
1
1
ADELANTE
Sabemos que el 0 corresponde a un 0 lógico y los 3,3V. a un 1 lógico por lo que tenemos una
tabla con todas las posibles combinaciones y su respectivo movimiento que llevara a cabo
finalmente.
BLOQUE 3. CONTROL DIGITAL
VCC
5V
P17
GND
P18
0
U3
17
18
1
2
3
C1
1n
RB0/INT
RB1
RB2
RB3
RB4
RB5
OSC1/CLKIN
RB6
OSC2/CLKOUT
RB7
16
15
Y1
4 MHZ
4
C2
MCLR
14
VDD
6
7
8
9
10
11
12
13
P7
P8
5
1n
P6
RA0
RA1
RA2
RA3
RA4/TOCKI
GND
P1
0
PIC16F84
VCC
VCC
0
R13
10k
C3
0,1F
0
SW1
PULSADOR RESET
0
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 5
En la parte de control Digital se utiliza un microcontrolador PIC16F84A (U3) configurado con
un oscilador de cristal a 4 Mhz (Y1) y un pulsador (SW1) para poder resetear el
microcontrolador en cualquier momento sin tener que desconectar la alimentación.
El PIC recibe los valores del comparador que se obtiene por las conexiones denominadas P17,
P18 y P1 y según nuestra tabla, se le enviaran las señales al servo que corresponda (P6, P7 y
P8) para hacer un movimiento en particular.
BLOQUE 4. SERVOMOTORES
P8
P7
P6
SM1
3
2
1
SM2
3
2
1
PATAS DELANTERAS
SM3
3
2
1
PATAS DEL MEDIO
PATAS TRASERAS
6V
GND
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 6
Como se muestra en la figura el servo tiene una movilidad de 180° y funciona con lo que se
conoce como modulación por ancho de pulsos o PWM. Es decir, este servo funciona a 50Hz, o
sea en un segundo le son enviados 50 pulsos, y con un simple cálculo se puede dividir 1/50 y
nos dará 20miliseg , el ancho de pulso se utilizara para el trabajo del movimiento de este.
Trabajando en este pequeño intervalo, podemos poner en un ángulo a nuestro antojo el
servomotor y que se quede fijo 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 mili-segundos, 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 mili-segundos, 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 mili-segundos, esto repetidamente por 50 Hz
nos dará la posición 180°. Para este caso en particular se usó 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.
Proyecto: Robot Araña Seguidora de Luz
Autor: Antonio José Morente Martín
Página 7