^{1}

^{*}

^{1}

^{1}

^{1}

The aim of the paper is trajectory tracking control of a non-holonomic mobile robot whose centroid doesn’t coincide to its rotation center in the middle of connecting axle of driving wheels. The nonholonomic dynamic model of the Wheeled Mobile Robot (WMR) is developed in global Cartesian coordinates where the WMR’s forward and angular velocities are used as internal state variables. In order to include the effects of parameter uncertainties, measurement noises and other anomalies in the WMR system, a bounded perturbation vector is embedded to the developed dynamical model. Through defining the control inputs by computed torque method, a Dynamic Sliding Mode Controller (DSMC) is proposed to stabilize the sliding surfaces. Based on the proposed robust control system, the effect of uncertainties and noises in the robot performance is attenuated. By use of the WMR forward and angular velocities as internal state variables in the dynamic modeling, the developed model is relatively simple and mainly independent of the robot states. This makes the dynamical model more robust against measurement errors. Design of the DSMC based on such a model leads to perfect trajectory tracking and compensation for initial off-tracks even in the presence of disturbances and modeling uncertainties.

Nowadays, Wheeled Mobile Robots (WMRs) have found many applications in industry, transportation, and inspection fields. Therefore, trajectory tracking control of nonholonomic WMRs has been an important problem in state of the art research works of recent literatures.

The assumption of pure rolling and not slipping motion leads to a non-integrable constraint in the kinematics of nonholonomic mobile robots. Since a non-holonomic system cannot be stabilized via smooth state feedback methods, the conventional linear control theories may not be applied to this class of systems [

As a robust control approach, sliding mode controller (SMC) is recently receiving increasing attentions. The advantages of using SMCs are fast response, good transient performance and significant robustness against perturbations and noises. This method is also respectively simple and doesn’t have complexities. The trajectory tracking of a nonholonomic WMR based on an improved sliding mode control method has been done in which the switch function of the variable structure control is designed based on the back stepping technique [

In this paper, we propose a new control law that stabilizes the WMR around the given reference trajectory. The developed dynamic model includes inertia moment of driving wheels, the total mass and inertia moment of WMR which has a centroid offset from the connection center of its driving wheels. Following linearizing the error dynamics of WMR through the computed torque method, a sliding mode control law is applied for stabilizing the robot around its reference trajectory even in the presence of exogenous disturbances/noises and modeling uncertainties.

The recent controllers in the literatures have been limited for implementations in special kind WMRs; for instance, the heading direction of the WMR should be tangent to the circular trajectory around the origin of the global coordinate system. Furthermore, both the reference and the real trajectory should not cross through the origin after starting over the initial position; and the initial position of reference trajectory is always set to be the origin of coordinates; or the angular velocity of WMR is assumed to be nonzero during trajectory tracking. However, in this paper, due to design of the WMR control system in a global Cartesian coordinate frame, the proposed DSMC doesn’t rely on the aforementioned limiting assumptions. Therefore, as it will be shown in the simulation results, the proposed control law results in smooth tracking and considerable robustness against perturbations and measurement noises. The rest of the paper is organized as follows:

In Section 2 using dynamics of nonholonomic mechanical systems and the kinematic model of the WMR, a new dynamic model of WMR is derived. Section 3 is devoted to present the design process of the proposed DSMC which stabilizes the WMR around its reference trajectory in the presence of perturbations and measurement noises. In Section 4, to show the performance of the proposed controller, tracking control of WMR on a circular path is simulated.

As represented by Hu and Huo, many nonholonomic mechanical systems can be described by the following dynamic equations [

And the nonholonomic kinematic constraints are as:

where, and are respectively the generalized configuration and the control input vectors, respectively; is the constraint force vector; is a positive definite matrix; is the term which may include centripetal and Coriolis forces; is a full rank transformation input matrix; is a full rank matrix associated with the constraints. Let i = is a set of smooth and linearly independent functions such that:

Considering as the distribution spanned by the vectors, then from (2) it follows that, that is, there exists an dimensional pseudo-velocity vector, such that:

where,.

Differentiating (4) results in:

Substituting (5) into (1) and then pre-multiplying by gives:

Through pre-multiplying (6) by, the nonholonomic mechanical system (1) and (2) reduces to:

where, is a matrix; is a matrix and. Now, the proposed system (7) is used to dynamic modeling of the WMR.

For the purpose of dynamical modeling, and should be determined. The driving wheels of the considered WMR rotate by independent actuator motors. According to the schematic model in

The symbol, is the angle between x-axis and Xaxis representing the heading angle. denotes the velocity of the robot along x-axis and denotes the angular velocity. and are the angular velocities of the right and left driving wheels, respectively. and denote the length of driving axel and the radius of every driving wheel, respectively.

The position vector of the WMR, is defined as:

According to the recent research works [

The following rotation matrix transforming the veloc-

ity components between the global and local coordinate systems, play an important role in developing the kinematics of WMR:

Obtaining, in terms of from (12) and using (9) and (10), the nonholonomic constraint of the WMR is represented as:

According to (8) and (13), and; and therefore, z is a two dimensional vector. Considering and as internal state variables gives:

Therefore, (4) can be constructed in the following form which is known the kinematic model of the WMR.

Now the following Lagrangian is considered for the WMR dynamic modeling [5,8].

where, is the total mass of the robot. is the moment of inertia around the axis crossing C and perpendicular to X-Y plane. The moment of inertia of driving wheels is shown by. By applying the Lagrangian approach, an equation like (1) is achieved, therefore, by comparing it with (1), and can be determined. Then, using (6) and (7), and can be easily computed. Finally, the dynamical model of the WMR is obtained as:

is the input torque vector in which and are the produced torques by the right and left driving wheels, respectively.

The purpose of the DSMC is computation of control inputs which make the WMR to track a feasible trajectory with bounded errors. The three dimensional posture variables of the reference trajectory are considered as,; the reference velocity and the acceleration vectors are derived by as, and, respectively. The real world robotic systems have inherent system perturbations such as parameter uncertainties and external disturbances. Therefore, dynamical equations of the WMR are represented as:

where, the perturbation vector, considers the uncertainty and disturbance effects in the dynamical model. It is assumed that is energy bounded and satisfies the uncertainty matching condition as:

and are the upper bounds of the perturbations.

First, the position and the orientation errors are defined as:

To stabilize the tracking errors, the sliding surfaces are defined as:

where and are positive fixed parameters. If is asymptotically stable, then and will converge to zero asymptotically. Because if then. Therefore, if then and if then. Therefore, the equilibrium state of is asymptotically stable. Similarly, if is asymptotically stable, and asymptotically converge to zero. Thus, if and become stabilized, the convergence of the WMR to the predetermined reference trajectory is guaranteed.

The control input vector is obtained through the computed-torque method as a feedback-linearization method [

where is the control law. Applying the control input (21) into the dynamic equation of WMR (18), the feedback-linearized dynamic equation is given as:

Hence, from (22):

The control actions and which stabilize the sliding surfaces and are proposed as:

where are greater than, respectively; and, are real positive constant values. Lyapunov’s direct method is used to prove the stability of and by imposing and. Substituting and in (22) and (23), respectively, yields and as:

According to Lyapunov’s direct method, the following Lyapunov function is introduced.

Taking the time derivative of V along the state trajectory gives:

Replacing and from (25) and (26) in (28) results in the following negative definite,.

Therefore, and are asymptotically stable and therefore, the WMR will converge to the desired reference trajectories. It should be noted that due to using the sign term in the designed controller, the chattering phenomenon may occur when the posture state errors are negligible values. To weaken the unwanted chattering phenomenon, some continuous functions, for example a saturation term could be used to approximate the sign term.

To assess the effectiveness of the proposed DSMC, software simulations using MATLAB/SIMULINK are implemented. The simulations of tracking a circular trajectory are performed in which the desired position, orientation, velocities and acceleration of the WMR is monitored. Figures 2-7 show the trajectory tracking performance of the designed control system of the WMR to compensate large initial off-tracks in the absence of uncertainties and measurement noises. According to Figures 2-7, by use of the proposed DSMC, the tracking errors of posture and velocity trajectories with respect to corresponding reference values smoothly converge to zero and therefore, a perfect trajectory tracking is obtained. On the other hand, the bounded control inputs of

Sliding mode control systems are known for robustness against parameter uncertainties and stochastic noises. To show this property of the proposed DSMC, Gaussian measurement noises are considered together with the measured posture variables. By the way, the simulated tracking performance of the WMR in the presence of measurement noises is shown in Figures 8-14. According to these figures, one can see that the DSMC keeps the posture and the velocity errors in a bounded small range and thus makes the WMR to track its reference trajectory

perfectly. For example, as

A dynamic sliding mode controller for trajectory tracking control of a nonholonomic WMR has been proposed where the center of mass of the vehicle does not coincide to the middle point of connection center of driving wheels.

The proposed controller is designed based on the developed dynamical model of the WMR in a global Cartesian coordinate system. According to simulation results, the designed DSMC keeps the WMR on the reference trajectory even in the presence of exogenous disturbances/ noises. Furthermore, in the proposed DSMC, bounded control torques lead to compensation of large off track.