În sistemele moderne de control, stabilitatea este piatra de temelie a unei operaţiuni sigure şi previzibile. Nicăieri nu este mai evidentă decât în drone cvadrotor, unde instabilitatea poate duce la o defecţiune catastrofală în câteva secunde. Acest studiu de caz demonstrează aplicarea practică a criteriului Routh-Hurwitz pentru a analiza şi stabiliza sistemul de control al unei drone cvadrotor. Prin construirea matricei Routh din polinomia caracteristică a sistemului de închidere, inginerii pot determina stabilitatea fără rezolvarea directă a rădăcinilor, permiţând reglarea rapidă a parametrilor şi performanţa robustă a zborului.

Dinamica Quadrotor si arhitectura de control

Un cvadrutor este un sistem neliniar cu o foarte mare cuplată. Mişcarea sa este controlată de variaţii ale vitezei a patru rotoare, care generează axialitate şi cuplu. Pentru analiza stabilităţii, sistemul este de obicei liniarizat în jurul unei stări de hover, producând un set de ecuaţii diferenţiale dezaburite de ordinul al doilea pentru rola, smoală, căscat şi altitudine. Sistemul de control utilizează în mod obişnuit controlori proporţionali-integrali-derivaţi (PID) pentru fiecare axă, cu buclele de feedback închise în jurul atitudinii şi măsurători unghiulare ale vitezei de la o unitate de măsurare inerţială (IMU). Funcţia de transfer închis-loop a fiecărei axe poate fi derivată, conducând la un polinomial caracteristic ale cărui rădăcini determină stabilitatea.

Model liniarizat pentru axa roll

Consideră dinamica rola. Ecuația liniară a mișcării este:

unde este unghiul de rulare, este momentul inerției, este derivatul aerodinamic de amortizare, iar este derivatul de control reprezentând cuplul produs de forța diferențială. Un controlor PID furnizează semnalul de control:

Substituirea și formarea funcției de transfer în circuit închis produce un polinom caracteristic de ordine trei (sau mai mare dacă sunt incluse dinamica senzorilor). Pentru un sistem de comandă a treia:

]

Criteriul Routh-Hurwitz ne permite apoi să analizăm semnul real al rădăcinilor fără a găsi în mod explicit rădăcini.

Criteriul Routh-Hurwitz: Un test de stabilitate sistematică

Dezvoltat independent de Edward John Routh și Adolf Hurwitz, criteriul Routh-Hurwitz oferă o condiție necesară și suficientă pentru stabilitatea sistemelor liniare de timp-variantă. Folosește coeficienții polinomului caracteristic pentru a construi un array (array Routh). Numărul de modificări de semn în prima coloană a acestui array este egal cu numărul de rădăcini cu părți reale pozitive. Pentru ca un sistem să fie stabil, toate intrările din prima coloană trebuie să aibă același semn (de obicei pozitiv).

Construirea Array Routh

Având în vedere un polinom , matricea Routh este construită rând cu rând:

  • Rândul 1:
  • Rândul 2:
  • Rândurile următoare sunt calculate utilizând formula: (unde a1 este primul element al celui de-al doilea rând).

Dacă orice element din prima coloană devine zero, este necesară manipularea specială (se repune la loc cu un mic epsilon sau se utilizează metoda auxiliară polinomială). Dacă un întreg rând devine zero, polinomul are rădăcini simetrice, iar matricea este continuată folosind un polinom auxiliar.

Condiții de stabilitate pentru sistemele de ordin al treilea

Pentru un polinom cubic , condițiile Routh-Hurwitz simplifică:

  • Toți coeficienții trebuie să fie pozitivi (condiție necesară).
  • Inegalitatea trebuie să dețină (condiție suficientă pentru ordinul al treilea).

Această regulă simplă este adesea folosită ca o verificare rapidă înainte de construirea întregului array.

Aplicare la sistemul de control cu rolă Quadrotor

Pentru studiul nostru de caz cvadrotor, polinomul caracteristic pentru axa roll, inclusiv câştigurile controler PID şi dinamica rotorului (modelat ca un decalaj de prim ordin cu τ constantă în timp), a fost derivat ca:

În cazul în care valorile numerice ale sistemului fizic sunt: τ = 0,05 s (constantă de timp de rotaţie), I xx = 0,01 kg·m2, L 2 = 0,5 N·m pe unitate de control. Câştigurile iniţiale de PID au fost alese pe baza tuningului euristic: K p = 10, K i = 2, K d = 5.

→

Construirea Array Routh

Construim matricea pentru acest polinom de gradul patru:

  • Rândul 1 (s4): 0,05, 15.1, 10
  • Rândul 2 (s3): 1,5, 52, 0
  • Rândul 3 (s2): calcul b1 = (1,5*15,1 - 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
  • Rândul 4 (s1): c1 = (13.36*52 - 1.5*10)/13.367 = (694.064 - 15)/13.367 = 50.84; c2 = 0
  • Rândul 5 (s0): d1 = (50,84*10 - 13,367*0)/50,84 = 10

Primele valori ale coloanei sunt: 0,05, 1.5, 13.367, 50.84, 10 . Toate pozitive, nu se schimbă semne. Astfel, sistemul cu aceste câștiguri este stabil. Cu toate acestea, dacă creștem câștigul integral la K i = 20, coeficienții polinomiali se schimbă și matricea Routh relevă o schimbare a semnelor, indicând instabilitatea. Aceasta demonstrează puterea criteriului pentru explorarea parametrilor spațiului.

Parametru Tuning Folosind Constrângeri Routh-Hurwitz

În loc de simularea de probă şi de urgenţă, criteriul Routh-Hurwitz oferă inegalităţi algebrice care trebuie satisfăcute pentru stabilitate. Pentru polinomul de gradul patru obţinut, condiţiile necesare sunt:

  • Toți coeficienții pozitivi: mulțumit automat dacă câștigurile sunt pozitive și τ > 0.
  • Prima coloană a matricei Routh nu trebuie să aibă modificări de semn.

Prin exprimarea simbolică a primelor intrări în coloană în termeni de K p, K i și K d, am derivat trei ecuații de constrângere. Rezolvarea acestor inegalități definește o regiune stabilă în spațiul câștigului. Pentru cvadrotor nostru, regiunea stabilă a fost găsită ca fiind:

  • (aproximativ din starea Routh)

Aceste constrângeri au ghidat selectarea câștigurilor finale: K p = 8, K i = 1, K d = 4, care se află bine în regiunea stabilă și oferă, de asemenea, o marjă bună de fază atunci când este evaluată prin răspunsul la frecvență.

Rezultatele simulării și validarea

O simulare neliniară a cvadrutorului în mediul gazebo[ a fost utilizată pentru validarea marjelor de stabilitate. Cu câștigurile optimizate de Routh-Hurwitz, răspunsul la o intrare în trepte de 10 grade a arătat un timp de decontare de 0,8 secunde, depășind mai puțin de 5% și fără eroare de echilibru. Spre deosebire de acestea, câștigurile din afara regiunii stabile (de exemplu, K i = 20) au produs oscilații divergente care au crescut nelegate în 2 secunde.

Testele suplimentare de robustețe au inclus rafale de vânt de până la 5 m/s și zgomot de senzor tipic pentru MMEMS cu costuri mici. Controlorul a menținut stabilitatea în toate cazurile, cu abaterea maximă a unghiului de rulare rămase sub 1,5 grade. Criteriul Routh-Hurwitz a oferit astfel nu numai stabilitate, ci și un punct de referință pentru performanța robustă.

Considerații practice privind punerea în aplicare

În timp ce criteriul Routh-Hurwitz este un instrument analitic puternic, acesta are limitări. Se aplică numai sistemelor liniare de timp-variante, astfel încât modelul liniarizat trebuie să fie valabil în jurul punctului de operare. Pentru manevre agresive, efecte neliniare (de exemplu, saturarea acţiunii, cuplul giroscopic) poate provoca degradarea stabilităţii. Inginerii trebuie să completeze analiza Routh-Hurwitz cu simulări de timp-domin şi metodele de frecvenţă-domeniul (cum ar fi parcelele Bode sau locusul root).

În plus, implementarea digitală introduce întârzieri de eșantionare și erori de cuantizare. Acestea pot fi modelate ca un decalaj suplimentar de fază, care reduce marja de fază efectivă. Criteriul poate fi aplicat încă prin includerea întârzierii de control digital ca un pol suplimentar în polinomul caracteristic. Pentru cvadrotor nostru, care rulează bucla de control la 500 Hz păstrat întârziere sub 2 ms, care nu a modificat semnificativ rezultatele matricei Routh.

Concluzie

Criteriul Routh-Hurwitz rămâne un prim pas indispensabil în proiectarea sistemului de control pentru drone cvadrotor. Acest studiu de caz a demonstrat cum să dea rezultate polinomiale caracteristice a unei axe de rulou cvadrotor, construi matrice Routh, și extrage constrângeri algebrice care definesc regiunile câștig stabil. Metoda a permis respingerea rapidă a seturi de parametri instabili fără simulare extinsă sau prototipare. Prin integrarea analizei Routh-Hurwitz cu orientări practice de tuning, inginerii pot atinge controlorii de zbor drone sigure, fiabile și de înaltă performanță.

Pentru a citi mai departe pe criteriul Routh-Hurwitz, a se vedea comproaspăt Wikipedia articol[.O referință excelentă pe dinamica cvadrotor este lucrarea de B. Corke în Robotics și Sisteme Autonome[.Pentru teoria controlului mai profund, consulta Universitatea din Michigans Control Tutorials for MATLAB. Mediul de simulare utilizat poate fi găsit la ]Pixhawks site-ul oficial[[FLT: ];