Модул за управление на мотор TB6612FNG за Arduino

/*
 * ==================================================================
 *  Generated by Codey.online  —  https://www.codey.online
 * ==================================================================
 *  Project   : TB6612FNG Dual Motor Driver Control
 *  Board     : Arduino UNO (arduino:avr:uno)
 *  Parts     : TB6612FNG Motor Driver
 *  Libraries : none (built-in)
 *
 *  Codey Online is an AI-powered browser IDE for Arduino and ESP32.
 *  Describe your project and Codey writes the code, draws the wiring
 *  diagram and uploads it to your board, straight from the browser.
 *  This code is free to use, modify and share, without warranty.
 * ==================================================================
 */

const int PIN_PWMA = 5;
const int PIN_STBY = 6;
const int PIN_AIN1 = 7;
const int PIN_AIN2 = 8;

void setup() {
  Serial.begin(115200);

  pinMode(PIN_PWMA, OUTPUT);
  pinMode(PIN_STBY, OUTPUT);
  pinMode(PIN_AIN1, OUTPUT);
  pinMode(PIN_AIN2, OUTPUT);

  // Take driver out of standby mode
  digitalWrite(PIN_STBY, HIGH);

  Serial.println(F("TB6612FNG Motor Driver Initialized"));
}

void driveMotorA(bool forward, int speed) {
  speed = constrain(speed, 0, 255);

  if (forward) {
    digitalWrite(PIN_AIN1, HIGH);
    digitalWrite(PIN_AIN2, LOW);
    Serial.print(F("Motor Forward at speed: "));
  } else {
    digitalWrite(PIN_AIN1, LOW);
    digitalWrite(PIN_AIN2, HIGH);
    Serial.print(F("Motor Reverse at speed: "));
  }

  analogWrite(PIN_PWMA, speed);
  Serial.println(speed);
}

void stopMotorA() {
  analogWrite(PIN_PWMA, 0);
  digitalWrite(PIN_AIN1, LOW);
  digitalWrite(PIN_AIN2, LOW);
  Serial.println(F("Motor Stopped"));
}

void loop() {
  // Drive forward at speed 200
  driveMotorA(true, 200);
  delay(2000);

  // Stop
  stopMotorA();
  delay(1000);

  // Drive reverse at speed 200
  driveMotorA(false, 200);
  delay(2000);

  // Stop
  stopMotorA();
  delay(1000);
}

/*
 * ==================================================================
 *  Generated by Codey.online  —  https://www.codey.online
 * ==================================================================
 *  Project   : TB6612FNG Motor Driver with ESP32
 *  Board     : ESP32 DEVKIT V1 (esp32:esp32:esp32doit-devkit-v1)
 *  Parts     : TB6612FNG Motor Driver
 *  Libraries : none (built-in)
 *
 *  Codey Online is an AI-powered browser IDE for Arduino and ESP32.
 *  Describe your project and Codey writes the code, draws the wiring
 *  diagram and uploads it to your board, straight from the browser.
 *  This code is free to use, modify and share, without warranty.
 * ==================================================================
 */

// TB6612FNG Dual H-Bridge Motor Driver Demo on ESP32

const int PIN_STBY = 13;
const int PIN_AIN1 = 12;
const int PIN_AIN2 = 14;
const int PIN_PWMA = 27;

void setup() {
  Serial.begin(115200);

  pinMode(PIN_STBY, OUTPUT);
  pinMode(PIN_AIN1, OUTPUT);
  pinMode(PIN_AIN2, OUTPUT);
  pinMode(PIN_PWMA, OUTPUT);

  // Enable driver
  digitalWrite(PIN_STBY, HIGH);
  Serial.println("TB6612FNG Motor Driver Initialized");
}

void driveMotor(bool forward, int speed) {
  if (forward) {
    digitalWrite(PIN_AIN1, HIGH);
    digitalWrite(PIN_AIN2, LOW);
  } else {
    digitalWrite(PIN_AIN1, LOW);
    digitalWrite(PIN_AIN2, HIGH);
  }
  analogWrite(PIN_PWMA, constrain(speed, 0, 255));
}

void stopMotor() {
  digitalWrite(PIN_AIN1, LOW);
  digitalWrite(PIN_AIN2, LOW);
  analogWrite(PIN_PWMA, 0);
}

void loop() {
  // Forward acceleration
  Serial.println("Motor Forward: Accelerating");
  for (int spd = 50; spd <= 255; spd += 25) {
    driveMotor(true, spd);
    delay(150);
  }
  delay(1000);

  // Stop
  Serial.println("Motor Stop");
  stopMotor();
  delay(1000);

  // Reverse acceleration
  Serial.println("Motor Reverse: Accelerating");
  for (int spd = 50; spd <= 255; spd += 25) {
    driveMotor(false, spd);
    delay(150);
  }
  delay(1000);

  // Stop
  Serial.println("Motor Stop");
  stopMotor();
  delay(2000);
}