that_one_nigga_you_k

Untitled

Jun 12th, 2018
157
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.26 KB | None | 0 0
  1. #include <SoftwareSerial.h>
  2.  
  3. /*#define FRENTE 'f'
  4. #define ESQ 'e'
  5. #define DIR 'd'
  6. #define TRAS 't'
  7. #define PARAR 'p'*/
  8.  
  9. SoftwareSerial Blue(3, 2); // Rdata, Tdata
  10. int data;
  11.  
  12. void setup() {
  13.   Serial.begin(9600);
  14.   Blue.begin(9600);
  15.   pinMode(5, OUTPUT);//Motor A
  16.   pinMode(6, OUTPUT);
  17.   pinMode(9, OUTPUT);//Motor B
  18.   pinMode(10, OUTPUT);
  19.  
  20.  
  21. }
  22.  
  23. void loop() {
  24.   if(Blue.available()){
  25.  if(Blue.read()=='f'){
  26.   Serial.print("frente");
  27.   digitalWrite(5, LOW);
  28.   digitalWrite(6, HIGH);
  29.   digitalWrite(9, HIGH);
  30.   digitalWrite(10, LOW);
  31.   delay(200);
  32.  }
  33.  
  34.  else if(Blue.read()=='p'){
  35.   Serial.print("parar");
  36.   digitalWrite(5, LOW);
  37.   digitalWrite(6, LOW);
  38.   digitalWrite(9, LOW);
  39.   digitalWrite(10, LOW);
  40.   delay(200);
  41.  }
  42.  else if(Blue.read()=='e'){
  43.   Serial.print("esquerda");
  44.   digitalWrite(5, LOW);
  45.   digitalWrite(6, LOW);
  46.   digitalWrite(9, HIGH);
  47.   digitalWrite(10, LOW);
  48.   delay(200);
  49.  }
  50.  else if(Blue.read()=='d'){
  51.   Serial.print("direita");
  52.   digitalWrite(5, LOW);
  53.   digitalWrite(6, HIGH);
  54.   digitalWrite(9, LOW);
  55.   digitalWrite(10, LOW);
  56.   delay(200);
  57.  
  58.  }
  59.  else if(Blue.read()=='t'){
  60.   Serial.print("tras");
  61.   digitalWrite(5, HIGH);
  62.   digitalWrite(6, LOW);
  63.   digitalWrite(9, LOW);
  64.   digitalWrite(10, HIGH);
  65.   delay(200);
  66.  }
Add Comment
Please, Sign In to add comment