Show PDF File - robotics - Universidad de Zaragoza
Show PDF File - robotics - Universidad de Zaragoza
Show PDF File - robotics - Universidad de Zaragoza
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.