Learning Lab Environnements Connectés - Contributions de l’utilisateur [fr]

RAMBOT

2024-05-15T07:26:03Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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=

==Programmation des cartes==
* ESP32 :
::- Ajouter le support de la carte dans l'IDE Arduino en insérant ce lien dans Fichier → Préférences → URL de gestionnaire de carte supplémentaire : https://dl.espressif.com/dl/package_esp32_index.json
::- Dans Outils → Type de carte → Gestionnaire de cartes, rechercher et installer ESP32
::- Dans Outils → Type de carte sélectionner la carte ESP32

* Teensy :
::- Installer le support de la carte dans l'IDE Arduino via ce [https://www.pjrc.com/teensy/td_download.html lien]

==Robot 1==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

Après ces modifications, nous avons constaté que :
:- Le moteur 1 est lié à la roue 3 et est inversé
:- Le moteur 2 est lié à la roue 1 dans le bon sens
:- Le moteur 3 est lié à la roue 2 et est inversé
:- Le moteur 4 est lié à la roue 4 dans le bon sens

Par ailleurs, nous avons eu quelques difficultés avec le moteur 4. Celui-ci tournait lorsqu'il ne devait pas. Après avoir isolé les différentes parties du robot, le problème n'intervient plus. Nous en avons donc conclu un problème de faux contact.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande : [[Fichier:Techniques Ingenieur.pdf]].

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo, et on va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

Suite à un problème de commande, nous avons du changer nos plan et partir sur une pince en impression 3D dont voici les plans. 
[[Fichier:plan_pince_3D.zip]]

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :
Schéma montage LED : [[Fichier:MontageLED.png]]

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :
Schéma montage phototransistor + comparateur : [[Fichier:MontagePhototransisitor.png]]

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :
Schéma montage pont diviseur : [[Fichier:PontDiv.png]]

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.
Image capteur sur mini breadboard : [[Fichier:Breadboard+capteur.png]]

L'objectif maintenant est de relier le capteur optique au servomoteur via une carte ESP32. On utilise une entrée analogique qui va lire la valeur en sortie du capteur (0V si présence d'objet et 5V si non présence). Lorsqu'on détecte le passage de 5V à 0V, on fait varier l'angle du servomoteur (ce qui fermera la pince).

Code servo/capteur : [[Fichier: ServoCapteur]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

Fichier:Breadboard+capteur.png

2024-05-14T15:13:31Z

Amaury G :

RAMBOT

2024-05-14T15:13:04Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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=

==Programmation des cartes==
* ESP32 :
::- Ajouter le support de la carte dans l'IDE Arduino en insérant ce lien dans Fichier → Préférences → URL de gestionnaire de carte supplémentaire : https://dl.espressif.com/dl/package_esp32_index.json
::- Dans Outils → Type de carte → Gestionnaire de cartes, rechercher et installer ESP32
::- Dans Outils → Type de carte sélectionner la carte ESP32

* Teensy :
::- Installer le support de la carte dans l'IDE Arduino via ce [https://www.pjrc.com/teensy/td_download.html lien]

==Robot 1==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :
Schéma montage LED : [[Fichier:MontageLED.png]]

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :
Schéma montage phototransistor + comparateur : [[Fichier:MontagePhototransisitor.png]]

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :
Schéma montage pont diviseur : [[Fichier:PontDiv.png]]

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.
Image capteur sur mini breadboard : [[Fichier:Breadboard+capteur.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

RAMBOT

2024-05-14T15:12:23Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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=

==Programmation des cartes==
* ESP32 :
::- Ajouter le support de la carte dans l'IDE Arduino en insérant ce lien dans Fichier → Préférences → URL de gestionnaire de carte supplémentaire : https://dl.espressif.com/dl/package_esp32_index.json
::- Dans Outils → Type de carte → Gestionnaire de cartes, rechercher et installer ESP32
::- Dans Outils → Type de carte sélectionner la carte ESP32

* Teensy :
::- Installer le support de la carte dans l'IDE Arduino via ce [https://www.pjrc.com/teensy/td_download.html lien]

==Robot 1==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :
Schéma montage LED : [[Fichier:MontageLED.png]]

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :
Schéma montage phototransistor + comparateur : [[Fichier:MontagePhototransisitor.png]]

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :
Schéma montage pont diviseur : [[Fichier:PontDiv.png]]

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.
Image capteur sur mini breadboard : [[Fichier:Breadboard.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

Fichier:PontDiv.png

2024-05-14T15:04:48Z

Amaury G :

RAMBOT

2024-05-14T15:04:13Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :
Schéma montage LED : [[Fichier:MontageLED.png]]

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :
Schéma montage phototransistor + comparateur : [[Fichier:MontagePhototransisitor.png]]

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :
Schéma montage pont diviseur : [[Fichier:PontDiv.png]]

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

Fichier:MontagePhototransisitor.png

2024-05-14T15:00:58Z

Amaury G :

RAMBOT

2024-05-14T15:00:31Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :
Schéma montage LED : [[Fichier:MontageLED.png]]

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :
Schéma montage phototransistor + comparateur : [[Fichier:MontagePhototransisitor.png]]

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

Fichier:MontageLED.png

2024-05-14T14:57:54Z

Amaury G :

RAMBOT

2024-05-14T14:57:31Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :

Schéma montage LED : [[Fichier:MontageLED.png]]
Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

Fichier:Tlc271a.pdf

2024-05-14T14:34:24Z

Amaury G : Datasheet AOP pour comparateur

== Description ==
Datasheet AOP pour comparateur

RAMBOT

2024-05-14T14:33:50Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur : [[Fichier:tlc271a.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

RAMBOT

2024-05-14T14:26:57Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Datasheet AOP pour comparateur :

Dans un premier temps on réalise le montage avec la LED infrarouge :

Ensuite on réalise le montage avec le phototransistor accompagné d'un comparateur qui va nous permettre d'avoir une sortie 5V si l'objet n'est pas détecté ou 0V si il est détecté :

Après plusieurs tests, on remarque que lorsque un objet sépare la diode du phototransistor, on a approximativement 0V aux bornes de la résistance. Lorsqu'il n'y a pas d'objet, on remarque que la tension aux bornes de la résistance est de plus de 100mV. Ainsi on choisie un seuil de 50mV pour le comparateur. On utilise un pont diviseur de tension pour obtenir cette tension :

Il nous faut 2 capteurs de ce type pour les 2 pinces qui seront sur les robots 2 et 3. Ainsi, on réalise ces montages sur 2 mini breadboard que l'on placera sur les robots avec les LED et phototransistors qui seront placés sur les pinces à l'aide de câbles plus long pour les excentrer des mini breadboard.

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

=Problèmes rencontrés=

Lors de ce projet nous avons rencontré plusieurs obstacles. Tout d'abord pendant la première semaine nous avons fait un inventaire sur le matériel nécessaire et le matériel déjà présent. A la fin de la première semaine nous avions donc tout le matériel nécessaire à part une pince afin d'attraper nos objets ainsi que des capteurs de suivi de ligne et du scotch blanc afin de faire la ligne pour la maquette. Nous avons donc envoyé un mail à Matthieu Dumay qui n'a malheureusement pas était pris en compte pendant les trois semaines que nous avons eu entre les deux semaines de robotique malgré un mail de rappel de la commande. Lors de la deuxième semaine nous avons donc du improviser. Nous avons utiliser des feuilles blanches découpées en lamelles pour le suivi de ligne. Nous avons également trouvé de nouveaux capteurs de suivi de ligne. Et enfin nous avons choisi d'imprimer des pinces au lieu de les commander.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

RAMBOT

2024-05-14T13:57:51Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Dans un premier temps on réalise le montage avec la LED infrarouge :

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

RAMBOT

2024-05-14T13:56:08Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

[[Fichier:Capture_d'écran_2024-04-19_150732.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

Fichier:Osram opto semiconductor.pdf

2024-05-14T13:52:01Z

Amaury G : Datasheet LED infrarouge

== Description ==
Datasheet LED infrarouge

RAMBOT

2024-05-14T13:51:18Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

[[Fichier:Capture_d'écran_2024-04-19_150732.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

Fichier:Osram opto semiconductor sfh 409 lead pb free prod-2891523.pdf

2024-05-14T13:45:42Z

Amaury G :

RAMBOT

2024-05-14T13:44:35Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:osram_opto_semiconductor_sfh_409_lead_pb_free_prod-2891523]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Par la suite, le phototransistor que l'on utilisait était trop sensible à la pollution par la lumière visible, on en a donc pris un nouveau :

Datasheet phototransistor_2 : [[Fichier:SFH_309_FA.pdf]]

[[Fichier:Capture_d'écran_2024-04-19_150732.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour

RAMBOT

2024-05-14T13:41:14Z

Amaury G : /* Détection de saisie */

=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é

Tout au long de la mission, l'utilisateur peut suivre le nombre de blessée rapatriés et d'ennemis capturés avec un interface.

=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==

La plateforme du robot 1 est constituée de 4 roues suédoises. D'après le wiki de l'année dernière un des moteurs (le moteur 3) ne tournait que dans un sens. La cause était un des pont en H qui avait cessé de fonctionner correctement. On a alors décidé de dessouder et ressouder un nouveau pont en H. Mais en dessoudant nous avons abîmé la carte alors nous avons dû nous accommoder et rajouter des fils. Ensuite nous avons testé les moteurs qui ont tous fonctionné dans un sens mais dans l'autre sens nous avons envoyé trop de courant d'un coup. Le driver a alors de nouveau grillé. Pour y remédier nous avons pris une deuxième carte électronique sur laquelle il y avait déjà un driver pour deux moteurs que nous avons alors connecté en soudant des fils entre elle est la carte principale sur laquelle il y a la teensy. C'est après beaucoup de difficultés que nous avons réussit a faire tourner les quatre roues.

== 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.

La fonction controleMoteur s'appuie sur la matrice donnée par Technique de l'ingénieur, à la partie 3.1 de Robotique mobile : conception, modélisation et commande.

[[Fichier:Schema angles 3 roues.png|center]].

==Odométrie==
L'odométrie consiste au calcul du déplacement du robot en fonction de la rotation de ses moteurs Elle est très complexe à mettre en place. On a donc décidé de trouver des alternatives car dans notre application l'odométrie n'est pas obligatoire.

=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 de ligne=
Dans cette partie, nous expliquons la méthode utilisée pour que les différents robots puissent suivre la ligne noire.

==Lien entre la carte Teensy et ESP32==
Les capteurs de réflexion sont connectés à la carte ESP32. Nos moteurs sont contrôlés par la carte Teensy. Afin, d'envoyer les données mesurés par ces capteurs à la carte Teensy, il est nécessaire de faire le lien via une connexion UART.

Dans notre cas, nous avons utilisé les ports 16 et 17 de l'ESP32 qui correspondent à UART2, pour envoyer les commandes, nous avons donc utilisé Serial2 sur cette carte.
Sur la carte Teensy c'est l'UART1 qui est connecté ; il faut donc utiliser le Serial1.

Sur la carte ESP32, il faut écrire :
 
<pre>
void setup()
{
// put your setup code here, to run once:
Serial2.begin(115200); // Initialize serial communication at 115200 baud
}
</pre>
Puis, dans la fonction concernée :

<pre>
Serial2.write((int) thetaP); // Envoie du float à la carte teensy
</pre>


De manière réciproque sur le code de la carte Teensy :
<pre>
// send data only when you receive data:
if (Serial1.available() > 0) {
// read the incoming byte:
thetatest = Serial1.read();
}
</pre>

==Envoie de données==
Une fois la connexion faite, nous avons du faire la conversion des valeurs. En effet, la fonction Serial.write() ne peut écrire qu'un octet.
Nous avons donc convertit les valeurs sur 12 bits récupérés par les 2 capteurs (grâce à capteurD = analogRead(CAN1); en données d'un octet.
<pre>
thetaP = ((255.0 / 8190.0) * thetaP) + 127.5;
</pre>

==Codes utilisés==
[[Fichier:AsservissementLigneESP.zip]]
 
[[Fichier:Essai moteur v3.zip]]


=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.

=Conception des cibles=
Les cibles ont été faites pour faciliter la préhension avec la pince

=Système de 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 a envisagé plusieurs méthodes : conception en lego, pièce en imprimante 3D ou tout simplement un achat. C'est cette dernière solution qui a eu notre préférence. On a choisit une pince adapté à notre servo; On va la modifié pour qu'elle corresponde aux dimension de la cible.

Modèle de la pince : Kitronik Klaw MK2 Robotic Gripper Kit.

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, à 950nm, et d'un récepteur fonctionnant avec un phototransistor, ayant un maximum de sensibilité vers 900nm.

Datasheet LED : [[Fichier:SFH485P.pdf]]

Datasheet phototransistor : [[Fichier:OFT-3301.pdf]]

Par la suite, le phototransistor que l'on utilisait était trop sensible à la pollution par la lumière visible, on en a donc pris un nouveau :

Datasheet phototransistor_2 : [[Fichier:SFH_309_FA.pdf]]

[[Fichier:Capture_d'écran_2024-04-19_150732.png]]

=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 [https://www.pjrc.com/teensy/td_download.html 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.

=Attention=

Pour l'année prochaine, la carte électronique pour la teensy, les drivers et les moteurs de la plateforme principale serait a changer si possible vu comment elle est soudée. Le mieux serait de la refaire et de la commander.

=Télémètre ultrason=

On utilise un télémètre ultrason pour les robots 2 et 3 dans 2 circonstances :

-Quand les robots reviennent à la base, ils détectent un amer (plafond) qui leur signale de bifurquer vers leur base.

-Dans la base, ils détectent un amer qui leur indique de faire demi-tour