18.08.2013 Views

Show PDF File - robotics - Universidad de Zaragoza

Show PDF File - robotics - Universidad de Zaragoza

Show PDF File - robotics - Universidad de Zaragoza

SHOW MORE
SHOW LESS

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

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!