// Initialise Motor

void init_IO() {
  pinMode(LEFT_FRONT_FW, OUTPUT);
  pinMode(LEFT_FRONT_BW, OUTPUT);

  pinMode(LEFT_BACK_FW, OUTPUT);
  pinMode(LEFT_BACK_BW, OUTPUT);

  pinMode(RIGHT_FRONT_FW, OUTPUT);
  pinMode(RIGHT_FRONT_BW, OUTPUT);

  pinMode(RIGHT_BACK_FW, OUTPUT);
  pinMode(RIGHT_BACK_BW, OUTPUT);

  pinMode(LIFT_UP, OUTPUT);
  pinMode(LIFT_DOWN, OUTPUT);

  // Ultrasonic Sensors

  pinMode(US_TRIGGER, OUTPUT);
  pinMode(US_ECHO, INPUT);
}

void int_sequence() {
  pinMode(LED_GREEN, OUTPUT);
  pinMode(LED_YELLOW, OUTPUT);

  for (int i = 0; i < 5; i++) {
    digitalWrite(LED_GREEN, HIGH);
    digitalWrite(LED_YELLOW, HIGH);
    delay(300);
    digitalWrite(LED_GREEN, LOW);
    digitalWrite(LED_YELLOW, LOW);
    delay(300);
  }
  digitalWrite(LED_GREEN, HIGH);
}