|
//Raphaël Coti
|
|
|
|
int M1=12;// moteur 1 ou A sur pin 12
|
|
int M2=13;// idem 2 ou B sur 13
|
|
int CG=02;// capteur gauche inrarouge sur pin 2
|
|
int CD=03;// idem droit sur 3
|
|
int E1=10;// vitesse du moteur 1 sur 10 (pas le choix car shield L298P)
|
|
int E2=11;// idem moteur 2 sur 11
|
|
|
|
void setup()
|
|
{
|
|
|
|
pinMode(M1,OUTPUT);//sortie sur moteur 1
|
|
pinMode(M2,OUTPUT);//idem 2
|
|
pinMode(CG,INPUT);//entré capteur ir gauche
|
|
pinMode(CD,INPUT);//idem droit
|
|
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
if (digitalRead(CG) == HIGH && digitalRead(CD) == HIGH) // si les capteurs ne détecte pas le sol
|
|
{
|
|
digitalWrite(M1, LOW);// alors moteur 1 éteint
|
|
digitalWrite(M2, LOW);//idem moteur 2
|
|
analogWrite(E1,0);//on gére la vitesse du moteur 1
|
|
analogWrite(E2,0);//idem moteur 2
|
|
}
|
|
else if (digitalRead(CG) == LOW && digitalRead(CD) == HIGH) // si le capteur gauche detecte le sol et le capteur droit est sur une ligne noir
|
|
{
|
|
digitalWrite(M1, HIGH);//alors moteur 1 tourne moins vite
|
|
digitalWrite(M2, HIGH);// et 2 allumé -> on tourne vers la droite
|
|
analogWrite(E1,0);//on gére la vitesse du moteur 1
|
|
analogWrite(E2,120);//idem moteur 2
|
|
}
|
|
else if (digitalRead(CG) == HIGH && digitalRead(CD) == LOW) // si inverse, droit detecte le sol, gauche sur une ligne noir
|
|
{
|
|
digitalWrite(M1, HIGH);// alors 1 allumé
|
|
digitalWrite(M2, HIGH);// 2 tourne moins vite -> on tourne vers la gauche
|
|
analogWrite(E1,120);//on gére la vitesse du moteur 1
|
|
analogWrite(E2,0);//idem moteur 2
|
|
}
|
|
else if (digitalRead(CG) == LOW && digitalRead(CD) == LOW)
|
|
{
|
|
digitalWrite(M1, HIGH);//1 allumé
|
|
digitalWrite(M2, HIGH);//2 allumé
|
|
analogWrite(E1,120);//on gére la vitesse du moteur 1
|
|
analogWrite(E2,105);//idem moteur 2
|
|
}
|
|
}
|