// Globale parameters
int pwm_a = 3;  // Snelheidsregeling motor 1
int pwm_b = 9;  // Snelheidsregeling motor 2
int dir_a = 2;  // Richting motor 1
int dir_b = 8;  // Richting motor 2
String readdata;

void setup() {
  // Instellen poorten
  pinMode(pwm_a, OUTPUT);
  pinMode(pwm_b, OUTPUT);
  pinMode(dir_a, OUTPUT);
  pinMode(dir_b, OUTPUT);

  // Instellen seriële communicatie, BT op Rx/Tx poorten
  // Dus steeds ontkoppelen bij opladen code
  Serial.begin(9600);
}

void loop() {
  while (Serial.available()>0) {
    delay(10);
    char data = Serial.read();
    readdata += data;
  }

  if(readdata.length() > 0) {
    Serial.println(readdata);

    if (readdata == "w") {
      digitalWrite(dir_a, HIGH);
      digitalWrite(dir_b, HIGH);

      analogWrite(pwm_a, 155);
      analogWrite(pwm_b, 225);

    }

    if (readdata == "t") {
      analogWrite(pwm_a, 0);
      analogWrite(pwm_b, 0);
    }

    if (readdata == "s") {
      digitalWrite(dir_a, LOW);
      digitalWrite(dir_b, LOW);


      analogWrite(pwm_a, 155);
      analogWrite(pwm_b, 225);
    }

	  if (readdata == "a") {
		  digitalWrite(dir_a, HIGH);
      digitalWrite(dir_b, HIGH);

      analogWrite(pwm_a, 0);
      analogWrite(pwm_b, 225);

    }

	  if (readdata == "d") {
		  digitalWrite(dir_a, HIGH);
      digitalWrite(dir_b, HIGH);

      analogWrite(pwm_a, 155);
      analogWrite(pwm_b, 0);

    }
  }

  readdata = "";
}