Advertisement
tomateblue

RobotOficina

Dec 16th, 2017
139
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.47 KB | None | 0 0
  1. // Robot Oficina
  2. char letra;
  3.  
  4. int pin3 = 8;
  5. int pin4 = 9;
  6. int pin5 = 10;
  7. int pin6 = 11;
  8.  
  9. void setup() {
  10.  Serial.begin(9600);
  11.  pinMode(pin3,OUTPUT);
  12.  pinMode(pin4,OUTPUT);
  13.  pinMode(pin5,OUTPUT);
  14.  pinMode(pin6,OUTPUT);
  15. }
  16.  
  17. void loop() {
  18.  
  19.   letra = Serial.read();
  20.   switch(letra){
  21.     case 's':
  22.     Serial.println("MOTOR A and B RUN ");
  23.     digitalWrite(pin3,HIGH);       // Motor A
  24.     digitalWrite(pin4,LOW);       // Motor A
  25.     digitalWrite(pin5,HIGH);
  26.     digitalWrite(pin6,LOW);
  27.     break;
  28.     case 'w':
  29.     Serial.println("MOTOR A and B  BACK ");  
  30.     digitalWrite(pin3,LOW);  // Motor A
  31.     digitalWrite(pin4,HIGH);  // Motor A
  32.     digitalWrite(pin5,LOW);   // MOtor B
  33.     digitalWrite(pin6,HIGH);    // MOtor B
  34.     break;
  35.     case 'p':
  36.     Serial.println("MOTOR A and B STOP ");
  37.     digitalWrite(pin3,LOW); // MOtor B
  38.     digitalWrite(pin4,LOW);  // MOtor B
  39.     digitalWrite(pin5,LOW); // MOtor B
  40.     digitalWrite(pin6,LOW);  // MOtor B
  41.     break;
  42.  
  43.     case 'd':
  44.      Serial.println("MOTOR 3 DIRECAO: (DIREITA)");
  45.      digitalWrite(pin3,LOW);
  46.      digitalWrite(pin4,HIGH);
  47.      delay(40);
  48.      digitalWrite(pin5,HIGH);
  49.      digitalWrite(pin6,LOW);
  50.      delay(40);
  51.    
  52.     break;
  53.     case 'a':
  54.      Serial.println("MOTOR 3 DIRECAO: (ESQUERDA");
  55.      digitalWrite(pin3,HIGH);
  56.      digitalWrite(pin4,LOW);
  57.      delay(40);
  58.      digitalWrite(pin5,LOW);
  59.      digitalWrite(pin6,HIGH);
  60.      delay(40);
  61.    
  62.  
  63.     break;
  64.  
  65.    
  66.   }
  67.  
  68. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement