//Program Robot Soccer
//By Nazwa Salsabila Kinanti
int kiri_mundur = 19;
int kiri_maju = 5;
int kanan_mundur = 16;
int kanan_maju = 0;
char data;
void setup() {
  pinMode(kiri_mundur, OUTPUT);
  pinMode(kiri_maju, OUTPUT);
  pinMode(kanan_mundur,OUTPUT);
  pinMode(kanan_maju, OUTPUT);
  data = 'p';
  Serial.begin(9600);
}

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 == 't'){
    berhenti();
  }
  else if(data == 'r'){
    rem();
  }
}

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 rem (){
  digitalWrite(kiri_mundur, HIGH);
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_mundur, HIGH);
  digitalWrite(kanan_maju, HIGH);
}