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 ...
- No tags were found...
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
2.2 Generalized <strong>Modeling</strong> 30⎡g R(J −1 ) T l 0 3(q) = ⎢⎣ ˆX g R g l R⎤⎥⎦ , T f =l⎡ ⎤1 10 00 00 0−h⎢⎣−c−h⎥⎦d. (2.52)In order to complete the generalized dynamic model <strong>of</strong> SSMRs, we must add the reaction<strong>for</strong>ces and torques in equation (2.49) and include the non-holonomic constraint (2.45) byusing the Lagrange multipliers. As previously said, in this section we are only consideringthe reaction <strong>for</strong>ces at the i th contact point as unknown functions f ix , f iy , f iz . Thereby, similarlyto case <strong>of</strong> the active <strong>for</strong>ces and torques, we can write the reaction <strong>for</strong>ce and torque vector expressedin the inertial frame, by first calculating it in the local frame, F r = [ f x f y f z τ x τ y τ z ] T ,and then multiplying by the Plücker trans<strong>for</strong>m. By considering the vector <strong>of</strong> reaction <strong>for</strong>cesand torques at each contact point defined as F i = [ f ix f iy f iz 0 0 0] T , we can calculatethe reaction <strong>for</strong>ce and torque vector expressed in the local frame as:⎡∑ 4i=1 f ix⎤F r =⎡4∑ I 3 0 3⎢⎣ˆp i I⎤⎥⎦ F i =3i=1∑ 4i=1 f iy∑ 4i=1 f iz∑ 4i=1(y i f iz − z i f iy )∑ 4i=1(−x i f iz + z i f ix )⎢⎣ ∑ 4⎥⎦i=1(x i f iy − y i f ix )(2.53)Thereby, the reaction <strong>for</strong>ce and torque vector expressed in the inertial frame can be calculatedas follows:R(q) = (J −1 ) T (q)F r (2.54)As it will be described in Chapter 4, the reaction <strong>for</strong>ces f ix , f iy , f iz exerted on the i th contactpoint depend respectively by the wheel center velocities v ix , v iy , v iz . The relation between thewheel center velocity v i and the robot linear and angular velocity can be written as follows: