//Program robot soccer
//by Nasywa Fatika
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 == 'p'){
    berhenti();
  }
  else if(data == 'r'){
    rem();
  }
}

void maju(){
  digitalWrite(kiri_mundur, LOW );
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_maju, LOW);
  digitalWrite(kanan_maju, HIGH);
}
void mundur(){
  digitalWrite(kiri_mundur, HIGH );
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_maju, HIGH);
  digitalWrite(kanan_maju, LOW);
}
void kanan(){
  digitalWrite(kiri_mundur, LOW );
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_maju, LOW);
  digitalWrite(kanan_maju, HIGH);
}
void kiri(){
  digitalWrite(kiri_mundur, LOW );
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_maju, LOW);
  digitalWrite(kanan_maju, HIGH);
}
void berhenti(){
  digitalWrite(kiri_mundur, LOW );
  digitalWrite(kiri_maju, LOW);
  digitalWrite(kanan_maju, LOW);
  digitalWrite(kanan_maju, LOW);
}
void rem(){
  digitalWrite(kiri_mundur, HIGH );
  digitalWrite(kiri_maju, HIGH);
  digitalWrite(kanan_maju, HIGH);
  digitalWrite(kanan_maju, HIGH);
}