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;}
}
