Nawigacja inercyjna pozwala pojazdowi wyznaczać orientację, prędkość i położenie bez ciągłego obserwowania świata zewnętrznego. Jej podstawą nie jest „żyroskop pokazujący kierunek”, lecz cały łańcuch: trójosiowe pomiary ruchu, kalibracja, warunki początkowe, mechanizacja równań, model Ziemi i grawitacji, reprezentacja orientacji, estymacja błędów, zarządzanie czasem oraz kontrola integralności rozwiązania.

W pocisku INS zwykle dostarcza szybki i autonomiczny stan do układów naprowadzania oraz autopilota. GNSS, radar, barometr, obraz terenu albo dane platformy mogą korygować dryf, lecz nie zamieniają IMU w głowicę naprowadzającą i nie usuwają potrzeby mechanizacji. Ta sama jednostka pomiarowa może dawać zupełnie różną jakość rozwiązania zależnie od orientowania początkowego, temperatury, oprogramowania i danych kalibracyjnych.

Artykuł wyjaśnia platformy stabilizowane i bezplatformowe, akcelerometry, żyroskopy mechaniczne, RLG, FOG i MEMS, korekcje ruchu wewnątrz interwału, orientowanie, wspomaganie GNSS, filtry Kalmana, nadmiarowość, BIT oraz weryfikację i walidację. Nie zawiera parametrów współczesnych wojskowych IMU, procedur inicjalizacji konkretnego uzbrojenia, wartości strojenia filtrów, interfejsów kryptograficznych ani metod omijania zakłóceń GNSS.

Problem systemowy: od czujnika do stanu z granicą zaufania

Inercyjna jednostka pomiarowa (IMU) nie podaje pozycji. Dostarcza trójosiowe inkrementy kąta lub prędkość kątową oraz siłę właściwą. System nawigacji inercyjnej (INS) dodaje do nich czas, dane kalibracyjne, orientację początkową, model grawitacji i Ziemi, numeryczną mechanizację oraz estymator błędów. Dopiero ten łańcuch publikuje orientację, prędkość i położenie. Jednostka odniesienia inercyjnego (IRU) może natomiast dostarczać przede wszystkim orientację; nazwa obudowy nie rozstrzyga jej funkcji.

Akcelerometr nie obserwuje grawitacji wprost, lecz siłę właściwą: dlatego w spoczynku rejestruje reakcję podłoża, a w idealnym swobodnym spadku dąży do zera. Żyroskop nie zna absolutnego kursu; mierzy ruch kątowy, który po skorygowaniu przesunięcia zera, skali i nieortogonalności jest całkowany. Platforma stabilizowana utrzymuje odniesienie mechanicznie, a układ bezplatformowy (strapdown) odtwarza je numerycznie z czujników przytwierdzonych do korpusu.1

Najgroźniejsze błędy powstają między tymi warstwami. Mały błąd orientacji rzutuje grawitację na oś poziomą, a podwójne całkowanie zamienia go w szybko rosnący błąd położenia. Niedokładny czas używa poprawnego pomiaru w niewłaściwej chwili. Błędna dźwignia między anteną i IMU przypisuje obrót do translacji. Z kolei niewłaściwy model niepewności może oznaczyć rozwiązanie jako wiarygodne właśnie wtedy, gdy rzeczywisty błąd rośnie.

Zewnętrzne wspomaganie — GNSS, barometr, radar, obraz terenu lub dane platformy — nie zastępuje INS. Dostarcza obserwacji, z którymi estymator porównuje przewidywany stan i koryguje te składniki błędu, które są w danej geometrii obserwowalne.2 Wynikiem dojrzałego rozwiązania nie jest więc samotna trójka współrzędnych, lecz stan opatrzony czasem, niepewnością, trybem pracy i ostrzeżeniem o integralności.

Od pomiaru do rozwiązania nawigacyjnego

Najkrótszy poprawny przepływ wygląda tak:

ŻYROSKOPY → Δkąta / prędkość kątowa ┐
                                 ├→ KOREKCJA IMU → MECHANIZACJA INS
AKCELEROMETRY → Δprędkości       ┘        ↓
                                  orientacja, prędkość, położenie
GNSS / BARO / RADAR / OPTYKA → ESTYMATOR BŁĘDÓW
                                        ↓ korekty
                              ROZWIĄZANIE NAWIGACYJNE
                                        ↓
                      NAPROWADZANIE / AUTOPILOT / ZAPALNIK

Mechanizacja może działać z wysoką częstotliwością, a filtr wspomagania z niższą. Pomiary mogą docierać asynchronicznie. Rozwiązanie powinno zawierać co najmniej stan, znacznik czasu, status, tryb, niepewność oraz flagi jakości. Sam wektor trzech współrzędnych nie informuje, czy powstał z pełnego INS/GNSS, krótkiej propagacji autonomicznej, czy po wykrytej awarii osi.

NASA definiuje współczesne pakiety od czujników jednoosiowych przez IRU z trzema żyroskopami po IMU zawierające trzy żyroskopy i trzy akcelerometry.7 Nazwy handlowe bywają luźne, dlatego w analizie trzeba sprawdzić fizyczne kanały i funkcję oprogramowania.

Układy współrzędnych

Nawigacja nie ma sensu bez jawnego układu. Ta sama trójka liczb może opisywać odczyt elementu pomiarowego, prędkość płatowca albo pozycję względem Ziemi:

Układ Z czym jest związany Konsekwencja dla obliczeń
czujnika z rzeczywistymi, nieidealnie ortogonalnymi osiami elementów macierz kalibracji opisuje skalę, nieortogonalność i czułość poprzeczną
korpusu z nominalnymi osiami płatowca orientacja czujnik–korpus jest wynikiem montażu i pomiaru
lokalnego horyzontu, np. NED albo ENU z pionem i kierunkami lokalnymi ułatwia interpretację wysokości i kursu, lecz obraca się podczas ruchu po Ziemi
ECEF ze środkiem i obrotem Ziemi obiekty naziemne są w przybliżeniu stałe, ale równania prędkości zawierają obrót planety
ECI ze środkiem Ziemi, lecz nie z jej obrotem dogodny dla dynamiki kosmicznej; przejście do ECEF wymaga dokładnego czasu i modelu orientacji Ziemi

Znak osi, handedness, jednostki, odniesienie wysokości i kolejność rotacji muszą być elementem interface control document. Liczba 52.2 może oznaczać szerokość geodezyjną w stopniach, radiany, współrzędną kartezjańską albo indeks. Bez metadanych jest niebezpieczna.

Czas jako czwarty wymiar stanu

IMU próbkuje szybko, GNSS wolniej, a wiadomość może przyjść z opóźnieniem. Estymator powinien znać:

  • czas fizycznego pomiaru;
  • czas odebrania wiadomości;
  • opóźnienie toru;
  • niepewność zegara;
  • kolejność próbek;
  • epokę układu współrzędnych;
  • sposób obsługi rollover i resetu.

Przy prędkości $v$ błąd czasu $\Delta t$ daje pierwsze przybliżenie błędu położenia $v\Delta t$. Przy obrocie błąd synchronizacji między żyroskopem i akcelerometrem powoduje transformację siły za pomocą orientacji z innej chwili. To może wyglądać jak przesunięcie zera osi.

Synchronizacja przez wspólny impuls sekundowy (PPS) nie gwarantuje, że znacznik czasu dotyczy początku integracji. Trzeba rozróżnić chwilę pomiaru, przedział całkowania i opóźnienie toru. W fotogrametrii bezpośrednie georeferencjonowanie również wymaga wspólnego czasu, wektora dźwigni i orientowania GNSS/INS względem kamery; lokalna monografia Kurczyńskiego pokazuje, że błąd całego łańcucha nie redukuje się do dokładności odbiornika.9

Co mierzy akcelerometr

Idealny akcelerometr mierzy siłę właściwą (specific force):

$$\mathbf f = \mathbf a - \mathbf g$$

gdzie $\mathbf a$ jest przyspieszeniem kinematycznym w odpowiednim układzie, a $\mathbf g$ przyspieszeniem grawitacyjnym. Zapis jest uproszczony; w układzie obracającym się dochodzą składniki Coriolisa i obrotu układu lokalnego podczas przemieszczania.

Pojazd stojący na stole ma $\mathbf a\approx0$, ale podłoże wywiera siłę równoważącą grawitację. Akcelerometr wskazuje więc około 1 g w osi pionowej. W idealnym swobodnym spadku obudowa i masa sejsmiczna przyspieszają razem grawitacyjnie, dlatego wskazanie dąży do zera.

To rozwiązuje popularny paradoks: INS „dodaje grawitację” do pomiaru siły właściwej, aby odzyskać przyspieszenie translacyjne w układzie nawigacyjnym. Jeżeli orientacja jest błędna, wektor grawitacji zostaje dodany w niewłaściwym kierunku.

Mechanika akcelerometru

Podstawowy model to masa $m$, sprężyna $k$ i tłumik $c$:

$$m\ddot x+c\dot x+kx=-ma_{base}$$

Przemieszczenie masy względem obudowy jest miarą przyspieszenia w określonym paśmie. Akcelerometr z równoważeniem siłowym utrzymuje masę blisko położenia zerowego, a prąd pętli staje się miarą siły. Zwiększa liniowość i zakres, ale dodaje czujnik położenia, aktuator oraz regulator. Lokalna monografia metrologiczna Piotrowskiego opisuje oba modele i podkreśla wpływ rezonansu, tłumienia oraz mocowania.8

MEMS wykorzystuje mikromechaniczną masę i pojemnościowy lub inny odczyt. Mała masa, objętość i moc nie usuwają temperaturowego przesunięcia zera, prostowania drgań ani czułości poprzecznej. Bardzo duże przyspieszenie może nasycić kanał albo trwale uszkodzić zawieszenie.

Co mierzy żyroskop

Żyroskop mierzy prędkość kątową albo inkrement kąta względem określonego odniesienia. Pomiar można zapisać:

$$\boldsymbol\omega_m=(\mathbf I+\mathbf S+\mathbf M)\boldsymbol\omega+\mathbf b+\mathbf n$$

gdzie $\mathbf S$ reprezentuje błędy skali, $\mathbf M$ nieortogonalność i czułość poprzeczną, $\mathbf b$ przesunięcie zera, a $\mathbf n$ szum. W praktyce składniki zależą od temperatury, czasu, wibracji i historii włączenia.

Żyroskop nie pokazuje północy sam z siebie. Dokładny czujnik może obserwować obrót Ziemi i pomóc w żyrokompasowaniu, ale wymaga znanej szerokości, poziomowania, czasu oraz wystarczająco małego przesunięcia zera. W krótkim systemie wysokodynamicznym kierunek początkowy często pochodzi z zewnętrznego orientowania.

Studium I: od przesunięcia zera do błędu położenia

Dla stałego błędu prędkości kątowej $b_g$ błąd kąta rośnie w przybliżeniu:

$$\delta\theta(t)\approx b_g t$$

Ten kąt obraca grawitację. Dla małego błędu pochylenia pozorne przyspieszenie poziome ma wartość około $g\delta\theta$. Jeżeli układ zaczyna od poprawnego stanu, a przesunięcie zera jest stałe, kolejne całkowania dają

$$\delta v_g(t)\approx\frac{1}{2}g b_g t^2, \qquad \delta r_g(t)\approx\frac{1}{6}g b_g t^3.$$

Przyjmijmy wyłącznie dydaktyczne wartości $b_g=10^{-5} \mathrm{rad/s}$, przesunięcie zera akcelerometru $b_a=2\cdot10^{-4} \mathrm{m/s^2}$ i czas $t=100 \mathrm{s}$. Nie są to parametry żadnego pocisku. Błąd kąta osiąga $0{,}001 \mathrm{rad}$, a końcowe pozorne przyspieszenie poziome około $0{,}009807 \mathrm{m/s^2}$. Składnik pochodzący z żyroskopu daje około $0{,}4903 \mathrm{m/s}$ błędu prędkości i $16{,}34 \mathrm{m}$ błędu położenia. Bezpośrednie przesunięcie zera akcelerometru daje w tym samym uproszczeniu $0{,}0200 \mathrm{m/s}$ i $1{,}00 \mathrm{m}$.

Rachunek nie jest prognozą dokładności kompletnego INS: pomija krzywiznę Ziemi, sprzężenia Schulerowskie, ruch pojazdu, zmienność błędów i korekty estymatora. Izoluje jeden mechanizm i pokazuje, dlaczego doskonały akcelerometr nie uratuje rozwiązania z niedostatecznie znanym pochyleniem.

Klasy błędów IMU

Czujnik nie ma jednego „dryfu”. Różne mechanizmy mają inny związek z wejściem, temperaturą, pasmem i czasem, dlatego wymagają innych prób:

Składnik błędu Jak zmienia pomiar Co pomaga go odróżnić
przesunięcie zera i jego niestabilność dodaje sygnał przy zerowym wejściu; część zmienia się między uruchomieniami i z temperaturą wielopołożeniowa kalibracja, wygrzanie, seria uruchomień i analiza Allana
błąd skali i nieliniowość błąd rośnie wraz z rzeczywistym wejściem, czasem nieliniowo kilka znanych poziomów pobudzenia w obu kierunkach
nieortogonalność i czułość poprzeczna sygnał jednej osi pojawia się w innej pobudzanie osi osobno oraz estymacja pełnej macierzy, nie trzech niezależnych współczynników
biały szum i błądzenie losowe całkowanie szumu prędkości kątowej lub siły tworzy błądzenie kąta albo prędkości charakterystyka widmowa i wariancja Allana w wielu czasach uśredniania
wrażliwość żyroskopu na przyspieszenie i prostowanie drgań ruch oscylacyjny może utworzyć niezerową średnią próby dynamiczne w reprezentatywnym widmie, których nie zastępuje test statyczny
kwantyzacja, nasycenie i obcięcie usuwa małe inkrementy albo szczyt sygnału poza zakresem analiza zakresu, rozdzielczości i flag przepełnienia dla pełnej dynamiki

Kalibracja kompensuje tylko tę część mechanizmu, którą model rozpoznaje i której współczynniki zachowują ważność. Błąd montażu całej IMU do płatowca jest odrębny od nieortogonalności elementów wewnątrz obudowy, a filtr cyfrowy nie odzyska próbki obciętej przez tor analogowy.

Platforma stabilizowana

W klasycznej platformie żyroskopy, akcelerometry i mechaniczny układ odniesienia znajdują się w zawieszeniu kardanowym. Serwa przeciwdziałają obrotowi pojazdu, utrzymując platformę w zadanej orientacji. Kąty ram zawieszenia opisują orientację, a akcelerometry mierzą w osiach zbliżonych do nawigacyjnych.

Zaletą jest fizyczne odseparowanie sensorów od dużych obrotów korpusu i mniejsze wymagania obliczeniowe historycznej elektroniki. Kosztem są:

  • łożyska, slip rings, torquers i serwa;
  • tarcie oraz luzy;
  • gimbal lock lub ograniczenie kątowe;
  • objętość, masa i złożoność;
  • wymagania uruchomienia i kalibracji mechanicznej.

Minuteman jest ważnym przykładem długowiecznej platformy inercyjnej. Program Guidance Replacement zastąpił zestawy naprowadzania NS-20 nowymi NS-50; według komunikatu USAF wymienił komputer i oprogramowanie, nadal wykorzystując istniejącą platformę żyrostabilizowaną.10 Pokazuje to, że INS jest zbiorem elementów konfiguracji: część pomiarowa może pozostać, gdy jej interfejs, kalibracja i zachowanie są zgodnie odtworzone przez nową elektronikę.

INS bezplatformowy (strapdown)

Układ bezplatformowy przytwierdza co najmniej trzy żyroskopy i trzy akcelerometry do pojazdu. Komputer utrzymuje transformację korpus–układ nawigacyjny i obraca siłę właściwą do układu nawigacyjnego. NASA opisuje ten podział jako czujniki zamocowane do korpusu, numeryczne odniesienie orientacji, transformację przyspieszeń i obliczenie prędkości oraz położenia.1

Podstawowe kroki dla każdego interwału są następujące:

  1. odebrać inkrementy kąta $\Delta\boldsymbol\theta$ i prędkości $\Delta\mathbf v$;
  2. poprawić je kalibracją i temperaturą;
  3. wykonać coning/sculling compensation;
  4. zaktualizować orientację;
  5. obrócić siłę właściwą do układu nawigacyjnego;
  6. dodać grawitację i składniki związane z obracającym się układem;
  7. scałkować prędkość;
  8. zaktualizować położenie;
  9. propagować status oraz niepewność;
  10. zastosować korekty estymatora, jeśli przyszły obserwacje wspomagające.

Strapdown usuwa gimbale, ale przenosi trudność do sensorów o dużym zakresie dynamicznym, szybkich obliczeń i algorytmów obrotu. Postęp komputerów cyfrowych umożliwił tę zmianę, ponieważ transformacje muszą być wykonywane w każdej próbce.1

Mechanizacja prędkości i położenia

W lokalnym układzie obracającym się schematyczne równanie prędkości ma postać:

$$\dot{\mathbf v}^{n}=\mathbf C_b^n\mathbf f^b+\mathbf g^n-\left(2\boldsymbol\omega_{ie}^n+\boldsymbol\omega_{en}^n\right)\times\mathbf v^n$$

gdzie $\mathbf C_b^n$ obraca wektory z układu korpusu do nawigacyjnego, $\boldsymbol\omega_{ie}$ jest obrotem Ziemi, a $\boldsymbol\omega_{en}$ obrotem układu lokalnego wynikającym z ruchu po powierzchni. Znaki zależą od przyjętych definicji układów i transformacji; kod oraz dokumentacja muszą używać jednej konwencji.

Pozycję geodezyjną aktualizuje się z prędkości i modelu elipsoidy. Promienie krzywizny zmieniają się z szerokością. W krótkim locie można czasem użyć lokalnego przybliżenia płaskiego, ale tylko po wykazaniu błędu. „Krótki” zależy od wymagań, nie od intuicji.

Grawitacja nie jest stałym $9{,}81$. Zależy od szerokości, wysokości i modelu. Dla bardzo precyzyjnej nawigacji ważne są anomalie lokalne. Model musi mieć wersję i obszar ważności.

Reprezentacja orientacji

Orientację można zapisać na kilka równoważnych fizycznie sposobów, ale ich ograniczenia programowe są różne:

Reprezentacja Zaleta Warunek lub pułapka
kąty Eulera: przechylenie, pochylenie i odchylenie intuicyjna prezentacja dla człowieka wynik zależy od kolejności obrotów i występuje osobliwość
macierz kierunkowych cosinusów $\mathbf C_b^n$ bezpośrednio przekształca wektory między układami dryf numeryczny narusza ortonormalność i wyznacznik równy jeden
kwaternion jednostkowy brak osobliwości kątów Eulera i zwarta propagacja trzeba ustalić kolejność składowych, stronę działania, regułę mnożenia i normalizację

Macierz $\mathbf C_b^n$ powinna spełniać

$$\mathbf C\mathbf C^T=\mathbf I, \qquad \det\mathbf C=1$$

Kwaterniony $q$ i $-q$ opisują ten sam obrót, więc prosty test równości czterech liczb może fałszywie zgłosić błąd. Nie istnieje też poprawna „implementacja kwaternionu” bez jawnej konwencji. Zestaw prób powinien obejmować znane obroty osiowe, składanie nieprzemiennych rotacji i przejście macierz–kwaternion–macierz.

Korekcje ruchu wewnątrz interwału

Obroty 3D nie są przemienne. Obrót wokół osi X, a następnie Y nie jest równoważny odwrotnej kolejności. Jeśli inkrementy zostaną tylko zsumowane, ruch oscylacyjny może pozostawić pozorną zmianę orientacji. Korekcja ruchu stożkowego (coning) używa iloczynów wektorowych kolejnych inkrementów kąta, aby zachować ich kolejność. Korekcja sculling łączy inkrement kąta i prędkości, ponieważ siła właściwa działa w osi, która zmienia orientację wewnątrz interwału. Scrolling przenosi analogiczny problem na aktualizację położenia.

Te nazwy nie oznaczają trzech dowolnych „poprawek dokładności”. Ich potrzebny rząd wynika z widma ruchu, częstości surowych próbek, częstości mechanizacji i budżetu aliasingu. Test rozstrzygający powinien podać znany ruch z zerowym wynikiem netto i wykazać, że implementacja nie tworzy sztucznego przyrostu.

Historyczna publikacja o mikroprocesorowym nawigatorze RLG opisuje cyfrową kompensację coning i sculling jako istotne obciążenie szybkości oraz pamięci.3 To nadal aktualna lekcja: częstość surowych pomiarów, mechanizacji i aktualizacji filtra to trzy różne parametry.

Orientowanie początkowe i geometria montażu

INS całkuje od stanu początkowego. Jeśli początkowa orientacja lub pozycja jest błędna, rozwiązanie może być bardzo powtarzalne, a mimo to stale przesunięte. Orientowanie zgrubne może wykorzystywać dane platformy, kierunek grawitacji albo zewnętrzne odniesienie kierunku. Estymacja dokładna wykorzystuje różnice pomiar–przewidywanie do poprawiania orientacji i przesunięć zera, lecz nie każdy składnik jest obserwowalny bez odpowiedniego ruchu lub odniesienia. Drgania podczas postoju naruszają założenie statyczności, a procedury konkretnych systemów pozostają poza zakresem artykułu.

Geometria nie kończy się na orientacji obudowy. Środek fazowy anteny GNSS, IMU, głowica obserwacyjna i punkt odniesienia płatowca leżą w różnych miejscach. Przy obrocie prędkość anteny różni się od prędkości IMU o $\boldsymbol\omega\times\mathbf r$. Wektor dźwigni musi zatem mieć ustalony znak, układ, jednostkę i zakres obowiązywania. Zmiana uchwytu albo struktury może zmienić orientowanie i dźwignię mimo niezmienionego numeru IMU; dane montażowe należą do konfiguracji konkretnego płatowca.

Rodziny żyroskopów

Zasada działania nie tworzy prostej hierarchii „stare–nowe” ani „gorsze–lepsze”. Określa za to dominujące ograniczenia, które trzeba skonfrontować z czasem autonomii, dynamiką, środowiskiem, dostępną mocą i objętością:

Rodzina Zjawisko pomiarowe Mocna strona architektoniczna Typowe ograniczenie wymagające dowodu
żyroskop mechaniczny zachowanie momentu pędu wirnika, precesja lub moment równoważący historycznie wysoka jakość i fizyczne odniesienie łożyska, rozruch, tarcie, termika, obsługa i elementy ruchome
laser pierścieniowy (RLG) różnica częstotliwości przeciwbieżnych wiązek przez efekt Sagnaca brak wirującego rotora, dojrzały pomiar optyczny sprzężenie wiązek przy małych prędkościach, wymuszanie drgań, optyka i sterowanie drogą
światłowodowy (FOG) faza przeciwbieżnych fal w długiej cewce światłowodu brak aktywnej wnęki i klasycznych łożysk rozpraszanie wsteczne, polaryzacja, źródło światła oraz zależność włókna i elektroniki od temperatury
rezonatorowy, np. HRG zmiana modów drgającego rezonatora pod wpływem obrotu mało elementów zużywających się przez ruch asymetria rezonatora, próżnia, wzbudzenie, odczyt i kompensacja
mikromechaniczny (MEMS) siła Coriolisa działająca na drgającą mikromasę mała masa, moc, objętość i łatwa integracja wielu osi przesunięcie zera, szum, temperatura, prostowanie drgań i rozrzut egzemplarzy

NASA dokumentowała zarówno mikroprocesorowe sterowanie RLG, jak i lotną próbę układu czterech nadmiarowych żyroskopów.3,4 Publikacja o cywilnym UAV pokazuje natomiast estymację orientacji z taniego MEMS, magnetometru i danych aerodynamicznych.5 Pierwsze źródła nie podają parametrów współczesnego uzbrojenia, a drugie nie dowodzi równoważności MEMS z klasą strategiczną; razem pokazują, że wynik zależy od całego toru i misji, nie samej etykiety czujnika.

Akcelerometry: to samo kryterium wyboru

Akcelerometr wahadłowy wykorzystuje masę z przesuniętym środkiem, często utrzymywaną pętlą siłową blisko zera. Giętki element kwarcowy tworzy precyzyjną sprężynę, a MEMS scala mikromasę z odczytem pojemnościowym. W każdym przypadku trzeba ocenić zakres i przeżywalność udaru, powtarzalność przesunięcia zera, stabilność w czasie pracy, skalę i nieliniowość, pasmo, szum, czułość poprzeczną, temperaturę, rozruch oraz koszt zasobów.

W krótkiej misji czujnik o umiarkowanym dryfie długookresowym może być właściwy, jeśli zachowuje liniowość podczas fazy największej dynamiki. Długi czas bez wspomagania przesuwa znaczenie ku stabilności. Z kolei świetny parametr katalogowy w spoczynku nie odpowiada na pytanie o zachowanie po udarze ani w widmie drgań. Porównanie technologii staje się sensowne dopiero po zapisaniu scenariusza i budżetu błędu.

Estymacja błędów

Mechanizacja tworzy nominalny stan. Estymator często śledzi małe błędy wokół tego stanu, np.:

$$\delta\mathbf x= [\delta\mathbf r,\delta\mathbf v,\delta\boldsymbol\psi, \mathbf b_g,\mathbf b_a,\ldots]^T$$

Może zawierać błędy pozycji, prędkości i orientacji, przesunięcia zera żyroskopów oraz akcelerometrów, błąd zegara, błędy skali, wektor dźwigni albo parametry atmosferyczne. Większy stan nie zawsze jest lepszy. Jeśli pomiary nie czynią składnika obserwowalnym, filtr może przypadkowo rozdzielić resztę między skorelowane stany.

Model procesu

Propagacja liniowego modelu błędów:

$$\delta\mathbf x_{k+1}=\mathbf F_k\delta\mathbf x_k+\mathbf G_k\mathbf w_k$$

$$\mathbf P^-_{k+1}=\mathbf F_k\mathbf P^+_k\mathbf F_k^T+\mathbf G_k\mathbf Q_k\mathbf G_k^T$$

$\mathbf Q$ opisuje przyjęty proces losowy. Zbyt małe Q czyni filtr sztywnym i nadmiernie pewnym; zbyt duże pozwala stanom błądzić i silnie reagować na pomiary.

Model pomiaru i innowacja

Pomiar opisuje:

$$\mathbf z_k=h(\mathbf x_k)+\mathbf v_k$$

Innowacja to $\mathbf y_k=\mathbf z_k-h(\hat{\mathbf x}^-_k)$. Jej kowariancja obejmuje niepewność przewidywania i pomiaru. Innowacja powinna być badana statystycznie; stale przesunięta średnia wskazuje nieujęte przesunięcie lub zły model.

Aktualizacja

Wzmocnienie Kalmana waży model i pomiar. Po korekcie błędy są wstrzykiwane do nominalnego stanu, a stan błędu zerowany zgodnie z przyjętą formulacją. Niepoprawne wyzerowanie błędu orientacji może wprowadzić skok mimo poprawnych równań filtra.

Tutorial NASA INS/GPS prowadzi od surowych czujników przez nawigację zliczeniową do korekty GPS filtrem Kalmana.2 Jego przykład dwuwymiarowy jest dydaktyczny; pocisk wymaga pełnej dynamiki, innych modeli i kwalifikowanego oprogramowania.

Studium II: jedna obserwacja i koszt błędnego modelu

Jednowymiarowy przykład pozwala zobaczyć logikę ukrytą w macierzach. Niech przewidywany błąd położenia wynosi $\hat x^-=4$, jego wariancja $P^-=9$, a niezależny pomiar wskazuje $z=1$ z wariancją $R=4$. Innowacja wynosi $y=z-\hat x^-=-3$, zaś wzmocnienie

$$K=\frac{P^-}{P^-+R}=0{,}6923.$$

Po aktualizacji $\hat x^+=\hat x^-+Ky=1{,}9231$, a wariancja maleje do $P^+=(1-K)P^-=2{,}7692$. Filtr nie przepisuje pomiaru i nie ignoruje modelu; waży oba źródła według deklarowanej niepewności.

Jeżeli ten sam pomiar zostanie błędnie uznany za szesnaście razy dokładniejszy, czyli przyjmie się $R=0{,}25$, wzmocnienie rośnie do $0{,}9730$, estymata przesuwa się do $1{,}0811$, a wariancja spada do $0{,}2432$. Wynik wygląda znacznie pewniej, chociaż nie pojawiła się żadna nowa informacja. Jeżeli błąd pomiaru był skorelowany albo jego wariancję zaniżono, mała macierz $P$ jest objawem nadmiernej pewności, nie sukcesem. W pełnym filtrze obserwacja pozycji może pośrednio poprawiać prędkość, orientację i przesunięcia zera tylko przez dynamikę oraz korelacje; składnik nieobserwowalny nie staje się znany od samego dodania go do wektora.

Filtr Kalmana nie jest „algorytmem prawdy”

Filtr jest optymalny tylko względem modelu i założeń. Problemy obejmują:

  • nieliniowość większą niż dopuszcza lokalna linearyzacja EKF;
  • błędne Q/R;
  • skorelowane pomiary potraktowane jako niezależne;
  • obserwacje odstające i wielodrogowość;
  • nieznane opóźnienie;
  • błędny wektor dźwigni;
  • utratę dodatniej określoności $P$ przez numerykę;
  • nieobserwowalne lub słabo obserwowalne stany;
  • wspólny błąd czujników nadmiarowych.

Macierz $P$ może maleć przy każdej aktualizacji nawet wtedy, gdy pomiary mają wspólne przesunięcie niewpisane do modelu. Monitorowanie integralności musi porównywać reszty, tryby, alternatywne źródła i granice fizyczne.

Wspomaganie GNSS: gdzie przebiega granica systemów

GNSS zapewnia zewnętrzne rozwiązanie pozycji, prędkości i czasu albo surowsze pseudoodległości i tempo ich zmian. INS dostarcza stan z dużą częstością i przechodzi przez krótkie przerwy. Poziom sprzężenia określa, po której stronie interfejsu powstaje obserwacja:

Sprzężenie Dane przekazywane do estymatora Korzyść i koszt
luźne gotowe rozwiązanie PVT odbiornika prostsza integracja, lecz brak pełnego rozwiązania może odciąć dostęp do użytecznych surowych obserwacji
ścisłe pseudoodległości, tempo ich zmian i geometria źródeł działanie z niepełnym zestawem obserwacji, ale silniejsza zależność od wspólnego czasu i modeli
głębokie informacje sięgające pętli śledzenia odbiornika lepsze wykorzystanie dynamiki INS kosztem złożonej odpowiedzialności, V&V i integracji

Orion EFT-1 używał dwóch IMU, jednego odbiornika GPS i barometrów, a rozszerzony filtr Kalmana przetwarzał pseudoodległości oraz ich zmiany.6 Ten publiczny przykład pokazuje, że nadmiarowość pomiarów inercyjnych i zewnętrzne wspomaganie są odrębnymi wymiarami projektu. Nie ujawnia architektury uzbrojenia.

Błędy GNSS, których INS nie usuwa magicznie

GNSS podlega błędom efemeryd, zegarów, jonosfery i troposfery, wielodrogowości, zasłonięcia, zakłócania i podszywania się pod sygnał. INS pomaga wykrywać niespójność dynamiki i kontynuować propagację autonomiczną, ale ma własny dryf. Powoli zmieniający się błąd zgodny z modelem może zostać błędnie wchłonięty jako poprawka przesunięcia zera.

Kontrola innowacji, geometrii, czasu, ograniczeń dynamiki i jakości odbiornika może ujawnić niespójność. Po utracie obserwacji system powinien jawnie zwiększać niepewność i zmienić tryb, a po jej odzyskaniu nie wstrzykiwać bez walidacji całej różnicy do stanu. Artykuł nie opisuje wojskowych kodów, anten przeciwzakłóceniowych ani algorytmów zwalczania podszywania się pod GNSS.

Inne źródła wspomagania i ich obserwowalność

Źródło Co bezpośrednio obserwuje Najważniejsze ograniczenie
barometr ciśnienie przeliczane modelem na wysokość pogoda, opóźnienie i błędy modelu atmosfery
radar wysokościowy odległość do powierzchni pod sensorem nie jest to wysokość nad elipsoidą; nachylenie terenu zmienia geometrię
radar lub lidar dopplerowski składowe prędkości względem powierzchni geometria wiązek, charakter odbicia i dźwignia między sensorami
dopasowanie terenu lub sceny pozycję względem mapy aktualność i unikalność mapy, pogoda, rozdzielczość i błędy obserwacji
obserwacja gwiazd lub punktów terenowych orientację albo kierunek do znanego odniesienia widoczność, identyfikacja, czas przetwarzania i geometria

NASA badała bezplatformowy INS wspomagany obserwacją gwiazd i punktów terenowych dla autonomicznego startu i orbity.13 Przypadek ma wartość architektoniczną, nie jest opisem pocisku. Każde źródło ogranicza inne kombinacje stanów: wysokość nie obserwuje bezpośrednio błędu poziomego, a pojedyncza pozycja nie rozdziela natychmiast wszystkich przesunięć zera i błędów orientacji.

Obserwowalność

Stan jest obserwowalny, jeśli dostępne pomiary w czasie pozwalają odróżnić jego wpływ od innych stanów. Dwa przesunięcia zera mogą tworzyć podobną resztę w statycznej geometrii. Ruch zmienia macierz obserwacji i może je rozdzielić.

Przykłady:

  • nieruchomy akcelerometr obserwuje kierunek grawitacji, ale nie odchylenie wokół pionu;
  • magnetometr może obserwować kierunek, lecz podlega lokalnym zakłóceniom;
  • prędkość GNSS podczas manewru pomaga rozdzielić błąd orientacji i przesunięcie zera akcelerometru;
  • dwa identyczne IMU z tym samym błędem temperaturowym nie tworzą niezależnego dowodu;
  • pomiar wysokości nie obserwuje bezpośrednio błędu poziomego.

Filtr nie powinien estymować parametru tylko dlatego, że można dodać go do wektora. Potrzebny jest dowód obserwowalności i jej ograniczeń.

Utrata wspomagania i lot autonomiczny

Po utracie GNSS INS nadal propaguje stan. Kowariancja powinna rosnąć według modelu. System może przechodzić przez poziomy:

  1. rozwiązanie w pełni wspomagane;
  2. krótkotrwała propagacja autonomiczna z zachowaną jakością;
  3. rozwiązanie zdegradowane z ograniczonymi funkcjami;
  4. stan nieważny albo bezpieczne zakończenie zadania.

Granice są wymaganiem systemowym i zależą od misji. Najgorszym zachowaniem jest utrzymanie starej flagi „ważne” przy zamrożonym stanie. Odbiorca powinien znać wiek rozwiązania i tryb degradacji.

Po powrocie wspomagania duża innowacja może być prawidłową korektą lub fałszywym pomiarem. Natychmiastowe wstrzyknięcie całej różnicy może stworzyć skok stanu przekazywanego do naprowadzania. Ponowne przyjęcie obserwacji wymaga walidacji, czasem stopniowego przywrócenia i zachowania ciągłości interfejsu.

Porównanie architektur rakietowych bez mieszania wariantów

Rodzina Co potwierdza wykorzystane źródło Czego z niego nie wolno wywnioskować
Minuteman III program GRP zastąpił zestaw NS-20 zestawem NS-50, wymieniając komputer i oprogramowanie przy zachowaniu istniejącej platformy żyrostabilizowanej10 algorytmów mechanizacji, bieżących parametrów czujników ani szczegółów inicjalizacji
AMRAAM nawigacja inercyjna obsługuje fazę pośrednią z aktualizacjami z platformy, a aktywna głowica radarowa działa w fazie końcowej11 zawartości wiadomości, poziomu sprzężenia filtra, kryteriów przełączenia ani zachowania po utracie łącza
JASSM i GMLRS publiczne opisy wskazują współpracę INS i GPS identycznej architektury wariantów, dokładności, modelu filtra i stopnia sprzężenia
Iskander jawne opracowania przypisują określonym wariantom nawigację inercyjną oraz różne korekty zewnętrzne jednego wspólnego pakietu INS–satelita–czujnik terminalny dla całej rodziny

Studium III: dwa stany w opisie AMRAAM

Krótka karta NAVAIR wystarcza do rozdzielenia dwóch często mieszanych informacji.11 Źródło wymienia jednostkę odniesienia inercyjnego i komputer oraz stwierdza, że w fazie pośredniej pocisk korzysta z naprowadzania inercyjnego i aktualizowanej przez łącze informacji o celu. Aktywna głowica radarowa prowadzi fazę końcową. Z tego opisu wynika funkcjonalny łańcuch propagowany stan własny + zewnętrzna informacja o celu → naprowadzanie pośrednie → obserwacja terminalna. Jest to jawnie oznaczony wniosek architektoniczny, nie opis formatu danych ani prawa naprowadzania.

Źródło nie mówi natomiast, w którym filtrze łączone są obserwacje, jak często przychodzą wiadomości, co dzieje się po ich utracie ani według jakiego warunku następuje przejście do głowicy. Rzetelne studium nie wypełnia tych luk rozwiązaniem „typowym”. Pokazuje, że ta sama informacja o położeniu może dotyczyć stanu własnego albo celu i że odbiorca rozwiązania INS — prawo naprowadzania — musi znać czas oraz jakość obu. Właśnie ta granica między faktem, bezpiecznym wnioskiem i niewiadomą jest częścią analizy architektury.

Nadmiarowość i FDIR

Minimalna IMU ma sześć osi pomiarowych. Nadmiarowość może oznaczać drugą kompletną jednostkę, czwartą skośną oś albo kilka czujników na każdą oś. Układ czterech RLG badany przez NASA pokazał, jak geometria ponad minimalne trzy osie pozwala wykrywać niespójność.4 Samo zdublowanie obudowy nie przesądza jednak o zdolności izolowania usterki.

Głosowanie większościowe wymaga co najmniej trzech dostatecznie niezależnych źródeł i znanego zakresu błędów. Dwa czujniki wykrywają rozbieżność, ale bez trzeciego odniesienia nie wskazują automatycznie winnego. Nadmiarowość analityczna porównuje pomiar z przewidywaniem dynamiki, GNSS lub innego sensora; reszta może ujawnić usterkę, lecz błąd modelu i gwałtowny manewr bywają podobne. Dwa identyczne kanały dzielące zasilanie, zegar, temperaturę, oprogramowanie albo kalibrację mogą ulec wspólnej przyczynie.

FDIR musi więc osobno określać wykrycie, izolację i odtworzenie funkcji. Wyłączenie zdrowej osi po fałszywym alarmie może być gorsze od pierwotnej degradacji. Diagram niezawodności powinien obejmować wspólne zasoby, a próba wstrzykiwania usterek — sprawdzać także niejednoznaczne i skorelowane przypadki.

Oprogramowanie czasu rzeczywistego

Mechanizacja musi być deterministyczna i numerycznie stabilna. Kluczowe są:

  • częstotliwość próbkowania sensorów;
  • częstość mechanizacji i przetwarzania podpróbek;
  • częstotliwość rozwiązania dla naprowadzania;
  • częstotliwość aktualizacji filtra;
  • kolejkowanie i pomiary przychodzące poza kolejnością czasu;
  • arytmetyka stało- lub zmiennoprzecinkowa oraz skalowanie;
  • ochrona przed NaN, overflow i utratą normalizacji;
  • atomowa publikacja kompletnego stanu;
  • nadzór czasu wykonania i mechanizm kontrolny.

W arytmetyce stałoprzecinkowej trzeba zaplanować zakres i rozdzielczość każdej zmiennej. Mały inkrement kwaternionu może zniknąć przez kwantyzację, a duża siła właściwa przepełnić akumulator. Arytmetyka zmiennoprzecinkowa ułatwia zakres, lecz nadal podlega utracie cyfr znaczących, liczbom zdenormalizowanym i zależności od trybu zaokrąglania.

Stan nie powinien być publikowany częściowo: położenie z chwili $k$, prędkość z $k+1$ i orientacja z $k-1$ tworzą zestaw, którego filtr nigdy nie obliczył.

Kalibracja jako element konfiguracji

Pakiet danych może zawierać:

  • przesunięcia zera osi w funkcji temperatury;
  • błędy skali i nieliniowość;
  • macierz nieortogonalności i czułości poprzecznej;
  • orientowanie czujnik–korpus;
  • wektory dźwigni;
  • charakterystyki opóźnień;
  • tablice g-sensitivity;
  • model szumów oraz macierze $Q$ i $R$;
  • model grawitacji/geoidy;
  • wersję układu współrzędnych;
  • kryteria ważności oraz FDIR.

Każdy zbiór potrzebuje przypisania do numeru seryjnego i zakresu obowiązywania, wersji formatu, sumy kontrolnej lub skrótu, daty, warunków wzorcowania i zatwierdzenia. Oprogramowanie musi bezpiecznie odrzucić niezgodną wersję zamiast interpretować inny układ danych.

Wymiana IMU bez wgrania jej danych może dać poprawny wynik komunikacyjnej części BIT i błędną nawigację. Z kolei aktualizacja filtra może wymagać ponownej kwalifikacji mimo braku zmiany sprzętu.

BIT i monitorowanie stanu

BIT może sprawdzić:

  • zasilania, temperatury i komunikację;
  • pamięć programu oraz danych;
  • zakres i wiarygodność fizyczną surowych osi;
  • zgodność sensorów redundantnych;
  • ciągłość czasu i sample counters;
  • normę quaternionu oraz ortogonalność DCM;
  • statystyki innowacji;
  • status GNSS i innych źródeł wspomagających;
  • integralność kalibracji.

Nie może bez ruchu w pełni sprawdzić błędu skali ani czułości poprzecznej. Wewnętrzny elektrostatyczny test MEMS może poruszyć masę próbną, ale nie sprawdza montażu całej IMU do płatowca. Wynik BIT „poprawny” oznacza pokrycie określonego zbioru sposobów uszkodzenia.

Failure indicator w Minuteman GRP był częścią wymiany remove-and-replace i utrzymania systemu.10 Dobra diagnostyka ma wskazać LRU, ale nie może ukrywać niepewności rozwiązania za prostą lampką.

Weryfikacja i walidacja

NASA zaleca dla odpornych systemów GNC śledzenie wymagań, niezależne analizy, jawne marginesy, próby przypadków pozanominalnych i korelację modeli.12 Dla INS nie powinno to być listą stanowisk, lecz łańcuchem, w którym wynik niższego poziomu jest wejściem do następnego:

Poziom dowodu Kontrolowane wejście i wynik Co przekazuje wyżej Czego nadal nie dowodzi
element pomiarowy stół obrotowy, wirówka, temperatura, drgania i udar; parametry skali, zera, szumu oraz przeżywalności model czujnika z niepewnością i zakresem ważności geometrii osi w złożonej IMU ani zachowania interfejsu
zespół IMU wiele orientacji, temperatura i ponowne sprawdzenie po środowisku macierz kalibracji, orientowanie osi i trwałe przesunięcia poprawności mechanizacji oraz wspólnego czasu z odbiorcami
oprogramowanie mechanizacji generator wzorcowych inkrementów, nieprzemienne obroty, granice czasu i liczb błąd algorytmiczny oraz potwierdzone konwencje układów zachowania na rzeczywistym komputerze i z rzeczywistym szumem
estymator Monte Carlo błędów zera, orientowania, opóźnień i utraty obserwacji rozkład błędu, zgodność kowariancji i statystyki innowacji odporności na mechanizm pominięty w modelu
HIL rzeczywisty komputer i interfejsy współpracujące z symulatorem ruchu i źródeł zewnętrznych zmierzone opóźnienia, kolejność danych, zachowanie trybów i FDIR pełnego środowiska, integracji mechanicznej i reprezentatywności lotu
próba w locie niezależne odniesienie z własną niepewnością i pełna konfiguracja błąd całego toru w zbadanym scenariuszu zachowania poza scenariuszem i granicami ważności referencji

Prześledźmy jedno wymaganie: „po przerwie obserwacji rozwiązanie ma zachować poprawny status i nie przekroczyć zadanej granicy błędu”. Charakterystyka czujnika dostarcza do symulacji rozkłady szumu i dryfu. Próba mechanizacji dowodzi poprawności całkowania oraz czasu, Monte Carlo sprawdza prawdopodobieństwo przekroczenia i zgodność macierzy $P$, HIL potwierdza rzeczywiste opóźnienia i zmianę trybu, a lot porównuje wynik z niezależnym odniesieniem. Jeżeli lot nie zgadza się z przewidzianym pasmem, nie wystarczy „zaliczyć końcowego punktu”: trzeba wrócić do modelu czujnika, czasu albo nieujętej wspólnej przyczyny.

Aparatura odniesienia nie jest prawdą absolutną. Musi mieć mniejszą, znaną niepewność, wspólny czas i osobną konfigurację. NASA przeprowadziła próbę lotną kompletnego układu czterech RLG, co dobrze ilustruje konieczność wyjścia poza badanie pojedynczego żyroskopu.4

Dokładność, precyzja, integralność, ciągłość i dostępność

Dokładność opisuje bliskość wartości prawdziwej. Precyzja — rozrzut powtarzanych wyników. System może być precyzyjnie przesunięty przez błąd stały.

Integralność to zdolność terminowego ostrzeżenia, że rozwiązaniu nie należy ufać. Ciągłość oznacza prawdopodobieństwo utrzymania funkcji przez potrzebny okres, a dostępność — udział czasu, gdy funkcja spełnia wymagania.

Wysoka dokładność bez integralności może być groźniejsza niż jawnie oznaczone rozwiązanie zdegradowane. Dla systemu bojowego ważne jest nie tylko „gdzie jestem?”, ale także „skąd wiem, że ta odpowiedź mieści się w zadanej granicy?”.

Bezpieczeństwo i analiza uszkodzonego wyposażenia

IMU może zawierać szybko wirujące elementy historyczne, laser, wysokie napięcie zapłonu, gaz, obudowę próżniową, baterie i kondensatory. Fragment sekcji naprowadzania należy traktować jak część niewybuchu:

  • nie dotykać i nie przemieszczać;
  • nie przykładać zasilania ani miernika do złączy;
  • nie otwierać hermetycznej obudowy;
  • nie ogrzewać, ciąć ani wiercić;
  • odizolować teren i powiadomić EOD;
  • po dopuszczeniu zachować ciąg nadzoru nad dowodem, orientację i oznaczenia.

Analiza samej płytki nie ujawnia parametrów INS. Potrzebne są dane kalibracyjne, oprogramowanie, montaż, orientacja osi i historia temperatury. Oznaczenie handlowego czujnika nie dowodzi, że egzemplarz lotny używał danych katalogowych bez selekcji i kompensacji.

Wniosek: rozwiązanie nawigacyjne jest kontraktem

Najważniejsza różnica nie przebiega między żyroskopem mechanicznym, RLG, FOG i MEMS, lecz między surowym pomiarem a rozwiązaniem, któremu odbiorca może przypisać znaczenie. IMU dostarcza inkrementów. INS wiąże je z układem współrzędnych, czasem, orientowaniem początkowym, kalibracją, grawitacją i modelem błędów. Estymator nie tworzy prawdy — aktualizuje wiedzę tylko o tych stanach, które dostępne obserwacje potrafią rozróżnić.

Studium propagacji pokazało, że niewielkie przesunięcie zera żyroskopu może przez błędny rzut grawitacji zdominować bezpośredni błąd akcelerometru. Studium aktualizacji pokazało z kolei, że samo zaniżenie wariancji pomiaru zmniejsza deklarowaną kowariancję bez dostarczenia nowej informacji. Przypadek AMRAAM rozdzielił stan własny, zewnętrzną informację o celu i obserwację terminalną, a zarazem wskazał granicę tego, czego oficjalna karta nie ujawnia.

Dlatego dojrzały interfejs INS musi publikować razem: stan, czas jego ważności, układ i jednostki, kowariancję lub uzgodnioną granicę ochronną, tryb źródeł, wiek ostatniej obserwacji oraz status integralności. Taki kontrakt powinien przejść od charakterystyki elementu przez kalibrację IMU, mechanizację, symulację statystyczną i HIL do próby w pełnej konfiguracji. Gdy model nie przewiduje wyniku lotu, to model lub zakres deklaracji wymaga korekty; zielona flaga i mała macierz $P$ nie mogą zastąpić dowodu.

Bibliografia i rejestr źródeł