gerak

//button boundary
int btnDepan = 2;
int btnKanan = 3;
int btnBawah = 4;
int btnKiri = 5;

//motor on pwm pin
int motorKanan = 9;
int motorKiri = 11;

//input data
int inputDepan = 0;
int inputKanan = 0;
int inputBawah = 0;
int inputKiri = 0;

//flag arah
//0 = maju
//1 = kanan
//2 = kiri
//3 = mundur
int arah = 0;

void setup() {
  // input button boundary
  pinMode(btnDepan, INPUT);
  pinMode(btnKanan, INPUT);
  pinMode(btnBawah, INPUT);
  pinMode(btnKiri, INPUT);

  //output motor
  pinMode(motorKanan, OUTPUT);
  pinMode(motorKiri, OUTPUT);
}

void gerakMotor(int arahMotor) {
  if(arahMotor == 0) {//maju
    digitalWrite(motorKanan, HIGH);
    digitalWrite(motorKiri, HIGH);
  } else if(arahMotor == 1) {//kanan
    digitalWrite(motorKanan, LOW);
    digitalWrite(motorKiri, HIGH);
  } else if(arahMotor == 2) {//kiri
    digitalWrite(motorKanan, HIGH);
    digitalWrite(motorKiri, LOW);
  } else if(arahMotor == 3) {//mundur
    digitalWrite(motorKanan, LOW);
    digitalWrite(motorKiri, LOW);
  }
}

void loop() {
  //read the button
  inputDepan = digitalRead(btnDepan);
  inputKanan = digitalRead(btnKanan);
  inputKiri = digitalRead(btnKiri);
  inputBawah = digitalRead(btnBawah);

  //cek maju
  if ((inputDepan == 1) &&
     (inputKanan == 0) &&
     (inputKiri ==0) &&
     (inputBawah == 0)) {
      arah = 0;
  }

  //cek mundur
  if ((inputDepan == 0) &&
     (inputKanan == 0) &&
     (inputKiri ==0) &&
     (inputBawah == 1)) {
      arah = 3;
  }

  //cek kanan
  if ((inputDepan == 0) &&
     (inputKanan == 1) &&
     (inputKiri ==0) &&
     (inputBawah == 0)) {
      arah = 1;
  }

  //cek kiri
  if ((inputDepan == 0) &&
     (inputKanan == 0) &&
     (inputKiri ==1) &&
     (inputBawah == 0)) {
      arah = 2;
  }

  //gerakMotor
  gerakMotor(arah);
}