Odométrie

L’odométrie est une technique permettant d'estimer la position d'un véhicule en mouvement. Le terme vient du grec hodos (voyage) et metron (mesure). Cette mesure de bas niveau est présente sur quasiment tous les robots mobiles, grâce à des capteurs embarqués permettant de mesurer le déplacement du robot (de ses roues).

Principe

L'odométrie repose sur la mesure individuelle des déplacements des roues pour reconstituer le mouvement global du robot. En partant d'une position initiale connue et en intégrant les déplacements mesurés, on peut ainsi calculer à chaque instant la position courante du véhicule.

Modèle de déplacement

Pour calculer le mouvement global du robot à partir des mesures odométriques, il est nécessaire de disposer d'un modèle décrivant le déplacement du robot. L'exemple le plus courant en robotique est celui d'un robot dont le déplacement est contrôlé par le différentiel de vitesse entre les deux roues motrices.

Nous noterons :

• d_g et d_d les déplacements respectifs des roues gauche et droite
• v_g et v_d les vitesses respectives des roues gauches et droite
• x,y,θ les coordonnées du robot (position et orientation)
• d le déplacement du robot
• v la vitesse du robot
• e l'écart entre les deux roues

Modèle direct

Si on suppose que la trajectoire du robot est un cercle de rayon R parcouru à la vitesse angulaire (R > 0 si le cercle est parcouru dans le sens trigonométrique), alors on a :

Dans ce cas, les vitesses des roues sont données par :

Nous avons donc construit un modèle direct du déplacement du robot (i.e. un modèle permettant de calculer les vitesses v_g et v_d des roues en fonction des paramètres de la trajectoire globale v et R.

Modèle inverse

L'odométrie va cependant nécessiter la connaissance du modèle inverse du déplacement du robot : connaissant les mesures odométriques, nous cherchons à retrouver les paramètres de la trajectoire. Nous pouvons supposer qu'à chaque instant et durant un intervalle de temps très court, la trajectoire du robot s'apparente à un cercle. Il nous suffit donc d'inverser le modèle direct précédemment construit pour un cercle, et nous pourrons reconstruire le rayon de courbure local de la trajectoire et la vitesse du robot.

L'inversion du système précédent nous donne :

Calcul d'odométrie

Nous sommes maintenant en mesure de mettre à jour la position du robot en temps réel :

• à chaque instant, les mesures odométriques nous donnent les déplacements des roues d_g et d_d depuis l'instant précédent
• le modèle inverse (dans lequel l'intervalle de temps a été éliminé et les vitesses remplacées par des déplacements) nous permet de calculer le déplacement d du robot et le rayon de courbure instantané R de la trajectoire.
• on calcule le changement d'orientation dθ du robot et les coordonnées du centre O du cercle trajectoire:

• on met à jour la position du robot :

Liens externes

• http://www.seattlerobotics.org/encoder/200108/using_a_pid.html
• http://www.simreal.com/twiki/bin/view.pl/Simreal/Odometry
• Implémentation d'une odométrie dans un FPGA (ClubElek)
• Calcule d'odomètrie dans l'approximation traprèze (ClubElek)

• Portail de la robotique