Paso 4: Subir archivos a tu Arduino
Subir este bosquejo a tu arduino, o descargar año-sketch.ino
#include
Servo Hservo;
Servo Vservo;
int Hstate = 90;
int vEstado = 90;
int in1 = A2;
in2 int = A3;
int in3 = A4;
int in4 = A5;
int camup = 6;
int camdown = 7;
int camleft = 8;
camright int = 9;
int p2;
int p3;
int p4;
int p5;
int p6;
int p7;
int p8;
int p9;
void setup() {}
Hservo.Attach(10);
Vservo.Attach(11);
pinMode (A2, entrada);
pinMode (A3, entrada);
pinMode (A4, entrada);
pinMode (A5, entrada);
pinMode (6, entrada);
pinMode (7, entrada);
pinMode (8, entrada);
pinMode (9, entrada);
pinMode (2, salida);
pinMode (3, salida);
pinMode (4, salida);
pinMode (5, salida);
}
void loop() {}
P2 = analogRead(A0);
P3 = analogRead(A1);
P4 = analogRead(A2);
P5 = analogRead(A3);
P6 = digitalRead(camup);
P7 = digitalRead(camdown);
P8 = digitalRead(camleft);
P9 = digitalRead(camright);
Si (p6 == baja || p7 == LOW)
STOP();
Si (p6 == alta || p7 == HIGH)
horizontal();
Si (p8 == alta || p9 == HIGH)
vertical();
Si (p2 > 512)
Forward();
Si (p3 > 512)
backward();
Si (p4 > 512)
Left();
Si (p5 > 512)
Right();
}
horizontal() vacío
{
Si (p6 == alto & & p7 == LOW)
{Hstate = Hstate + 2;}
Si (p6 == baja & & p7 == HIGH)
{Hstate = Hstate - 2;}
Si (p6 == alto & & p7 == HIGH)
{Hstate = 90;}
Si (Hstate > = 180) Hstate = 180;
Si (Hstate < = 0) Hstate = 0;
Hservo.Write(Hstate);
Delay(150);
}
void vertical()
{
Si (p8 == alto & & p9 == LOW)
{VEstado = vEstado + 2;}
Si (p8 == baja & & p9 == HIGH)
{VEstado = vEstado - 2;}
Si (p8 == alto & & p9 == HIGH)
{VEstado = 90;}
Si (vEstado > = 180) vEstado = 180;
Si (vEstado < = 0) vEstado = 0;
Vservo.Write(Vstate);
Delay(150);
}
forward() vacío
{
digitalWrite(2,HIGH);
digitalWrite(3,LOW);
digitalWrite(4,HIGH);
digitalWrite(5,LOW);
}
void backward()
{
digitalWrite(2,LOW);
digitalWrite(3,HIGH);
digitalWrite(4,LOW);
digitalWrite(5,HIGH);
}
left() vacío
{
digitalWrite(2,HIGH);
digitalWrite(3,LOW);
digitalWrite(4,LOW);
digitalWrite(5,HIGH);
}
right() vacío
{
digitalWrite(2,LOW);
digitalWrite(3,HIGH);
digitalWrite(4,HIGH);
digitalWrite(5,LOW);
}
void stop()
{
digitalWrite(2,LOW);
digitalWrite(3,LOW);
digitalWrite(4,LOW);
digitalWrite(5,LOW);
}
La biblioteca del servo debe instalarse ya