//project Robot Soccer 
// By Baruna Hidayatul Ilmi XI

int kiri_mundur = 19;
int kiri_maju = 5;
int kanan_mundur = 0;
int kanan_maju = 15;
char data;

void setup() {
  pinMode(kiri_mundur, OUTPUT);
  pinMode (kiri_maju, OUTPUT);
  pinMode(kanan_mundur, OUTPUT);
  pinMode(kanan_maju, OUTPUT);
  Serial.begin(9600);
}

void maju() {
  digitalWrite(kiri_mundur, LOW);
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_mundur, LOW);
  digitalWrite(kanan_maju, HIGH);
}

void mundur() {
  digitalWrite(kiri_mundur, HIGH);
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_mundur, HIGH);
  digitalWrite(kanan_maju, LOW);
}

void kanan() {
  digitalWrite(kiri_mundur, LOW);
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_mundur, LOW);
  digitalWrite(kanan_maju, LOW);
}

void kiri() {
  digitalWrite(kiri_mundur, LOW);
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_mundur, LOW);
  digitalWrite(kanan_maju, HIGH);
}

void berhenti() {
  digitalWrite(kiri_mundur, LOW);
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_mundur, LOW);
  digitalWrite(kanan_maju, LOW);
}

void brake() {
  digitalWrite(kiri_mundur, HIGH);
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_mundur, HIGH);
  digitalWrite(kanan_maju, HIGH);
}

void loop() {
  if(Serial.available() > 0) {
    data = Serial.read();
  }
  if(data == 'w'){
    maju();
  }
  else if(data == 's'){
    mundur();
  }
  else if(data == 'd'){
    kanan();
  }
  else if (data == 'a'){
    kiri();
  }
  else if (data == 'p'){
    berhenti();
  }
  else if (data == 'x'){
    brake();
  }
}