13.07.2015 Views

Advance Modeling of a Skid-Steering Mobile Robot for Remote ...

Advance Modeling of a Skid-Steering Mobile Robot for Remote ...

Advance Modeling of a Skid-Steering Mobile Robot for Remote ...

SHOW MORE
SHOW LESS
  • No tags were found...

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

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

2.2 Generalized <strong>Modeling</strong> 29⎤00⎡mI 3 0 3Γ = ⎢⎣0 3 I⎤⎥⎦ ¨q + mg 1= M g ¨q + G (2.49)g 00⎡⎢⎣ ⎥⎦0where I 3 indicates a three dimensional identity matrix and G = −m[g T0 T 3 ] T is a sixdimensionvector representing the contribution <strong>of</strong> gravity.As Assumption 4 is still considered valid, also because our robot has only one motor <strong>for</strong>each side’s two wheels, we will be considering the vector τ defined in (2.22) as controlinput at dynamic level. Thereby, similarly to the planar case, we can calculate the vectorΓ by considering the vector <strong>of</strong> the active <strong>for</strong>ces and torques exerted on the i th wheel/-ground contact point expressed on the local frame as F ia= [ τ ir0 0 0 0 0] T . Toobtain the total active <strong>for</strong>ce and torque applied to the CoM and expressed in the inertialframe, first we compute the resultant active <strong>for</strong>ce and torque vector on the local frame,F a = [F ax F ay F az M ax M ay M az ] T , and then we multiply it by the Plücker trans<strong>for</strong>m<strong>for</strong> spatial <strong>for</strong>ce vectors [18], [19]. In particular, as we are considering the frame centered atthe i th contact point parallel to the local frame, we can calculate the active <strong>for</strong>ce and torquevector in the local frame as:F a =⎡4∑ I 3 0 3⎢⎣ˆp i I⎤⎥⎦ F ia =3i=1Thereby, we can express Γ also as follows:⎡⎢⎣τ L +τ Rr000−h(τ L +τ R )r−cτ L +dτ Rr⎤⎥⎦(2.50)Γ = (J −1 ) T (q)F a = (J −1 ) T (q)T f τ = B(q)τ (2.51)where

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

Saved successfully!

Ooh no, something went wrong!