Trieur M&M's

robot trieur smarties

pédagogie

manipuler les outils éléctronique

membres de l'équipe

• Najib CHAOUI
• Naoufal LAABID
• Dalal EL ADBI
• Amine EL MAMSAOUI
• Mohamed Amine EL AARAJE

Fichier:TrieurM&M.pdf

1. include<Servo.h>

Servo Tservo; Servo Bservo; //La déclaration de 4 variable entier int color,R,G,B; void setup(){

 pinMode(2,OUTPUT);//cette fonction definie la pile numero 2 comme sortie 
 pinMode(3,OUTPUT);//cette fonction definie la pile numero 3 comme sortie 
 pinMode(4,OUTPUT);//cette fonction definie la pile numero 4 comme sortie 
 Tservo.attach(8);
 Bservo.attach(9);
 Serial.begin(9600);

}

void loop(){

 Bservo.write(0);
 Tservo.write(95);
 delay(2500);
 
 for(int i = 95; i > 20; i--) {
   Tservo.write(i);
   delay(2);
 }
 delay(300);
 color=getcolor();
 switch (color) {
   case 1:
  { 
   Bservo.write(45);
   break;
   }
   case 2:
  { 
   Bservo.write(90);
   break;
   }
   case 3:
  { 
   Bservo.write(0);
   break;
   }
   default:
   break;
 }
 delay(300);
 
 for(int i = 20; i > 0; i--) {
   Tservo.write(i);
   delay(2);
 } 
 delay(1000);
 
 for(int i = 20; i < 95; i++) {
   Tservo.write(i);
   delay(2);
 }
 color=0;

} //definir une fonction qui récupère les valeurs de tension des couleurs int getcolor(){ digitalWrite(2,HIGH); delay(2000); Serial.println("R = "); Serial.println(analogRead(0)); //La fonction analogRead permet de lire la tension de couleur ,par defaut la plus grande tension c'est celle de rouge puis de vert ,puis de bleau R=analogRead(0); digitalWrite(2,LOW); digitalWrite(3,HIGH);//cette fonction ca sort le courant de 5 v sur la pile 4 delay(2000); Serial.println("G = "); Serial.println(analogRead(0)); G=analogRead(0);// //la fonction digitalwrite c'est pour ecrire sur une sortie numérique digitalWrite(3,LOW);//envoyer un courant de 0 v digitalWrite(4,HIGH);//alors ca sort le courant de 5 v sur la pile 4 delay(2000);//cette fonction delay permet d'attendre pendant 2000ms Serial.println("B = "); Serial.println(analogRead(0)); B=analogRead(0); digitalWrite(4,LOW); delay(50); //faire un test sur les valeur de tension des couleurs if(R>B && R>G) {color=1;return color;} if(G>R && G>B) {color=2;return color;} if(B>R && B>G) {color=3;return color;} }