Stap 4: Upload bestand naar je Arduino
Uploaden van deze schets aan de arduino, of downloaden van jaar-sketch.ino
#include
Servo Hservo;
Servo Vservo;
int Hstate = 90;
int Vstate = 90;
int in1 = A2;
int in2 = A3;
int 3 = A4;
int in4 = A5;
int camup = 6;
int camdown = 7;
int camleft = 8;
int camright = 9;
int p2;
int p3;
int p4;
int p5;
int p6;
int de p7;
int de p8;
int p9;
VOID Setup {}
Hservo.attach(10);
Vservo.attach(11);
pinMode (A2, INPUT);
pinMode (A3, INPUT);
pinMode (A4, INPUT);
pinMode (A5, INPUT);
pinMode (6, INPUT);
pinMode (7, INPUT);
pinMode (8, INPUT);
pinMode (9, INPUT);
pinMode (2, OUTPUT);
pinMode (3, OUTPUT);
pinMode (4, OUTPUT);
pinMode (5, OUTPUT);
}
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);
Als (p6 == lage || p7 == laag)
Stop();
Als (p6 == HIGH || p7 == HIGH)
Horizontal();
Als (p8 == HIGH || p9 == HIGH)
Vertical();
Als (p2 > 512)
vooruit();
Als (p3 > 512)
backward();
Als (p4 > 512)
datumwaarde;
Als (p5 > 512)
rechts();
}
VOID horizontal()
{
Als (p6 == HIGH & & p7 == laag)
{Hstate = Hstate + 2;}
Als (p6 == LOW & & p7 == HIGH)
{Hstate = Hstate - 2;}
Als (p6 == HIGH & & p7 == HIGH)
{Hstate = 90;}
Als (Hstate > = 180) Hstate = 180;
Als (Hstate < = 0) Hstate = 0;
Hservo.write(Hstate);
delay(150);
}
VOID vertical()
{
Als (p8 == HIGH & & p9 == laag)
{Vstate = Vstate + 2;}
Als (p8 == LOW & & p9 == HIGH)
{Vstate = Vstate - 2;}
Als (p8 == HIGH & & p9 == HIGH)
{Vstate = 90;}
Als (Vstate > = 180) Vstate = 180;
Als (Vstate < = 0) Vstate = 0;
Vservo.write(Vstate);
delay(150);
}
VOID vooruit()
{
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);
}
VOID datumwaarde
{
digitalWrite(2,HIGH);
digitalWrite(3,LOW);
digitalWrite(4,LOW);
digitalWrite(5,HIGH);
}
VOID rechts()
{
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);
}
De bibliotheek van de servo moet al worden geïnstalleerd