Simulatore di controllore PID per sistemi robotici

Controlli

Il simulatore espone valore di riferimento, guadagni proporzionale, integrale e derivativo, intervallo di campionamento, limite dell’attuatore e ampiezza del disturbo. I grafici allineati mostrano valore di riferimento, uscita misurata, errore e sforzo di controllo. Il reset cancella la memoria del controllore, così gli esperimenti restano confrontabili.

Teoria

Un controllore di retroazione calcola l’errore come valore di riferimento meno misurazione. L’azione proporzionale reagisce immediatamente, quella integrale accumula l’errore persistente e quella derivativa risponde alla velocità di variazione. La loro somma diventa il comando dell’attuatore.

Le prestazioni del controllore sono limitate dal sistema. Campionare troppo lentamente nasconde il movimento; superare il limite dell’attuatore causa saturazione; misurazioni rumorose rendono instabile un termine derivativo non filtrato. La regolazione è quindi un esperimento che coinvolge controllore e sistema.

Algoritmo

1. Leggi la misurazione a intervalli fissi e calcola l’errore.
2. Accumula un integrale limitato usando il passo temporale effettivo.
3. Stima la derivata dalla misurazione o dall’errore e applica un filtraggio adeguato.
4. Somma i tre termini pesati e limita il risultato all’intervallo dell’attuatore.
5. Applica il comando, memorizza il campione precedente e registra le metriche.
6. Reimposta l’integrale e la storia quando la modalità di controllo o il sistema cambiano in modo significativo.

Codice sorgente

Questa implementazione include una semplice condizione anti-windup:

float updatePid(float setpoint, float measured, float dt) {
  const float error = setpoint - measured;
  const float derivative = (error - previousError) / dt;
  const float candidateIntegral = integral + error * dt;
  const float raw = kp * error + ki * candidateIntegral + kd * derivative;

  const float output = constrain(raw, outputMin, outputMax);
  if (raw == output) integral = candidateIntegral;
  previousError = error;
  return output;
}

I controllori di produzione definiscono anche il comportamento per misurazioni non valide, overrun del timer, transizioni di modalità e guasti degli attuatori.

Ipotesi e differenze hardware

Il sistema qui è un modello pulito del secondo ordine, con massa, smorzamento e ritardo noti che imposti con i cursori, non un vero motore con attrito, zona morta, coppia che diminuisce con la velocità e un driver che si scalda. Il campionamento è fisso per costruzione, quindi il termine derivativo resta ben comportato; su un Arduino, delay() o altro lavoro bloccante fa oscillare l’intervallo e il termine D si comporta male anche quando i guadagni non cambiano. La saturazione dell’attuatore è modellata come un limite rigido con anti-windup, ma un sistema fisico ha anche limiti di corrente, cali della tensione di alimentazione e calore che modificano il limite durante il funzionamento. Regola la forma qui, poi verifica sull’hardware dove il sistema è noto solo approssimativamente.

Schema elettrico

Il sensore di retroazione riporta l’uscita effettiva; non sostituisce la limitazione della corrente né l’arresto di sicurezza hardware. Il controllore confronta il valore di riferimento con la lettura condizionata del sensore, poi comanda l’attuatore tramite uno stadio PWM dimensionato per il carico.

Esperimenti guidati

Leggere dell’overshoot non equivale a produrlo deliberatamente. Ogni esperimento seguente richiede un paio di minuti e isola esattamente un effetto.

1. Trova il guadagno critico

Imposta Ki e Kd a zero. Aumenta Kp finché l’uscita oscilla con ampiezza costante, né crescente né decrescente. Annota quel guadagno (Ku) e il periodo di oscillazione (Tu).

Quei due numeri sono tutto ciò che serve per una prima regolazione:

Inseriscili e confrontali. La riga classica è aggressiva e produce un overshoot del 20–40%; la seconda arriva senza overshoot ma richiede più tempo. Nessuna delle due è «corretta»: sono risposte diverse a requisiti diversi, ed è questo il punto.

2. Osserva il windup integrale verificarsi

Imposta un limite basso per l’attuatore, intorno al 20% del suo intervallo, poi comanda un grande gradino del valore di riferimento. Osserva il grafico dello sforzo di controllo: satura immediatamente e resta lì, mentre l’integrale continua ad accumulare un errore su cui non può agire. Quando l’uscita raggiunge finalmente il valore di riferimento, tutta quell’azione memorizzata si scarica e il sistema va ben oltre.

Ora aumenta il limite dell’attuatore e ripeti con gli stessi guadagni. L’overshoot scompare in gran parte. Nulla del controllore è cambiato: è questo il punto. Il windup è una proprietà dell’interazione tra controllore e attuatore che satura, non dei guadagni.

3. Dimostra che è il ritardo, non il rumore, a distruggere il ciclo

Aumenta l’intervallo di campionamento dal valore minimo a incrementi, mantenendo fissi i guadagni. La risposta peggiora molto prima che il grafico appaia rumoroso: l’overshoot cresce, compare l’oscillazione, poi il sistema diventa instabile.

Ecco perché rimuovere un delay() dal ciclo di un robot spesso migliora il tracciamento più di qualsiasi altra regolazione. Un’informazione obsoleta non può essere recuperata da un guadagno.

4. Fornisci rumore al termine derivativo

Aumenta l’ampiezza del disturbo con Kd a zero, poi aumenta Kd. L’andamento dello sforzo di controllo diventa frastagliato molto prima di quello dell’uscita: stai osservando la differenziazione amplificare il contenuto ad alta frequenza, esattamente come deve.

È questo comportamento a portare le persone a concludere che D sia inutile e a impostarlo a zero. La correzione reale è a monte: filtra la misurazione o filtra direttamente il termine derivativo.

Cosa devi osservare

L’offset a regime con P e D ma senza I vale la pena produrlo deliberatamente almeno una volta. È la dimostrazione più chiara di ciò a cui serve realmente il termine integrale: l’azione proporzionale ha bisogno di un errore diverso da zero per produrre qualsiasi uscita, quindi necessariamente si ferma leggermente prima.

Passaggio all’hardware

I guadagni trovati qui sono un punto di partenza, non un trasferimento. Ciò che si trasferisce perfettamente è la procedura; non si trasferiscono i numeri, perché descrivono questo sistema.

L’ultima riga causa la maggiore confusione nella pratica. Una regolazione perfetta con batterie nuove diventa pigra con batterie scariche, perché lo stesso comando produce ora meno coppia. Non è un fallimento del metodo: i guadagni sono proprietà del sistema, e il sistema è cambiato. Le risposte professionali sono un ciclo di velocità interno oppure la pianificazione dei guadagni. Segui come regolare un controllore PID per la procedura completa, poi porta tutto nel laboratorio di inseguimento della linea, dove il sistema contrattacca.