Position et détection d'obstacle
Sommaire
Présentation
Notre projet à pour but de concevoir un robot pour participer à La coupe de France des IUT GEII à Cachan
Dans cette partie nous allons nous concentrer sur la position du robot sa navigation et sa faculté a éviter les obstacles décrit dans le règlement.
Codeur rotatif
Afin de connaitre la position des roues, de savoir de combien elles ont tournés nous utiliserons un codeur rotatif. Les codeurs rotatifs sont un type de capteurs permettant de délivrer une information d'angle, en mesurant la rotation effectuée autour d'un axe. L'information de vitesse peut alors être déduite de la variation de la position par rapport au temps. Plus le codeur rotatif tourne lentement, plus la déduction de vitesse perd en précision.
Il existe 2 principaux types :
- Le codeur rotatif incrémental qui ajoute ou soustrait (selon le sens de rotation) une unité à un compteur à chaque rotation supérieure à la résolution du capteur. Le compteur est généralement remis à zéro lorsque l'appareil est allumé. C'est le cas de la souris d'ordinateur à boule.
- Le codeur rotatif absolu qui intègre son propre compteur. Ce genre de capteur est généralement calibré et initialisé une seule fois, et il conserve normalement sa valeur lors de l'arrêt de l'appareil. C'est le cas des compteurs kilométriques des automobiles à la différence du "compteur journalier" qui peut être remis a zéro par l'utilisateur.
Nous utiliseront des codeurs incrémentaux fixé sur les axes des deux moteur ce qui nous permettra d'asservir la rotation des robot c'est à dire que nous pourrons avoir un retour sur les commande du moteur de plus on connaîtra l'angle pris par le robot par rapport a sa position de départ. En effet ce genre des capteur a plus de précision par rapport à l'autre car en réinitialisant il va supprimé les erreurs accumulé .
équation de positionnement
Le positionnement du robot en intégration les information reçu des codeur incrémentaux qui constituera des petits déplacements avec les quelle on pourra nous positionner.
Il y a en fait deux manières d'approximer la trajectoire parcourue par le robot pendant un temps :
- En utilisant des segments de droites. On considère alors que le robot va en ligne droite pendant le temps . Ceci revient à supposer que les deux roues ont une vitesse constante et identique sur cet élément de trajectoire. A la fin de cet élément de trajectoire, on corrige l'orientation du robot en fonction de la différence de distance parcourue par les deux roues
- En utilisant des arcs de cercles(permet de tourner) . On considère alors que le robot se déplace et change d'orientation en suivant un arc de cercle pendant le temps . Ceci revient à considérer que chacune des roues a une vitesse constante sur la période mais que les vitesses des 2 roues ne sont pas identiques.
et on peux cacluler les positionement en calculant la distance parcouru et le temps fonctionnement des 2 roues :
et donc on peut accéder à position (coordonnées x,y)
Réalisation de la roue codeuse
Nous avons pris les mesures du moteur et du châssis imposé pour la compétition afin de fabriquer notre roue codeuse puis nous l'avons représenter sur le logiciel de création de Charly robot. Nous avons choisit des fentes ouvertes sur l’extérieur, c'est a dire pas de contour la taille de la fente est limité par les outils que nous avons une fraise de 2 mm donc la taille de nos fente est de 2 mm une taille minimal permet une précision maximal lors de la rotation. La première roue que l'on a usiner était trop fine et donc pas assez rigide :
nous avons donc choisit de mettre deux épaisseurs l'une plus fine (1 mm) pour la partie extérieur et l'autre plus épaisse pour la partie intérieure de la roue (2 mm). :
Réalisation du montage électronique
le montage Electronique a pour but d'avoir les signaux de l'optocoupleur TCUT 1300 pour nous permettre de compter les numéros d’encoche parcouru et savoir le sens de rotation grace aux 2 phototransistor . On a d'abord utilisé le montage d'un groupe qui a travaillé sur le projet avant nous , toutefois leur montage n'a pas fonctionner . On a fini par modifié leur montage pour pouvoir le programme et on a abouti au monter suivant :
- Si il y de la lumiere emit par la photodiode et recu par le photo-transistor on a un état logique "1" => trou
- Si il y a quelque chose assez absorbant de rayonnement IR entre la photodiode et le photo-transistor on a un état logique "0" => pas trou.
et donc on devra avoir une signal de cette allure :
Phase de test
On a eu une problème c'est quand la roue codeuse tourne rapidement on arrive plus à détecter la trou donc l’état 0 :
Pour la résoudre on a utilisé à la place d'un RE résistance fixe une résistance variable qu'on a tester les différence valeur à fin d'avoir un rapport cyclique le proche possible de 50% quand on est au vitesse maximal . En effet cette problème est du à la présence d'un capacité au montage donc si on tourne rapidement le rue codeuse la circuit ne peux plus détecter le 0 à cause la constante de temps R*C trop petit donc il faut augmenté R à fin que le temps de réponse sera plus rapide .En effet si RE est petit la tension n'aura pas de temps de descendre puis remonter donc elle reste à l’état haut .
REMARQUE :
- On place un condensateur en parallèle de chaque phototransistors pour filtrer les éventuelles pics qui pourraient venir perturber le fonctionnement des capteurs.
- On a inserer un condensateur de découplage à fin de filterer les pic provenant d'alimentation
Réalisation de la carte
Suite à la phase de test nous avons commencé la conception de la carte
Le schéma:
Le board :
Tout sera relié à un microcontrôleur en occurrence c'est ATtiny10 (mais on a fait les testes en utilisant un arduino Uno) car c'est la moins chere et presente 5 pin qui nous suffit largement (voir annexe pour la documentation )
Compter le numéro d’encoche et détermination de sens
Il faut faire un programme qui, à partir des signaux obtenu dans la partie montage électronique compte le numéro d’encoches tout en tenant compte de sens de rotation !
Il faut tout d'abord initialisé un sens comme le sens direct qui , à chaque encoche parcouru incrémentera le compteur d'un et diminuer à chaque encoche parcouru dans le sens inverse .
Pour détecter dans quelle sens la rue tourne, on compare le retard juste après la changement (on peut comparé juste après la phase montante ou que après la phase descendante mais pour un meilleur précision on compare pour les 2 phases) d'état de la signal A par rapport à la signal B de l’optocoupleur , en effet il y a 4 cas de figures possibles :
- La signal A =1 et B=1 ==> sens directe ==> on incrémente
- La signal A =1 et B=0 ==> sens directe ==> on diminue
- La signal A =0 et B=1 ==> sens directe ==> on diminue
- La signal A =0 et B=0 ==> sens directe ==> on incrémente
Maintenant il faut écrire le programme :
- En premier temps on a fais le programme en utilisant les fonctions que la bibliothèque d'arduino nous offre pour tester et bien comprendre.
Voici donc le programme:
Programme comptant les encoches
volatile int s=0;
void setup()
{
Serial.begin(9600);
attachInterrupt(0, counnt, CHANGE);
}
void loop()
{
Serial.println(s);
}
void count()
{
if (digitalRead(2)==HIGH)
{
if (digitalRead(3)==HIGH) s++ ;
else s-- ;
}
else
{
if (digitalRead(3)==HIGH) s-- ;
else s++ ;
}
}
- Puis pour essayer d'amiliorer on a programmer les differant registres directement à fin d'amiliorer la vitesse d'excustion tache faite dans la microcontrôleur , en effet il y a une augementation d'un facteur de 30 en programmant les registre .
Voici donc le programme:
Programmation des registres pour compter les encoches
#include <avr/io.h>
volatile int s=0;
ISR(INT0_vect) // programmed'interruption : le programme principal est interrompu,
{ // l'interruptionexécutée et ensuite le programme principal continu normalement sonexécution
if (PORTD&(1<<PIND2)==HIGH)
{
if (PORTD&(1<<PIND3)==HIGH)
s++ ;
else
s-- ;
}
else
{
if (PORTD&(1<<PIND3)==HIGH)s-- ;
else s++ ;
}
}
void setup()
{
Serial.begin(9600);
cli(); // arrêt desinterruptions
EICRA=0x01; // mode dedéclenchement de l'interruption : change
EIMSK=0x01; // choix desinterruptions actives : interruption 0
sei(); // autorisation desinterruptions
}
void loop()
{
Serial.println(s);
}
programme finale : Obtention des coordonnées x , y , l'angle
Transmissions des coordonnées vers la carte principal
Contrainte et choix de support de transmission
Les constraint :
- Support du transmission le plus rapide à fin une meilleur precision et comptage de nombre d'encouches peu importe à quel vitesse le robt tourne .
- notre carte comunique que avec la carte mere à fin d'envoyer les coordonné donc on pas besoin juste d'un seul fil pour le transfert de donné => pas besoin de beacoup de conxeion sans oublier la masse & le vcc.
- le type de reseau qu'on cherche est maitre-esclave : carte mere- notre carte qui envoi les information sachant que notre microcontrleur supporte que i²c et SPI : on debut on fais une comparaison général des differant supprt de transmission puis on se lmite au I²C et SPI à fin d'en choisir un
en comparant les diferant support de transmission presenté dans le tableau on peu voir que:
- 1wire, i2c & SMBUS sont lents ce qui nous induit au erreur de posionnement => on ne prend pas .
- Il nous reste CAN, SPI et M-BUS qu'on peux prendre => on essai de prendre le plus facile et le plus compatible :
- le M-BUS est peu compatible => on prend pas .
- le CAN est relativment complexe => on prend pas .
- le SPI est relativment facil et je l'ai utlisé au paravant => on prend .
Explication de SPI
SPI ( Serial Peripheral Interface) est une liason serie sychronisé à l'aide d'un horloge ,de type maitre esclave .
Le bus SPI est composé de 4 signaux logiques :
- SCLK — Serial Clock, Horloge (généré par le maître) permet de sychronisé la transmission de donnés .
- MOSI — Master Output, Slave Input (généré par le maître et envoyé à l'esclave )
- MISO — Master Input, Slave Output (généré par l'esclave et envoyé au maître )
- SS — Slave Select, Actif à l'état bas (généré par le maître)
Donc en gros on met SS =0 puis à l'aide de MISO on envoi x,y,phi puis on remet SS=1 .
Annexes
Pages en relation avec le positionnement
http://manubatbat.free.fr/doc/positionning/node5.html
http://www.pobot.org/Asservissement-d-un-moteur-a.html
