RobotRamasseur2014-1
Sommaire
Introduction
Dans le cadre du bureau d’étude notre groupe est chargé de concevoir un robot ramasseur de balle .En effet , le but de ce bureau d’étude est d'effectuer un match de foot entièrement avec des robots .Notre robot a pour rôle de repérer la balle , de se diriger vers cette dernière de l'attraper et de la remettre au centre du terrain et d'aller se garer dans son garage.Il a donc fallu concevoir et programmer notre robot afin qu'il effectue ces taches.
- Présentation rapide du BE et du jeu (à relire )
- Rôle de notre robot(à relire )
Construction du robot
Afin de bien remplir son rôle, il est nécessaire au robot de pouvoir se diriger vers la balle grâce à l'infrarouge, d'attraper celle-ci puis de se diriger grâce aux lignes situées sur le terrain. Il est donc indispensable de construire le robot de manière à ce qu'il puisse effectuer ces manœuvres. Il a donc fallu poser différents capteurs tels que le capteur couleur, le capteur infrarouge, le capteur ultrason et le capteur "touch". Il a également fallu construire une pince adaptée pour attraper la balle, l’immobiliser et à la transporter jusqu'au centre du terrain.
Pour ce robot il m'est pas important qu'il puisse avoir des variations de vitesse car lorsqu'il entre en jeu aucun autre robot n'est sensé être sur le terrain .De plus son rôle est uniquement de ramasser la balle et de la remettre au centre , il n'est donc pas important qu'il puissent accélérer .
1ère et 2ème versions
Nous avons attaqué la construction du robot par le système moteur, constitué des roues et de servomoteurs.
Dans la première version, nous étions partis sur un servomoteur pour chaque paire de roues, avant et arrière, et de ce fait, le robot ne pouvait pas tourner. En effet, pour lui permettre de tourner, il est nécessaire de donner des vitesses différentes aux côtés gauche et droit du robot. Nous avons donc décidé de placer deux servomoteurs pour les deux roues avant et par la même occasion, un troisième moteur pour la pince. Cependant un autre problème se posait alors, celui de relier les deux roues d'un même côté entre elles. Le problème a facilement été résolu grâce à l’installation de chenilles, permettant à la force motrice appliquée à la roue avant d'entraîner la roue arrière .
Puis nous avons continué d'assembler le robot afin que la structure motrice soit stable et solide . Cette structure doit être capable de supporter le poids de la pince, de manière à ce que celle-ci ne fasse pas basculer vers l'avant le robot tout entier une fois qu'il est posé au sol.
1ère version du robot
2ème version du robot
Version finale du Robot
La version finale est une version plus stable avec une pince mieux construite et l’ensemble des capteurs nécessaire aux fonctionnements de notre robot disposé de manière à optimiser leur utilisation . Nous allons maintenant détailler la construction et le placement de chaque élément de la version finale de notre robot.
Fonctionnement et fabrication de la pince
La pince a été fabriquée à partir d'un mécanisme d’engrenage. Pour pouvoir mettre en place ce système, nous avons tout d'abord commencé par déplacer le servomoteur dédié à la pince, jusque-là pris entre les deux roues avant.
Un premier engrenage est lié au servomoteur de manière à ce que l'activation de celui-ci engendre une rotation de la roue. A cette roue sera attaché le premier côté de la pince. Cet engrenage est collé a un autre engrenage, lui même lié à l'autre côté de la pince. Il était particulièrement important d'avoir un nombre pair de roues dentées, de manière à ce que les rotations des roues situées aux extrémités s'effectuent dans le même sens. C'est ce qui permet la fermeture des pinces. En effet, avec un nombre impair de roues dentées une partie de la pince irait vers l’intérieur alors que l'autre la fuirait. Il serait alors impossible d’attraper la balle.
Une fois le mécanisme conçu, il a fallu construire la pince elle-même. Nous avions d'abord opté pour une version uniquement construite à partir de bâtonnets assemblés entre eux comme on peut le voir sur la première version de la pince .De plus la pince était alors trop petite pour capturer la balle. C'est pourquoi , nous avons donc opté pour une version plus stable en agrandissant la pince et en ajoutant des jonctions afin de solidifier la structure et donner la forme voulu à la pince auquel nous avons ajouté des terminaisons plus stable et rendant plus pratique la capture de la balle .
Les différents capteurs et leurs placements
Le capteur couleur
Ce capteur fixé à l'avant du robot et orienté vers le bas permet de distinguer les couleurs des marquages situés au sol. En effet, les marquages au sol, déterminés par concertation avec les autres équipes, sont les principales indications concernant les directions vers lesquelles notre robot doit se diriger. Notre robot devra suivre des lignes au sol afin de se repérer et de déposer la balle au milieu du terrain après l'avoir ramassé.
Le capteur infrarouge
Ce capteur est situé juste à coté du capteur couleur et dirigé vers l'avant. C'est ce capteur qui permettra de détecter la balle et les buts. C'est le capteur principal utilisé pour se diriger dans la première phase d'action. Il devra être programmé de sorte à ce qu'il distingue les deux buts de la balle car tous deux émettent un signal infrarouge.
Le capteur ultrason
Le capteur ultrason est le capteur qui permet de détecter les objets matériels tels que les obstacles ou même la balle. Il est situé à l'avant du robot, un peu plus haut que la partie supérieure de la pince, afin que celle-ci n'obstrue pas le champ de vision du capteur. Son rôle principal est de détecter les obstacles afin de les éviter, et de détecter la distance du robot par rapport à la balle pour savoir quand celui-ci doit refermer ses pinces. Il est programmé de manière à faire demis tour lorsqu'il détecte un obstacle ( voir partie programmation )
Le capteur touch
Le capteur touch sert principalement à vérifier que la balle se trouve bien entre les pinces lorsque celles-ci se referment. Lorsque la balle est bien entre les pinces, ce capteur est enfoncé. C'est pour cette raison que nous l'avons placé sur la pince même. Ce capteur est utilisé en complément du capteur ultrason afin de repérer et d’attraper la balle correctement. Ainsi, si la pince se referme sans avoir réussi à attraper la balle, elle se rouvre automatiquement dès qu'elle s'aperçoit que le capteur n'a pas été enfoncé.
Ça capteur nous a posé quelques problèmes, la structure de la pince rendant son positionnement difficile. En effet , nous pensions d'abord le fixer directement au robot afin qu'il soit stable .Seulement avec déjà le capteur couleur et le capter infrarouge nous ne pouvions donc pas le placer à cette endroit . De plus il était impossible de le fixer là , car il aurait fallu fabriquer un système de plusieurs barre , qui serrais un raccord entre la structure du robot et ce capteur (été irréalisable par manque de place ) . Nous avons donc décidé de placer ce capteur directement sur la pince en compliquant un peu sa programmation .
((Le principe est de vérifier que , lorsque les capteurs l'indiquent , il y a fermeture de la pince .Une fois fermée il faut vérifier que la balle est bien à l’intérieur , c'est pourquoi une fois la balle entre les pinces fermées le capteur est positionné de manière à être enfoncé comme expliqué précédemment . ))
Programmation du Robot
A FAIRE
Nous avons opté pour la programmation du robot par le langage C, plutôt que par l'éditeur graphique.
Structure du programme
Nous avons d'abord commencé par réfléchir au parcours effectué par notre robot lors de sa mission. Cela nous a permis de découper notre programme en fonctions. Chaque fonction réalise une action (attraper la balle, etc). Nous avons ainsi pu classer la première partie des actions effectuées dans la catégorie capteur "Infrarouge" et la seconde dans la catégorie "Déplacement en suivant les lignes".
Plus tard, une mise au point avec les autres équipes a été faite, permettant d'affiner le découpage. Le robot doit ainsi :
- Aller vers la balle et la saisir (capteur infrarouge)
- Se diriger vers le but le plus éloigné jusqu'à rencontrer une ligne médiane (capteurs couleur et ultrason)
- Suivre la ligne médiane jusqu'à trouver son garage et retourner au centre du terrain (capteur couleur)
- Déposer la balle au sol et repartir se garer. (capteur couleur)
Nous avons fait le choix d'exécuter les fonctions les unes après les autres, le rôle de ramasseur de balles du robot ne nécessitant pas d'effectuer des actions simultanément.
Infrarouge
A l'origine, deux parties concernant ce capteur étaient prévues. Cependant, au cours de la réalisation du robot, nous nous sommes aperçues que lorsque le robot se déplace vers les buts, il a déjà la balle entre ses pinces, ce qui rend impossible une autre mesure au vu de la position du capteur. Cette action se fera donc grâce au capteur couleur.
Pour permettre au robot d'aller vers la balle, nous avons commencé par le faire suivre sa direction. Cela s'est cependant avéré être un mauvais choix : en effet, la direction du signal est donnée par la somme des signaux infrarouges, or sur le terrain il y a également deux buts émettant eux aussi dans l'infrarouge. Le robot se serait ainsi dirigé vers ce signal, c'est-à-dire là où il n'y a ni balle, ni buts. Une seconde approche de ce problème est de considérer la continuité des signaux : la balle émet en continu, contrairement aux buts qui, en boucle, émettent pendant plusieurs secondes puis s'interrompent une seconde. Il a donc fallu réussir à isoler le signal continu.
Pour cela, nous avions à disposition 5 signaux reçus par le capteur, chacun correspondant à une direction :
- A gauche vers l'arrière
- A gauche vers l'avant
- En face
- A droite vers l'avant
- A droite vers l'arrière
Les signaux varient entre 0 et 255.
Notre première solution a été d'utiliser un tableau du langage C à cinq cases, initialisé aux valeurs des cinq signaux, et un entier retenant le nombre de signaux qui ne se sont jamais éteints (le tableau permet de savoir quelle direction prendre une fois le signal continu trouvé). Ensuite, dans une boucle, on lit les signaux et on met à jour les valeurs du tableau dès qu'un signal est égal à 0. Cela nous permet ainsi d'éliminer les signaux dès qu'ils arrêtent de transmettre, jusqu'à ce qu'il n'en reste plus qu'un (le signal continu). Enfin, on tourne ou on avance en fonction de la direction du signal.
Ci-dessous, l'algorithme correspondant :
Déclaration du tableau à 5 cases "tab" et de l'entier "cpt"
Initialiser le tableau avec les valeurs des 5 signaux
Tant que cpt plus grand que 1
initialiser cpt à 0
Lecture du capteur infrarouge (récupération des nouvelles valeurs des signaux)
(Pour chaque signal) Si le signal est égal à 0 et que la case de tab correspondante est différente de 0
alors mettre 0 dans la case de tab
Pour un indice i allant de 0 à 5
si le tab à l'indice i est différent de 0
incrémenter cpt
Fin Pour
Fin Tant que
Si une case de tab correspondante à la gauche est différente de 0
alors tourner à gauche
Si une case de tab correspondante à la droite est différente de 0
alors tourner à droite
sinon
avancer tout droit
Cependant, nous observions un problème récurrent : il était parfois nécessaire d'agiter la balle pour que le robot la détecte pour la première fois. Nous nous sommes ensuite aperçues que ce problème venait de notre algorithme qui ne prenait pas en compte la taille de la balle. En effet, celle-ci étant assez large, elle se retrouvait parfois sur deux signaux du capteur à la fois. Nous avons ainsi dû modifier notre algorithme de façon à prendre en compte ces cas-là.
Si la balle se trouve sur deux signaux en même temps, alors elle sera sur deux signaux consécutifs. Pour implémenter cette solution, nous avons déclaré un nouvel entier "allume", initialisé à -1, dont le rôle est de retenir l'indice dans le tableau du dernier signal allumé. S'il est différent de -1 à la fin, au moins un signal a repéré la balle. Nous avons également géré les cas d'erreurs, c'est-à-dire lorsque la balle est sur deux signaux non-consécutifs ou sur plus de deux signaux à la fois.
Cet algorithme fonctionne toujours pour différencier la balle des buts, car si on repère un but sur un signal non-consécutif à celui de la balle, cela est vu comme une erreur et on recommence alors la démarche (on pourra se diriger vers la balle lorsqu'on sera dans l'intervalle de temps pendant lequel le signal infrarouge du but est éteint). Sinon si le but se trouve derrière ou à coté de la balle, ils sont dans la même direction donc cela n'a pas d'importance.
Dans cet algorithme nous avons également rajouté la gestion de l'ultrason pour détecter la distance par rapport à la balle et savoir quand fermer la pince; ainsi que le capteur touch, pour savoir si la balle a été attrapée correctement.
Ci-dessous, l'algorithme final :
Tant que vrai
Lecture du capteur infrarouge (récupération des nouvelles valeurs des signaux)
Assignation d'un signal à une case de tableau, pour les 5 signaux
Initialiser cpt à 0 et allume à -1
Pour chaque signal (indice i allant de 0 à 5)
Si allume est plus grand ou égal à 0 (un signal a été repéré plus tôt) et la valeur de la case actuelle du tableau est supérieure à 0 (un signal est repéré maintenant)
et le signal repéré maintenant n'est pas consécutif au signal repéré avant et qu'il ne correspond pas aux cases 0 et 4 du tableau
Alors on sort du pour (on recommence le tant que)
Si la valeur de la case actuelle du tableau est supérieure à 0 (un signal est repéré maintenant)
Alors on donne l'indice de la case actuelle à allume et on incrémente cpt.
Si cpt est plus grand que 2
alors on sort du pour (trois capteurs étaient allumés, on recommence le tant que)
Fin pour
Si allume est plus grand ou égal à 0 (un signal au moins a été repéré plus tôt) et que i correspond au nombre de signaux (on a parcouru tout le tableau donc on n'a pas eu de problème)
Alors on sort du tant que
Fin Tant que
Si une case de tab correspondante à la gauche est différente de 0
alors tourner à gauche
Si une case de tab correspondante à la droite est différente de 0
alors tourner à droite
Sinon si le capteur ultrason ne détecte rien en face
avancer tout droit
Sinon
On avance un peu, on ferme la pince.
Si on détecte la balle dans les pinces grâce au capteur touch
Alors on arrête
Sinon
on ouvre la pince et on recommence
Déplacement en suivant les lignes
Le robot doit commencer par se diriger vers le but le plus éloigné jusqu'à rencontrer une ligne médiane. Pour cela, nous avons décidé de le faire avancer tout droit jusqu'à, ou rencontrer un obstacle repéré par le capteur ultrasons (mur, but, ...), ou croiser une ligne médiane. S'il croise cette ligne, de couleur bleue, le relais est passé à la fonction suivante.
Le robot se déplace alors en suivant cette ligne jusqu'à détecter une autre ligne. Suivant sa couleur, l'action effectuée est différente :
- Si c'est le contour du terrain (couleur rouge) ou un ligne devant un but (couleur verte), alors il fait demi-tour et continue de suivre la ligne médiane.
- Si c'est le centre du terrain (couleur jaune), alors il fait un quart de tour et suit de nouveau la ligne médiane.
- Si c'est un garage (couleur noire), alors c'est forcément le sien; Les garages des joueurs se trouvent à l'intersection d'une ligne devant un but et du contour du terrain, alors que celui du ramasseur se trouve au bout d'une ligne médiane. Il est nécessaire pour le robot de trouver son garage avant de déposer sa balle, car sinon celui-ci ne sait pas où aller se garer et ne peut plus chercher le long des lignes médianes, la balle étant au centre du terrain.
Après avoir trouvé le garage, le robot fait demi-tour et suit la ligne médiane jusqu'au centre du terrain, puis il y dépose la balle. Après cela, il recule un peu, fait demi-tour et suit la ligne médiane jusqu'à son garage. Pour se garer, il lui suffit juste d'avancer le long de la ligne du garage puis de faire demi-tour.
Nous avons également donné au robot la capacité de corriger légèrement sa trajectoire s'il suit déjà une ligne médiane et que son capteur couleur voit du blanc, c'est-à-dire le terrain lui-même. Cela lui sera utile s'il croise perpendiculairement la ligne médiane : sans cela, il continuerait d'avancer tout droit et n'arriverait pas à la suivre.
Au cours des tests sur le vrai terrain, nous nous sommes rendu compte que le robot ne voyait pas du blanc lorsqu'il dévie de sa ligne de couleur comme sur le terrain en papier, mais du noir. En effet, les lignes étant larges, lorsque le robot dévie, son capteur couleur voit à la fois la ligne et le blanc du terrain, ce qu'il interprète alors comme du noir.
Un problème majeur se pose alors : comment différencier une déviation, vue comme du noir, de la ligne du garage de couleur noire ?
CF PHOTOS DU CODE PRISES LUNDI + POSTER VIDÉO SUR VRAI TERRAIN
Tout en suivant les lignes, le robot peut également détecter s'il arrive face à un obstacle, il fait alors demi-tour et reprend son chemin en sens inverse.
Vidéo : Le robot qui suit les lignes
Ramassage de la balle
L'étape du ramassage de balle nous a posé de nombreux problème. En effet, lorsque le robot avance vers la balle en suivant son signal infrarouge, il lui faut savoir quand s'arrêter et fermer sa pince.
Nous avons d'abord pensé à placer un capteur tactile, que la balle enfoncera lorsqu'elle se trouve entre les pinces. Cependant, il nous était impossible de placer ce capteur à la bonne hauteur avec la façon dont nous avons construit notre pince. Nous avons ensuite essayé de détecter la distance entre la balle et le robot à l'aide du capteur infrarouge. Malheureusement, la distance détectée était à chaque fois différente. Nous avons donc décidé d'utiliser le capteur ultrason pour trouver la distance de la balle par rapport au robot et avons finalement réussi à installer le capteur touch.
La distance par rapport à la balle est ainsi détectée par le capteur ultrason. En dessous d'un certain seuil, le robot avance un peu et referme ses pinces. Le capteur touch prend alors le relais en détectant si la balles se trouve bien entre les pinces (son bout est enfoncé). Si ce n'est pas le cas, le robot rouvre sa pince et continue sa recherche.
GARDER LE MOTEUR DE LA PINCES TOURNANT LORS DU TRANSPORT DE LA BALLE POUR BIEN L'EMPRISONNER ? TESTER SI C'EST NECESSAIRE OU PAS SUR VRAI TERRAIN !
Communication avec l'Arbitre
ATTENTE DES TESTS SUR VRAI TERRAIN ET AVEC ARBITRE POUR SAVOIR SI CORRECT
Réalisation du terrain
DIMENSIONS A VERIFIER
Pour réaliser le terrain, quatre plaques d'1,5m sur 1m et des rubans adhésifs de couleur nous ont été attribués.
Nous avons d'abord réfléchi à l'emplacement des différentes lignes sur le terrain. En effet, les robots et les buts ne font pas tous la même taille, et il faut que tous les robots puissent se déplacer et faire demi-tour et que les buts rentrent tous dans l'espace prévu sur le terrain. Ces lignes ont ensuite été tracées au crayon gris sur les plaques, puis les rubans ont été collés.
Nous avons décidé de garder les quatre plaques séparées et d'ensuite les assembler pour le jeu afin de faciliter leur rangement.
Conclusion
A FAIRE
