Différences

Cette page vous affiche les différences entre la révision choisie et la version actuelle de la page.

--- robotics:asservissement_d_un_robot [2014/09/24 11:09]
ldo créée
+++ robotics:asservissement_d_un_robot [2014/11/28 14:05] (Version actuelle)
ldo [Asservissement différentiel]
@@ Ligne 22: / Ligne 22: @@
 ==== Asservissement simple ====
-Le robot est équipé de deux moteurs CC. La première solution est d'asservir les deux moteurs indépendamment. Cette solution fonctionne bien si les moteurs sont sensiblement identiques.
+Le robot est équipé de deux moteurs CC. La première solution est d'asservir les deux moteurs indépendamment (l'asservissement de position d'un moteur est expliqué [[robotics:asservissement_d_un_moteur|ici ]]). Cette solution fonctionne bien si les moteurs sont sensiblement identiques.
 En asservissant les deux moteurs séparément, on devrait théoriquement avoir la même réponse et le robot devrait rouler droit. Malheureusement, en pratique, 2 moteurs d'une même série ne sont pas exactement identiques (inertie, résistance, jeu du réducteur...) donc même en appliquant la même consigne aux moteurs, les 2 vont réagir différemment. Si un des moteurs est plus réactif, il va accélérer plus vite que l'autre et le robot va tourner sur lui même au lieu d'aller tout droit.
 ==== Asservissement différentiel ====
+=== Principe ===
 Il faut donc travailler sur l'ensemble des 2 moteurs en asservissant un moteur en tenant compte de l'autre. En couplant l'asservissement du moteur droit à celui du moteur gauche, si le moteur gauche prend du retard sur le moteur droit, le moteur gauche va accélérer alors que le moteur droit va ralentir.
-On va donc définir une vitesse linéaire et une vitesse angulaire à partir de la vitesse de chaque moteur :
+=== Position et vitesse ===
+Pour plus de simplicité, nous allons travailler en coordonnées polaires et donc définir une position et une vitesse, linéaire et angulaire pour l'ensemble du robot.
-vitesselinéaire = (vitessemoteur_droit + vitessemoteur_gauche) / 2 \\
+Grâce aux encodeurs placés sur les moteurs, nous pouvons mesurer la vitesse des moteur droit et gauche. A partir de ces mesures, nous allons calculer la vitesse linéaire (vitesse de déplacement) et la vitesse angulaire (vitesse de rotation) du robot :
-vitesseangulaire = vitessemoteur_droit - vitessemoteur_gauche
-Si on veut que le robot aille tout droit, la consigne de vitesse angulaire doit être nulle et si on veut que le robot tourne sur lui même, c'est la consigne de vitesse linéaire qui doit être nulle. \\
+  * vitesse_linéaire_robot = (vitesse_moteur_droit + vitesse_moteur_gauche) / 2
+  * vitesse_angulaire _robot= vitesse_moteur_droit - vitesse_moteur_gauche
+A partir de ces 2 vitesses, nous allons déterminer la position du robot par [[robotics:odometrie|odométrie]].
+=== Asservissement ===
+L'asservissement va se dérouler en 2 étapes. D'abord on va asservir la position (x,y) du robot. Une fois que le robot est arrivé à la position consigne, on va asservir son orientation.
+== Etape 1 : Positionner le robot ==
+Dans un premier temps, nous allons chercher à positionner correctement le robot à sa position cible (x, y).
+Pour cela, nous allons calculer une erreur de distance et une erreur d'angle (erreur en coordonnée polaire):
+  * l'erreur_distance est la distance entre le robot et sa cible : erreur_distance = sqrt (square (x) + square (y))
+  * l'erreur_orientation est l'angle entre l'orientation du robot et sa cible : erreur_angle = atan (y,x) + orientation_robot
+== Etape 2 : Orienter le robot ==
+Une fois le robot positionné, il faut l'orienter correctement. La consigne de distance sera mise à zéro (erreur de distance = 0) et la consigne angulaire sera l'orientation O de la consigne initiale.
+  * l'erreur_distance est nulle
+  * l'erreur_orientation est l'angle entre la consigne O et l'orientation du robot : erreur_angle = O - orientation_robot;
+== Schéma ==
+Une fois que l'erreur de distance et orientation est calculée (étape 1 ou 2), nous appliquons 2 [[robotics:asservissement_d_un_moteur|asservissements de position/vitesse]] en parallèle (un pour la distance, l'autre pour l'angle). Puis nous allons coupler les commandes distance et angulaire pour obtenir les commandes moteurs droit et gauche.
+{{:robotics:asservissement_robot.png?600|}}
+=== Remarques ===
+== Fréquence d'asservissement ==
+Pour être réactif, l'asservissement doit être effectué régulièrement et fréquemment (ici nous prendrons 10 ou 20 ms). Si la fréquence est trop basse, le robot ne sera pas réactif et aura du mal à corriger. Au contraire, si la fréquence est trop élevée, les mesures (de vitesse principalement) ne seront pas significatives (0, 1 ou 2 pulses par cycles d'asservissement) et le robot ne corrigera pas bien.

Geonobot Wiki

Outils pour utilisateurs

Outils du site

Différences

Outils de la page