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.

˜θ a V a ˆpa V a ∈ R3(n−1) <br />

<br />

ˆp a Va =<br />

ˆx a V a<br />

ˆθ a V a<br />

<br />

= Σˆp a VaBΣ−1 w w, Σˆp a Va = BΣ −1<br />

w B T −1 , <br />

B = blkDiag ((A a ⊗ I2), In−1) Σw w <br />

ˆp a V ∈ R3n V a <br />

<br />

ˆp a V = (0 T 3×1, (ˆp a Va)T ) T , Σˆp a V = blkDiag(03×3, Σˆp a ). <br />

V<br />

ˆx a V a ˆ θ a V a<br />

<br />

ˆx a V a = L−1 (A a ⊗ I2)Υ˜zxy<br />

<br />

I2m + JΣˆ θ a V a J T Υ˜zxyE<br />

˜R zxy,<br />

ˆθ a V a = (Aa Σ −1<br />

zθ (Aa ) T ) −1 A a Σ −1<br />

zθ zθ + Σˆ θ a V a J T Υ˜zxyE ˜ R zxy, where <br />

Υ˜zxy = ( ˜ RΣzxy ˜ R T ) −1 , E = (A a ⊗ I2) T L −1 (A a ⊗ I2)Υ˜zxy − I2m,<br />

Σˆ θ a V a = ((Σ˜ θ a V a )−1 − J T Υ˜zxyEJ) −1 , L = (A a ⊗ I2)Υ˜zxy(A a ⊗ I2) T , <br />

ˆp a V <br />

<br />

ˆx a V ˆ θa V <br />

<br />

<br />

<br />

<br />

˜ θ a V a Σ˜ θ a V a <br />

˜θ a V a = Σ˜ θ a V a Aa Σ −1<br />

zθ zθ, Σ˜ θ a V a = (Aa Σ −1<br />

zθ (Aa ) T ) −1 . <br />

w <br />

Σw <br />

w =<br />

˜zxy<br />

˜θ a V a<br />

<br />

˜Rzxy<br />

=<br />

˜θ a V a<br />

<br />

<br />

˜RΣzxy<br />

, Σw =<br />

˜ RT + JΣ˜ θa Va J T JΣ˜ θa Va Σ˜ θa Va J T Σ˜ θa Va <br />

<br />

ˆp a Va =<br />

ˆx a V a<br />

ˆθ a V a<br />

T<br />

. <br />

= (BΣ −1<br />

w B T ) −1 BΣ −1<br />

w w.

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

Saved successfully!

Ooh no, something went wrong!