macierz kowariancji w EKF?

16

Walczę z koncepcją macierzy kowariancji. Teraz rozumiem dla σ x x , σ y y i σ θ θ, że oni opisać niepewność. Na przykład dla σ x x

Σ=[σxxσxyσxθσyxσyyσyθσθxσθyσθθ]
σxxσyyσθθσxx, opisuje niepewność wartości x. Teraz moje pytanie o pozostałe sigmy, co one reprezentują? Co to znaczy, że są zerami? Mogę zinterpretować, że jeśli wynosi zero, oznacza to, że nie mam wątpliwości co do wartości x.σxx

Uwaga, czytam Zasady ruchu robota - Teoria, algorytmy i implementacje Howie Choset i in. al., który stwierdza, że

Według tej definicji jest takie samo jak σ 2 i wariancja X i . Dla ı j jeżeli σ i j = 0 , a X i i X J są niezależnie od siebie.σiiσi2Xiijσij=0XiXj

To może odpowiedzieć na moje pytanie, jeśli pozostałe sigma są zerami, jednak nadal jestem zdezorientowany co do związku między tymi zmiennymi, na przykład i y . Kiedy to się dzieje? Mam na myśli korelację między nimi. Innymi słowy, czy mogę założyć, że są to zera?xy

Kolejna książka, a mianowicie FastSLAM: A Scalable Method ... autorstwa Michaela i Sebastiana, która stwierdza

Nie-diagonalne elementy macierzy kowariancji tego wielowymiarowego Gaussa kodują korelacje między parami zmiennych stanu.

Nie wspominają, kiedy może dojść do korelacji i co to oznacza?

CroCo
źródło

Odpowiedzi:

5

Oto jeden przypadek zabawki, w którym elementy o przekątnej są niezerowe.

Zastanów się nad wektorem stanu, który obejmuje pozycję lewego i prawego koła zamiast tylko jednej pozycji robota. Teraz, jeśli lewe koło ma pozycję 100 m, to wiesz, że prawe koło również będzie miało pozycję około 100 m (w zależności od długości osi). Gdy lewe koło zwiększa pozycję, tak samo będzie z prawym kołem. To nie jest dokładna korelacja 1: 1, np. Nie utrzymuje się dokładnie, gdy robot się obraca, ale ogólnie utrzymuje.

Tak więc tutaj odchylenie od przekątnej między położeniem x lewego koła i położeniem x prawego koła byłoby bliskie 1.

ryan0270
źródło
Ok, jeśli mój model jest reprezentowany jako punkt, który porusza się w środowisku planarnym (np. 2D), więc elementy nie ukośne są zerami, ponieważ nie ma takich korelacji między elementami ukośnymi. Czy to założenie jest prawidłowe? A co w przypadku, gdy ten punkt wykryje punkt orientacyjny, który ma dwie współrzędne (ei ), czy mogę również założyć zera korelacji? x,y
CroCo
Na twoje pierwsze pytanie: tak, możesz pozostawić elementy poza przekątną zero. Po drugie, to zależy od tego, jak sobie z tym poradzisz. Jeśli użyjesz punktu orientacyjnego do oszacowania aktualnej pozycji, nie będzie żadnych korelacji. Jeśli dodasz punkty orientacyjne do wektora stanu (co jest powszechne w SLAM), zaczną one rozwijać między sobą korelacje.
ryan0270
4

Aby poznać matrycę kowariancji - bez wchodzenia w szczegóły matematyczne - najlepiej zacząć od macierzy 2x2. Następnie pamiętaj, że macierz kowariancji jest rozszerzeniem pojęcia wariancji na przypadek wielowymiarowy. W przypadku 1D wariancja jest statystyką dla jednej zmiennej losowej. Jeśli twoja zmienna losowa ma rozkład Gaussa ze średnią zerową, jej wariancja może precyzyjnie zdefiniować funkcję gęstości prawdopodobieństwa.

Teraz, jeśli rozszerzysz to na dwie zmienne zamiast jednej, możesz rozróżnić dwa przypadki. Jeśli dwie zmienne są niezależne, co oznacza, że ​​wynik jednej wartości nie ma związku z drugą wartością, jest ona zasadniczo taka sama jak w przypadku 1D. Twój a σ y y dać wariancji x i y części zmiennej losowej, a σ x y będzie równa zero.σxxσyyxyσxy

Jeśli twoje zmienne są zależne, jest inaczej. Środki zależne, że istnieje zależność między wynikami i y . Na przykład możesz mieć to, że gdy x jest dodatnie, y jest na ogół bardziej prawdopodobne, że będzie dodatni. Daje to twoja wartość kowariancji σ x y .xyxyσxy

Podanie przykładu robota w przypadku 2D bez orientacji jest nieco wymyślone, ale powiedzmy, że masz losowy komponent wzdłuż kierunku ruchu na osi i wiesz, że ten komponent generuje również dryft na osi bocznej ( y ). Może to być na przykład wadliwe koło. Spowoduje to obróconą elipsę niepewności. Teraz, na przykład, gdy później masz coś, co mierzy twoją rzeczywistą pozycję x , możesz oszacować rozkład niepewności na składniku y .xyxy

θ

1σ

Dotyczy to również przypadku 3D. Chciałbym uzyskać więcej matematyki tutaj, ale może jakiś czas później.

Jakob
źródło
Σxy
1
@CroCo Myślę, że przykład, o który prosisz, jest opisany w czwartym akapicie odpowiedzi.
Demetris