3

Mobile Robot Dynamics

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.

Keywords

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

3.1 Introduction

The next problem in the study of all types of robots, after kinematics, is the dynamic modeling [14]. 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 [57].

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.

3.2 General Robot Dynamic Modeling

Robot dynamic modeling deals with the derivation of the dynamic equations of the robot motion. This can be done using the following two methodologies:

• Newton–Euler method

• Lagrange method

The complexity of the Newton–Euler method is O(n), whereas the complexity of the Lagrange method can only be reduced up to image, where n is the number of degrees of freedom.

Like kinematics, dynamics is distinguished in:

• Direct dynamics

• Inverse dynamics

Direct dynamics provides the dynamic equations that describe the dynamic responses of the robot to given forces/torques image 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.

image

Figure 3.1 Direct and inverse dynamic modeling.

In the inverse dynamic model the inputs are the desired trajectories of the link variables, and outputs the motor torques.

3.2.1 Newton–Euler Dynamic Model

This model is derived by direct application of the Newton–Euler equations for translational and rotational motion. Consider the object image (robotic link, WMR, etc.) of Figure 3.2 to which a total force image is applied at its center of gravity (COG).

image

Figure 3.2 A solid body image and the inertial coordinate frame Oxyz.

Then, its translational motion is described by:

image (3.1)

Here, image is the linear momentum given by:

image (3.2)

where image is the mass of the body and image is the position of the COG with respect to the world (inertial) coordinate frame Oxyz. Assuming that image is constant, then Eqs. (3.1) and (3.2) give:

image (3.3)

which is the general translational dynamic model.

The rotational motion of image is described by:

image (3.4)

where image is the total angular momentum of image with respect to COG, and image is the total external torque that produces the rotational motion of the body. The total momentum image is given by:

image (3.5)

Here, image is the inertia tensor given by the volume integral:

image (3.6)

where image is the mass density of image, dV is the volume of an infinitesimal element of image lying at the position image with respect to COG, image is the angular velocity vector about the inertial axis passing from COG, image is the 3×3 unit matrix, and image is the volume of image.

3.2.2 Lagrange Dynamic Model

The general Lagrange dynamic model of a solid body (multilink robot, WMR, etc.) is described by1:

image (3.7)

where image is the ith-degree of freedom variable, image 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:

image (3.8)

Here, K is the total kinetic energy, and P the total potential energy of the body given by:

image (3.9)

where image is the kinetic energy of link (degree of freedom) image, and image its potential energy. The kinetic energy K of the body is equal to:

image (3.10)

where image is the linear velocity of the COG, image is the angular velocity of the rotation, m is the mass, and image the inertia tensor of the body.

3.2.3 Lagrange Model of a Multilink Robot

Given a general multilink robot, the application of Eq. (3.7) leads (always) to a dynamic model of the form:

image (3.11a)

where, for any image is an image positive define matrix, and:

image (3.11b)

is the vector of generalized variables (linear, angular) image represents the inertia force, image represents the centrifugal and Coriolis force, and image stands for the gravitational force. Since image is the net force/torque applied to the robot, if there is also friction force/torque image, then image where image 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:

image (3.12)

The expressions of image, and image 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 image can be written in the form:

image (3.13)

A useful universal property of the Lagrange model given by Eqs. (3.11a)(3.13) is that the image matrix image is antisymmetric, that is, image.

3.2.4 Dynamic Modeling of Nonholonomic Robots

The Lagrange dynamic model of a nonholonomic robot (fixed or mobile) has the form (3.7):

image (3.14)

where image is the image matrix of the image nonholonomic constraints:

image (3.15)

and image is the vector Lagrange multiplier. This model leads to:

image (3.16)

where image is a nonsingular transformation matrix. To eliminate the constraint term image in Eq. (3.16) and get a constraint-free model we use an image matrix image which is defined such that:

image (3.17)

From Eqs. (3.15) and (3.17), one can verify that there exists an image-dimensional vector image such that:

image (3.18)

Now, premultiplying Eq. (3.16) by image and using Eqs. (3.15), (3.17), and (3.18) we get:

image (3.19a)

where:

image (3.19b)

The reduced (unconstrained) model (3.19a,b) describes the dynamic evolution of the n-dimensional vector image in terms of the dynamic evolution of the image-dimensional vector image.

3.3 Differential-Drive WMR

The dynamic model of the differential-drive WMR will be derived here by both the Newton–Euler and Lagrange methods.

3.3.1 Newton–Euler Dynamic Model

In the present case use will be made of the Newton–Euler equations:

image (3.20a)

image (3.20b)

where image is the total force applied at the COG G, image 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:

image (3.21a)

i.e:

image (3.21b)

where image and image are the forces that produce the torques image and image, respectively.

Also:

image (3.22)

Therefore, (3.20a,b) give the WMR’s dynamic model:

image (3.23a)

image (3.23b)

3.3.2 Lagrange Dynamic Model

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)):

image (3.24)

Since the WMR moves on a horizontal planar terrain, the terms image and image in Eq. (3.16) are zero. Therefore, the model (3.16) becomes:

image (3.25)

where:

image (3.26a)

image (3.26b)

To convert the model (3.25) to the corresponding unconstrained model (3.19a,b), we need the matrix image in (3.17). Here, this matrix is:

image (3.27)

which satisfies Eq. (3.17). Therefore, Eq. (3.19b) gives:

image (3.28)

and the model (3.19a) becomes:

image (3.29)

Noting that image is the translation velocity v and image the angular velocity image of the robot, Eq. (3.29) gives the model:

image (3.30a)

image (3.30b)

which is identical to Eq. (3.23a,b), as expected. Finally, using Eq. (3.18) we get:

image (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.

Example 3.1

The problem is to derive the Lagrange dynamic model using directly the Lagrangian function L for a differential-drive WMR in which:

1. There is linear friction in the wheels with the same friction coefficient.

2. The wheel midpoint Q does not coincide with the COG G.

3. The wheel–motor assemblies have nonzero inertia.

Solution

We will work with the WMR of Figure 2.7.The kinetic energy K of the robot is given by:

image (3.32)

where:

image (3.33)

and (Example 2.2):

image

with:

image=mass of the entire robot

image=linear velocity of the COG G

image=moment of inertia of the robot with respect to Q

image=moment of inertia of each wheel plus the corresponding motor’s rotor moment of inertia.

The velocities image, and image are given by Eq. (2.36a–c):

image (3.34)

Using Eqs. (3.33) and (3.34) in Eq. (3.32) the total kinetic energy K of the robot is found to be:

image (3.35)

Here the kinetic energy is expressed directly in terms of the angular velocities image and image of the driving wheels. The Lagrangian L is equal to K, since the robot is moving on a horizontal plane and so the potential energy P is zero. Therefore, the Lagrange dynamic equations of this robot are:

image (3.36)

where β is the wheels’ common friction coefficient, and image are the right and left actuation torques. Using (3.35) in (3.36) we get:

image (3.37)

where:

image (3.38)

Using the known relations:

image, one can easily verify that in the case where the above conditions 1, 2, and 3 are relaxed (i.e., β=0, b=0, image), the above dynamic model reduces to the model (3.30a,b). This model was implemented and validated using MATLAB/SIMULINK in Ref. [8].

3.3.3 Dynamics of WMR with Slip

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 image) and lateral slip (variables image) are present will be considered [5].

For convenience we write again the kinematic equations of the robot (with steering angles image):

image

Defining the generalized variables’ vector image as:

image (3.39)

the above relations can be written in the following Pfaffian matrix form:

image

where:

image (3.40)

The matrix image and the velocity vector image that satisfy the relations (Eqs. (3.17)(3.18)):

image (3.41)

are found to be:

image (3.42)

where:

image (3.43a)

image (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).

image

Figure 3.3 Force–torque diagram of the body of the WMR (without the wheels).

image

Figure 3.4 Force–torque diagram of the two wheels. The coordinate frame image is fixed at the driving wheels’ midpoint.

In Figures 3.3 and 3.4, we have the following dynamic parameters and variables:

image: The torque given to the wheels by the body of the WMR

image: The driving torques exerted to the right and left wheel by their motors

image: The mass of the WMR body without the wheels

image: The mass of each driving wheel assembly (wheel plus DC motor of the robot body)

image: The moment of inertia about a vertical axis passing via G (without the wheels)

image: The wheel moment of inertia about its axis

image: The wheel moment of inertia about its diameter

image: The reaction forces between the WMR body and the wheels

image: The lateral traction force at each wheel.

image: The longitudinal traction force at each wheel.

Using the above notation, the Newton–Euler dynamic equations of the robot, written down for each generalized variable in the vector (3.39), are:

image (3.44)

where image.

The detailed Eq. (3.44) can be written in the compact form of Eq. (3.16), namely:

image (3.45)

where image is given by (3.40), and:

image

Applying to Eq. (3.45) the procedure of Section 3.2.4, we get the following reduced model (3.19a,b):

image (3.46)

where:

image

The model (3.46) can be split as:

image (3.47a)

image (3.47b)

image (3.47c)

where:

image

image

image

image

image

image

image (3.48)

with A, B, C, and D as in Eq. (3.43b). Writing image in the form of Eq. (3.13), that is, image, the model (3.47a) takes the form:

image (3.49)

where:

image

Finally, Eq. (3.47b,c) can be written in the matrix form:

image (3.50)

where:

image (3.51)

To summarize, the dynamic model of the differential-drive WMR with slip is:

image (3.52a)

image (3.52b)

with:

image (3.52c)

3.4 Car-Like WMR Dynamic Model

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.

image

Figure 3.5 Free-body diagram of the equivalent bicycle.

The WMR is subject to the driving force image and two lateral slip forces image and image 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:

image (3.53)

Denoting by image and image the coordinates of the point G in the world coordinate frame we get:

image (3.54)

Introducing the relations (3.54) into (3.53) yields:

image (3.55)

Now, denoting by image the velocity of the COG G in the local coordinate frame image and applying the rotational transformation (2.17) (Example 2.1) we get:

image (3.56)

Introducing Eq. (3.56) into Eq. (3.55) yields:

image (3.57)

which, upon differentiation, give:

image (3.58a)

image (3.58b)

From Eqs. (3.57) and (3.58a,b) we get:

image (3.59)

Referring to Figure 3.5 we obtain the following Newton–Euler dynamic equations:

image (3.60a)

image (3.60b)

image (3.60c)

image (3.60d)

where:

image=mass of the WMR

image=moment of inertia of the WMR about G

image=driving force

image=front and rear wheel lateral forces

image=time constant of the steering system

image=steering control input

image=a constant coefficient (gain)

image, with r the rear wheel radius, and image the applied motor torque.2

We will now put the above dynamic equations into state space form, where the state vector is:

image (3.61)

To this end, we solve Eq. (3.60c) for image and introduce it, together with Eq. (3.58a) into (3.60b) to get:

image

whence:

image (3.62)

Now introducing Eqs. (3.57), (3.58b), and (3.62) into Eq. (3.60a) we get:

image (3.63a)

where:

image (3.63b)

Finally, introducing Eq. (3.57) into Eq. (3.56) gives:

image (3.64)

with image. The model (3.64) represents an affine system with two inputs image, a five-dimensional state vector:

image (3.65a)

a drift term:

image (3.65b)

and the two input fields:

image (3.65c)

namely:

image (3.66)

3.5 Three-Wheel Omnidirectional Mobile Robot

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. [1114].

Consider the WMR in the pose shown in Figure 3.6 in which the three wheels are placed at angles image, respectively.

image

Figure 3.6 Geometry of the three-wheel omnidirectional WMR.

The rotation matrix of the robot’s local coordinate frame image with respect to the world coordinate frame image is:

image (3.67)

Let image be the position vector of the COG image. Then:

image (3.68)

where image, m is the robot’s mass, and image is the force exerted at the COG expressed in the world coordinate frame. Denoting by:

image (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:

image (3.70)

Thus, using Eq. (3.70) in Eq. (3.68) we get:

image (3.71)

Now, the dynamic equation of the rotation about the COG Q is:

image (3.72)

where image is the moment of inertia of the robot about Q, and image is the applied torque at Q.

From the geometry of Figure 3.6 we obtain:

image (3.73)

where D is the distance of the wheels from the rotation point Q, and image are the driving forces of the wheels.

The rotation of each wheel is described by the dynamic equation:

image (3.74)

where image is the common moment of inertia of the wheels, image is the angular position of wheel image, imageis the linear friction coefficient, image is the common radius of the wheels, image is the driving input torque of wheel image, and image 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: image

Thus, we obtain the inverse kinematics equations from image to image as:

image (3.75a)

image (3.75b)

image (3.75c)

Using Eqs. (3.69)(3.75c) we get after some algebraic manipulation:

image (3.76a)

image (3.76b)

image (3.76c)

where:

image

image

Finally, combining Eqs. (3.67), (3.68), and (3.76ac) we get the following state–space dynamic model of the WMR’s motion:

image (3.77a)

image (3.77b)

where:

image

image

image

image

image

The azimuth of the robot in the world coordinate frame is denoted by image, where image (image denotes the angle between image and image, that is, the azimuth of the robot in the moving coordinate frame). Then:

image

Whence:

image (3.78)

where the positive direction is the counterclockwise rotation direction. It is noted that the motions along image and image are coupled because the dynamic equations are derived in the world coordinate frame. But since the rotational angle is always equal to image, despite the fact that image 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:

image (3.79)

where:

image

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.

Example 3.2

Derive the dynamic equations of the three-wheel omnidirectional robot using the unit directional vectors image of the wheel velocities.

Solution

To simplify the derivation we select the pose of the WMR in which the wheel 1 orientation is perpendicular to the local coordinate axis image as shown in Figure 3.7 [15]. Thus the unit directional vectors image, and image are:

image (3.80)

image

Figure 3.7 The three-wheel omnidirectional mobile robot (image perpendicular to image).

The rotational matrix of image with respect to imageis given by (3.67).

Therefore, the driving velocities image of the wheels are:

image

or

image (3.81)

where:

image

This is the inverse kinematic model of the robot. Now, applying the Newton–Euler method to the robot we get:

image (3.82a)

image (3.82b)

where image is the magnitude of the driving force of the ith wheel, m is the robot mass, image is the robot moment of inertia about Q, and:

image (3.83)

are two-dimensional vectors found using Eqs. (3.67) and (3.80). The driving forces imageimage are given by the relation:

image (3.84)

where image is the voltage applied to the motor of the ith wheel, “a” is the voltage–force constant, and image is the friction coefficient.

Combining Eqs. (3.82a,b), (3.83), and (3.84) we obtain the model:

image (3.85a)

where:

image (3.85b)

image (3.85c)

The model (3.85ac) has the standard form of the robot model described by Eqs. (3.11) and (3.13).

Example 3.3

We are given a car-like robot where there are lateral slip forces and longitudinal friction forces on all wheels. It is desired to write down the Newton–Euler dynamic equations in the form (3.60ad).

Solution

The free-body diagram of the robot is as shown in Figure 3.8.

image

Figure 3.8 Free-body diagram of the car-like WMR.

We use the following definitions:

image

where the upper index r refers to the right wheel and the upper index l to the left wheel. Therefore, considering the bicycle model of the WMR we get the following Newton–Euler dynamic equations in the local coordinate frame:

image

where all variables have the meaning presented in Section 3.4. From this point the development of the full model can be done as in Section 3.4.

3.6 Four Mecanum-Wheel Omnidirectional Robot

We consider the four-wheel omnidirectional robot of Figure 3.9A [3].

image

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 image and image acting on the robot in the x and y directions are:

image (3.86a)

image (3.86b)

where image 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 image where:

image (3.87)

The torque image that produces pure rotation is:

image (3.88)

where positive rotation is in the counterclockwise direction.

The Newton–Euler motion equations are:

image (3.89a)

image (3.89b)

image (3.89c)

where image, and image are the linear friction coefficients in the x, y, and image motion, and image are the mass and moment of inertia of the robot. Equations (3.89ac) show that the robot can achieve steady-state velocities image and image equal to:

image (3.90)

Example 3.4

The problem is to calculate the wheel angular velocities which are required to achieve a desired translational and rotational motion (WMR velocities v and image) of the mecanum mobile robot of Figure 3.9A.

Solution

A solution to this problem was provided by the relations (2.84) and (2.85). Here we will provide an alternative method [3]. We draw the displacement and velocity vectors of a single wheel which are as shown in Figure 3.10A and B, where “image” is the roller angle image.

image

Figure 3.10 (A) Displacement vectors of a wheel and roller and (B) velocity vectors (image is the rollers angle).

The vector image represents the displacement due to the wheel rotation (in the positive direction), image represents the displacement vector due to rolling which is orthogonal to the roller axis, and image represents the total displacement vector. The dotted horizontal lines represent the discontinuities where the roller contact point transfers from one roller to the next. In Figure 3.10, the point A was selected in the middle of this discontinuity line to facilitate the calculation.

From Figure 3.10B we get image because the components of image and image along the roller axis are equal. Therefore:

image (3.91)

for image. If image, the rotation of the wheel does not produce translation motion of the rollers. Solving Eq. (3.91) for v we get:

image (3.92)

When image, the rotational speed image of the wheel must be zero, but the wheel can have any value of translation velocity because of the motion of the other wheels.

We now calculate the wheel angular velocity image for a desired translational motion velocity v. From Eq. (3.90), we see that the wheel velocity is proportional to the forces applied by each wheel, that is:

image proportional to image,” and because the WMR is a rigid body, all wheels should have the same translational speed, that is:

image

Therefore, from Eq. (3.92) we have:

image (3.93)

Equation (3.93) gives the velocities image of the four wheels needed to get a desired translational velocity v of the robot.

Finally, we will calculate the wheel angular velocities required to get a desired rotational speed image. Consider a robot with velocity v. Then the instantaneous curvature radius (ICR) of its path is:

image (3.94)

These relations give the following world frame coordinates image of the ICR (Figure 3.11):

image

image

Figure 3.11 Geometry of wheel i with reference to the coordinate frame image. Each wheel has its own total velocity image and angle image.

The geometry of each wheel is defined by its position image and the orientation image of its rollers. Let image be the contact point of wheel i then:

image (3.95)

where image is the same for all wheels due to the symmetry of the wheels with respect to the point Q. The distance image of the ICR and the contact point image is given by the triangle formula, as:

image (3.96)

The velocity image of the wheel should be perpendicular to the line image. Therefore, the angle image of the line image with the x-axis is determined by the relation:

image (3.97)

whence:

image (3.98)

because, in Figure 3.11, image is actually negative image. Now, in view of Eq. (3.94) we have:

image (3.99)

Finally, using Eq. (3.99), Eq. (3.93) gives:

image (3.100)

for image, where r is the common radius of the wheels. Equation (3.100) gives the required rotational speeds of the wheels in terms of the position image of ICR and the desired rotational speed image of the robot. Actually, in view of Eqs. (3.94) and (3.96), Eq. (3.100) gives image in terms of the known (desired) values of image, image, image, and image.

Example 3.5

It is desired to describe a way for identifying the dynamic parameters of a differential-drive WMR by converting its dynamic model to a linear form which uses the robot linear displacement in place of image, and image.

The nonlinear dynamic model of this WMR is given by Eqs. (3.30a,b) and (3.31) which is written as:

image

where image and image are the dynamic parameters to be identified. Using the robot’s linear displacement:

image

in place of the components image and image (Figure 2.7) we get the linear model:

image

which reduces to:

image (3.101)

This is a linear model with two outputs image and image. The identification will be made rendering the model (3.101) to the standard linear regression model:

image (3.102)

where:

image

image

The matrix image is known as “regressor matrix.” Under the assumption that image is independent of image, and image the solution for image is given by3:

image (3.103)

To convert Eq. (3.101) into the regression form (3.102) we discretize it in time using the first order approximation: image, where image and image is the sampling period. Then, Eq. (3.101) becomes:

image (3.104)

where image. Clearly, the parameters image and image are identifiable, but the difficulty is that image cannot be measured. To overcome this difficulty we use a second-order parametric representation of image, and image, namely [16]:

image

with boundary conditions:

image

From the above conditions, the parameters image and imageimage are computed as:

image (3.105a)

image (3.105b)

The approximate length increment image of image is given by:

image (3.106a)

where:

image (3.106b)

Equation (3.106a) is an integral equation, the close solution of which is available in integral tables. The sign of image, which determines whether the robot moved forward or backward, can be determined by the following relation:

image

where image is the current position and image is the past position of the robot. Several numerical experiments performed using the above WMR identification method gave very satisfactory results for both image and image [16].


3Equation (3.103) can be found by minimizing the function image with respect to image. An easy way to get Eq. (3.103) is by multiplying Eq. (3.102) by imageand solving for image, under the assumption that image (image independent of image,and rank image. Actually, Eq. (3.103) is image where image is the generalized inverse of image (Eq. (2.8a)).

Example 3.6

Outline a method for applying the least squares identification model (3.102)(3.103) to the general nonholonomic WMR model (3.19ab)

Solution

The model (3.19a,b):

image

is put in the form:

image

where image is the vector of unknown parameters The above model can be written in the form (3.102) by computing image as:

image (3.107)

where image and T is the sampling period of the measurements.

Now, defining image and image as:

image

The model (3.107), after N measurements, becomes:

image (3.108)

This method overcomes the noise problem posed by the calculation of the acceleration. The optimal estimate image of image is given by Eq. (3.103):

image (3.109)

The identification process can be simplified if it is split in two parts, namely: (i) identification when the robot is moving on a line without rotation, and (ii) identification when the robot has pure rotation movement. In the pure linear motion we keep the angle image constant (i.e., image), and in the pure rotation motion we have image (i.e., image and image) [17].

References

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.

..................Content has been hidden....................

You can't read the all page of ebook, please click here login for view all page.
Reset
3.145.191.22