Mobile robot dynamics is a challenging field on its own, especially due to the variety of the imposed constraints. Delicate stability and control problems that have very often to be faced are due to longitudinal or lateral slip, and to the features of the ground (roughness, etc.). This chapter has the following objectives: (i) to present the general dynamic modeling concepts and techniques of robots, (ii) to study the Newton–Euler and Lagrange dynamic models of differential-drive mobile robots, (iii) to study the dynamics of differential-drive mobile robots with longitudinal and lateral slip, (iv) to derive a dynamic model of car-like wheeled mobile robots, (v) to derive a dynamic model of three-wheel omnidirectional robots, and (vi) to derive a dynamic model of four-wheel mecanum omnidirectional robots.
Newton–Euler dynamic model; Lagrange dynamic model; slip dynamic model; force–torque diagram; car-like dynamic model; omnidirectional WMR dynamic model; three-wheel omnidirectional robot; four-wheel omnidirectional robot
The next problem in the study of all types of robots, after kinematics, is the dynamic modeling [1–4]. Dynamic modeling is performed using the laws of mechanics that are based on the three physical elements: inertia, elasticity, and friction that are present in any real mechanical system such as the robot. Mobile robot dynamics is a challenging field on its own and has attracted considerable attention by researchers and engineers over the years. Most mobile robots, employed in practice, use conventional wheels and are subject to nonholonomic constraints that need particular treatment. Delicate stability and control problems, that often have to be faced in the design of a mobile robot, are due to the existence of longitudinal and lateral slip in the movement of the wheeled mobile robot (WMR) wheels [5–7].
This chapter has the following objectives:
• To present the general dynamic modeling concepts and techniques of robots.
• To study the Newton–Euler and Lagrange dynamic models of differential-drive mobile robots.
• To study the dynamics of differential-drive mobile robots with longitudinal and lateral slip.
• To derive a dynamic model of car-like WMRs.
• To derive a dynamic model of three-wheel omnidirectional robots.
• To derive a dynamic model of four-wheel mecanum omnidirectional robots.
Robot dynamic modeling deals with the derivation of the dynamic equations of the robot motion. This can be done using the following two methodologies:
The complexity of the Newton–Euler method is O(n), whereas the complexity of the Lagrange method can only be reduced up to , where n is the number of degrees of freedom.
Like kinematics, dynamics is distinguished in:
Direct dynamics provides the dynamic equations that describe the dynamic responses of the robot to given forces/torques that are exerted by the motors.
Inverse dynamics provides the forces/torques that are needed to get desired trajectories of the robot links. Direct and inverse dynamic modeling is pictorially illustrated in Figure 3.1.
In the inverse dynamic model the inputs are the desired trajectories of the link variables, and outputs the motor torques.
This model is derived by direct application of the Newton–Euler equations for translational and rotational motion. Consider the object (robotic link, WMR, etc.) of Figure 3.2 to which a total force is applied at its center of gravity (COG).
Then, its translational motion is described by:
(3.1)
Here, is the linear momentum given by:
(3.2)
where is the mass of the body and is the position of the COG with respect to the world (inertial) coordinate frame Oxyz. Assuming that is constant, then Eqs. (3.1) and (3.2) give:
(3.3)
which is the general translational dynamic model.
The rotational motion of is described by:
(3.4)
where is the total angular momentum of with respect to COG, and is the total external torque that produces the rotational motion of the body. The total momentum is given by:
(3.5)
Here, is the inertia tensor given by the volume integral:
(3.6)
where is the mass density of , dV is the volume of an infinitesimal element of lying at the position with respect to COG, is the angular velocity vector about the inertial axis passing from COG, is the 3×3 unit matrix, and is the volume of .
The general Lagrange dynamic model of a solid body (multilink robot, WMR, etc.) is described by1:
(3.7)
where is the ith-degree of freedom variable, is the external generalized force vector applied to the body (i.e., force for translational motion, and torque for rotational motion), and L is the Lagrangian function defined by:
(3.8)
Here, K is the total kinetic energy, and P the total potential energy of the body given by:
(3.9)
where is the kinetic energy of link (degree of freedom) , and its potential energy. The kinetic energy K of the body is equal to:
(3.10)
where is the linear velocity of the COG, is the angular velocity of the rotation, m is the mass, and the inertia tensor of the body.
Given a general multilink robot, the application of Eq. (3.7) leads (always) to a dynamic model of the form:
(3.11a)
where, for any is an positive define matrix, and:
(3.11b)
is the vector of generalized variables (linear, angular) represents the inertia force, represents the centrifugal and Coriolis force, and stands for the gravitational force. Since is the net force/torque applied to the robot, if there is also friction force/torque , then where is the force/torque exerted by the actuators at the joints.
It is useful to note that given the model (3.11a,b) one can express the kinetic energy of the robot as:
(3.12)
The expressions of , and have to be derived in each particular case. General derivations of Eq. (3.11a) from Eq. (3.7) are given in standard industrial (fixed) robotics books.
Typically, the function can be written in the form:
(3.13)
A useful universal property of the Lagrange model given by Eqs. (3.11a)–(3.13) is that the matrix is antisymmetric, that is, .
The Lagrange dynamic model of a nonholonomic robot (fixed or mobile) has the form (3.7):
(3.14)
where is the matrix of the nonholonomic constraints:
(3.15)
and is the vector Lagrange multiplier. This model leads to:
(3.16)
where is a nonsingular transformation matrix. To eliminate the constraint term in Eq. (3.16) and get a constraint-free model we use an matrix which is defined such that:
(3.17)
From Eqs. (3.15) and (3.17), one can verify that there exists an -dimensional vector such that:
(3.18)
Now, premultiplying Eq. (3.16) by and using Eqs. (3.15), (3.17), and (3.18) we get:
(3.19a)
where:
(3.19b)
The reduced (unconstrained) model (3.19a,b) describes the dynamic evolution of the n-dimensional vector in terms of the dynamic evolution of the -dimensional vector .
The dynamic model of the differential-drive WMR will be derived here by both the Newton–Euler and Lagrange methods.
In the present case use will be made of the Newton–Euler equations:
(3.20a)
(3.20b)
where is the total force applied at the COG G, is the total torque with respect to the COG m is the mass of the WMR, and I is the inertia of the WMR. Referring to Figure 2.7, and assuming that the COG G coincides with the midpoint Q (i.e., b=0), we find:
(3.21a)
i.e:
(3.21b)
where and are the forces that produce the torques and , respectively.
Also:
(3.22)
Therefore, (3.20a,b) give the WMR’s dynamic model:
(3.23a)
(3.23b)
We refer to Figure 2.7 and assume again that the point Q is at the position of point G. Here, the nonholonomic constraint matrix is (Eq. (2.42)):
(3.24)
Since the WMR moves on a horizontal planar terrain, the terms and in Eq. (3.16) are zero. Therefore, the model (3.16) becomes:
(3.25)
where:
(3.26a)
(3.26b)
To convert the model (3.25) to the corresponding unconstrained model (3.19a,b), we need the matrix in (3.17). Here, this matrix is:
(3.27)
which satisfies Eq. (3.17). Therefore, Eq. (3.19b) gives:
(3.28)
and the model (3.19a) becomes:
(3.29)
Noting that is the translation velocity v and the angular velocity of the robot, Eq. (3.29) gives the model:
(3.30a)
(3.30b)
which is identical to Eq. (3.23a,b), as expected. Finally, using Eq. (3.18) we get:
(3.31)
which is the WMR’s kinematic model. The dynamic and kinematic Eqs. (3.30a,b) and (3.31) describe fully the motion of the differential-drive WMR.
Here we will derive the Newton–Euler dynamic model of the slipping differential-drive WMR considered in Example 2.2. The case where both longitudinal slip (variables ) and lateral slip (variables ) are present will be considered [5].
For convenience we write again the kinematic equations of the robot (with steering angles ):
Defining the generalized variables’ vector as:
(3.39)
the above relations can be written in the following Pfaffian matrix form:
where:
(3.40)
The matrix and the velocity vector that satisfy the relations (Eqs. (3.17)–(3.18)):
(3.41)
(3.42)
where:
(3.43a)
(3.43b)
To derive the Newton–Euler dynamic model we draw the free-body diagram of the WMR body without the wheels (Figure 3.3), and the free-body diagram of the two wheels (Figure 3.4).
Figure 3.4 Force–torque diagram of the two wheels. The coordinate frame is fixed at the driving wheels’ midpoint.
In Figures 3.3 and 3.4, we have the following dynamic parameters and variables:
: The torque given to the wheels by the body of the WMR
: The driving torques exerted to the right and left wheel by their motors
: The mass of the WMR body without the wheels
: The mass of each driving wheel assembly (wheel plus DC motor of the robot body)
: The moment of inertia about a vertical axis passing via G (without the wheels)
: The wheel moment of inertia about its axis
: The wheel moment of inertia about its diameter
: The reaction forces between the WMR body and the wheels
Using the above notation, the Newton–Euler dynamic equations of the robot, written down for each generalized variable in the vector (3.39), are:
(3.44)
where .
The detailed Eq. (3.44) can be written in the compact form of Eq. (3.16), namely:
(3.45)
where is given by (3.40), and:
Applying to Eq. (3.45) the procedure of Section 3.2.4, we get the following reduced model (3.19a,b):
(3.46)
where:
The model (3.46) can be split as:
(3.47a)
(3.47b)
(3.47c)
where:
(3.48)
with A, B, C, and D as in Eq. (3.43b). Writing in the form of Eq. (3.13), that is, , the model (3.47a) takes the form:
(3.49)
where:
Finally, Eq. (3.47b,c) can be written in the matrix form:
(3.50)
where:
(3.51)
To summarize, the dynamic model of the differential-drive WMR with slip is:
(3.52a)
(3.52b)
with:
(3.52c)
The kinematic equations of the car-like WMR were derived in Section 2.6. Here, we will derive the Newton–Euler dynamic model for a four-wheel rear-drive front-steer WMR [9]. The equivalent bicycle model shown in Figure 3.5 will be used.
The WMR is subject to the driving force and two lateral slip forces and applied perpendicular to the corresponding wheels. Before presenting the dynamic equations we derive the nonholonomic constraints that apply to the COG G which lies at a distance b from Q, and a distance d from P. To this end, we start with the nonholonomic constraints (2.50a,b) that refer to the points Q and P:
(3.53)
Denoting by and the coordinates of the point G in the world coordinate frame we get:
(3.54)
Introducing the relations (3.54) into (3.53) yields:
(3.55)
Now, denoting by the velocity of the COG G in the local coordinate frame and applying the rotational transformation (2.17) (Example 2.1) we get:
(3.56)
Introducing Eq. (3.56) into Eq. (3.55) yields:
(3.57)
which, upon differentiation, give:
(3.58a)
(3.58b)
From Eqs. (3.57) and (3.58a,b) we get:
(3.59)
Referring to Figure 3.5 we obtain the following Newton–Euler dynamic equations:
(3.60a)
(3.60b)
(3.60c)
(3.60d)
=moment of inertia of the WMR about G
=front and rear wheel lateral forces
=time constant of the steering system
=a constant coefficient (gain)
, with r the rear wheel radius, and the applied motor torque.2
We will now put the above dynamic equations into state space form, where the state vector is:
(3.61)
To this end, we solve Eq. (3.60c) for and introduce it, together with Eq. (3.58a) into (3.60b) to get:
(3.62)
Now introducing Eqs. (3.57), (3.58b), and (3.62) into Eq. (3.60a) we get:
(3.63a)
where:
(3.63b)
Finally, introducing Eq. (3.57) into Eq. (3.56) gives:
(3.64)
with . The model (3.64) represents an affine system with two inputs , a five-dimensional state vector:
(3.65a)
a drift term:
(3.65b)
and the two input fields:
(3.65c)
namely:
(3.66)
Here, we will derive the dynamic model of a three-wheel omnidirectional robot using the Newton–Euler method [10]. This derivation is the same for any number of universal (orthogonal) omniwheels. Some further studies of omnidirectional WMRs are presented in Refs. [11–14].
Consider the WMR in the pose shown in Figure 3.6 in which the three wheels are placed at angles , respectively.
The rotation matrix of the robot’s local coordinate frame with respect to the world coordinate frame is:
(3.67)
Let be the position vector of the COG . Then:
(3.68)
where , m is the robot’s mass, and is the force exerted at the COG expressed in the world coordinate frame. Denoting by:
(3.69)
the position vector of the COG and the force vector expressed in the local (moving) coordinate frame, then Eq. (3.67) implies that:
(3.70)
Thus, using Eq. (3.70) in Eq. (3.68) we get:
(3.71)
Now, the dynamic equation of the rotation about the COG Q is:
(3.72)
where is the moment of inertia of the robot about Q, and is the applied torque at Q.
From the geometry of Figure 3.6 we obtain:
(3.73)
where D is the distance of the wheels from the rotation point Q, and are the driving forces of the wheels.
The rotation of each wheel is described by the dynamic equation:
(3.74)
where is the common moment of inertia of the wheels, is the angular position of wheel , is the linear friction coefficient, is the common radius of the wheels, is the driving input torque of wheel , and is the driving torque gain.
Now, from the geometry of Figure 3.6 we see that the angles of the wheel velocities in the local coordinate frame are:
Thus, we obtain the inverse kinematics equations from to as:
(3.75a)
(3.75b)
(3.75c)
Using Eqs. (3.69)–(3.75c) we get after some algebraic manipulation:
(3.76a)
(3.76b)
(3.76c)
Finally, combining Eqs. (3.67), (3.68), and (3.76a–c) we get the following state–space dynamic model of the WMR’s motion:
(3.77a)
(3.77b)
where:
The azimuth of the robot in the world coordinate frame is denoted by , where ( denotes the angle between and , that is, the azimuth of the robot in the moving coordinate frame). Then:
Whence:
(3.78)
where the positive direction is the counterclockwise rotation direction. It is noted that the motions along and are coupled because the dynamic equations are derived in the world coordinate frame. But since the rotational angle is always equal to , despite the fact that may be changing arbitrarily, the WMR can realize a translational motion without changing the pose (i.e., the WMR is holonomic). The model (3.77a) can be written in a three-input affine form with drift as follows:
(3.79)
where:
The dynamic model (3.77a) of a three-wheel omnidirectional robot (with universal wheels) is one of the many different models available. Actually, many other equivalent models were derived in the literature.
We consider the four-wheel omnidirectional robot of Figure 3.9A [3].
Figure 3.9 (A) The four-wheel mecanum WMR and the forces acting on it and (B) an experimental four-wheel mecanum WMR prototype. Source: www.robotics.ee.uwa.edu.au/eyebot/doc/robots/omni.html.
The total forces and acting on the robot in the x and y directions are:
(3.86a)
(3.86b)
where are the forces acting on the wheels along the x and y axes. In the absence of separate rotation motion, the direction of motion is defined by an angle where:
(3.87)
The torque that produces pure rotation is:
(3.88)
where positive rotation is in the counterclockwise direction.
The Newton–Euler motion equations are:
(3.89a)
(3.89b)
(3.89c)
where , and are the linear friction coefficients in the x, y, and motion, and are the mass and moment of inertia of the robot. Equations (3.89a–c) show that the robot can achieve steady-state velocities and equal to:
(3.90)
1. McKerrow PK. Introduction to robotics Reading, MA: Addison-Wesley; 1999.
2. Dudek G, Jenkin M. Computational principles of mobile robotics Cambridge: Cambridge University Press; 2010.
3. De Villiers M, Bright G. Development of a control model for a four-wheel mecanum vehicle. In: Proceedings of twenty fifth international conference of CAD/CAM robotics and factories of the future conference. Pretoria, South Africa; July 2010.
4. Song JB, Byun KS. Design and control of a four-wheeled omnidirectional mobile robot with steerable omnidirectional wheels. J Rob Syst. 2004;21:193–208.
5. Sidek SN. Dynamic modeling and control of nonholonomic wheeled mobile robot subjected to wheel slip. PhD Thesis, Vanderbilt University, Nashville, TN, December 2008.
6. Williams II RL, Carter BE, Gallina P, Rosati G. Dynamic model with slip for wheeled omni-directional robots. IEEE Trans Rob Autom. 2002;18(3):285–293.
7. Stonier D, Se-Hyoung C, Sung–Lok C, Kuppuswamy NS, Jong-Hwan K. Nonlinear slip dynamics for an omniwheel mobile robot platform. In: Proceedings of IEEE international conference on robotics and automation. Rome, Italy; April 10–14, 2007. p. 2367–72.
8. Ivanjko E, Petrinic T, Petrovic I. Modeling of mobile robot dynamics. In: Proceedings of seventh EUROSIM congress on modeling and simulation. Prague, Czech Republic; September 6–9, 2010. p. 479–86.
9. Moret EN. Dynamic modeling and control of a car-like robot. MSc Thesis, Virginia Polytechnic Institute and State University, Blacksburg, VA, February 2003.
10. Watanabe K, Shiraishi Y, Tzafestas SG, Tang J, Fukuda T. Feedback control of an omnidirectional autonomous platform for mobile service robots. J Intell Rob Syst. 1998;22:315–330.
11. Pin FG, Killough SM. A new family of omnidirectional and holonomic wheeled platforms for mobile robots. IEEE Trans Rob Autom. 1994;10(4):480–489.
12. Rojas R. Omnidirectional control. Freie University, Berlin; May 2005. <http://robocup.mi.fu-berlin.de/buch/omnidrive.pdf>.
13. Connette CP, Pott A, Hagele M, Verl A. Control of a pseudo-omnidirectional, non-holonomic, mobile robot based on an ICM representation in spherical coordinates. In: Proceedings of 47th IEEE conference on decision and Control. Canum, Mexico; December 9–11, 2008. p. 4976–83.
14. Moore KL, Flann NS. A six-wheeled omnidirectional autonomous mobile robot. IEEE Control Syst Mag. 2000;20(6):53–66.
15. Kalmar-Nagy T, D’Andrea R, Ganguly P. Near-optimal dynamic trajectory generation and control of an omnidirectional vehicle. Rob Auton Syst. 2007;46:47–64.
16. Cuerra PN, Alsina PJ, Medeiros AAD, Araujo A. Linear modeling and identification of a mobile robot with differential drive. In: Proceedings of ICINCO international conference on informatics in control automation and robotics. Setubal, Portugal; 2004. p. 263–9.
17. Handy A, Badreddin E. Dynamic modeling of a wheeled mobile robot for identification, navigation and control. In: Proceedings of IMACS conference on modeling and control of technological systems. Lille, France; 1992. p. 119–28.
1Derivations of Eq. (3.7) from first principles are provided in textbooks on mechanics.
2Here, the driving motor dynamics is not included. Derivation of DC motor dynamic models is provided in Example 5.1.
3.145.191.22