Robot transporteur
Sommaire
Introduction
Nous allons vous présentez notre projet pour le bureau d'étude IMA 2012/2013. Nous sommes tous les deux très intéressé par ce département, et ce petit robot nous a passionné dans sa conception et sa programmation. Nous avons choisi de mélanger les différents style de robot à concevoir, pour proposer une idée personnelle de projet. Notre objectif est de créer un robot autonome qui transporte des objets. Cela passe par deux grandes étapes : la conception d'un système à 4 servomoteurs et la programmations des tâches réalisées en autonomie.
La Conception
Le robot est composé deux éléments essentiels : une base motrice et une pince de levage. Il comporte aussi deux capteurs pour le rendre autonome.
La base motrice
La base est composée de deux servomoteurs qui sont reliés entre eux pour former un socle solide. En effet, ce socle doit être capable de supporter le poids de deux boites NXT, ainsi que celui de la pince et de l'objet transporté. Les servomoteurs entraînent la rotation de 4 roues sur lesquelles sont fixées des chenilles pour lui permettre d'avancer. La première boite NXT est directement fixée sur les servomoteurs, puis derrière, nous avons mis en place un réceptacle capable de contenir une deuxième boite NXT ou une Foxboard (nous ne savions pas encore comment guider le robot). La structure devait être solide, car on devait encore ajouter la pince de levage sur le dessus. Voici quelques illustration de la construction.
La pince de levage
La pince de levage a été l'objet de toute la première séance, c'était l'élément le plus compliqué à assembler. Nous avons été confronté à plusieurs contraintes : le poids des objets transporté, la résistance du système de levage, et l'adaptation de la forme de la pince.
Nous avons d'abord crée une pince composée de deux servomoteurs pour le serrage et un autre pour le levage de la pince, mais ce système était trop lourd et peu pratique à solidariser avec le reste du robot. Nous avons donc évolué vers un système plus léger composé de seulement 2 servomoteurs. Dans ce nouveau système, un servomoteurs était dédié à serrer la pince et l'autre à la soulever par un mouvement de rotation. Le problème est que la pince était encore lourde et compliquée à fixer, car tout était accroché à l'avant du véhicule, il y a donc eu un problème de répartition de poids.Inutile de préciser qu'en ajoutant en plus un objet dans la pince, le robot se serait effondré.Nous avons alors pensé à mettre en place une poulie, ce qui a permis de surpasser tout ces obstacles.
La pince est donc composée de deux parties :
- Un servomoteur fixé sur le dessus du robot, pour répartir le poids et assurer une fixation solide. Sur ce moteur, nous avons fixer de petits embouts, ainsi que l’extrémité d'un fil. De cette manière quand le moteur tourne, le fil s'enroule autour de ceux-ci. C'est donc la poulie.
- Un servomoteur relié à l'avant du véhicule par une liaison pivot. Il peut donc se déplacer de haut en bas sans problème. Ce moteur permet de serrer la pince par une rotation d'une des deux branches qui la compose. Vous voyez, à gauche, que la pince est constituée d'une barre fixe sur laquelle s'appuie l'objet quand la pince est en position fermée, et d'une partie partie mobile , liée au moteur (en arc de cercle pour favoriser la prise des objets à transporter) qui change de position pour ouvrir et fermer la pince. L'autre extrémité du fil, provenant de la poulie, est fixée sur la barre fixe.
Nous avons donc une pince qui se ferme pour saisir un objet, puis qui se soulève et redescend grâce à une poulie, pour enfin se rouvrir et déposer l'objet.
/* attention à ne pas confondre "er" et "é" .. */
Les capteurs
Le robot est doté de deux capteur : un capteur de couleur pour suivre une ligne, et un capteur RFID qui lui sert à détecter les bases sur lesquelles il doit effectuer une action.
Nous avions d'abord pensé à installer un capteur de pression sur la pince pour vérifier si l'objet était bien serrer dans la pince. Mais celui-ci s'est avéré inutile après programmation, car le programme permet de serrer l'objet autant qu'il faut pour que l'objet soit correctement maintenu. La détection de pression n'était donc pas nécessaire.
En revanche,comme nous voulions faire un robot guider par des lignes de scotch noires au sol, nous avions besoin d'un capteur de couleurs. La difficulté est que ce capteur n'a qu'une très courte portée, c'est pourquoi nous avons du le placer dans un endroit ou il serait immobile, le plus proche du centre de l'avant du robot et le plus proche du sol possible. De cette façon, la détection est bonne continue, et permet une bonne correction de trajectoire. Cependant, le robot n'était pas conçu pour avoir un capteur à cet endroit, nous l'avons donc décentré un peu. Mais après quelques test, la position que nous avons choisi, nous a permis d'obtenir une trajectoire correcte.
Le capteur RFID a été beaucoup plus simple à installer, car il a une plus grande portée (3cm). Nous l'avons donc placé juste à coté du capteur de couleur. Cet emplacement, permet une bonne détection des cartes RFID,et le robot distingue facilement la position des objets à transporter.
Robot final
Voici l'allure de notre robot totalement assemblé, on peut voir les capteurs, la pince, mais surtout le fil qui relie la poulie et la pince.
La programmation
Nous avons choisi de programmer en langage NXC (Not eXactly C) que nous avons compilé avec l'IDE BricxCC (Bricx Command Center).
Nous avons décidé de faire suivre au robot un ensemble d'action dans un ordre précis.
La première partie consiste à initialiser les deux capteurs de couleurs et RFID.
Les recherches de base
Durant ces phases, le robot suit les lignes de couleurs vertes. Dès qu'il détecte une ligne rouge, il essaye de lire la carte RFID présente sur le sol pour savoir s'il faut déposer ou prendre un colis.
La recherche de ligne
Dans un premier temps, nous avons créer un programme permettant de retrouver une ligne de couleur suivant le raisonnement suivant :
INITIALISER timer A 0 ms
INITIALISER ligne_trouvee A faux
TANT QUE ligne_trouvee DIFFERENT DE vrai FAIRE
SI detecteur_de_couleur = couleur_ligne
ligne_trouvee = vrai
FIN SI
SI timer < 2500 ms
ROBOT tourne a GAUCHE
ET SI timer < 6000 ms
ROBOT tourne a DROITE
SINON
timer = 0 ms
FIN SI
INCREMENTER timer DE 1 ms
FIN TANT QUE
Cette solution nous a permis de faire fonctionner le robot avec toutes les autres parties du programme. Cependant, il était plutôt long pour trouver les lignes de couleurs sur sa droite.
Cette problématique nous a amenés à écrire un deuxième algorithme permettant de retrouver une ligne plus rapidement, quelque soit le côté où elle se trouve par rapport au robot.
Nous avons donc créer un algorithme dit d'exagération de recherche, c'est à dire qu'il cherche pendant un cours lapse de temps dans une direction, puis dans l'autre sens pendant une durée plus importante. Le robot répète ces deux opérations pendant un certain nombre de fois, en augmentant à chaque fois un peu plus la durée de recherche. Si au bout d'un nombre d'itération le robot ne trouve toujours pas la ligne, on lui ordonne de faire demi-tour.
Après avoir effectué des tests comparatifs, nous sommes arrivés à la conclusion que le robot était, avec le deuxième programme, 50 à 60 % plus rapide.
L'intégration des fonctionnalité
Nous avons commencé à intégrer les fonctionnalité supplémentaire lors de la séance du 7/03. Le robot doit :
- être contrôlable à distance avec une webcam par l’intermédiaire du site internet de la Foxboard
- pouvoir lire des RFID pour se situer sur le circuit
