RAMBOT : Différence entre versions
(→Détection de saisie) |
|||
| Ligne 119 : | Ligne 119 : | ||
===Détection de saisie=== | ===Détection de saisie=== | ||
Il va nous falloir détecter la présence de cible dans la pince pour activer sa fermeture. Pour cela nous avons décider d'utiliser un capteur optique qui arrêtera le robot lorsque la cible est détectée et fermera la pince. | Il va nous falloir détecter la présence de cible dans la pince pour activer sa fermeture. Pour cela nous avons décider d'utiliser un capteur optique qui arrêtera le robot lorsque la cible est détectée et fermera la pince. | ||
| + | |||
| + | Nous n'avons pas trouvé de capteurs correspondant à nos besoins, nous avons donc décidé d'en concevoir un par nous même. On utilise pour cela un émetteur fonctionnant avec une LED émettant dans l'infrarouge, à 880nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm. | ||
| + | |||
| + | Datasheet LED : | ||
| + | Datasheet phototransistor : | ||
==Communication Wi-Fi== | ==Communication Wi-Fi== | ||
Version du 19 avril 2024 à 08:22
Sommaire
Présentation
Mission des robots
Le but est d'assiéger une base ennemie tout en récupérant les blessés sur le chemin. Pour cela nous avons trois robots:
- L'éclaireur :
- il assiège les ennemis
- il suit une ligne (suiveur) qui forme un escargot pour finir sur un drapeau qui signalera la fin du siège
- il envoie les positions des obstacles qu'il rencontre (blessé à sauver ou ennemi à capturer)
- Le sauveteur :
- il reçoit les informations de position des blessés
- il récupère les blessés et les ramène à la base (hôpital)
- Le blindé :
- il reçoit les informations de position des ennemis
- il récupère les ennemis et les ramène à la base (prison)
Décomposition des actions élémentaires des robots
Dans l'idéal voici toutes les étapes à réaliser avec les robots:
- Les trois robots sont au camp de base
- Tant que pas d'obstacles : robot 1 fait sa "ronde" en suiveur de ligne
- Détecte un obstacle
- Identification blessé / ennemi
- Communication avec tous les robots
- Le robot 1 se déplace vers l'extérieur (pour laisser la place aux autres robots de passer)
- Le robot 2 ou 3 (suivant celui qui est nécessaire) s'active et va à la position du robot 1 (suivant la ligne)
- Il attrape l'individu
- Retour à la base et dépose de l'individu
- Envoie d'un signal au robot 1 pour qu'il se réactive
- Envoie l'information à l'utilisateur
- On reboucle sur l'étape 2
- On atteint le drapeau et c'est gagné
Décomposition du travail
Tâches à réaliser par ordre de priorité :
- Contrôle des moteurs de la plateforme principale et des plateformes secondaires
- Odométrie et repérage dans l'espace
- Détection de ligne
- Asservissement
- Détection des cibles
- Identification
- Communication sans fil entre les robots et avec l'utilisateur
- Attrapage de la cible
- Interface utilisateur
Contrôle des moteurs
Robot 1
Robot 2 et 3
Afin de contrôler les déplacements des robots 2 et 3 nous avons utilisés le code suivant : Fichier:Essai moteurs.zip.
Voici la procédure à suivre pour vérifier et tester le fonctionnement des moteurs :
- Alimenter la carte Teensy.
- Téléverser ce code dans la carte Teensy.
- Alimenter les moteurs via une batterie externe.
Ce code contient :
- - La déclaration des constantes et variables utiles.
- - La défintion des fonctions MotorCCx (x correspondant au numéro du moteur) permettant de définir la vitesse et le sens de rotation de chaque moteur.
- - La fonction controleMoteur qui calcul l'orientation des roues.
- - La boucle principale permettant de vérifier que le robot avance, recule et tourne sur lui-même.
Odométrie
Détection de ligne
On utilise le capteur SparkFun Line sensor Breakout QRE1113. Il s'agit d'un capteur de réflexion. Lorsque la réflexion est minimale (couleur noir), il nous renvoie la valeur de la tension d'alimentation (autour de 3,3V ici). Pour pouvoir détecter correctement il faudra le mettre à 2mm du sol.
Datasheet : https://www.sparkfun.com/datasheets/Robotics/QR_QRE1113.GR.pdf
Code : Fichier:Test ligne.zip
Asservissement
Détection des cibles
La détection de cible consiste à repérer les cibles qui se trouvent à une certaine distance bien définie du robot, puis d'exécuter les actions nécessaires correspondantes. Cela nécessite l'utilisation des capteurs afin de collecter les données de distance entre l'objet (cible) et le robot, puis lire les données recueillies afin d'appliquer les actions prédéfinies.
Plusieurs possibilités ont été envisagées :
- Capteur ultrason : ce capteur était trop imprécis de près. Il permet de détecter des obstacles imposants, nous allons donc l'utiliser plus tard pour la détection d'amers.
- Télémètre infrarouge : Distance minimale de détection trop élevée (environ 10 cm).
- Capteur à effet Hall : Ne capte que des aimants et uniquement de près et dans la direction du champ magnétique, ce qui est inutile dans notre cadre d'utilisation.
- Capteur de lumière infrarouge : Distance maximale de détection trop élevée (plusieurs mètres).
- Capteur couleur : Ce capteur nous permet de capter des couleurs (blanc, bleu, rouge, vert) à une distance assez faible (environ 8cm).
On a donc choisi le capteur de couleur. Malgré sa faible distance de détection, il est assez fiable et nous permet de simplifier l'identification des cibles.
On utilise le capteur TCS3200
Datasheet : Fichier:TCS3200 (1).PDF
Identification des cibles
Une fois que le robot a détecté la présence de cibles à proximité, encore faut-il les identifier pour différencier les alliés des ennemis. Pour cela, on utilise un capteur de couleur, plus précisément le modèle TCS3200.
Datasheet : Fichier:TCS3200 (1).PDF
Code Arduino_Uno : Fichier:Test color sensor 4.zip
Code ESP32 THING : Fichier:Test color sensor esp 1.zip
On utilise le capteur pour identifier les objets rouges et les objets bleus. La mesure fonctionne jusqu'à environ 5cm.
Préhension
Capture
Les robots 2 et 3 doivent ramener une cible à leur base
Plusieurs solution ont été envisagées :
- Un électro-aimant : Efficace uniquement à très courte distance (autour de 1cm). Pour palier à cela on a envisagé de le mettre sous le robot mais cela cause des problèmes de demi-tour et d'empilement dans les zones de dépôts. De plus, il chauffe assez rapidement, alimenté sous 24V.
- Une spatule qui s'inclinerait, et qui passerait sous le personnage : problèmes de stabilité et de précision.
- Une pince : plus stable, nécessite un servo moteur, plus maniable.
On a opté pour la pince qui semple être la solution la plus pratique et efficace pour notre cas. On va la faire en lego.
On va utiliser le servo moteur suivant : MicroServo99 qui a une amplitude de 180°
Code : Fichier:Servo.zip
Détection de saisie
Il va nous falloir détecter la présence de cible dans la pince pour activer sa fermeture. Pour cela nous avons décider d'utiliser un capteur optique qui arrêtera le robot lorsque la cible est détectée et fermera la pince.
Nous n'avons pas trouvé de capteurs correspondant à nos besoins, nous avons donc décidé d'en concevoir un par nous même. On utilise pour cela un émetteur fonctionnant avec une LED émettant dans l'infrarouge, à 880nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.
Datasheet LED : Datasheet phototransistor :
Communication Wi-Fi
Notre cahier des charges inclut la nécessité de communication entre les trois machines ainsi que l'utilisateur. Deux choix s'offrent à nous, la communication Bluetooth ou bien la communication Wi-Fi. Après avoir vu les échecs essuyés par les groupes des années précédentes quand ils essayaient d'utiliser cette technologie, nous avons décidé d'utiliser la communication Wi-Fi.
Connexion à la carte ESP32
La première marche à franchir est de réussir à connecter les robots à un point d'accès Wi-Fi. Pour cela, la carte ESP32 dispose d'un module qui le permet.
Voilà le code: Fichier:Connexion wifi.zip
Ce dernier est assez simple. Dans un premier temps, on appelle une fonction permettant de rechercher et d'afficher dans la console tous les points d'accès Wi-Fi disponibles dans les environs de la carte. Ensuite, en remplaçant les valeurs des variables ssid et password par le nom du réseau et le mot de passe pour y accéder, on peut s'y connecter et récupérer l'adresse IP de la carte sur ledit réseau.
Teensy :
- - Installer le support de la carte dans l'IDE Arduino via ce lien
Interface utilisateur
Pour mettre en forme les deux informations sur le nombre de soldats sauvés et capturés et assurer un retour utilisateur clair, nous avons décidé de créer une page internet qui va mettre en forme les données susmentionnées.