const int MTR_A_EN_PIN = 14;
const int MTR_A_IN1_PIN = 26;
const int MTR_A_IN2_PIN = 27;
const int MTR_B_EN_PIN = 25;
const int MTR_B_IN3_PIN = 33;
const int MTR_B_IN4_PIN = 32;

void setup() {
  pinMode(MTR_A_EN_PIN, OUTPUT);
  pinMode(MTR_A_IN1_PIN, OUTPUT);
  pinMode(MTR_A_IN2_PIN, OUTPUT);
  pinMode(MTR_B_EN_PIN, OUTPUT);
  pinMode(MTR_B_IN3_PIN, OUTPUT);
  pinMode(MTR_B_IN4_PIN, OUTPUT);
  Serial.begin(115200);
}

void loop() {
  Serial.println("Motor A forward");
  digitalWrite(MTR_A_EN_PIN, HIGH);
  digitalWrite(MTR_A_IN1_PIN, HIGH);
  digitalWrite(MTR_A_IN2_PIN, LOW);
  delay(2000);
  Serial.println("Motor A stop");
  //digitalWrite(MTR_A_EN_PIN, LOW);
  digitalWrite(MTR_A_IN1_PIN, LOW);
  digitalWrite(MTR_A_IN2_PIN, LOW);
  delay(2000);
  Serial.println("Motor A backward");
  digitalWrite(MTR_A_IN1_PIN, LOW);
  digitalWrite(MTR_A_IN2_PIN, HIGH);
  delay(2000);
  Serial.println("Motor A stop");
  digitalWrite(MTR_A_EN_PIN, LOW);
  digitalWrite(MTR_A_IN1_PIN, LOW);
  digitalWrite(MTR_A_IN2_PIN, LOW);
  delay(2000);

  Serial.println("Motor B forward");
  digitalWrite(MTR_B_EN_PIN, HIGH);
  digitalWrite(MTR_B_IN3_PIN, HIGH);
  digitalWrite(MTR_B_IN4_PIN, LOW);
  delay(2000);
  Serial.println("Motor B stop");
  //digitalWrite(MTR_B_EN_PIN, LOW);
  digitalWrite(MTR_B_IN3_PIN, LOW);
  digitalWrite(MTR_B_IN4_PIN, LOW);
  delay(2000);
  Serial.println("Motor B backward");
  digitalWrite(MTR_B_IN3_PIN, LOW);
  digitalWrite(MTR_B_IN4_PIN, HIGH);
  delay(2000);
  Serial.println("Motor B stop");
  digitalWrite(MTR_B_EN_PIN, LOW);
  digitalWrite(MTR_B_IN3_PIN, LOW);
  digitalWrite(MTR_B_IN4_PIN, LOW);
  delay(2000);
}