TB6612FNG Motor Driver

// TB6612FNG Motor Driver canonical example
// Drives one DC motor on channel A using PWM speed control and direction pins.

const int PWMA = 5;
const int AIN1 = 7;
const int AIN2 = 8;
const int STBY = 6;

void setup() {
  pinMode(PWMA, OUTPUT);
  pinMode(AIN1, OUTPUT);
  pinMode(AIN2, OUTPUT);
  pinMode(STBY, OUTPUT);

  Serial.begin(9600);
  while (!Serial) {
    ;
  }

  // Enable the driver
  digitalWrite(STBY, HIGH);

  Serial.println("TB6612FNG motor driver demo");
}

void setMotorA(bool forward, int speedValue) {
  speedValue = constrain(speedValue, 0, 255);

  if (forward) {
    digitalWrite(AIN1, HIGH);
    digitalWrite(AIN2, LOW);
    Serial.print("Motor A forward, speed=");
  } else {
    digitalWrite(AIN1, LOW);
    digitalWrite(AIN2, HIGH);
    Serial.print("Motor A reverse, speed=");
  }

  analogWrite(PWMA, speedValue);
  Serial.println(speedValue);
}

void motorStop() {
  analogWrite(PWMA, 0);
  digitalWrite(AIN1, LOW);
  digitalWrite(AIN2, LOW);
  Serial.println("Motor A stop");
}

void loop() {
  setMotorA(true, 200);
  delay(2000);

  motorStop();
  delay(1000);

  setMotorA(false, 200);
  delay(2000);

  motorStop();
  delay(1000);
}