closed-loop-speed-control.ino

Unit 4-Encoder Motor Driver (DRV8837DSGR) · Archivo : closed-loop-speed-control.ino · Lenguaje : arduino · Uso : Maintenir une vitesse constante d'un moteur malgré les variations de charge grâce à l'encodeur.

Configura el canal del motor 1 en modo de regulación automática de velocidad usando los datos del codificador integrado.

Requiere la biblioteca M5Stack_MotorDriverUnit. El módulo usa impulsos del codificador para ajustar la PWM en tiempo real. Asegúrese de que el motor tenga un codificador conectado al conector PH2.0-6P.

closed-loop-speed-control.ino

#include <M5Stack_MotorDriverUnit.h>

M5Stack_MotorDriverUnit motorDriver;

void setup() {
  M5.begin();
  if (!motorDriver.begin()) {
    Serial.println("Motor Driver Unit not found!");
    while (1);
  }
  // Configurer le canal 1 pour le contrôle en boucle fermée (vitesse)
  motorDriver.setMode(1, MODE_SPEED);
  motorDriver.setSpeed(1, 50); // Objectif : 50% de la vitesse max
}

void loop() {
  // Le module gère la régulation PID en interne via les données de l'encodeur
  // Lecture optionnelle de la vitesse actuelle
  int currentSpeed = motorDriver.getSpeed(1);
  Serial.printf("Motor 1 Current Speed: %d\n", currentSpeed);
  delay(1000);
}

← Volver a la ficha