ssi_elec_regulation_asservissement
Différences
Ci-dessous, les différences entre deux révisions de la page.
| Les deux révisions précédentesRévision précédenteProchaine révision | Révision précédente | ||
| ssi_elec_regulation_asservissement [2025/11/29 14:03] – mistert2 | ssi_elec_regulation_asservissement [2025/12/09 13:54] (Version actuelle) – mistert2 | ||
|---|---|---|---|
| Ligne 1: | Ligne 1: | ||
| - | long ticksMesures | + | ===== REGULATION ET ASSERVISSEMENT ===== |
| - | ticks = 0; // RAZ pour prochaine fenêtre | + | |
| - | float vitesse | + | ==== COURS ==== |
| - | // ================= PID ================= | + | {{https://mistert.freeboxos.fr/ |
| - | erreur = consigne - vitesse; | + | |
| - | integral += erreur * (period / 1000.0); | + | |
| - | float deriv = (erreur | + | |
| - | erreurPrec = erreur; | + | |
| - | float commande | + | ==== MODELES MATLAB |
| - | // Limiter entre -255 et 255 | + | {{https://mistert.freeboxos.fr/ |
| - | if (commande > 255) commande = 255; | + | |
| - | if (commande < -255) commande = -255; | + | |
| - | commandeMoteur(commande); | + | {{https:// |
| - | // --- Affichage TP --- | ||
| - | Serial.print(" | ||
| - | Serial.print(consigne); | ||
| - | Serial.print(" | ||
| - | Serial.print(vitesse); | ||
| - | Serial.print(" | ||
| - | Serial.println(commande); | ||
| - | ==== Code Arduino du TP ==== | + | ---- |
| - | < | + | ==== TP – Régulation de vitesse d’un moteur à courant continu avec PID ==== |
| + | |||
| + | === Objectifs du TP === | ||
| + | |||
| + | * Mesurer la vitesse d’un moteur CC avec un codeur incrémental | ||
| + | * Comprendre la différence entre boucle ouverte et boucle fermée | ||
| + | * Mettre en œuvre progressivement un correcteur P, puis PI, puis PID | ||
| + | * Observer l’erreur statique, le dépassement et la sensibilité au bruit | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === Travail demandé === | ||
| + | |||
| + | * Décrire la réponse du moteur en boucle ouverte | ||
| + | * Tracer ou décrire la courbe vitesse / consigne | ||
| + | * Expliquer pourquoi un écart statique persiste | ||
| + | * Montrer comment I supprime cet écart | ||
| + | * Comparer les dépassements pour P, PI et PID | ||
| + | * Conclure sur l’intérêt des trois termes du PID | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === 1) Commande du moteur en boucle ouverte === | ||
| + | |||
| + | Manipulations : | ||
| + | |||
| + | * Choisir le mode boucle ouverte | ||
| + | * Choisir une consigne en < | ||
| + | * Observer la vitesse indiquée par le programme | ||
| + | * Bloquer légèrement l’axe du moteur avec le doigt | ||
| + | |||
| + | Observations attendues : | ||
| + | |||
| + | * La vitesse chute immédiatement lorsque l’axe est freiné | ||
| + | * Le moteur ne corrige pas cette chute : c’est normal en boucle ouverte | ||
| + | * La vitesse dépend | ||
| + | |||
| + | Conclusion : | ||
| + | La boucle ouverte ne permet pas de maintenir une vitesse constante | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === 2) Mise en place d’un | ||
| + | |||
| + | Manipulations : | ||
| + | |||
| + | * Activer le correcteur proportionnel : <mt>u = K_p \cdot e</ | ||
| + | * Fixer une consigne (ex : 1500 tr/min) | ||
| + | * Le programme convertit automatiquement en ticks/s | ||
| + | * Freiner légèrement le moteur | ||
| + | * Augmenter progressivement K_p : 0.2 → 0.5 → 1.0 → 2.0 | ||
| + | |||
| + | Observations attendues : | ||
| + | |||
| + | * Le moteur augmente la PWM pour compenser la perturbation | ||
| + | * La vitesse remonte partiellement | ||
| + | * Il reste un écart statique : < | ||
| + | * Si K_p devient trop grand : oscillations, | ||
| + | |||
| + | Conclusion : Le correcteur P réduit l’erreur, mais ne la supprime pas | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === 3) Mise en place du correcteur I (Intégral) === | ||
| + | |||
| + | Manipulations : | ||
| + | |||
| + | * Ajouter le terme intégral : <mt>u = K_p e + K_I \int e(t)\, | ||
| + | * Débuter avec < | ||
| + | * Freiner l’axe puis relâcher | ||
| + | |||
| + | Observations attendues : | ||
| + | |||
| + | * L’erreur statique disparaît | ||
| + | * La vitesse | ||
| + | * Si < | ||
| + | |||
| + | Conclusion : Le correcteur I supprime l’erreur statique, mais ne doit jamais être trop fort | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === 4) Mise en place du correcteur D (Dérivé) === | ||
| + | |||
| + | Manipulations : | ||
| + | |||
| + | * Ajouter le terme dérivé : <mt>u = K_p e + K_I \int e\,dt + K_D \frac{de}{dt}< | ||
| + | * Tester avec < | ||
| + | * Freiner l’axe pour observer la réaction | ||
| + | |||
| + | Observations attendues : | ||
| + | |||
| + | * Le système est mieux amorti | ||
| + | * Le dépassement diminue | ||
| + | * La stabilité augmente | ||
| + | |||
| + | Attention : Si < | ||
| + | |||
| + | Conclusion : Le terme D stabilise | ||
| + | |||
| + | ---- | ||
| + | |||
| + | === Synthèse des rôles P / I / D === | ||
| + | |||
| + | ^ Correcteur ^ Rôle principal ^ Risques si trop fort ^ | ||
| + | | P | réduit l’erreur | oscillations | | ||
| + | | I | supprime l’erreur statique | dépassement, | ||
| + | | D | amortit, stabilise | amplification du bruit | | ||
| + | |||
| + | ---- | ||
| + | |||
| + | ==== Code Arduino du TP (consigne | ||
| + | |||
| + | <code C++> | ||
| + | /* | ||
| + | | ||
| + | TP REGULATION : MODE BO / MODE PID | ||
| + | | ||
| + | |||
| + | MODE BO : | ||
| + | - PWM = conversion(consigne_tr/ | ||
| + | - 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 --- | // --- Pont en H --- | ||
| - | const int M_AV = 3; // PWM forward | + | const int M_AV = 3; |
| - | const int M_AR = 6; // PWM reverse | + | const int M_AR = 6; |
| - | // --- Codeur | + | // --- Codeur --- |
| - | const int canalA = 2; // interruption 0 | + | const int canalA = 2; |
| const int canalB = 11; | const int canalB = 11; | ||
| - | volatile long ticks = 0; // compteur modifié par ISR | + | volatile long ticks = 0; |
| - | // === PID === | + | // --- PID --- |
| - | float consigne = 0; // vitesse ciblée (ex : en ticks/s) | + | float kp = 0.8; |
| - | float kp = 0.8; // gains PID : à régler en TP | + | |
| float ki = 0.1; | float ki = 0.1; | ||
| float kd = 0.05; | float kd = 0.05; | ||
| Ligne 49: | Ligne 163: | ||
| float integral = 0; | float integral = 0; | ||
| - | // === Mesure | + | float consigne_rpm = 0; |
| + | float consigne_ticks_s | ||
| + | |||
| + | // --- Modes --- | ||
| + | enum Mode { BO, PID_MODE }; | ||
| + | Mode mode = BO; | ||
| + | |||
| + | // --- Mesure | ||
| unsigned long lastMeasure = 0; | unsigned long lastMeasure = 0; | ||
| - | const unsigned long period = 100; // calcul vitesse toutes les 100 ms | + | const unsigned long period = 100; // 100 ms |
| - | // === Prototypes === | ||
| - | void ISR_codeur(); | ||
| - | void commandeMoteur(float pwm); | ||
| - | float lireConsigne(); | ||
| - | void setup() { | + | // ============ INTERRUPTIONS CODEUR ============ |
| - | Serial.begin(9600); | + | void ISR_codeur() { |
| + | | ||
| + | ticks++; | ||
| + | else | ||
| + | ticks--; | ||
| + | } | ||
| - | pinMode(M_AV, | ||
| - | pinMode(M_AR, | ||
| - | pinMode(canalB, INPUT); | + | // ============ 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; | ||
| - | attachInterrupt(digitalPinToInterrupt(canalA), ISR_codeur, RISING); | + | return map(rpm, 0, 150, 0, 255); |
| + | } | ||
| - | Serial.println(" | + | |
| - | Serial.println(" | + | // ============ CONVERSION tr/min -> ticks/s (PID) ============ |
| + | float rpmToTicksSec(float rpm) { | ||
| + | return (rpm * TICKS_PAR_TOUR) / 60.0; | ||
| } | } | ||
| - | // ====================== BOUCLE PRINCIPALE =========================== | + | |
| - | void loop() { | + | // ============ |
| - | // --- Lecture consigne si disponible --- | + | void setPWM(int pwm) { |
| - | if (Serial.available() | + | if (pwm >= 0) { |
| - | consigne = lireConsigne(); | + | |
| - | Serial.print(" | + | |
| - | Serial.println(consigne); | + | } else { |
| + | digitalWrite(M_AV, LOW); | ||
| + | analogWrite(M_AR, | ||
| + | } | ||
| } | } | ||
| - | // --- Boucle PID toutes les 100 ms --- | ||
| - | unsigned long now = millis(); | ||
| - | if (now - lastMeasure >= period) { | ||
| - | lastMeasure = now; | ||
| - | long ticksMesures | + | // ============================================= |
| - | ticks = 0; // RAZ pour prochaine fenêtre | + | // SETUP |
| + | // ============================================= | ||
| + | void setup() { | ||
| + | Serial.begin(9600); | ||
| - | float vitesse = ticksMesures * (1000.0 / period); | + | pinMode(M_AV, OUTPUT); |
| + | pinMode(M_AR, | ||
| + | pinMode(canalB, | ||
| - | // ================= PID ================= | + | attachInterrupt(digitalPinToInterrupt(canalA), ISR_codeur, RISING); |
| - | erreur = consigne - vitesse; | + | |
| - | integral += erreur * (period / 1000.0); | + | |
| - | float deriv = (erreur - erreurPrec) / (period / 1000.0); | + | |
| - | erreurPrec = erreur; | + | |
| - | float commande | + | Serial.println(" |
| + | Serial.println(" | ||
| + | Serial.println(" | ||
| + | } | ||
| - | // Limiter entre -255 et 255 | ||
| - | if (commande > 255) commande = 255; | ||
| - | if (commande < -255) commande = -255; | ||
| - | commandeMoteur(commande); | + | // ============================================= |
| + | // LOOP | ||
| + | // ============================================= | ||
| + | void loop() { | ||
| - | // --- Affichage TP --- | + | |
| - | Serial.print(" | + | |
| - | Serial.print(consigne); | + | |
| - | Serial.print(" | + | txt.trim(); |
| - | Serial.print(vitesse); | + | |
| - | Serial.print(" | + | |
| - | Serial.println(commande); | + | |
| + | if (txt.equalsIgnoreCase(" | ||
| + | mode = BO; | ||
| + | Serial.println(" | ||
| + | return; | ||
| + | } | ||
| - | } | + | if (txt.equalsIgnoreCase(" |
| - | } | + | mode = PID_MODE; |
| + | Serial.println(" | ||
| + | return; | ||
| + | | ||
| - | // ========== INTERRUPTIONS CODEUR ========== | + | |
| - | void ISR_codeur() { | + | consigne_rpm |
| - | if (digitalRead(canalB)) | + | |
| - | ticks++; | + | |
| - | else | + | |
| - | ticks--; | + | |
| - | } | + | |
| - | // ========== COMMANDE MOTEUR ========== | + | Serial.print(" |
| - | void commandeMoteur(float pwm) { | + | |
| - | if (pwm >= 0) { | + | |
| - | digitalWrite(M_AR, LOW); | + | |
| - | analogWrite(M_AV, pwm); | + | |
| - | } else { | + | } |
| - | digitalWrite(M_AV, LOW); | + | |
| - | analogWrite(M_AR, -pwm); | + | |
| - | } | + | |
| - | } | + | |
| - | // ========== LECTURE CONSIGNE ========== | ||
| - | float lireConsigne() { | ||
| - | String txt = Serial.readStringUntil(' | ||
| - | txt.trim(); | ||
| - | return txt.toFloat(); | ||
| - | } | ||
| - | </ | ||
| + | // ----------- 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); | ||
| + | setPWM(pwm); | ||
| + | |||
| + | Serial.print(" | ||
| + | Serial.print(consigne_rpm); | ||
| + | Serial.print(" | ||
| + | Serial.print(vitesse_ticks_s); | ||
| + | Serial.print(" | ||
| + | Serial.print(vitesse_rpm); | ||
| + | Serial.print(" | ||
| + | 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(" | ||
| + | Serial.print(consigne_rpm); | ||
| + | Serial.print(" | ||
| + | Serial.print(vitesse_ticks_s); | ||
| + | Serial.print(" | ||
| + | Serial.print(vitesse_rpm); | ||
| + | Serial.print(" | ||
| + | Serial.println(commande); | ||
| + | |||
| + | return; | ||
| + | } | ||
| + | } | ||
| + | |||
| + | </ | ||
ssi_elec_regulation_asservissement.1764425026.txt.gz · Dernière modification : de mistert2
