Étape 4: Téléchargez le fichier sur votre Arduino
Télécharger cette esquisse à votre arduino ou télécharger an-sketch.ino
#include
Servo Hservo ;
Servo Vservo ;
int Hstate = 90 ;
int Vstate = 90 ;
int in1 = A2 ;
int in2 = A3 ;
in3 int = A4 ;
in4 int = A5 ;
int camup = 6 ;
int camdown = 7 ;
int camleft = 8 ;
int camright = 9 ;
int p2 ;
int p3 ;
int p4 ;
int p5 ;
int p6 ;
int p7 ;
int p8 ;
p9 int ;
void setup() {}
Hservo.Attach(10) ;
Vservo.Attach(11) ;
pinMode (entrée, A2) ;
pinMode (entrée, A3) ;
pinMode (entrée, A4) ;
pinMode (entrée, A5) ;
pinMode (6, entrée) ;
pinMode (7, entrée) ;
pinMode (8 entrées) ;
pinMode (9, entrée) ;
pinMode (sortie 2) ;
pinMode (3, sortie) ;
pinMode (sortie 4) ;
pinMode (5, sortie) ;
}
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 == LOW || p7 == faible)
Stop() ;
Si (p6 == haute || p7 == HIGH)
horizontal() ;
Si (p8 == haute || p9 == HIGH)
vertical() ;
Si (p2 > 512)
mémoire ;
Si (p3 > 512)
Backward() ;
Si (p4 > 512)
Left() ;
Si (p5 > 512)
Right() ;
}
Sub horizontal()
{
Si (p6 == HIGH & & p7 == faible)
{Hstate = Hstate + 2;}
Si (p6 == LOW & & p7 == HIGH)
{Hstate = Hstate - 2;}
Si (p6 == HIGH & & p7 == HIGH)
{Hstate = 90;}
Si (Hstate > = 180) Hstate = 180 ;
Si (Hstate < = 0) Hstate = 0 ;
Hservo.Write(Hstate) ;
Delay(150) ;
}
Sub vertical()
{
Si (p8 == HIGH & & p9 == faible)
{Vstate = Vstate + 2;}
Si (p8 == LOW & & p9 == HIGH)
{Vstate = Vstate - 2;}
Si (p8 == HIGH & & p9 == HIGH)
{Vstate = 90;}
Si (Vstate > = 180) Vstate = 180 ;
Si (Vstate < = 0) Vstate = 0 ;
Vservo.Write(Vstate) ;
Delay(150) ;
}
mémoire vide
{
digitalWrite(2,HIGH) ;
digitalWrite(3,LOW) ;
digitalWrite(4,HIGH) ;
digitalWrite(5,LOW) ;
}
Sub backward()
{
digitalWrite(2,LOW) ;
digitalWrite(3,HIGH) ;
digitalWrite(4,LOW) ;
digitalWrite(5,HIGH) ;
}
left() Sub
{
digitalWrite(2,HIGH) ;
digitalWrite(3,LOW) ;
digitalWrite(4,LOW) ;
digitalWrite(5,HIGH) ;
}
right() Sub
{
digitalWrite(2,LOW) ;
digitalWrite(3,HIGH) ;
digitalWrite(4,HIGH) ;
digitalWrite(5,LOW) ;
}
stop() Sub
{
digitalWrite(2,LOW) ;
digitalWrite(3,LOW) ;
digitalWrite(4,LOW) ;
digitalWrite(5,LOW) ;
}
La bibliothèque du servo doit être déjà installée