//Program robot soccer
//By Muhammad Abi Rafdi

int m_kn_ma = 5;
int m_kn_mu = 17;
int m_kr_ma = 19;
int m_kr_mu = 18;
char data;
void setup() {
  pinMode(m_kn_ma, OUTPUT);
  pinMode(m_kn_mu, OUTPUT);
  pinMode(m_kr_ma, OUTPUT);
  pinMode(m_kr_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_kn_ma, LOW);
  digitalWrite(m_kn_mu, LOW);
  digitalWrite(m_kr_ma, LOW);
  digitalWrite(m_kr_mu, LOW);
}

void maju(){
  digitalWrite(m_kn_ma, HIGH);
  digitalWrite(m_kn_mu, LOW);
  digitalWrite(m_kr_ma, HIGH);
  digitalWrite(m_kr_mu, LOW);
}

void mundur(){
  digitalWrite(m_kn_ma, LOW);
  digitalWrite(m_kn_mu, HIGH);
  digitalWrite(m_kr_ma, LOW);
  digitalWrite(m_kr_mu, HIGH);
}

void kanan(){
  digitalWrite(m_kn_ma, LOW);
  digitalWrite(m_kn_mu, LOW);
  digitalWrite(m_kr_ma, HIGH);
  digitalWrite(m_kr_mu, LOW);
}
void kiri(){
  digitalWrite(m_kn_ma, HIGH);
  digitalWrite(m_kn_mu, LOW);
  digitalWrite(m_kr_ma, LOW);
  digitalWrite(m_kr_mu, LOW);
}