1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
|
/* Le code exécutable commence ici */
void main() // `Debut` (Appelé au RESET)
{
SEN_CONFIG();
MOT_CONFIG();
do // `Début d'itération Répéter..`
{
if (SEN_LINE_DIG(LINE_L)==1 && SEN_LINE_DIG(LINE_R)==1) // Faire avancer le robot sur la ligne noire
{
MOT_STR(50,FWD,TIME,0);
}
else if (SEN_LINE_DIG(LINE_R)==0 && SEN_LINE_DIG(LINE_L)==1) :// Faire dévier le robot vers la gauche quand capteurs de ligne droit voit du blanc
{
MOT_ROT(50,FWD,CENTER,LEFT,ANGLE,10);
}
else if (SEN_LINE_DIG(LINE_R)==1 && SEN_LINE_DIG(LINE_L)==0) // Faire dévier le robot vers la droite quand capteur ligne gauche voit du blanc
{
MOT_ROT(50,FWD,CENTER,RIGHT,ANGLE,10);
}
else if (SEN_OBS_ANALOG(OBS_SIDE_L)>100 || SEN_OBS_ANALOG(OBS_SIDE_R)>100 || SEN_OBS_ANALOG(OBS_CENTER_L)>100 || SEN_OBS_ANALOG(OBS_CENTER_R)>100) // Arreter le robot si obstacle
{
MOT_STOP();
PAUSE_SECONDE(10);
MOT_ROT(100,FWD,CENTER,RIGHT,ANGLE,50);
while (!MOT_END);
}
}
while(1);
} // Fin de la fonction "main"
/* Fin du texte */ |
Partager