Geometric model for differential wheeled mobile robot

In the following, the geometric model is a mathematical transformation where the inputs are the angular velocities of the wheels (usualy measured with encoders) and the output is the pose (position and orientation) of the mobile robot in the working space.

Problem specification

We focus here on a differential wheeled mobile robot. Such robot is composed of two wheels aligned on the same axis. Here is an illustration of Rat-Courci, a small differential wheeled robot designed for the Micromouse competition:

3D CAD rendering of a mobile robot

The wheel diameter is given by \(D=2.r\) where \(r\) is the radius. The distance between the center of the robot and the wheels is given by \(l\), the distance between wheels is \(2 \times l \) according to the following illustration:

Dimensions and parameters of the differential mobile robot

We’ll assume that the following parameters are known:

Top view for the mobile robot, parameters and frames

Our goal is to calculate the pose of the robot according to the upper figure:

Elementary displacement calculation

First, let's calculate the linear velocity of each wheel:

$$ \begin{array}{r c l} v_l &=& r.\omega_l \\ v_r &=& r.\omega_r \end{array} $$

The average velocity of the robot is then given by:

$$ v_{robot}=\frac {v_l + v_r} {2} $$

The robot velocity can now be projected along the \(x\) and \(y\) axes:

$$ \begin{array}{r c l} \Delta_x &=& v_{robot}.cos(\psi) &=& \frac {r}{2} [ \omega_l.cos(\psi) &+& \omega_r.cos(\psi) ] \\ \Delta_y &=& v_{robot}.sin(\psi) &=& \frac {r}{2} [ \omega_l.sin(\psi) &+& \omega_r.sin(\psi) ] \end{array} $$

The angular velocity of the robot is given by the difference of the wheels linear velocities:

$$ 2.l.\Delta_{\Psi}=r.\omega_r - r.\omega_l$$

Previous equation can be reformulated as:

$$ \Delta_{\Psi}=\frac {r.\omega_r - r.\omega_l} {2.l} $$

The elementary displacement of the robot is given by the following relation:

$$ \left[ \begin{matrix} \Delta_x \\ \Delta_y \\ \Delta_{\Psi} \end{matrix} \right]= \frac{r}{2} \times \left[ \begin{matrix} cos(\psi) & cos(\psi) \\ sin(\psi) & sin(\psi) \\ \frac{1}{l} & \frac{-1}{l} \end{matrix} \right] \times \left[ \begin{matrix} \omega_r \\ \omega_l\end{matrix} \right] $$

Absolute position

The absolute position can be calculated thanks to the following equations:

$$ \begin{array}{r c l} x_{i}&=&x_{i-1}+\Delta_x \\ y_{i}&=&y_{i-1}+\Delta_y \\ \Psi_{i}&=&\Psi_{i-1}+\Delta_{\Psi} \end{array} $$

where

Of course, this model has some limitations. The result is highly dependant on the accuracy of the robot (mechanical assembly, wheel diameter, distances ...). We assume that wheels rotate without any slippery problems which is not true in practice. We also assume that the sampling rate is fast enough to assume that \(\Delta_x\), \(\Delta_y\) and \(\Delta_\Psi\) will remain elementary displacements.

See also


Last update : 06/12/2018