Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

Technische Samenvatting: Gecoördineerd Trajectcontrole-algoritme voor de Beweging van een Quadcopter langs een Gladde Ruimtelijke Traject

Probleemstelling
Het artikel behandelt de uitdaging om een quadcopter te besturen zodat deze zich verplaatst langs een gladde, driedimensionale ruimtelijke traject. De auteurs onderscheiden twee primaire controleparadigma's: volgcontrole, waarbij de robot probeert een specifieke positie op een specifiek tijdstip te bereiken (wat vaak leidt tot kortste-pads-oplossingen die kunnen falen in omgevingen met obstakels), en gecoördineerde controle. Bij gecoördineerde controle zijn het traject en het snelheidsprofiel langs die kromme vooraf gespecificeerd. Het controledoel is om de afwijking van het pad te minimaliseren, in plaats van de afstand tot een specifiek punt in de tijd, waardoor het voertuig obstakels kan omzeilen door zijn snelheid langs de kromme aan te passen.

Het specifieke probleem dat hier wordt aangepakt, betreft een niet-lineair dynamisch model van een quadcopter waarbij de relatieve graad van de controlekanalen niet-identiek is, wat de modeldecompositie bemoeilijkt. Bovendien moet de voorgestelde oplossing uitsluitend vertrouwen op uitgangsmetingen (lineaire coördinaten $x, y, z$ en de gierhoek $\psi$) in plaats van metingen van de volledige toestandsvector, wat een aanzienlijke beperking vormt ten opzichte van bestaande toestandsfeedbackbenaderingen.

Methodologie
De auteurs ontwikkelen een controlesynthese gebaseerd op een geometrische aanpak en robuuste uitgangsfeedback:

1. Dynamische Modellering en Definitie van Afwijking:
   Er wordt een volledig niet-lineair model van de quadcopter opgesteld, rekening houdend met lineaire coördinaten en oriëntatie (gier, pitch, roll). De afwijking van het gewenste traject $S$ wordt gedefinieerd met behulp van een coördinatentransformatie. Dit omvat:

   • Een padcoördinaat $s$ die het dichtstbijzijnde punt op de kromme voorstelt.
   • Twee lineaire foutcoördinaten ($e_1, e_2$) die de afstand voorstellen tot twee vlakken die snijden in het gewenste snelheidsvector.
   • Hoekfouten ($\delta\phi, \delta\theta, \delta\psi$), waarbij de gewenste pitch en roll als nul worden verondersteld en de gewenste gierhoek wordt afgeleid uit de projectie van het traject.

2. Transformatie naar Normaalvorm:
   Om het ontwerpen van de regeling te vergemakkelijken, wordt het systeem getransformeerd naar een "normaalvorm" met behulp van een reeks differentiaties en coördinatentransformaties. De auteurs introduceren hulpvariabelen en integratoren om de verzadiging van de stuwkrachtcontrole-ingang ($u_1$) te behandelen. Deze transformatie resulteert in een systeem waarbij de gereguleerde variabelen ($\xi_1$) en hun afgeleiden ($\xi_2, \xi_3, \xi_4$) een uitgebreide toestandsvector vormen. Het systeem blijkt inverteerbaar te zijn, waardoor de reconstructie van de oorspronkelijke controle-ingangen vanuit de normaalvormvariabelen mogelijk is.

3. Synthese van Robuuste Uitgangsfeedbackcontrole:

   • Ideale Toestandsfeedback: Aanvankelijk wordt een controlewet gesynthetiseerd onder de aanname van volledige toestandsbeschikbaarheid. Deze wet maakt gebruik van een lineaire feedbackstructuur met gains ($\gamma_1$ tot $\gamma_4$) die zo worden gekozen dat ze een Hurwitz-polynoom vormen, waardoor lokale asymptotische stabiliteit van de foutdynamica wordt gewaarborgd.
   • Implementatie van Uitgangsfeedback: Omdat volledige toestandsmeting niet beschikbaar is, maken de auteurs gebruik van een uitgebreide observermethode. Er wordt een hoge-versterkingsobserver ontworpen om de niet-gemeten toestanden ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) en de onbekende verstoringsterm ($\hat{\sigma}$) te schatten.
   • Controlewet: De uiteindelijke controlewet maakt gebruik van deze geschatte toestanden en bevat een gladde verzadigingsfunctie om ervoor te zorgen dat de controle-ingangen binnen de fysieke limieten blijven. De stuwkrachtkrachten voor de vier propellers worden berekend door de transformatiematrix die uit de normaalvorm is afgeleid, te inverteren.

Belangrijkste Bijdragen

• Volledig 3D-model: In tegenstelling tot eerdere werken die onvolledige modellen gebruikten die de gierdynamica negeerden of beperkt waren tot planaire beweging, presenteert dit artikel een volledig dynamisch model voor quadcopterbeweging in de 3D-ruimte.
• Gecoördineerde Controle met Uitgangsfeedback: Het artikel synthetiseert een gecoördineerde controlewet die uitsluitend vertrouwen op metingen van lineaire coördinaten en de gierhoek, waarmee de moeilijkheid van niet-identieke relatieve graden in de controlekanalen wordt aangepakt.
• Vereenvoudigde Afstelling: Door gebruik te maken van extra integratoren en een dynamisch controle-algoritme, stellen de auteurs een methodologie voor met vereenvoudigde regelaarafstelling in vergelijking met eerdere volgcontrole-algoritmen die complexe parameterselectie vereisten om bewijsvoorwaarden te voldoen.
• Robuustheid: De opname van een uitgebreide observer stelt het systeem in staat om onbekende termen en verstoringen te hanteren, waardoor een robuuste oplossing voor trajectvolging wordt geboden.

Resultaten en Beweringen
Het artikel levert een theoretisch bewijs van lokale stabiliteit voor het gesloten-luipsysteem. De auteurs tonen aan dat, als de controllerparameters worden gekozen als coëfficiënten van een Hurwitz-polynoom, de afwijkingsvariabelen ($\tilde{\xi}$) asymptotisch naar nul neigen. Dit garandeert dat de quadcopter zal:

1. Het voorgeschreven ruimtelijke kromme volgen.
2. Het voorgeschreven snelheidsprofiel langs de kromme handhaven.
3. Oriëntatiefouten binnen bounded limieten houden.

De wiskundige afleiding bevestigt dat de controlewet de doelstellingen bereikt van het minimaliseren van de afwijking van het traject en het handhaven van de gewenste snelheid en oriëntatie, mits de kromming van het traject begrensd is en de beginvoorwaarden binnen het gebied van aantrekking liggen.

Betekenis
Het artikel claimt een gat in de literatuur te dichten door gecoördineerde trajectcontrole uit te breiden van planaire mobiele robots naar 3D quadcopterbeweging, uitsluitend met behulp van uitgangsfeedback. Het contrasteert met eerdere werken die óf onvolledige modellen gebruikten óf volledige toestandsmetingen vereisten. De betekenis ligt in het bieden van een theoretisch onderbouwde, robuust algoritme voor ruimtelijke padvolging dat praktisch implementeerbaar is gezien standaard sensorbeperkingen (positie en gier), zonder de noodzaak van complexe toestandschatting van hoeksnelheden of volledige oriëntatievectoren. De auteurs merken op dat hoewel het theoretische kader is vastgesteld, volledige experimentele studies zijn gepland voor toekomstig werk om de gesynthetiseerde controlewet te valideren.