Robotyka
4-DoF pose graph SE(2)×ℝ
AktywnyOpublikowany
Graf pozycji o 4 stopniach swobody w grupie SE(2)×ℝ reprezentuje pozy jako położenie i orientację w płaszczyźnie (x, y, yaw) plus niezależną wysokość (z), wykorzystując wyrównanie do grawitacji.
Kluczowa
innowacja
Redukcja estymacji do 4 DoF (SE(2)×ℝ) przy wyrównaniu do grawitacji, z zachowaniem wysokości jako osobnej zmiennej.
Kategoria
Robotyka
Poziom abstrakcji
Wzorzec
Poziom operacji
Sterowanie robotem
Jak działa
Pozy w grafie modeluje się jako elementy SE(2)×ℝ; krawędzie (odometria, domknięcia pętli, ograniczenia przejść między piętrami, prior wysokości) wiążą te zmienne, a solver (np. GTSAM) minimalizuje błąd przy wyrównaniu do grawitacji. Wysokość pozostaje niezależnym stopniem swobody, co pozwala rozdzielać piętra.
Rozwiązany problem
Pełna optymalizacja 6-DoF (SE(3)) jest nadmiarowa i mniej stabilna, gdy roll i pitch są dobrze obserwowalne z IMU, a kluczowa jest poprawna wysokość (np. numer piętra).