#include <SoftwareSerial.h>

#define VEL_MAdata 200
#define VEL_MIN 50
#define FRENTE 'f'
#define ESQ 'e'
#define DIR 'd'
#define TRAS 'b'
#define PARAR 'o'
#define DELAY 200

SoftwareSerial Blue(1, 2); // Rdata, Tdata
int data;

void setup() {
  Serial.begin(9600);
  Blue.begin(9600);
  pinMode(5, OUTPUT);//Motor A
  pinMode(6, OUTPUT);
  //pinMode(3, OUTPUT);
  pinMode(9, OUTPUT);//Motor B
  pinMode(10, OUTPUT);
  //pinMode(11, OUTPUT);
}

void loop() {
  if (Blue.available()) {
    data = leitura();
    switch (data) {
      case ESQ:
        esquerda();
        break;
      case DIR:
        direita();
        break;
      case FRENTE:
        frente();
        break;
      case TRAS:
        tras();
        break;
      default:
        parar();
    }
    //    if (data == ESQ){
    //      esquerda();
    //    }
    //    else if (data == FRENTE){
    //      frente();
    //    }
    //    else if (data == DIR) {
    //      direita();
    //    }
    //    else if (data == TRAS) {
    //      tras();
    //    }
    //    else {
    //      parar();
    //    }

  }
}

int leitura() {
  return Blue.read();
}

void frente() {
  Serial.print("frente");
  digitalWrite(5, LOW);
  digitalWrite(6, HIGH);
  //analogWrite(3, VEL_MAdata);
  digitalWrite(9, HIGH);
  digitalWrite(10, LOW);
  //analogWrite(11, VEL_MAdata);
  //delay(DELAY);
  parar();
}

void esquerda() {
  digitalWrite(5, LOW);
  digitalWrite(6, HIGH);
 // analogWrite(3, VEL_MIN);
  digitalWrite(9, HIGH);
  digitalWrite(10, LOW);
  //analogWrite(11, VEL_MAdata);
  //delay(DELAY);
  parar();
}

void direita() {
  digitalWrite(5, LOW);
  digitalWrite(6, HIGH);
  //analogWrite(3, VEL_MAdata);
  digitalWrite(9, HIGH);
  digitalWrite(10, LOW);
  // analogWrite(11, VEL_MIN);
  //delay(DELAY);
  parar();
}

void tras() {
  digitalWrite(5, HIGH);
  digitalWrite(6, LOW);
 // analogWrite(3, VEL_MAdata);
  digitalWrite(9, LOW);
  digitalWrite(10, HIGH);
 // analogWrite(11, VEL_MAdata);
//  delay(DELAY);
  parar();
}

void parar() {
  digitalWrite(5, HIGH);
  digitalWrite(6, HIGH);
  //analogWrite(3, VEL_MAdata);
  digitalWrite(9, HIGH);
  digitalWrite(10, HIGH);
  //analogWrite(11, VEL_MAdata);
}