//Program Robot Soccer
//By Azzahid Tawarra

int kiri_mundur = 19;
int kiri_maju = 5;
int kanan_mundur = 16;
int kanan_maju = 0;
char sigma;
void setup() {
  pinMode(kiri_mundur,OUTPUT); 
  pinMode(kiri_maju,OUTPUT);
  pinMode(kanan_mundur,OUTPUT);
  pinMode(kanan_maju,OUTPUT);
  sigma = 'p';
  Serial.begin(9600);
}

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

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);
}