Advertisement
Guest User

Robot v1.0 Darven project

a guest
Mar 21st, 2018
86
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 2.84 KB | None | 0 0
  1. #include <SoftwareSerial.h>
  2. #include <Servo.h>
  3.  
  4. SoftwareSerial HC06(11,10);
  5. Servo Scanner;
  6. const char klaxon = 4;
  7. const char motor_d = 2;
  8. const char motor_g = 3;
  9. const char LED_d = 7;
  10. const char LED_g = 6;
  11. String messageRecu;
  12.  
  13. void setup() {
  14.   Serial.begin(9600);
  15.   HC06.begin(9600);  
  16.   Scanner.attach(5);
  17.   Scanner.write(90);
  18.   pinMode(motor_d, OUTPUT);
  19.   pinMode(motor_g, OUTPUT);
  20.   pinMode(klaxon, OUTPUT);
  21.   digitalWrite(motor_d, 1);
  22.   digitalWrite(motor_g, 1);
  23. }
  24.  
  25. void loop()
  26. {
  27.     while(HC06.available())
  28.     {
  29.       delay(3);
  30.       char c = HC06.read();
  31.       messageRecu += c;
  32.     }
  33.     if (messageRecu.length() >0)
  34.     {
  35.       Serial.println(messageRecu);
  36.       if (messageRecu == "Scann")    
  37.         {Scanner.write(5);
  38.          delay(1000);
  39.          Scanner.write(90);
  40.          delay(1000);
  41.          Scanner.write(175);
  42.          delay(1000);
  43.          Scanner.write(90);}
  44.       if (messageRecu == "tut-tut")    
  45.         {digitalWrite(klaxon, 1);
  46.          delay(500);
  47.          digitalWrite(klaxon, 0);
  48.          delay(500);
  49.          digitalWrite(klaxon, 1);
  50.          delay(500);
  51.          digitalWrite(klaxon, 0);}
  52.       if (messageRecu == "avancer")    
  53.         {digitalWrite(motor_d, 0);
  54.          digitalWrite(motor_g, 0);
  55.          delay(1000);
  56.          digitalWrite(motor_d, 1);
  57.          digitalWrite(motor_g, 1);}
  58.       if (messageRecu == "droite")    
  59.         {digitalWrite(motor_d, 1);
  60.          digitalWrite(motor_g, 0);
  61.          delay(100);
  62.          digitalWrite(LED_g, 1);
  63.          delay(100);
  64.          digitalWrite(LED_g, 0);
  65.          delay(100);
  66.          digitalWrite(LED_g, 1);
  67.          delay(100);
  68.          digitalWrite(LED_g, 0);
  69.          delay(100);
  70.          digitalWrite(LED_g, 1);
  71.          delay(100);
  72.          digitalWrite(LED_g, 0);
  73.          delay(100);
  74.          digitalWrite(LED_g, 1);
  75.          delay(100);
  76.          digitalWrite(LED_g, 0);
  77.          delay(100);
  78.          digitalWrite(LED_g, 1);
  79.          delay(100);
  80.          digitalWrite(LED_g, 0);
  81.          digitalWrite(motor_d, 1);
  82.          digitalWrite(motor_g, 1);}
  83.       if (messageRecu == "gauche")    
  84.         {digitalWrite(motor_d, 0);
  85.          digitalWrite(motor_g, 1);
  86.          delay(100);
  87.          digitalWrite(LED_d, 1);
  88.          delay(100);
  89.          digitalWrite(LED_d, 0);
  90.          delay(100);
  91.          digitalWrite(LED_d, 1);
  92.          delay(100);
  93.          digitalWrite(LED_d, 0);
  94.          delay(100);
  95.          digitalWrite(LED_d, 1);
  96.          delay(100);
  97.          digitalWrite(LED_d, 0);
  98.          delay(100);
  99.          digitalWrite(LED_d, 1);
  100.          delay(100);
  101.          digitalWrite(LED_d, 0);
  102.          delay(100);
  103.          digitalWrite(LED_d, 1);
  104.          delay(100);
  105.          digitalWrite(LED_d, 0);
  106.          digitalWrite(motor_d, 1);
  107.          digitalWrite(motor_g, 1);}
  108.       messageRecu="";
  109.     }
  110. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement