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

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

i mi ∈ N <br />

i <br />

Mi = + mi <br />

ˆxi ∈ R Mi Σi ∈ R Mi×Mi <br />

= 3 <br />

(x, y) θ = 2 = 3 <br />

xi ∈ R Mi <br />

mi <br />

ˆxi = xi + vi, <br />

vi Σi <br />

<br />

m ∈ N <br />

i ∈ {1, . . . , n} mi ≤ m x ∈ R MG <br />

n m MG = n +m <br />

Hi ∈ {0, 1} Mi×MG x <br />

i 0 1<br />

1 xi = Hix <br />

ˆxi = Hix + vi,<br />

vi Σi <br />

<br />

T ˆx 1 . . . ˆx T T T<br />

n = H1 . . . H T T T<br />

n x + v1 . . . v T T n .<br />

vi <br />

E[ vT 1 . . . vT T <br />

T<br />

n v1 . . . vT <br />

n ] = diag (Σ1, . . . , Σn)<br />

i Ii ∈<br />

RMG×MG ii ∈ RMG Ii = H T i Σ −1<br />

i Hi, ii = H T i Σ −1<br />

i ˆxi. <br />

n <br />

<br />

IG =<br />

n<br />

Ii, iG =<br />

i=1<br />

n<br />

ii, <br />

<br />

<br />

i=1<br />

ˆxG = (IG) −1 iG, ΣG = (IG) −1 .

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

Saved successfully!

Ooh no, something went wrong!