Stap 5: Code in Arduino
/** line_follower.ino
* Gemaakt op: 10-Jan-2014 4:19:47 PM
* Auteur: Manpreet Singh Minhas
* De website: http://learningmsp430.wordpress.com/
*/
VOID Setup
{
pinMode(2,INPUT);
pinMode(3,INPUT);
pinMode(4,OUTPUT);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);
pinMode(7,OUTPUT);
}
void loop
{
int l = digitalRead(2);
int r = digitalRead(3);
Als (l == HIGH & & r == HIGH)
{
digitalWrite(4,HIGH);
digitalWrite(5,LOW); 12 en 13 voor de linker motor
digitalWrite(6,HIGH); / / 10 en 11 voor rechts motor
digitalWrite (7, laag);
}
Als (l == LOW & & r == HIGH)
{
digitalWrite(4,HIGH);
digitalWrite(5,LOW);
digitalWrite(6,LOW); //
digitalWrite (7, laag);
}
Als (l == HIGH & & r == laag)
{
digitalWrite(4,LOW);
digitalWrite(5,LOW);
digitalWrite(6,HIGH);
digitalWrite (7, laag);
}
}
Opmerking: U zult energia voor het branden van de 'Ino' code in launchpad. Voor arduino mensen is dit zoals het is.