Stap 3: Code voor Arduino Uno
int in4 = 13;
int 3 = 12;
int in2 = 11;
int in1 = 10;
int en2 = 9;
int en1 = 6;
VOID Setup
{
voor leonardo
/ * Serial1.begin(9600);
terwijl (!. Serieel) {; / / wait voor seriële poort aansluiten. Alleen nodig voor Leonardo} * /
Serial.begin(9600);
pinMode (in4, OUTPUT);
pinMode (3, OUTPUT);
pinMode (in2, OUTPUT);
pinMode (in1, OUTPUT);
pinMode (en2, OUTPUT);
pinMode (en1, OUTPUT);
}
void loop {}
char karakter = Serial.read();
Als (karakter == 'a') //forward
{
analogWrite(en1,160); eerste motor voor het rijden
analogWrite(en2,0); tweede motor voor steer as
digitalWrite(in4,LOW);
digitalWrite(in3,HIGH);
}
Als (karakter 'b' ==) //back
{
analogWrite(en1,160);
analogWrite(en2,0);
digitalWrite(in4,HIGH);
digitalWrite(in3,LOW);
}
Als (karakter 'c' ==) //stop
{
analogWrite(en1,0);
analogWrite(en2,0);
}
Als (karakter == had') //turn links
{
analogWrite(en2,255);
digitalWrite(in2,LOW);
digitalWrite(in1,HIGH);
}
Als (karakter 'e' ==) //turn recht
{
analogWrite(en2,255);
digitalWrite(in2,HIGH);
digitalWrite(in1,LOW);
}
}