RobotDefense2013-1 : Différence entre versions
(→Tests moteurs - Capteurs) |
(→Programmation) |
||
Ligne 63 : | Ligne 63 : | ||
== Programmation == | == Programmation == | ||
− | + | '''1er programme, repérer un émetteur InfraRouge, avancer vers celui-ci puis s'arrêter à une certaine distance de celui ci''' | |
Nous avons commencé par faire repérer un émetteur IR (la balle ici, mais on pourra utiliser les buts plus tard) et faire avancer le robot vers l'émetteur. | Nous avons commencé par faire repérer un émetteur IR (la balle ici, mais on pourra utiliser les buts plus tard) et faire avancer le robot vers l'émetteur. | ||
Le robot commence par repérer l'émetteur, voir si il se trouve a sa gauche ou a sa droite (en utilisant la fonction DegDirection du capteur IR). Une fois l'émetteur repéré, le robot se tourne de manière à se mettre en face de l'émetteur. Ensuite il avance. Tout au long de son avancé vers l'émetteur, le robot continue de tester s'il se trouve toujours bien en face de l'émetteur. Si non, il corrige sa trajectoire avant de continuer à avancer. | Le robot commence par repérer l'émetteur, voir si il se trouve a sa gauche ou a sa droite (en utilisant la fonction DegDirection du capteur IR). Une fois l'émetteur repéré, le robot se tourne de manière à se mettre en face de l'émetteur. Ensuite il avance. Tout au long de son avancé vers l'émetteur, le robot continue de tester s'il se trouve toujours bien en face de l'émetteur. Si non, il corrige sa trajectoire avant de continuer à avancer. | ||
Ligne 70 : | Ligne 70 : | ||
Ceci permet de définir une certaine distance entre le robot et l'émetteur, de manière a ce que lors d'un match, le robot se position à une certaine distance de son but. Ainsi il ne masque pas le but, mais se trouve dans une "zone de défense". | Ceci permet de définir une certaine distance entre le robot et l'émetteur, de manière a ce que lors d'un match, le robot se position à une certaine distance de son but. Ainsi il ne masque pas le but, mais se trouve dans une "zone de défense". | ||
+ | '''Ajout d'une procédure pour éviter un obstacle''' | ||
Ensuite, nous avons inclus dans ce programme la capacité d'éviter un obstacle sur sa trajectoire via le capteur ultrasons. De la même manière que le robot test sa distance avec l'émetteur IR, ici il test, au long de son avancée, s'il y a un obstacle à une distance symbolisée par une constante. Si le capteur trouve un obstacle a une distance inférieure à la constante, le robot s'arrête. | Ensuite, nous avons inclus dans ce programme la capacité d'éviter un obstacle sur sa trajectoire via le capteur ultrasons. De la même manière que le robot test sa distance avec l'émetteur IR, ici il test, au long de son avancée, s'il y a un obstacle à une distance symbolisée par une constante. Si le capteur trouve un obstacle a une distance inférieure à la constante, le robot s'arrête. | ||
Pour l'instant, il évite forcément l'obstacle par la gauche. lorsque le robot s'est arrêté, il se tourne a gauche, avance un peu, puis recalcule sa trajectoire pour aller vers l'émetteur IR. Si l'obstacle, ou un autre, se trouve encore sur sa route, cette procédure se répète. Plus tard, nous essayerons de le faire choisir s'il va contourner l'obstacle par la gauche ou par la droite. | Pour l'instant, il évite forcément l'obstacle par la gauche. lorsque le robot s'est arrêté, il se tourne a gauche, avance un peu, puis recalcule sa trajectoire pour aller vers l'émetteur IR. Si l'obstacle, ou un autre, se trouve encore sur sa route, cette procédure se répète. Plus tard, nous essayerons de le faire choisir s'il va contourner l'obstacle par la gauche ou par la droite. |
Version du 6 février 2014 à 10:22
Réalisation mécanique du Robot
Nous avons commencé par construire le "châssis" du robot avec les roues, nous avons décidé d'utiliser des chenilles plutôt que des pneus (pour que le robot avant droit).
Ensuite nous avons construit le support du nxt. Un support qui peut se rabattre vers l'avant. De plus, il est accessible car séparé du reste et à l'arrière. On peut ainsi le retirer relativement aisément.
Puis, nous avons ajouté les capteurs ultrasons, couleurs et RFID vers l'avant du robot, entre les roues. Les capteurs couleurs & RFID sont pointés vers le sol.
Pour symboliser un moyen de taper la balle, nous avons ajouté le 3ème moteur avec une batte à l'avant droit du robot.
Enfin, nous avons ajouté le capteur infrarouge en hauteur, sur la partie gauche du robot.
Tests moteurs - Capteurs
Test avancer On a vérifié que le robot avançait en ligne droite, savait tourner et même faire un demi tour sur place. C'est lors de ces test que nous avons décidé d'utiliser des chenilles plutôt que des pneus.
Tests ultrasons
Nous avons surélevé le nxt par rapport au capteur ultrason, car lorsque celui est rabattu vers l'avant, il gênait le capteur. (photo à venir)
Ensuite, on a demander à visualiser la distance avec ce capteur. Nous avons remarqué que la distance maximum programmable est de 2,55m. De plus, l'affichage qui se fait centimètres, nous a révélé que sa précision était adéquate (au centimètre).
Test couleur
Nous avons du abaisser le capteur couleur(h=~2mm), car étant trop haut, il ne détectait pas les différentes couleurs. une fois abaissé, nous avons pu demander au robot différentes actions comme faire demi tour dans le cas d'une ligne de limite de terrain. Ainsi, le robot ne dépasse pas entièrement la ligne. (photo à venir)
Test infra rouge
On a d'abord du télécharger le module IRSeeker sur www.hitechnics.com pour l'intégrer au software lego mindstorm nxt.
Ce qui nous a permis de tester les différents paramètres de la détection infrarouge.
la force (Strength) qui indique si la balle est proche ou loin, sur un échelle allant de 340(la balle est collé au récepteur) à 10( à une distance supérieur à 5m) en analysant la force du signal.
Direction (IRDirection) qui indique où se trouve la balle sur une échelle de 0 à 9. Si la balle se trouve derrière on obtient 0. Si la balle se trouve à la perpendiculaire gauche du récepteur on obtient 1. Si la balle se trouve directement en face, on a 5. Enfin si la balle se trouve à la perpendiculaire droit on a 9. Si la balle se trouve entre ces directions, les valeurs varient. En résumé, [1,5] la balle est à gauche, [5,9] la balle est à droite.
Degrés (DegDirection) indique la même chose que la direction, mais en degrés. On obtient une échelle de degrés de 0 à -150, avec -120 a la perpendiculaire gauche et 120 à la perpendiculaire droite. En résumé, [0,120] la balle est devant à droite, [120,-150] la balle est derrière à droite, [-150,-120] la balle est derrière à gauche, et [-120,0] la balle est devant à gauche. On remarque la précision vers l'arrière laisse à désirer.
Le module permet aussi de choisir si l'on souhaite détecter une émission infrarouge continue (DC) ou alternative, avec une fréquence (AC).
à tester --> Utilisation de degrés ou de direction.
Test lecteur RFID
On a d'abord du télécharger le module RFID Read sur generationrobot.
Ensuite, comme pour le capteur couleur, nous avons du rapprocher le capteur du sol (h=~2mm), autrement, le robot ne détectais pas assez bien la carte RFID. (voir photo)
On a su faire repérer au robot la présence, ou non, d'une carte RFID sur son passage, et d'agir en conséquence (changer de direction, s'arrêter...)
à tester --> utilisation de plusieurs cartes pour assigner des ordres différents par cartes.
Programmation
1er programme, repérer un émetteur InfraRouge, avancer vers celui-ci puis s'arrêter à une certaine distance de celui ci Nous avons commencé par faire repérer un émetteur IR (la balle ici, mais on pourra utiliser les buts plus tard) et faire avancer le robot vers l'émetteur. Le robot commence par repérer l'émetteur, voir si il se trouve a sa gauche ou a sa droite (en utilisant la fonction DegDirection du capteur IR). Une fois l'émetteur repéré, le robot se tourne de manière à se mettre en face de l'émetteur. Ensuite il avance. Tout au long de son avancé vers l'émetteur, le robot continue de tester s'il se trouve toujours bien en face de l'émetteur. Si non, il corrige sa trajectoire avant de continuer à avancer.
Pour l'arrêt, on utilise la fonction Strength du capteur IR. On compare, tout au long de l'avancée du robot vers l'émetteur, la force du signal à une constante. Par exemple, 90. Lorsque le capteur trouve un signal supérieur à 90, le robot s'arrête. Ceci permet de définir une certaine distance entre le robot et l'émetteur, de manière a ce que lors d'un match, le robot se position à une certaine distance de son but. Ainsi il ne masque pas le but, mais se trouve dans une "zone de défense".
Ajout d'une procédure pour éviter un obstacle Ensuite, nous avons inclus dans ce programme la capacité d'éviter un obstacle sur sa trajectoire via le capteur ultrasons. De la même manière que le robot test sa distance avec l'émetteur IR, ici il test, au long de son avancée, s'il y a un obstacle à une distance symbolisée par une constante. Si le capteur trouve un obstacle a une distance inférieure à la constante, le robot s'arrête. Pour l'instant, il évite forcément l'obstacle par la gauche. lorsque le robot s'est arrêté, il se tourne a gauche, avance un peu, puis recalcule sa trajectoire pour aller vers l'émetteur IR. Si l'obstacle, ou un autre, se trouve encore sur sa route, cette procédure se répète. Plus tard, nous essayerons de le faire choisir s'il va contourner l'obstacle par la gauche ou par la droite.