Paso 5: El código
puede descargar el código de abajo en esta página/ * Este código es escrito por geobruce
para más información consulta mi página http://xprobe.net
*/
#include < Servo.h > / / incluye biblioteca de Servo
Servo horizontal; servo horizontal
int servoh = 90; soporte servo horizontal
Servo vertical; servo vertical
servov int = 90; soporte servo vertical
Conexiones de perno LDR
nombre = analogpin;
int ldrlt = 0; Arriba a la LDR izquierda
int ldrrt = 1; LDR rigt superior
int ldrld = 2; LDR abajo a la izquierda
int ldrrd = 3; LDR abajo rigt
void setup()
{
Serial.Begin(9600);
conexiones de servo
Name.attacht(PIN);
horizontal.Attach(9);
vertical.Attach(10);
}
void loop()
{
int lt = analogRead(ldrlt); arriba a la izquierda
int rt = analogRead(ldrrt); arriba a la derecha
int ld = analogRead(ldrld); abajo a la izquierda
rd de int = analogRead(ldrrd); abajo rigt
int tiempo = analogRead 4/20; leer los potenciómetros
int tol = analogRead 5/4;
avt int = (lt + rt) / 2; arriba del valor medio
avd de int = (ld + rd) / 2; valor promedio por
int avl = (lt + ld) / 2; valor medio izquierda
avr de int = (rt + rd) / 2; valor medio derecha
dvert int = avt - avd; comprobar la diffirence de arriba y abajo
dhoriz int = avl - avr; / cheque de la diffirence og izquierda y rigt
Si (-1 * tol > dvert || dvert > tol) / / Compruebe si el diffirence está en la tolerancia cambiar otro ángulo vertical
{
Si (avt > avd)
{
servov = ++ servov;
Si (servov > 180)
{
servov = 180;
}
}
else if (avt < avd)
{
servov =--servov;
Si (servov < 0)
{
servov = 0;
}
}
vertical.Write(servov);
}
Si (-1 * tol > dhoriz || dhoriz > tol) / / comprueba si el diffirence está en la tolerancia de otro cambio de ángulo horizontal
{
Si (avl > avr)
{
servoh = - servoh;
Si (servoh < 0)
{
servoh = 0;
}
}
else if (avl < avr)
{
servoh = ++ servoh;
Si (servoh > 180)
{
servoh = 180;
}
}
else if (avl == avr)
{
nada
}
horizontal.Write(servoh);
}
Delay(dtime);
}