//Program Robot Soccer
 // By Aldi Ferdian

int m_ka_ma = 17;
int m_ka_mu = 5;
int m_ki_ma =18;
int m_ki_mu = 19;
char data;

void setup() {
  pinMode(m_ka_ma, OUTPUT);
  pinMode(m_ka_mu, OUTPUT);
  pinMode(m_ki_ma, OUTPUT);
  pinMode(m_ki_mu, 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();
  }
}


void berhenti(){
  digitalWrite(m_ka_ma, LOW);
  digitalWrite(m_ka_mu, LOW);
  digitalWrite(m_ki_ma, LOW);
  digitalWrite(m_ki_mu, LOW);
}

void maju(){
  digitalWrite(m_ka_ma, HIGH);
  digitalWrite(m_ka_mu, LOW);
  digitalWrite(m_ki_ma, HIGH);
  digitalWrite(m_ki_mu, LOW);

}
void mundur(){
  digitalWrite(m_ka_ma, LOW);
  digitalWrite(m_ka_mu, HIGH);
  digitalWrite(m_ki_ma, LOW);
  digitalWrite(m_ki_mu, HIGH);
}
void kanan(){
  digitalWrite(m_ka_ma, HIGH);
  digitalWrite(m_ka_mu, LOW);
  digitalWrite(m_ki_ma, LOW);
  digitalWrite(m_ki_mu, LOW);
}
void kiri (){
  digitalWrite(m_ka_ma, LOW);
  digitalWrite(m_ka_mu, LOW);
  digitalWrite(m_ki_ma, HIGH);
  digitalWrite(m_ki_mu, LOW);
}