Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <SoftwareSerial.h>
- #include <Servo.h>
- SoftwareSerial HC06(11,10);
- Servo Scanner;
- const char klaxon = 4;
- const char motor_d = 2;
- const char motor_g = 3;
- const char LED_d = 7;
- const char LED_g = 6;
- String messageRecu;
- void setup() {
- Serial.begin(9600);
- HC06.begin(9600);
- Scanner.attach(5);
- Scanner.write(90);
- pinMode(motor_d, OUTPUT);
- pinMode(motor_g, OUTPUT);
- pinMode(klaxon, OUTPUT);
- digitalWrite(motor_d, 1);
- digitalWrite(motor_g, 1);
- }
- void loop()
- {
- while(HC06.available())
- {
- delay(3);
- char c = HC06.read();
- messageRecu += c;
- }
- if (messageRecu.length() >0)
- {
- Serial.println(messageRecu);
- if (messageRecu == "Scann")
- {Scanner.write(5);
- delay(1000);
- Scanner.write(90);
- delay(1000);
- Scanner.write(175);
- delay(1000);
- Scanner.write(90);}
- if (messageRecu == "tut-tut")
- {digitalWrite(klaxon, 1);
- delay(500);
- digitalWrite(klaxon, 0);
- delay(500);
- digitalWrite(klaxon, 1);
- delay(500);
- digitalWrite(klaxon, 0);}
- if (messageRecu == "avancer")
- {digitalWrite(motor_d, 0);
- digitalWrite(motor_g, 0);
- delay(1000);
- digitalWrite(motor_d, 1);
- digitalWrite(motor_g, 1);}
- if (messageRecu == "droite")
- {digitalWrite(motor_d, 1);
- digitalWrite(motor_g, 0);
- delay(100);
- digitalWrite(LED_g, 1);
- delay(100);
- digitalWrite(LED_g, 0);
- delay(100);
- digitalWrite(LED_g, 1);
- delay(100);
- digitalWrite(LED_g, 0);
- delay(100);
- digitalWrite(LED_g, 1);
- delay(100);
- digitalWrite(LED_g, 0);
- delay(100);
- digitalWrite(LED_g, 1);
- delay(100);
- digitalWrite(LED_g, 0);
- delay(100);
- digitalWrite(LED_g, 1);
- delay(100);
- digitalWrite(LED_g, 0);
- digitalWrite(motor_d, 1);
- digitalWrite(motor_g, 1);}
- if (messageRecu == "gauche")
- {digitalWrite(motor_d, 0);
- digitalWrite(motor_g, 1);
- delay(100);
- digitalWrite(LED_d, 1);
- delay(100);
- digitalWrite(LED_d, 0);
- delay(100);
- digitalWrite(LED_d, 1);
- delay(100);
- digitalWrite(LED_d, 0);
- delay(100);
- digitalWrite(LED_d, 1);
- delay(100);
- digitalWrite(LED_d, 0);
- delay(100);
- digitalWrite(LED_d, 1);
- delay(100);
- digitalWrite(LED_d, 0);
- delay(100);
- digitalWrite(LED_d, 1);
- delay(100);
- digitalWrite(LED_d, 0);
- digitalWrite(motor_d, 1);
- digitalWrite(motor_g, 1);}
- messageRecu="";
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement