PID-regelaarsimulator voor regelsystemen in de robotica

Bediening

De simulator biedt de setpoint, proportionele, integrale en differentiële versterkingen, het bemonsteringsinterval, de actuatorgrens en de grootte van de storing. Uitgelijnde grafieken tonen de setpoint, de gemeten uitvoer, de regelfout en de regelinspanning. Reset wist het geheugen van de regelaar zodat experimenten vergelijkbaar blijven.

Theorie

Een terugkoppelingsregelaar berekent de regelfout als setpoint minus meting. Het proportionele aandeel reageert onmiddellijk, het integrale aandeel bouwt aanhoudende fout op en het differentiële aandeel reageert op de veranderingssnelheid. De som ervan wordt het commando voor de actuator.

De prestaties van de regelaar worden begrensd door het proces. Te traag bemonsteren verbergt beweging; doorbuiten de actuatorgrens werken leidt tot verzadiging; ruisachtige metingen maken een ongefilterde differentiële term instabiel. Afstellen is dus een experiment dat zowel regelaar als systeem omvat.

Algoritme

1. Lees de meting met een vast interval en bereken de regelfout.
2. Bouw een begrensde integraal op met de werkelijke tijdstap.
3. Schat de differentiaal uit de meting of de fout en pas de juiste filtering toe.
4. Tel de drie gewogen termen op en begrens het resultaat tot het bereik van de actuator.
5. Voer het commando uit, sla de vorige sample op en leg de meetwaarden vast.
6. Reset de integraal en de historie wanneer de regelmodus of het proces wezenlijk verandert.

Broncode

Deze implementatie bevat een eenvoudige anti-windupvoorwaarde:

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;
}

Industriële regelaars definiëren ook gedrag voor ongeldige metingen, timeroverschrijdingen, modusovergangen en actuatorstoringen.

Aannames en hardwareverschillen

Het proces hier is een schoon tweede-ordemodel met bekende massa, demping en vertraging die je met de schuifregelaars instelt — geen echte motor met wrijving, dode zone, koppel dat afneemt bij toenemende snelheid en een driver die opwarmt. Het bemonsteringsinterval is per constructie vast, waardoor de differentiële term netjes blijft; op een Arduino zorgen delay() of andere blokkerende taken voor een schokkend interval en gedraagt de D-term zich niet naar behoren, ook als de versterkingen ongewijzigd blijven. Verzadiging van de actuator is gemodelleerd als een harde begrenzing met anti-windup, maar een fysiek systeem heeft ook stroomgrenzen, spanningsdaling en warmte die de grens tijdens het bedrijf veranderen. Stel de vorm hier af en verifieer vervolgens op hardware, waar het proces slechts bij benadering bekend is.

Schakelschema

De terugkoppelsensor geeft de werkelijke uitvoer door; hij vervangt geen stroombegrenzing en geen hardwarematige veiligheidsstop. De regelaar vergelijkt de setpoint met de geconditioneerde sensorwaarde en stuurt daarna de actuator aan via een PWM-trap die op de belasting is gedimensioneerd.

Begeleide experimenten

Over overschwing lezen is niet hetzelfde als die bewust opwekken. Elk experiment hieronder duurt een paar minuten en isoleert precies één effect.

1. Bepaal de kritische versterking

Zet Ki en Kd op nul. Verhoog Kp tot de uitvoer oscilleert met een constante amplitude — noch groeiend noch afnemend. Noteer die versterking (Ku) en de oscillatieperiode (Tu).

Die twee getallen zijn alles wat je nodig heeft voor een eerste afstelling:

Typ die waarden in en vergelijk ze. De klassieke rij is agressief en overschwingt 20–40%; de tweede komt zonder overschwing aan en doet er langer over. Geen van beide is “juist” — het zijn verschillende antwoorden op verschillende eisen, en dat is precies het punt.

2. Observeer integralewindup

Stel de actuatorgrens laag in — rond 20% van het bereik — en geef dan een grote setpointstap. Kijk naar de grafiek van de regelinspanning: die verzadigt onmiddellijk en blijft daar, terwijl de integraal fout blijft opbouwen die hij niet kan verwerken. Wanneer de uitvoer eindelijk de setpoint bereikt, ontrolt al die opgeslagen actie en zeilt het systeem er ver voorbij.

Verhoog nu de actuatorgrens en herhaal met dezelfde versterkingen. De overschwing verdwijnt grotendeels. Er is niets aan de regelaar veranderd — en dat is de les. Windup is een eigenschap van de interactie tussen de regelaar en een verzadigende actuator, niet van de versterkingen.

3. Bewijs dat vertraging, niet ruis, de regelkring doodt

Verhoog het bemonsteringsinterval vanaf zijn laagste waarde in stappen en houd de versterkingen vast. De respons degradeert lang voordat de grafiek er ruisachtig uitziet: de overschwing groeit, er ontstaat oscillatie en vervolgens wordt het systeem instabiel.

Daarom verbetert het verwijderen van een delay() uit de regelkring van een robot het volgvermogen vaak meer dan welke afstelling ook. Verouderde informatie kan niet door een versterking worden teruggewonnen.

4. Voer ruis toe aan de differentiële term

Verhoog de grootte van de storing terwijl Kd op nul staat en verhoog daarna Kd. Het spoor van de regelinspanning wordt al geserreerd lang voordat de uitvoer dat is — je ziet differentiëren hoogfrequente inhoud versterken, precies zoals het moet.

Dat gedrag is de reden waarom mensen concluderen dat D nutteloos is en het op nul zetten. De werkelijke oplossing ligt verderop in de signaalketen: filter de meting, of filter de differentiële term zelf.

Wat je moet zien

De stationaire offset met P en D maar zonder I is de moeite waard één keer bewust op te wekken. Het is de duidelijkste demonstratie van waar de integrale term eigenlijk voor dient: proportioneel regelen heeft een niet-nul regelfout nodig om überhaupt uitvoer te produceren, dus het resultaat blijft noodzakelijk net onder de setpoint staan.

Naar de hardware

Versterkingen die je hier vindt zijn een startpunt, geen overdracht. Wat perfect overgaat is de procedure; wat niet overgaat zijn de getallen, want die beschrijven dit proces.

De laatste regel zorgt in de praktijk voor de meeste verwarring. Een afstelling die perfect is op volle cellen zal traag zijn op lege, omdat hetzelfde commando nu minder koppel oplevert. Dat is geen falen van de methode — versterkingen zijn eigenschappen van het proces, en het proces is verplaatst. De professionele antwoorden zijn een snelheidsregelkring eronder, of gain scheduling (meerdere afstellingen bewaren en op basis van snelheid, belasting of accuspanning ertussen wisselen). Werk de volledige procedure door via een PID-regelaar afstemmen en breng het daarna naar het lijnvolgerlab, waar het proces tegenspartij.