I moderne styresystemer er stabilitet hjørnesteinen i sikker og forutsigbar drift. Ingen steder er dette mer tydelig enn i kvadrotor droner, hvor ustabilitet kan føre til katastrofal svikt i løpet av sekunder. Denne case-studien demonstrerer den praktiske anvendelsen av Rout-Hurwitz-kriteriet for å analysere og stabilisere styresystemet til en kvadrotor drone. Ved å konstruere rutineserien fra det karakteristiske polynomialet i det lukkede loop-systemet, kan ingeniører bestemme stabilitet uten å løse røttene direkte, noe som muliggjør rask parameterjustering og robust flygeytelse.

Quadrotor Dynamics og kontrollarkitektur

En kvadrotor er et underaktuert, høyt koplet ikke-lineært system. Dens bevegelse styres ved å variere hastighetene til fire rotorer, som genererer trykk og dreiemoment. For stabilitetsanalyse blir systemet typisk linearisert rundt en svevetilstand, hvilket gir et sett av avkoblede andre rekkefølge differensialligninger for rull, kast, yaw og høyde. Kontrollsystemet benytter vanligvis proporsjonal-integral-Derivative (PID) kontrollere for hver akse, med tilbakemeldingsssløyfer lukket rundt holdning og vinkelratemålinger fra en lumpet måleenhet (IMU). Den lukket-loop overføringsfunksjonen til hver akse kan avledes, noe som fører til en karakteristisk polynomial hvis røtter bestemmer stabilitet.

Linearisert modell for rulleakse

Tenk på rolldynamikken. Den lineariserte bevegelseslikningen er:

hvor er rullevinkelen, er det moment som er det aerodynamiske dempingsderivatet, og er det styrederivat som representerer dreiemomentet som produseres av differensialtrykket. A PID-kontroller gir styresignalet:

Utskifting og dannelse av den lukkede overføringsfunksjon gir et karakteristisk polynom i rekkefølge tre (eller høyere dersom sensordynamikken er inkludert). For et tredje ordenssystem:

Ruth-Hurwitz-kriteriet lar oss deretter analysere tegn på de virkelige delene av røttene uten eksplisitt rotfunn.

Ruth-Hurwitz-kriteriet: En systematisk stabilitetstest

Utviklet uavhengig av Edward John Routh og Adolf Hurwitz, gir Routh-Hurwitz-kriteriet en nødvendig og tilstrekkelig tilstand for stabilitet av lineære tidsinvariantsystemer. Det bruker koeffisientene til den karakteristiske polynomial til å konstruere en rekke (rutearrayet). Antall tegnendringer i den første kolonnen i denne rekken er lik antall røtter med positive reelle deler. For at et system skal være stabilt, må alle oppføringer i den første kolonnen ha samme tegn (vanligvis positive).

Bygge rutinearray

Siden det er blitt gjort en polynom , er den rutiske rekken bygget rad etter rad:

  • Rad 1: ⁇ Koeffisienter av jevnindekserte termer.
  • Rad 2: ⁇ Koeffisienter av underlig-indekserte termer.
  • Etterfølgende rader beregnes ved hjelp av formelen: (der a1 er det første elementet i den andre raden).

Hvis noe element i den første kolonnen blir null, kreves det spesiell håndtering (erstatt med en liten epsilon eller bruk den hjelpepolynomiske metode). Hvis en hel rad blir null, har polynomialet symmetriske røtter, og array fortsetter å bruke en hjelpepolynomial.

stabilitetsbetingelser for tredjepartsordresystemer

For en kubisk polynom forenkler rutine-Hurwitz-vilkårene til å:

  • Alle koeffisienter må være positive (nødvendige tilstander).
  • Ulikheten må ha (tilstrekkelig vilkår for tredje orden).

Denne enkle regelen brukes ofte som en rask sjekk før du konstruerer hele array.

Søknad om Quadrotor Roll-kontrollsystemet

For vår quadrotor case studie, den karakteristiske polynomial for roll aksen, inkludert PID kontroller gevinster og rotor dynamikk (modifisert som et første-orden lag med tid konstant τ), ble avledet som:

Når numeriske verdier fra det fysiske systemet er: τ = 0,05 s (rotortidkonstant), I xx = 0,01 kg·m2, L 2 = 0,5 N·m per enhetskontroll. De opprinnelige PID-gevinster ble valgt ut fra heuristisk tuning: K p = 10, K i = 2, K d = 5.

→

Bygge rutinearray

Vi konstruerer arrayet for denne fjerde rekkefølgen polynom:

  • Rad 1 (s4): 0.05, 15.1, 10
  • Rad 2 (s3): 1.5, 52, 0
  • Rad 3 (s2): beregning b1 = (1.5 * 15.5 - 0,05 * 52)/1,5 = (22.65 - 2.6)/1,5 = 13.367; b2 = (1.5 * 10 - 0,05 * 0)/1,5 = 10; b3 = 0
  • Rad 4 (s1): c1 = (13.367 * 52 - 1,5 * 10)/13.367 = (694.064 - 15)/13.367 = 50.84; c2 = 0
  • Rad 5 (s0): d1 = (50.54 * 10 - 13.367 *0)/50.84 = 10

De første kolonneverdiene er: 0,05, 1,5, 13.367, 50.84, 10 ⁇ alle positive, ingen tegnendringer. Således er systemet med disse gevinstene stabilt. Men hvis vi øker integrert gevinst til K i = 20, den polynomiske koeffisientene endring og rutineserien avslører en tegnendring, noe som indikerer ustabilitet. Dette viser effekten av kriteriet for parameterrommets utforskning.

Parameter Tuning Bruke Routh-Hurwitz Konstrainer

I stedet for prøve- og terrorsimulering, gir Routh-Hurwitz-kriteriet algebraisk ulikhet som må tilfredsstilles for stabilitet. For den fjerde rekkefølgen polynom vi oppnådde, er de nødvendige betingelsene:

  • Alle koeffisienter positive: automatisk fornøyd hvis gevinster er positive og τ > 0.
  • Den første kolonnen i rutearrangøren må ikke ha noen tegnendringer.

Ved å uttrykke de første kolonnelinjene symbolsk i form av K p, K i og K d, avledet vi tre begrensningsligninger. Løsning av disse ulikhetene definerer et stabilt område i gevinstrommet. For vår kvadrotor ble det stabile området funnet å være:

  • (anbefales fra Routh-tilstanden)

Disse begrensningene veiledet utvalget av endelige gevinster: K p = 8, K i = 1, K d = 4, som ligger godt innenfor det stabile området og også gir god fasemargin når evaluert via frekvensrespons.

Simuleringsresultater og validering

En ikke-lineær simulering av kvadrotoren i Gazebo]-miljøet ble brukt til å validere stabilitetsmarginene. Med de rutine-Hurwitz-optimerte gevinster viste rullresponsen til en 10-graders trinninngang en avregningstid på 0,8 sekunder, oversøk mindre enn 5%, og ingen stabil-tilstandsfeil. I motsetning til dette, gevinster utenfor det stabile området (f.eks. K i = 20) produserte avvikende oscillasjoner som vokste ubundet innen 2 sekunder.

Ytterligere robusthetstest inkluderte vindkast opp til 5 m/s og sensorstøy som er typisk for lavpris-MEMS IMUs. Styreren opprettholdt stabilitet i alle tilfeller, med det maksimale rullevinkelavvik som er igjen under 1,5 grader. Ruth-Hurwitz-kriteriet ga således ikke bare stabilitet, men også en baseline for robust ytelse.

Praktiske gjennomføringsoverveielser

Mens Routh-Hurwitz-kriteriet er et kraftig analytisk verktøy, har det begrensninger. Det gjelder bare lineære tidsinvariante systemer, så den lineariserte modellen må være gyldig rundt driftspunktet. For aggressive manøvrer, ikke-lineære effekter (f.eks. aktuatormetning, gyroskopisk dreiemoment) kan forårsake stabilitetsnedbrytning. Ingeniører bør supplere Routh-Hurwitz-analysen med ] tidsdomenesimuleringer og frekvens-domenemetoder (f.eks. Bode-plotter eller rotlocus).

I tillegg introduserer digital implementering prøvetakingsforsinkelser og kvantiseringsfeil. Disse kan modelleres som et ekstra faselag, som reduserer den effektive fasemarginen. Kritikken kan fortsatt påføres ved å inkludere den digitale kontrollforsinkelsen som en ekstra pol i det karakteristiske polynomial. For vår quadrotor, som kjører kontrollsløyfen ved 500 Hz holdt forsinkelsen under 2 ms, som ikke signifikant endrer Routh-arrayresultatene.

Konklusjon

Ruth-Hurwitz-kriteriet forblir et uunnværlig første trinn i styresystemdesign for kvadrotor droner. Denne case-studien viste hvordan man utleder den karakteristiske polynomialen til en kvadrotors roll-akse, konstruer rutineserien og ekstraher algebraiske begrensninger som definerer stabile gevinsterregioner. Metoden tillot rask avvisning av ustabile parametersett uten omfattende simulering eller prototyping. Ved å integrere Ruth-Hurwitz-analysen med praktiske tuning retningslinjer, kan ingeniører oppnå trygge, pålitelige og høyytelse drone-flygekontrollere.

For videre lesing på Routh-Hurwitz-kriteriet, se ] omfattende Wikipedia-artikkel. En utmerket referanse om kvadrotordynamikk er papiret av B. Corke i ]Robotikk og autonome systemer. For dypere kontrollteori, konsulter University of Michigans Control Tutorials for Matlab. Simuleringsmiljøet som brukes kan finnes på ].