Jak działa quadrocopter

Quadrocopter utrzymuje się w powietrzu dzięki czterem wirnikom o stałym skoku, których prędkości są zmieniane setki lub tysiące razy na sekundę. Nie ma naturalnej stateczności typowego samolotu: kontroler lotu stale mierzy ruch, estymuje orientację i koryguje momenty. Rama, śmigła, silniki, ESC, akumulator i algorytm tworzą jeden układ dynamiczny.

Siła pojedynczego wirnika#

W statycznym przybliżeniu ciąg wirnika rośnie w przybliżeniu z kwadratem prędkości kątowej:

T = kT · omega²
Q = kQ · omega²

T jest ciągiem, Q momentem aerodynamicznym, a współczynniki zależą od średnicy, skoku, profilu, gęstości powietrza i warunków napływu. Zależność kwadratowa jest lokalnym modelem; przy szybkich zmianach dochodzi bezwładność wirnika, dynamika ESC i przepływ przez sąsiednie śmigła.

W zawisie suma ciągów równoważy ciężar. Dla masy m:

T1 + T2 + T3 + T4 = m · g

Każdy silnik pracuje wtedy w pobliżu jednej czwartej ciężaru, ale tolerancje napędu, położenie środka masy i wiatr powodują nierówny podział.

Roll, pitch, yaw i collective#

Zmiana wszystkich obrotów w tym samym kierunku daje collective thrust. Roll powstaje przez różnicę ciągu lewej i prawej strony, pitch przez przód–tył. Yaw korzysta głównie z momentów reakcyjnych par wirujących przeciwnie.

Żądanie	Działanie miksera w układzie X
wzrost wysokości	zwiększyć cztery silniki
roll w prawo	zwiększyć lewą parę, zmniejszyć prawą
pitch do przodu	zwiększyć tylną parę, zmniejszyć przednią
yaw	zwiększyć jedną parę kierunku obrotu i zmniejszyć przeciwną

Znaki zależą od numeracji, orientacji FC i kierunków śmigieł. Jeden błąd znaku zamienia ujemne sprzężenie w dodatnie. Test kierunku korekcji wykonuje się bez śmigieł oraz przez obserwację modelu i wyjść.

Mikser jako alokator#

Mikser przekształca żądany ciąg i trzy momenty w cztery wyjścia. To macierz zależna od położeń oraz osi napędów. Klasyczny quad ma cztery stopnie swobody sterowane czterema aktuatorami, więc po utracie jednego silnika nie zachowuje pełnej sterowalności bez specjalnej strategii.

Wyjścia mają limity. Jeżeli wszystkie silniki są blisko maksimum, nie ma miejsca na zwiększenie jednej strony; regulator musi zmniejszyć collective albo zaakceptować brak momentu. Saturacja prowadzi do windup członu I, jeśli nie jest zwracana do regulatora. W pobliżu minimum występuje podobny problem oraz ryzyko zatrzymania wirnika.

Dynamika obrotowa#

Równanie bryły sztywnej można zapisać:

I · omega_dot + omega × (I · omega) = tau

Macierz bezwładności I zależy od rozmieszczenia masy. Akumulator odsunięty od środka zwiększa bezwładność i zmienia odpowiedź mimo tej samej masy całkowitej. Długa rama potrzebuje większego momentu dla tej samej prędkości kątowej, ale dłuższe ramiona zwiększają moment z danego ciągu.

Wirniki mają własny moment pędu. Szybka zmiana prędkości oraz manewr ramy powodują efekty żyroskopowe, zwykle drugorzędne w małym quadzie, lecz widoczne w agresywnym locie i dużych napędach.

Translacja wymaga przechylenia#

Quad nie ma osobnego napędu poziomego. Przechylając wektor ciągu, tworzy składową poziomą, a traci część pionową. Aby utrzymać wysokość przy kącie phi, całkowity ciąg musi wzrosnąć w przybliżeniu jak 1/cos(phi). Przy 60° potrzebny byłby około dwukrotnie większy ciąg niż w zawisie, pomijając opór i dynamikę.

To wyjaśnia, dlaczego duży kąt, ciężka platforma i słaby zapas napędu prowadzą do utraty wysokości mimo poprawnej pracy regulatora.

Pętle sterowania#

W trybie rate drążek zadaje prędkość kątową. W trybie attitude pętla zewnętrzna zamienia błąd orientacji na żądane rate. Tryby pozycyjne dodają pętle prędkości i pozycji:

pozycja -> prędkość -> przyspieszenie/tilt -> attitude -> rate -> moment -> silniki

Pętle wewnętrzne muszą być szybsze od zewnętrznych. Estimator dostarcza orientację i prędkości; regulator rate korzysta bezpośrednio z żyroskopu lub przetworzonego sygnału. Opóźnienie filtrów zmniejsza margines fazy.

IMU, estymacja i osie#

Żyroskop mierzy prędkość kątową, akcelerometr specific force obejmującą grawitację i przyspieszenie ruchu. W zawisie kierunek grawitacji pomaga korygować dryf roll/pitch; w manewrze akcelerometr nie jest prostym „czujnikiem pionu”. Magnetometr, GNSS i barometr wspierają yaw, pozycję i wysokość.

Montaż IMU musi minimalizować drgania bez tworzenia miękkiego rezonatora. Filtracja usuwa energię poza pasmem sterowania, ale nie naprawia źle wyważonego śmigła. Timestamp próbki i stały okres są równie ważne jak wartość.

Napęd i autorytet sterowania#

Zapas ciągu określa wznoszenie oraz możliwość generowania momentów podczas przechylenia. TWR 2:1 oznacza statyczny maksymalny ciąg dwa razy większy od ciężaru, nie gwarantuje identycznego zachowania dynamicznego. Napięcie spada pod obciążeniem, a ciąg zależy od gęstości powietrza i temperatury.

Autorytet yaw jest zwykle mniejszy niż roll/pitch, bo wynika z różnicy momentu aerodynamicznego, nie z ramienia pełnego ciągu. Śmigła o innym skoku, ducty lub tilt silników zmieniają tę relację.

Energia i czas lotu#

W zawisie wirnik musi stale nadać pęd strudze. Większy łączny dysk wirników obniża disk loading i zwykle poprawia sprawność zawisu. Mały szybki quad ma wysokie obciążenie dysku, dużą moc właściwą i krótki czas lotu. Duże wolniejsze śmigła są sprawniejsze, lecz zwiększają rozmiar, moment bezwładności i wymagania ramy.

Szacunek czasu z pojemności Ah jest niewystarczający. Trzeba znać energię Wh, prąd profilu, sag, rezerwę i sprawność. Dobór akumulatora powinien wynikać z pomiaru całego napędu.

Wpływ geometrii#

Rama X daje symetryczną odpowiedź roll/pitch. Deadcat odsuwa przednie śmigła z pola kamery, ale zmienia ramiona miksera. Środek masy powinien leżeć blisko punktu przecięcia osi i płaszczyzny ciągu. Payload poniżej ramy obniża CG i może działać wahadłowo; elastyczne mocowanie wprowadza dodatkowe mody.

Interakcja strug rośnie przy nakładaniu dysków, osłonach i bliskości ramion. Dane pojedynczego silnika z hamowni nie zawierają tych efektów.

Zakłócenia i stany graniczne#

Podmuch jest zewnętrzną siłą i momentem. Regulator koryguje go tylko w granicach ciągu i pasma. Propwash podczas szybkiego opadania daje turbulentny napływ i zmienne obciążenie łopat. Ground effect zmienia strugę blisko podłoża. Desync ESC lub utrata łopaty jest nagłą zmianą aktuatora, której zwykły quad często nie skompensuje.

Failsafe musi rozróżniać utratę RC, nieważną pozycję, niski akumulator i awarię sensora. „Return” nie jest bezpieczny bez wiarygodnej pozycji; „land” nie zawsze jest właściwy nad wodą lub ludźmi. Reakcję projektuje się jako maszynę stanów.

Proces uruchomienia#

zważyć platformę i zmierzyć środek masy;
sprawdzić sztywność, śruby, śmigła i silniki;
zweryfikować orientację FC oraz wszystkie osie;
bez śmigieł sprawdzić kolejność i kierunki silników;
potwierdzić, że korekcja roll/pitch zwiększa właściwe wyjścia;
skalibrować pomiar napięcia/prądu i RC;
przetestować arming oraz failsafe bez napędu;
wykonać krótki zawis z ustawieniami bazowymi;
sprawdzić log, saturację, wibracje i temperaturę;
dopiero potem rozszerzać obwiednię lotu.

Diagnostyka objawów#

Objaw	Możliwe warstwy
przewraca się przy starcie	kolejność/kierunek silników, śmigła, orientacja, znak miksera
oscyluje wysoko	mechanika, P/D, filtry, opóźnienie, RPM
opada w zakręcie	brak kompensacji collective, niski TWR, sag
dryfuje yaw	asymetria napędu, magnetometr, rama, zły kierunek śmigła
gorące silniki	D-term, szum, uszkodzone łożyska, niewłaściwe śmigło
bounce przy lądowaniu	ground effect, idle, I-term, detekcja lądowania

Model siły i momentu wirnika#

W prostym modelu statycznym:

T_i = kT · ω_i²
Q_i = kQ · ω_i²

T_i jest ciągiem, Q_i momentem reakcyjnym, a ω_i prędkością wirnika. Współczynniki zależą od śmigła, gęstości, napływu i zakresu RPM. Komenda ESC nie jest bezpośrednio ω²: pomiędzy nimi są napięcie, sterownik, silnik, bezwładność i aerodynamika.

W zawisie suma ciągów równoważy ciężar. Każdy z czterech rotorów idealnie daje około mg/4, ale asymetria środka masy wymaga różnych wartości. Zapas ciągu nie służy tylko szybkiemu wznoszeniu; jest potrzebny do momentów, hamowania, wiatru i utrzymania kontroli przy spadku napięcia.

Dynamika bryły sztywnej#

Orientację wygodnie reprezentować kwaternionem, ponieważ kąty Eulera mają osobliwość. Równanie obrotu ma postać:

J·ωdot + ω × (J·ω) = τ

J jest tensorem bezwładności, a τ sumą momentów. Ten sam moment daje mniejsze przyspieszenie osi o większej bezwładności. Długa bateria lub payload daleko od środka może znacząco spowolnić pitch, mimo niezmienionej masy.

Translacja zależy od orientacji wektora ciągu:

m·vdot = R(q)·[0,0,T] + F_aero + m·g

Aby przyspieszyć poziomo, quad przechyla wektor. Pionowa składowa maleje, więc regulator zwiększa całkowity ciąg. Przy dużym przechyleniu wymaganie rośnie jak 1/cos φ; szybko dochodzi do saturacji i utraty wysokości.

Układy osi i znaki#

Firmware może używać NED (x północ/przód, y wschód/prawo, z w dół) albo ENU. Sensory mają własne osie nadrukowane na obudowie, a płytka może być zamontowana obrócona. Transformacje muszą być wykonane raz i w znanej kolejności.

Test znaków wykonuje się bez śmigieł. Przechylenie prawej strony w dół powinno dać odpowiedni znak gyro i wizualizacji. Następnie żądany dodatni moment roll powinien zwiększyć wyjścia silników, które fizycznie podniosą tę stronę. Poprawny model 3D przy złym mikserze nadal kończy się wywróceniem.

Kierunki CW/CCW decydują o znaku yaw. Odwrócenie silnika bez zmiany konfiguracji albo założenie śmigła o złym skoku daje ciąg lub moment niezgodny z macierzą.

Alokator i desaturacja#

Mikser można zapisać macierzowo:

[u1 u2 u3 u4]ᵀ = A · [thrust roll pitch yaw]ᵀ

Macierz A wynika z położeń i kierunków rotorów. Wyniki są ograniczane do zakresu aktuatorów. Jeżeli jedno wyjście przekracza maksimum, proste obcięcie zniekształca wszystkie żądane momenty. Desaturacja przesuwa lub skaluje wektor, zachowując priorytet osi.

Yaw zwykle ma mniejszy autorytet niż roll/pitch, bo korzysta z momentu oporowego śmigieł, nie z dużej różnicy sił na ramionach. Priorytetyzowanie yaw podczas maksymalnego ciągu może odebrać zdolność utrzymania przechylenia. Alokator powinien raportować ograniczenia regulatorowi dla anti-windup.

W konstrukcji nieregularnej ramiona mają różne długości. Standardowy mikser X staje się tylko przybliżeniem. Macierz wyznacza się z wektorów położenia i kierunku ciągu, a następnie weryfikuje na stanowisku.

Silnik, ESC i śmigło jako jeden układ#

Silnika nie dobiera się niezależnie od śmigła i napięcia. KV określa prędkość bez obciążenia na wolt, lecz prąd i moment wynikają z obciążenia. Większa średnica albo skok zwiększa wymagany moment. Zbyt agresywne śmigło może przegrzać silnik i ESC, mimo że statyczny ciąg wygląda atrakcyjnie.

Średnica mocno wpływa na powierzchnię dysku. Większy dysk może wytwarzać ten sam ciąg przy mniejszej prędkości indukowanej i lepszej sprawności zawisu, ale potrzebuje przestrzeni, większego momentu oraz sztywniejszej ramy. Ciężkie śmigło ma większą bezwładność, więc wolniej zmienia RPM.

Dane z thrust standu powinny obejmować ciąg, moment lub moc, prąd, napięcie, RPM i temperaturę dla dokładnej konfiguracji. Krótki pomiar przy pełnym gazie nie dowodzi zdolności ciągłej. Trzeba uwzględnić chłodzenie w locie i gorsze warunki w ciasnej ramie.

Protokoły ESC i telemetria#

PWM oraz OneShot kodują polecenie czasem impulsu. DShot przesyła cyfrową ramkę z sumą kontrolną, dzięki czemu nie wymaga kalibracji zakresu impulsu i wykrywa część błędów. Bidirectional DShot może zwracać informację potrzebną do estymacji RPM.

Cyfrowy protokół nie usuwa opóźnienia napędu ani awarii mocy. Częstotliwość wysyłania wyższa od szybkości aktualizacji regulatora nie tworzy nowych informacji. Timing musi współistnieć z DMA i innymi peryferiami FC.

Telemetria ESC — RPM, prąd, napięcie, temperatura i błędy — jest cenna diagnostycznie, lecz jej definicja zależy od firmware. Prąd pojedynczego ESC może być estymowany z ograniczoną dokładnością. Alarm temperatury powinien mieć znaczenie operacyjne, a nie być tylko polem w OSD.

Aerodynamika wirników#

Wirnik przyspiesza powietrze w dół, tworząc strugę. Sąsiednie rotory, rama i payload zaburzają napływ. Gdy dyski zachodzą na siebie albo pracują blisko płyty, sprawność i hałas mogą się pogorszyć. Osłony zwiększają bezpieczeństwo małych platform, lecz mogą działać jako kanał tylko w określonym zakresie geometrii.

W locie postępowym napływ nie jest symetryczny. Rotor po jednej stronie może pracować w innym przepływie niż drugi. Przy gwałtownym opadaniu wirniki mogą wejść w niekorzystny stan recyrkulacji strugi. Sterowanie wymaga wtedy odpowiedniego ruchu poziomego i zapasu, a nie tylko zwiększenia collective.

Efekt przyziemny zmniejsza moc potrzebną blisko powierzchni, ale nierówna ziemia i ściana powodują asymetrię. Autopilot strojony wyłącznie w tethered hover kilka centymetrów nad podłogą może zachowywać się inaczej w swobodnym locie.

Masa, bezwładność i rozmieszczenie#

Środek masy powinien leżeć blisko przecięcia płaszczyzn rotorów i osi geometrycznych. Przesunięcie wymaga stałej różnicy ciągów, zmniejszając zapas w jednym kierunku. Wysoko położony payload zmienia momenty przy przechyleniu i reakcję na kontakt.

Dwa quady o tej samej masie mogą mieć różną dynamikę, jeżeli jeden skupia elementy w centrum, a drugi ma ciężkie silniki i osprzęt na końcach ramion. Moment bezwładności rośnie z kwadratem odległości. Strojenie PID nie powinno być przenoszone tylko dlatego, że zgadza się masa.

Elastyczna bateria lub payload na miękkim mocowaniu tworzy dodatkowy stopień swobody. Może wzbudzać niskoczęstotliwościowe kołysanie, którego filtr gyro nie rozwiąże. Mocowanie musi utrzymać element także przy maksymalnym współczynniku obciążenia.

Rama i rezonanse#

Rama przenosi siły rotorów do centrum. Jej częstotliwości własne zależą od długości ramion, przekroju, materiału, połączeń i mas końcowych. Włókno węglowe jest sztywne, ale przewodzi i może ekranować RF. Druk 3D pozwala kształtować geometrię, lecz jest anizotropowy i zależny od temperatury.

Rezonans pobudzany harmonicznymi RPM pojawia się w gyro i składniku D regulatora. Dynamic notch oraz RPM filter ograniczają jego wpływ, lecz nie zastępują naprawy pękniętego ramienia, zużytego łożyska albo niewyważonego śmigła. Miękkie mocowanie FC powinno izolować wysokie częstotliwości bez pozwalania płytce na wolny ruch.

Analiza porównuje widmo przed i po zmianie RPM. Częstotliwość rosnąca proporcjonalnie do obrotów wskazuje napęd; stała może pochodzić z konstrukcji lub przetwornicy. Aliasing potrafi przesunąć wysoką harmoniczną w pozornie niższy zakres.

Estymacja orientacji#

Żyroskop dobrze mierzy krótkotrwałą zmianę, ale jego bias całkuje się do dryftu. Akcelerometr widzi sumę grawitacji i przyspieszeń, więc podczas manewru nie jest prostym „czujnikiem pionu”. Magnetometr dostarcza odniesienie yaw, lecz jest podatny na prąd i metal. EKF łączy źródła z modelem oraz ich niepewnością.

W zawisie GNSS może korygować pozycję, ale pętla attitude nadal potrzebuje IMU z małym opóźnieniem. Optical flow mierzy ruch obrazu i wymaga odległości do podłoża oraz tekstury. Barometr wspiera wysokość, lecz propwash i zmiany ciśnienia w obudowie wnoszą błąd.

Awaria sensora nie zawsze wygląda jak brak danych. Zamrożona próbka, zmiana biasu albo błędny timestamp mogą przejść podstawową kontrolę. Estymator monitoruje innowacje, a automat stanów ogranicza tryby wymagające utraconego źródła.

Kaskada regulatorów#

Pętla rate działa najszybciej i steruje momentem. Pętla attitude zamienia błąd orientacji na zadane rate. Pętla velocity generuje żądane przechylenie i ciąg, a position żądaną prędkość. Każda zewnętrzna pętla musi mieć mniejsze pasmo niż wewnętrzna.

Setpointy mają ograniczenia prędkości i przyspieszenia. Skok pozycji nie powinien zamienić się w natychmiastowy maksymalny kąt. Regulator wysokości musi uwzględnić, że dostępny pionowy ciąg maleje podczas przechylenia oraz że maksymalny napęd zależy od napięcia.

Saturacja jest stanem systemu, nie tylko obcięciem liczby. Log powinien zawierać żądania przed i po alokatorze, stany integratorów, RPM oraz napięcie. Bez tego nie wiadomo, czy błąd wynika z tuningu czy fizycznego braku autorytetu.

Budżet ciągu#

Stosunek maksymalnego ciągu do ciężaru liczony z danych stanowiskowych jest wskaźnikiem, ale nie pełnym projektem. Maksymalny ciąg powinien być dostępny przy napięciu odpowiadającym końcowej fazie misji, nie tylko na świeżym pakiecie. Ciąg czterech rotorów nie zawsze jest dokładnie sumą testów pojedynczych ze względu na interferencję.

Budżet obejmuje:

zawis przy masie maksymalnej;
kompensację przechylenia i wiatru;
momenty dla roll/pitch/yaw;
degradację baterii i temperatury;
tolerancje silników i śmigieł;
payload oraz przewidywany wzrost masy;
procedurę awaryjnego lądowania.

Quad nie jest zwykle odporny na utratę jednego silnika. Hexa lub octo może mieć geometryczną możliwość sterowania po awarii, lecz potrzebuje odpowiedniego alokatora, zapasu ciągu i wykrycia uszkodzenia. Sama liczba rotorów nie gwarantuje bezpiecznej redundancji.

Energia i wybór punktu pracy#

Moc zawisu zależy od disk loading. Zwiększenie masy wymaga więcej niż proporcjonalnego wzrostu mocy w idealnym modelu indukowanym. Dodawanie baterii daje malejący przyrost czasu: dodatkowa energia zwiększa również ciężar.

Profil misji zawiera start, wznoszenie, lot poziomy, zawis z payloadem, wiatr i rezerwę. Prąd średni z jednego spokojnego zawisu w pomieszczeniu jest słabą podstawą. Rejestruje się Wh, ponieważ samo mAh nie pozwala porównywać różnych napięć.

Duże śmigła i niskie RPM sprzyjają sprawności zawisu, a mniejsze dają kompaktowość i często szybszą odpowiedź. Punkt pracy wybiera się z uwzględnieniem hałasu, bezpieczeństwa, transportu i zdolności sterowania, nie tylko czasu lotu.

Zachowanie po utracie funkcji#

Utrata RC, GNSS, barometru, jednego IMU i energii to różne awarie. Dla każdej istnieje wykrycie, czas potwierdzenia, stan przejściowy i akcja. Return-to-home jest sensowny tylko przy wiarygodnej pozycji, wysokości i zapasie energii. Przy podejrzanym GNSS może zwiększyć ryzyko.

Brownout FC może zresetować cały automat, dlatego avionika ma stabilizowane zasilanie i log przyczyny resetu. Odbiornik podający ostatnie kanały bez flagi utraty nie pozwala kontrolerowi podjąć właściwej decyzji. Testy wykonuje się bez śmigieł i w SITL przed lotem.

Po odzyskaniu sensora lub łącza nie należy bezwarunkowo skakać do poprzedniego trybu. Potrzebna jest histereza, ocena jakości i bezudarowe przejęcie setpointów.

Plan uruchomienia platformy#

Zweryfikować masę, CG, geometrię, kierunki silników i właściwe śmigła.
Bez śmigieł sprawdzić osie IMU, mikser, protokół ESC i failsafe.
Zmierzyć każdy napęd na stanowisku oraz pobór avioniki.
Uruchomić logowanie gyro, PID, wyjść, RPM, napięcia i stanów ograniczeń.
Wykonać krótki test przyziemny lub tethered tylko w zakresie, który nie zmienia dynamiki.
Pierwszy swobodny zawis przeprowadzić nisko, ale poza silnym efektem przyziemnym.
Ocenić temperatury, widmo drgań, tracking rate i zapas napędu.
Stopniowo zwiększać kąty, prędkości, wiatr i masę.
Osobno testować tryby pozycyjne oraz kontrolowane stany awaryjne.

Każdy etap ma kryterium przerwania: nietypowy dźwięk, wzrost temperatury, clipping IMU, trwała saturacja, utrata ramek lub niespójność estymatora. „Jeszcze jeden lot” nie jest metodą diagnostyczną.

Powiązane tematy#

Przypisy#

R. Beard, T. McLain, Small Unmanned Aircraft: Theory and Practice — dynamika i sterowanie multirotorem.
PX4 Controller Diagrams — kaskada regulatorów i alokacja.
NASA — Guide to Aerodynamics — siły i ruch statku powietrznego.
UIUC Propeller Database — dane eksperymentalne małych śmigieł.

Źródła z centralnego rejestru

Terry Kilby, Belinda Kilby, „Make: Drony dla początkujących” [książka]
Sumit Sharma, „Drone Development from Concept to Flight” [książka]
Ty Audronis, „Drony. Wprowadzenie” [książka]