Show PDF File - robotics - Universidad de Zaragoza
Show PDF File - robotics - Universidad de Zaragoza
Show PDF File - robotics - Universidad de Zaragoza
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
pi <br />
i <br />
xi <br />
i ∈ {1, . . . , n} p− xi ∈ R p <br />
xj −xi <br />
<br />
e = (i, j) ∈ E G = (V, E)<br />
i ze ∈ R p j<br />
ze = xj − xi + ve, <br />
ve ∼ N (0p×p, Σze) z ∈ R mp Σz ∈ R mp×mp<br />
m <br />
z = (z T 1 , . . . , z T m) T , Σz = blkDiag(Σz1, . . . , Σzm), <br />
G <br />
i Ni <br />
<br />
n z <br />
<br />
a ∈ V a = 1 <br />
ˆx a a = 0p a <br />
ˆx a V a ∈ R(n−1)p <br />
ˆx a V a = ((ˆxa 2) T , . . . , (ˆx a n) T ) T V a = V\{a} a <br />
<br />
ˆx a V a = Σˆx a V a (Aa ⊗ Ip) Σ −1<br />
z z, Σˆx a V a = (A a ⊗ Ip)Σ −1<br />
z (A a ⊗ Ip) T −1 , <br />
A a ∈ R (n−1)×m G <br />
a ˆx a V = (0Tp , (ˆx a Va)T ) T Σˆx a V =<br />
blkDiag 0p×p, Σˆx a Va <br />
a <br />
<br />
i <br />
Ni