Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- /* Utilisation du capteur Ultrason HC-SR04 */
- #include <Stepper.h>
- // 32 pas par tour, reducteur de 1/64... Donc 32*64 pas pour 1 tour.
- int NbPas = 2048;
- //pour un moteur de 200 pas par tour et brancher sur les broches 6, 9, 10 et 11
- Stepper moteur(NbPas, 3, 5, 4, 6);
- // définition des broches utilisées
- int trig = 12;
- int echo = 11;
- long lecture_echo;
- long cm;
- #define avertisseur 7 //Led
- void setup()
- {
- pinMode(trig, OUTPUT);
- digitalWrite(trig, LOW);
- pinMode(echo, INPUT);
- Serial.begin(9600);
- pinMode(avertisseur, OUTPUT); //On défini la led comme une sortie
- moteur.setSpeed(17);
- }
- void loop()
- {
- digitalWrite(trig, HIGH);
- delayMicroseconds(10);
- digitalWrite(trig, LOW);
- lecture_echo = pulseIn(echo, HIGH);
- cm = lecture_echo / 58;
- Serial.print("Distance en cm : ");
- Serial.println(cm);
- delay(100);
- //Faire un tour = 2048 pas dans le sens 1
- //Faire un tour = 2048 pas dans le sens 2
- switch (cm) {
- case 1 ( cm < 50 ) : // On allume la led si on est moins loin que cm
- digitalWrite(avertisseur, HIGH);
- moteur.step(512);
- delay(200);
- break;
- }
- case 2 ( cm > 50 ) : //sinon on éteind la led // else ou if penser a essayer
- digitalWrite(avertisseur, LOW);
- moteur.step(-512);
- delay(200);
- break;
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement