Paso 5: Código de Arduino
/** line_follower.ino
* Creado en: 10 de enero de 2014 16:19:47
* Autor: Manpreet Singh Minhas
* Sitio web: 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);
Si (l == alto & & r == HIGH)
{
digitalWrite(4,HIGH);
digitalWrite(5,LOW); 12 y 13 para el motor izquierdo
digitalWrite(6,HIGH); / / 10 y 11 para el mismo motor
digitalWrite (7, bajo);
}
Si (l == baja & & r == HIGH)
{
digitalWrite(4,HIGH);
digitalWrite(5,LOW);
digitalWrite(6,LOW); //
digitalWrite (7, bajo);
}
Si (l == alto & & r == LOW)
{
digitalWrite(4,LOW);
digitalWrite(5,LOW);
digitalWrite(6,HIGH);
digitalWrite (7, bajo);
}
}
Nota: Se le energia para quemar el código '.ino' en launchpad. Para la gente de arduino es como es.
