Stateczność i sterowność UAV

Stateczność nie jest tym samym co sterowność#

Stateczność opisuje naturalną lub zamkniętopętlową reakcję po małym zaburzeniu od stanu równowagi. Sterowność opisuje zdolność do wytworzenia wymaganej zmiany ruchu za pomocą aktuatorów. Statek może być stateczny, lecz słabo sterowny; może też być naturalnie niestateczny, ale sterowny dzięki szybkiemu systemowi aktywnemu.

Rozdzielamy co najmniej cztery pojęcia:

Pojęcie	Pytanie
równowaga/trim	czy suma sił i momentów wynosi zero w punkcie lotu?
stateczność statyczna	w którą stronę pojawi się pierwsza tendencja po zaburzeniu?
stateczność dynamiczna	czy przebieg z czasem zanika, pozostaje czy narasta?
sterowność/control authority	czy aktuatory mogą osiągnąć i utrzymać żądany stan?

Autopilot nie usuwa potrzeby rozróżnienia. Może zapewnić zamkniętopętlową stateczność, ale potrzebuje obserwowalnego stanu, pasma, zapasu momentu, zasilania i poprawnych znaków.

Punkt trymu#

Trim jest stanem, w którym przy stałych warunkach suma sił i momentów daje wymagany ruch ustalony. Nie zawsze oznacza lot poziomy: może to być zawis, zakręt ze stałą prędkością kątową, wznoszenie lub cruise.

Model nieliniowy:

x_dot = f(x,u,w)

ma punkt trymu (x0,u0,w0), gdy po uwzględnieniu oczekiwanej kinematyki pochodne dynamiczne spełniają warunki stanu ustalonego. Dla prostego lotu poziomego część x_dot wynosi zero; dla zakrętu yaw/pozycja zmieniają się mimo stałych prędkości body.

Stateczność ocenia się wokół konkretnego trymu. Statek stabilny w cruise może być niestabilny blisko przeciągnięcia albo podczas przejścia VTOL.

Stateczność statyczna#

Po małym zaburzeniu:

dodatnia — początkowa siła/moment dąży do powrotu;
neutralna — brak tendencji do powrotu lub dalszego odejścia;
ujemna — tendencja zwiększa odchylenie.

Dla pitch fixed-wing interesuje nas nachylenie momentu względem kąta natarcia:

C_mα = ∂C_m/∂α

Przy typowej konwencji dodatni pitch nose-up, dodatnia stateczność podłużna wymaga C_mα < 0: wzrost α daje moment nose-down przywracający stan.

Sam znak jednej pochodnej nie gwarantuje dobrego przebiegu dynamicznego, kontroli ani zachowania przy dużym α.

Stateczność dynamiczna#

Dynamiczna odpowiedź może być:

aperiodycznie zbieżna;
oscylacyjnie tłumiona;
neutralna;
oscylacyjnie rozbieżna;
aperiodycznie rozbieżna.

Układ może mieć dodatnią stateczność statyczną, lecz słabe lub ujemne tłumienie dynamiczne. Po pierwszym ruchu w stronę równowagi przeregulowanie rośnie z każdym cyklem.

Dla linearyzacji:

δx_dot = A δx + B δu

wartości własne macierzy A określają mody. Ujemna część rzeczywista oznacza zanikanie w modelu ciągłym. Para zespolona opisuje oscylację o częstotliwości i tłumieniu. Wynik obowiązuje lokalnie wokół punktu trymu.

Stateczność otwartej i zamkniętej pętli#

Open-loop opisuje płatowiec i aktuatory bez aktywnej korekty regulatora. Closed-loop obejmuje sensor, estymator, regulator, mikser, aktuator i dynamikę statku.

zakłócenie → płatowiec → sensory → estymator → regulator → aktuatory
                 ↑__________________________________________|

Naturalnie niestateczny płatowiec może być stabilizowany, jeśli:

niestabilny mod narasta wolniej niż reaguje system;
sensory mają wystarczające pasmo i mały bias;
opóźnienie jest ograniczone;
aktuatory mają siłę, prędkość i zapas;
regulator pozostaje stabilny w całej obwiedni;
awarie są wykrywane i obsługiwane.

„Autopilot to naprawi” bez analizy tych warunków jest nieweryfikowalne.

Stateczność podłużna fixed-wing#

Podłużna obejmuje pitch, prędkość, kąt natarcia i tor pionowy. Główne wkłady tworzą skrzydło, kadłub, usterzenie poziome, napęd i CG.

Neutral point i static margin#

Neutral point jest położeniem CG, dla którego całkowity statek ma neutralną statyczną stateczność podłużną. Zapas stateczności:

SM = (x_NP − x_CG) / c̄

przy osi X rosnącej do tyłu i odpowiedniej konwencji daje dodatni wynik, gdy CG jest przed neutral point. c̄ to mean aerodynamic chord.

Przesunięcie CG do tyłu zmniejsza SM, redukuje wymagany moment trymujący i może zmniejszyć trim drag, ale pogarsza naturalną stateczność. NASA SP-367 wskazuje, że przy CG za neutral point nachylenie momentu prowadzi do niestateczności.

Zbyt przedni CG zwiększa stateczność, lecz może przekroczyć zdolność elevatora do uniesienia nosa przy małej prędkości/lądowaniu. Obwiednia CG ma więc limit przedni i tylny z innych powodów.

Usterzenie poziome#

Statecznik umieszczony za CG działa na ramieniu. Wzrost α zmienia jego siłę i tworzy moment przywracający, jeśli geometria oraz downwash są właściwe.

Współczynnik objętości ogona:

V_H = S_H l_H / (S_W c̄)

jest użytecznym parametrem porównawczym, ale nie projektuje ogona sam. Potrzebne są slope lift, downwash, sprawność dynamic pressure, ster, Re i interferencja śmigła.

T-tail może wejść w cień aerodynamiczny skrzydła przy dużym α. V-tail łączy pitch/yaw i wymaga miksera oraz analizy sprzężeń.

Canard i latające skrzydło#

Canard ma przednią powierzchnię nośną. Projekt stateczny wymaga odpowiedniej kolejności utraty nośności i momentów. Przeniesienie klasycznych reguł ogona bez znaków jest błędne.

Latające skrzydło nie ma osobnego długiego ramienia statecznika. Używa profilu reflex, skosu, skręcenia, elevonów i rozmieszczenia CG. Zakres CG bywa wąski, a błąd kilku milimetrów istotny dla małej cięciwy.

Mody podłużne#

Short period#

Szybka oscylacja głównie α, pitch rate i pitch attitude. Jej tłumienie zależy od aerodynamiki, usterzenia i momentu bezwładności. Regulator rate/attitude działa w podobnym paśmie i może poprawić lub pogorszyć mod.

Phugoid#

Wolna wymiana energii kinetycznej i potencjalnej: prędkość, wysokość i pitch zmieniają się w dłuższym okresie. Phugoid może być słabo tłumiony, mimo stabilnego short period. Regulator prędkości/wysokości musi uwzględniać energię, aby nie pobudzać oscylacji.

Stateczność kierunkowa#

Directional stability dotyczy yaw po zaburzeniu kąta ślizgu β. Statecznik pionowy za CG tworzy efekt chorągiewki: boczny napływ generuje siłę na ogonie i moment kierujący nos w relative wind.

Typowy warunek znaku zależy od konwencji β i momentu C_n; nie należy kopiować C_nβ>0 bez sprawdzenia definicji osi. Ważna jest tendencja fizyczna: po bocznym podmuchu moment zmniejsza ślizg.

Wkład mają również:

boczna powierzchnia kadłuba przed/za CG;
winglets i końcówki;
napęd pusher/tractor oraz spirala strugi;
asymetria silników;
podwozie i payload;
powierzchnie pionowe ramion.

Duża kamera z przodu może przesunąć center of side area przed CG i zmniejszyć stateczność yaw.

Stateczność boczna#

Lateral stability opisuje reakcję roll na ślizg. Wznios skrzydeł powoduje, że boczny napływ zmienia efektywne kąty natarcia skrzydeł i tworzy moment przywracający. Skos, położenie skrzydła i kadłub również wnoszą wkład.

Za duży efekt wzniosu przy słabej stateczności kierunkowej może pogorszyć mody sprzężone. Nie projektuje się roll i yaw niezależnie.

Mody lateral-directional#

Roll subsidence#

Szybko tłumiony mod prędkości roll, wynikający z oporu/tłumienia skrzydeł. Lotki lub różnicowanie ciągu kontrolują roll.

Dutch roll#

Sprzężona oscylacja yaw–roll–sideslip. Statecznik pionowy, wznios, bezwładność i tłumienie określają przebieg. UAV z dużym skosem lub słabym tłumieniem yaw może wymagać yaw damper.

Spiral mode#

Wolna tendencja do zacieśniania lub wychodzenia z zakrętu. Może być lekko niestabilna bez natychmiastowego problemu, jeśli autopilot ją koryguje. Jednak długi lot bez właściwego modu może prowadzić do narastającego banku.

Sterowność fixed-wing#

Statek jest sterowny, gdy powierzchnie/napęd mogą wytworzyć wymagane momenty w całej obwiedni. Authority zależy od dynamic pressure:

τ_control ∝ q S l C_δ δ

Przy małej prędkości klasyczny ster ma mniej siły, a przy dużej może przekroczyć obciążenie serwa/struktury. Propwash może utrzymywać skuteczność ogona przy małym airspeed, ale zależy od mocy.

Sprawdza się:

moment do trymu dla skrajnego CG;
moment odzyskania z dużego α;
roll rate i przeciwstawienie podmuchowi;
yaw przy asymetrii napędu;
zapas wychylenia po trymie;
prędkość i moment serwa;
luzy, ugięcie i saturację.

Ster osiągający mechaniczny limit nie ma dalszej rezerwy dla regulatora.

Multirotor: stateczność naturalna#

Idealny sztywny multirotor w poziomym zawisie nie ma klasycznej aerodynamicznej stateczności attitude wystarczającej do lotu bez regulatora. Małe przechylenie pochyla wektor ciągu i generuje poziome przyspieszenie, ale niekoniecznie moment przywracający orientację.

Flight controller zamyka szybką pętlę rate i zewnętrzną attitude. Zamknięta pętla tworzy oczekiwane zachowanie. Jakość zależy od:

pasma IMU i filtra;
opóźnienia obliczeń;
dynamiki silnik–ESC–śmigło;
ramienia momentu;
bezwładności;
rezerwy ciągu w obu kierunkach zmiany;
saturacji miksera.

W zawisie regulator może wyglądać stabilnie, a utracić margines przy maksymalnym ciągu, gdy wszystkie silniki są blisko górnego limitu i nie można zwiększyć jednej strony.

Control allocation i osiągalny zbiór momentów#

Alokator mapuje żądane F,τ na aktuatory:

u_act = B⁺ [F; τ]

z ograniczeniami u_min ≤ u ≤ u_max. Pseudoodwrotność bez saturacji może dać niewykonalne wartości. Gdy jeden silnik osiąga maksimum, trzeba priorytetyzować osie lub zmniejszyć ciąg zbiorczy.

Zbiór osiągalnych sił/momentów zależy od bieżącego punktu. Przy niskim idle nie da się szybko zmniejszyć ciągu poniżej minimum; przy pełnym gazie brak kierunku „więcej”. Authority yaw może być znacznie mniejsze niż roll/pitch.

Awaria wirnika zmienia macierz B. Hexacopter może zachować część sterowności, ale nie automatycznie pełny zbiór. Analiza musi uwzględnić kierunek uszkodzonego napędu i pozostałe limity.

Stateczność pozycji multirotora#

Stabilna attitude nie oznacza stabilnej pozycji. Pętla position tworzy żądane przyspieszenie, velocity przelicza je na orientację/ciąg, a attitude/rate realizują momenty.

Łańcuch:

position → velocity → acceleration/thrust vector
         → attitude → body rates → moments → motors

Błąd wiatru, tilt limit, brak GNSS i saturacja napędu wpływają na zewnętrzne pętle. Position hold może być stabilny względem błędnego lub skaczącego estymatora, prowadząc statek fizycznie w złą stronę.

Damping od aerodynamiki i napędu#

Prędkość kątowa zmienia lokalny napływ na skrzydła, ramiona i wirniki. Powstają momenty tłumiące. Współczynniki C_mq, C_lp, C_nr opisują lokalnie to zjawisko w fixed-wing.

Multirotor ma damping aerodynamiczny łopat i elektroniczny od regulatora RPM/komutacji. Model T=kω² bez napływu może niedoszacować tłumienia lub sił podczas szybkiej rotacji.

Masa, CG i bezwładność#

Przesunięcie CG zmienia momenty trymu i zapas stateczności fixed-wing. W multirotorze offset od środka geometrycznego wymaga stałej różnicy ciągu. Może zmniejszyć authority i zwiększyć temperaturę jednej strony.

Moment bezwładności decyduje o przyspieszeniu dla danego momentu. Payload daleko od CG zwiększa I, nawet jeśli CG pozostaje w tym samym miejscu dzięki przeciwwadze. Ten sam zestaw gainów może wtedy dać wolną odpowiedź lub nadmierne przeregulowanie.

Iloczyny bezwładności sprzęgają osie. Masa i środek ciężkości opisuje obliczenia.

Saturacja i integral windup#

Gdy żądany moment przekracza możliwości, regulator może akumulować całkę. Po ustaniu zaburzenia duża całka utrzymuje błędne wyjście. Anti-windup powinien znać rzeczywisty wynik alokatora, nie tylko surowe ograniczenie PID.

Symptomy braku authority:

jeden lub więcej aktuatorów długo na limicie;
rosnący błąd mimo rosnącego polecenia;
gwałtowne odbicie po wyjściu z saturacji;
utrata wysokości przy dużym bank;
niesymetryczne temperatury silników;
stały trym blisko końca zakresu serwa.

Zwiększenie gainu nie tworzy brakującego momentu.

Opóźnienie i margines fazy#

Sensor, filtr, scheduler, protokół, ESC, silnik i śmigło dodają opóźnienie. Przy częstotliwości f opóźnienie τ daje przesunięcie fazy:

φ_delay = −2π f τ

10 ms to tylko 3,6° przy 1 Hz, ale 72° przy 20 Hz. Dlatego filtr poprawiający szum może destabilizować szybką pętlę, jeśli wnosi zbyt duże opóźnienie.

Margines gain/phase ocenia odporność na niepewność. Samo „nie oscyluje w jednym teście” nie dowodzi stabilności przy zmianie masy, napięcia i temperatury.

Stateczność a estymator#

Regulator zamyka pętlę na estymowanym stanie. Bias gyro może wyglądać jak stały rate, błąd osi jak odwrócony moment, a opóźniona vision pose jak dodatkowa faza.

Należy testować:

poprawność znaków i frame'ów;
timestamp oraz opóźnienie;
przejście GNSS/vision;
skok originu i loop closure SLAM;
odrzucenie sensora;
magnetyczny yaw disturbance;
nasycenie i clipping IMU.

Układ może być matematycznie stabilny dla prawdziwego stanu, a niestabilny z błędnym estymatorem.

Sterowność i obserwowalność modelu#

Dla linearyzacji (A,B,C) macierz sterowności:

Co = [B, AB, A²B, ...]

oraz obserwowalności:

Ob = [C; CA; CA²; ...]

pozwalają sprawdzić, czy lokalne mody można pobudzić aktuatorami i odtworzyć sensorami. Pełny rząd jest warunkiem modelowym, nie gwarancją jakości przy ograniczeniach, szumie i nieliniowości.

Praktycznie: yaw bez magnetometru/GNSS heading/vision może być względnie obserwowalny tylko przez gyro i dryfować. Pozycja bez zewnętrznego odniesienia integruje błąd IMU. Aktuator o zbyt małym ramieniu może formalnie sterować osią, ale z nieakceptowalnym zapasem.

Gain scheduling#

Dynamika fixed-wing zależy od dynamic pressure, a multirotora od napięcia, RPM i obciążenia. Jeden zestaw gainów może nie zapewnić tych samych biegunów w całej obwiedni.

Gain scheduling dobiera parametry według airspeed, tilt, trybu, masy lub innych zmiennych. Harmonogram musi być ciągły i odporny na błędny scheduling variable. Jeśli airspeed sensor zawiedzie, regulator nie powinien przejść do agresywnego gainu dla złego punktu.

Alternatywy obejmują sterowanie robust/adaptive, ale zwiększają wymagania weryfikacyjne. Złożoność nie zastępuje danych.

VTOL w przejściu#

Przejście zmienia macierz sterowania oraz naturalną dynamikę:

skrzydło przejmuje lift;
wirniki tracą lub zmieniają authority;
stery aerodynamiczne zyskują skuteczność z q;
gondole tworzą momenty żyroskopowe;
przepływ na usterzeniu zależy od napędu;
frame reprezentacji może się zmieniać.

Blending dwóch regulatorów na podstawie czasu jest słaby, jeśli airspeed różni się od założenia. Lepszy harmonogram używa stanu aerodynamicznego i sprawdza osiągalność aktuatorów. Strefa, w której ani wirniki, ani stery nie mają wystarczającej authority, jest luką projektu.

Failsafe a stateczność#

Po utracie sensora lub łącza system wybiera tryb, ale musi pozostać sterowalny z dostępnymi danymi. Return-to-home wymaga wiarygodnej pozycji i headingu. Kontynuacja fixed-wing bez airspeed może używać groundspeed/attitude, lecz ma inne marginesy w wietrze.

Degraded mode powinien mieć:

jawny zestaw dostępnych stanów;
ograniczoną obwiednię;
własne gainy/limity;
warunek przejścia i brak oscylacji między trybami;
test HIL i bezpieczny test fizyczny.

Projektowanie zapasu stateczności#

Większy static margin nie zawsze oznacza lepszy statek. Zwiększa moment przywracający, ale może zwiększyć wymagany moment trymu, opór i siłę steru. Mniejszy margines poprawia część osiągów, lecz wymaga aktywnego systemu i bardziej rygorystycznej niezawodności.

Proces fixed-wing:

oszacuj aerodynamic center/neutral point metodą analityczną;
wybierz wstępny zakres CG i ogon;
policz C_mα, trim i control authority w obwiedni;
zweryfikuj CFD/tunelem;
uwzględnij napęd, flap, podwozie i payload;
zbuduj model dynamiczny;
wykonaj testy narastające z przednim CG;
ustal zatwierdzoną obwiednię konfiguracji.

Nie przesuwa się CG do tyłu „aż będzie dobrze latał” bez pomiaru i planu.

Projektowanie multirotora#

Ustal CG blisko środka osiągalnego ciągu.
Wyznacz tensor bezwładności i momenty napędów.
Zmierz dynamikę silnik–ESC–śmigło.
Zbuduj alokator z ograniczeniami.
Zapewnij zapas góra/dół wokół punktu zawisu.
Zidentyfikuj rezonanse i filtruj minimalnie potrzebnie.
Strojenie zaczynaj w symulacji/stanowisku.
Waliduj przy masach, napięciach i payloadach skrajnych.

Duży TWR poprawia authority w górę, ale ciężkie śmigła i silniki mogą zwiększyć bezwładność oraz opóźnienie. Parametry muszą być rozpatrywane razem.

Metody oceny#

Analiza statyczna#

Krzywe momentu względem α, β i wychyleń sterów. Pozwalają znaleźć trim, nachylenie stateczności i authority.

Analiza modalna#

Linearyzacja i wartości własne w wielu punktach obwiedni. Pokazuje lokalne mody, ale wymaga poprawnego modelu.

Symulacja nieliniowa#

SITL/HIL z saturacją, opóźnieniami, wiatrem i awariami. Scenariusze powinny obejmować przejścia oraz skraje.

Tunel/stanowisko#

Pomiary sił i momentów, skuteczności sterów, propwash i damping. Mały model wymaga podobieństwa Re/Mach albo korekty.

Identyfikacja lotna#

Małe wymuszenia w bezpiecznej obwiedni, zsynchronizowane logi i dopasowanie parametrów. Walidacja na oddzielnym locie.

Próby narastające#

Bezpieczna kolejność dla nowego fixed-wing:

kontrola masy/CG i kierunków sterów;
test zawiasów, luzów i obciążenia serw;
model/symulacja;
szybki przejazd lub rzut bez napędu tylko jeśli procedura jest odpowiednia dla skali;
lot w środku konserwatywnej obwiedni;
małe doublety sterów;
rozszerzanie airspeed, CG i konfiguracji pojedynczo;
analiza logu po każdym kroku.

Nie łączy się jednocześnie nowego CG, nowego firmware, większego śmigła i innego payloadu, bo nie da się przypisać efektu.

Logi#

Do oceny potrzebne są:

attitude i body rates;
wartości zadane;
wyjścia przed i po alokacji;
saturacje i integral state;
airspeed, groundspeed i wiatr;
α/β, jeśli mierzone/estymowane;
RPM/telemetria napędu;
pozycje sterów, najlepiej rzeczywiste;
napięcie i temperatury;
tryby, reset i health sensorów.

Analiza tylko attitude nie rozróżni braku authority od błędu gainu.

Typowe błędne diagnozy#

Obserwacja	Nie wyciągaj od razu wniosku	Sprawdź
oscylacja pitch	„P za wysokie”	CG, luz steru, airspeed, opóźnienie, short period
powolne odchodzenie bank	„IMU dryfuje”	spiral mode, wiatr, asymetria, trim
yaw w zakręcie	„ster kierunku odwrotnie”	adverse yaw, β, koordynacja
utrata wysokości w roll	„za mało throttle”	tilt compensation i saturacja
stabilnie bez payloadu, źle z nim	„trzeba inne PID”	CG, inertia, opór i elastyczność
niestabilnie przy niskim napięciu	„bateria zła”	dynamika napędu i brak authority
poprawnie w SITL, źle fizycznie	„sensor wadliwy”	model aktuatora, opóźnienie, rezonans

Kryteria jakości#

Zamiast „lata stabilnie” raportuj:

czas narastania i przeregulowanie;
damping ratio i częstotliwość modu;
margines gain/phase albo zapas robust;
maksymalny błąd po podmuchu;
czas powrotu;
procent saturacji aktuatorów;
zapas steru/momentu;
wrażliwość na masę, CG i napięcie;
odpowiedź w degraded mode.

Kryteria dobiera się do misji. Platforma fotograficzna ma inne limity niż szybki badawczy fixed-wing.

Stateczność strukturalna i aeroelastyka#

Sztywność nie jest nieskończona. Ugięcie skrzydła zmienia wznios i kąt, link steru wprowadza opóźnienie, a ramię multirotora drga. Regulator może pobudzić mod strukturalny, którego nie ma w modelu bryły sztywnej.

Flutter jest samowzbudnym sprzężeniem aerodynamiki, sprężystości i bezwładności. Nie jest zwykłym „wibracyjnym PID”. Zwiększanie prędkości bez analizy może prowadzić do gwałtownej utraty struktury.

Filtry notch zmniejszają reakcję regulatora na rezonans, ale nie zwiększają marginesu flutter i nie naprawiają luzu.

Pewność danych#

Neutral point z prostego kalkulatora jest szacunkiem. CG z pomiaru wag ma niepewność. Pochodne z CFD zależą od modelu, a identyfikacja od pobudzenia. Obwiednia operacyjna powinna zawierać margines na te błędy.

Portal oznacza:

potwierdzone pomiarem;
producent deklaruje;
źródła publiczne podają;
szacunek/model;
informacja niepotwierdzona.

Niepewny neutral point nie może być podstawą ustawienia CG dokładnie na granicy.

Wnioski#

Stateczność to reakcja po zaburzeniu, sterowność to możliwość narzucenia ruchu, a trim to równowaga w konkretnym punkcie. Fixed-wing może mieć naturalną stateczność zależną od CG i usterzenia; multirotor opiera się głównie na aktywnej pętli.

Bezpieczny projekt łączy aerodynamikę, masę, sensory, opóźnienia i ograniczenia aktuatorów. Regulator nie naprawi braku momentu, błędnego CG, odwrotnej osi ani aeroelastyki. Najsilniejszy dowód daje zgodność analizy, symulacji, testu naziemnego i stopniowo rozszerzanego lotu w całej zatwierdzonej obwiedni.

Przypisy

NASA SP-367: Introduction to the Aerodynamics of Flight [monografia techniczna]
FAA: Pilot’s Handbook of Aeronautical Knowledge [podręcznik instytucji lotniczej]
FAA-H-8083-1B: Aircraft Weight and Balance Handbook [podręcznik instytucji lotniczej]
Sumit Sharma, „Drone Development from Concept to Flight” [książka]
Ty Audronis, „Drony. Wprowadzenie” [książka]