matriks kovarians dalam EKF?

16

Saya berjuang dengan konsep matriks kovarians. Sekarang, pemahaman saya untuk σ x x , σ y y , dan σ θ θ bahwa mereka menggambarkan ketidakpastian. Misalnya, untuk σ x x , ini menggambarkan ketidakpastian nilai x. Sekarang, pertanyaan saya tentang sisa sigma, apa yang mereka wakili? Apa artinya jika mereka nol? Saya bisa mengartikannya jika σ x x

Σ=[σxxσxyσxθσyxσyyσyθσθxσθyσθθ]
σxxσyyσθθσxxσxx adalah nol, itu berarti saya tidak memiliki ketidakpastian tentang nilai x.

Catatan, saya membaca Prinsip Gerakan Robot - Teori, Algoritma, dan Implementasi oleh Howie Choset et. al., yang menyatakan itu

Dengan definisi ini adalah sama dengan σ 2 i varian X i . Untuk i j , jika σ i j = 0 , maka X i dan X j tidak tergantung satu sama lain.σiiσi2Xiijσij=0XiXj

Ini mungkin menjawab pertanyaan saya jika sisa sigma nol tetapi, saya masih bingung tentang hubungan antara variabel-variabel ini misalnya dan y . Kapan ini terjadi? Maksud saya korelasi di antara mereka. Atau dengan kata lain, dapatkah saya menganggapnya nol?xy

Buku lain yaitu FastSLAM: A Scalable Method ... oleh Michael dan Sebastian yang menyatakan

Elemen off-diagonal dari matriks kovarians dari Gaussian multivariat ini mengkodekan korelasi antara pasangan variabel keadaan.

Mereka tidak menyebutkan kapan korelasinya mungkin terjadi dan apa artinya?

CroCo
sumber

Jawaban:

5

Berikut ini adalah satu kotak mainan di mana elemen off-diagonal tidak nol.

Pertimbangkan vektor keadaan yang mencakup posisi roda kiri dan kanan, alih-alih hanya satu posisi untuk robot. Sekarang jika roda kiri memiliki posisi 100m maka Anda tahu roda kanan juga akan memiliki posisi sekitar 100m (tergantung pada panjang gandar). Sebagai roda kiri meningkatkan posisi demikian juga roda kanan, secara umum. Ini bukan korelasi 1: 1 yang tepat, mis. Itu tidak berlaku tepat ketika robot berputar, tetapi secara keseluruhan itu berlaku.

Jadi di sini entri off-diagonal antara posisi x roda kiri dan posisi x roda kanan akan mendekati 1.

ryan0270
sumber
Ok, jika model saya direpresentasikan sebagai titik yang bergerak dalam lingkungan planar (ei 2D), maka elemen off-diagonal adalah nol karena tidak ada korelasi antara elemen diagonal. Apakah asumsi ini benar? Dan bagaimana jika titik ini mendeteksi tengara yang memiliki dua koordinat (ei ), dapatkah saya juga mengasumsikan nol korelasi? x,y
CroCo
Untuk pertanyaan pertama Anda, ya Anda bisa membiarkan elemen off-diagonal nol. Untuk yang kedua, itu tergantung pada bagaimana Anda menanganinya. Jika Anda hanya menggunakan tengara untuk memperkirakan posisi Anda saat ini, tidak ada korelasi. Jika Anda menambahkan posisi tengara ke vektor negara (seperti yang umum di SLAM) maka mereka akan mulai mengembangkan korelasi di antara mereka sendiri.
ryan0270
4

Untuk mendapatkan perasaan tentang matriks kovarians - tanpa masuk ke rincian matematika di sini - yang terbaik untuk memulai dengan matriks 2x2. Maka ingatlah bahwa matriks kovarians adalah perpanjangan dari konsep varians ke dalam kasus multivariat. Dalam kasus 1D, varians adalah statistik untuk variabel acak tunggal. Jika variabel acak Anda memiliki distribusi Gaussian dengan rata-rata nol, variansnya dapat dengan tepat menentukan fungsi kepadatan probabilitas.

Sekarang, jika Anda memperluas ini ke dua variabel, bukan satu, Anda dapat membedakan antara dua kasus. Jika dua variabel Anda independen, yang berarti hasil dari satu nilai tidak ada hubungannya dengan nilai lainnya, pada dasarnya sama dengan kasus 1D. Anda dan Anda σ y y memberikan varians dari x dan y bagian dari variabel acak Anda, dan σ x y akan menjadi nol.σxxσyyxyσxy

Jika variabel Anda tergantung ini berbeda. Dependen berarti ada hubungan antara hasil dan y . Misalnya, Anda dapat memiliki bahwa setiap kali x positif, y secara umum lebih cenderung juga positif. Ini diberikan oleh nilai kovarian Anda σ x y .xyxyσxy

Memberi contoh untuk robot dalam kasus 2D tanpa orientasi sedikit dibuat-buat, tetapi katakanlah Anda memiliki komponen acak di sepanjang arah perjalanan pada -aksi dan Anda tahu bahwa komponen ini juga menghasilkan penyimpangan pada sumbu lateral Anda ( y ). Misalnya ini bisa menjadi roda yang rusak. Ini akan menghasilkan elips ketidakpastian yang diputar. Sekarang untuk misalnya ketika nanti Anda memiliki sesuatu yang mengukur posisi x aktual Anda, Anda dapat memperkirakan distribusi ketidakpastian pada komponen y Anda .xyxy

θ

1σ

Ini juga berlaku dalam kasus 3D. Saya ingin mendapatkan lebih banyak matematika di sini, tetapi mungkin beberapa waktu kemudian.

Jakob
sumber
Σxy
1
@CroCo Saya pikir contoh yang Anda minta dijelaskan pada paragraf keempat dari jawabannya.
Demetris