Manipulations :
Observations attendues :
Conclusion : La boucle ouverte ne permet pas de maintenir une vitesse constante
Manipulations :
Observations attendues :
Conclusion : Le correcteur P réduit l’erreur, mais ne la supprime pas
Manipulations :
Observations attendues :
Conclusion : Le correcteur I supprime l’erreur statique, mais ne doit jamais être trop fort
Manipulations :
Observations attendues :
Attention : Si trop élevé → bruit, vibrations, instabilité
Conclusion : Le terme D stabilise le système, mais n’améliore pas la précision
| Correcteur | Rôle principal | Risques si trop fort |
|---|---|---|
| P | réduit l’erreur | oscillations |
| I | supprime l’erreur statique | dépassement, instabilité |
| D | amortit, stabilise | amplification du bruit |
/* ====================================== TP REGULATION : MODE BO / MODE PID ====================================== MODE BO : - PWM = conversion(consigne_tr/min) - codeur mesure mais NE corrige PAS - aucune régulation MODE PID : - consigne tr/min convertie en ticks/s - codeur mesure vitesse - PID corrige PWM */ const int TICKS_PAR_TOUR = 90; // à ajuster selon le codeur // --- Pont en H --- const int M_AV = 3; // PWM forward const int M_AR = 6; // PWM reverse // --- Codeur --- const int canalA = 2; const int canalB = 11; volatile long ticks = 0; // --- PID --- float kp = 0.8; float ki = 0.1; float kd = 0.05; float erreur, erreurPrec = 0; float integral = 0; float consigne_rpm = 0; // consigne entrée par Serial (tr/min) float consigne_ticks_s = 0; // consigne convertie pour le PID // --- Modes --- enum Mode { BO, PID_MODE }; Mode mode = BO; // --- Mesure --- unsigned long lastMeasure = 0; const unsigned long period = 100; // 100 ms // ============ INTERRUPTIONS CODEUR ============ void ISR_codeur() { if (digitalRead(canalB)) ticks++; else ticks--; } // ============ CONVERSION tr/min -> PWM (BO) ============ int rpmToPWM(float rpm) { // Ajuste selon ton moteur // Ex : 0–150 tr/min -> 0–255 PWM if (rpm < 0) rpm = 0; if (rpm > 150) rpm = 150; return map(rpm, 0, 150, 0, 255); } // ============ CONVERSION tr/min -> ticks/s (PID) ============ float rpmToTicksSec(float rpm) { return (rpm * TICKS_PAR_TOUR) / 60.0; } // ============ COMMANDE MOTEUR ============ void setPWM(int pwm) { if (pwm >= 0) { digitalWrite(M_AR, LOW); analogWrite(M_AV, pwm); } else { digitalWrite(M_AV, LOW); analogWrite(M_AR, -pwm); } } // ============================================= // SETUP // ============================================= void setup() { Serial.begin(9600); pinMode(M_AV, OUTPUT); pinMode(M_AR, OUTPUT); pinMode(canalB, INPUT); attachInterrupt(digitalPinToInterrupt(canalA), ISR_codeur, RISING); Serial.println("=== TP REGULATION : BO / PID ==="); Serial.println("Tapez BO ou PID pour changer de mode."); Serial.println("Tapez une consigne en tr/min (ex : 150)"); } // ============================================= // LOOP // ============================================= void loop() { // ----------- Lecture mode / consigne ------------ if (Serial.available() > 0) { String txt = Serial.readStringUntil('\n'); txt.trim(); if (txt.equalsIgnoreCase("BO")) { mode = BO; Serial.println("Mode = BOUCLE OUVERTE"); return; } if (txt.equalsIgnoreCase("PID")) { mode = PID_MODE; Serial.println("Mode = PID"); return; } // Sinon c'est une consigne tr/min consigne_rpm = txt.toFloat(); consigne_ticks_s = rpmToTicksSec(consigne_rpm); Serial.print("Consigne = "); Serial.print(consigne_rpm); Serial.print(" tr/min -> "); Serial.print(consigne_ticks_s); Serial.println(" ticks/s"); } // ----------- Mesure toutes les 100 ms ----------- unsigned long now = millis(); if (now - lastMeasure < period) return; lastMeasure = now; long ticks_mes = ticks; ticks = 0; float vitesse_ticks_s = ticks_mes * (1000.0 / period); float vitesse_rpm = (vitesse_ticks_s * 60.0) / TICKS_PAR_TOUR; // ============================================ // MODE BO // ============================================ if (mode == BO) { int pwm = rpmToPWM(consigne_rpm); // conversion directe consigne → PWM setPWM(pwm); Serial.print("[BO] consigne = "); Serial.print(consigne_rpm); Serial.print(" tr/min | vitesse = "); Serial.print(vitesse_ticks_s); Serial.print(" ticks/s | "); Serial.print(vitesse_rpm); Serial.print(" tr/min | PWM = "); Serial.println(pwm); return; } // ============================================ // MODE PID // ============================================ if (mode == PID_MODE) { erreur = consigne_ticks_s - vitesse_ticks_s; integral += erreur * (period / 1000.0); float deriv = (erreur - erreurPrec) / (period / 1000.0); erreurPrec = erreur; float commande = kp * erreur + ki * integral + kd * deriv; // saturation if (commande > 255) commande = 255; if (commande < -255) commande = -255; setPWM(commande); Serial.print("[PID] consigne = "); Serial.print(consigne_rpm); Serial.print(" tr/min | vitesse = "); Serial.print(vitesse_ticks_s); Serial.print(" ticks/s | "); Serial.print(vitesse_rpm); Serial.print(" tr/min | PWM = "); Serial.println(commande); return; } }