Binome2018-1 : Différence entre versions
Ligne 41 : | Ligne 41 : | ||
=<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Logiciels </div>= | =<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Logiciels </div>= | ||
− | Pour concevoir un schéma propre du câblage de | + | Pour concevoir un schéma propre du câblage de notre robot, nous avons utlisé [http://fritzing.org/home/ fritzing]. Tous les composants de notre robot ne sont pas modélisés dans fritzing car certains ont du être rajouté en cours de route. |
* détecteur ultrason : [[Fichier:UltrasonicSensor_HCSR04.zip]] | * détecteur ultrason : [[Fichier:UltrasonicSensor_HCSR04.zip]] | ||
* contrôleur de moteurs : [[Fichier:MotorDriver_Pololu_md08a.zip]] | * contrôleur de moteurs : [[Fichier:MotorDriver_Pololu_md08a.zip]] | ||
Ligne 48 : | Ligne 48 : | ||
Pour la découpe laser nous avons utilisé ce logiciel [https://inkscape.org/fr/ inkscape]. | Pour la découpe laser nous avons utilisé ce logiciel [https://inkscape.org/fr/ inkscape]. | ||
− | + | 3D solidwork est très utilisé pour construire le support de notre robot. Mais nous ne l'avons pas utilisé. | |
− | + | Notre programme a été realisé en C++ ce qui est relativement abordable. Il y a de nombreux site internet qui proposent de claires explication. | |
− | Pour | + | Pour nous aider dans la conception des circuits imprimés, nous avons utilisé fritzing. cela nous a permis de personnaliser notre circuit imprimé |
Ligne 61 : | Ligne 61 : | ||
= Répartition des tâches = | = Répartition des tâches = | ||
− | + | Valentin a travaillé sur la strcuture du robot. Pour ma part, je me suis chargé du programme informatique. | |
=<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Programme informatique </div>= | =<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Programme informatique </div>= | ||
+ | |||
+ | |||
+ | =Ajout bibliothèques= | ||
+ | |||
+ | |||
+ | #include <boarddefs.h> | ||
+ | #include <IRremote.h> | ||
+ | #include <IRremoteInt.h> | ||
+ | #include <ir_Lego_PF_BitStreamEncoder.h> | ||
Ligne 69 : | Ligne 78 : | ||
− | int MotorG1=8; | + | int MotorG1=8; |
− | int MotorG2=7; | + | int MotorG2=7; |
− | int MotorD1=4; | + | int MotorD1=4; |
− | int MotorD2=A5; | + | int MotorD2=A5; |
− | int SpeedG=6; | + | int SpeedG=6; |
− | int SpeedD=10; | + | int SpeedD=10; |
− | int echo=A3; | + | int echo=A3; |
− | int trigger=A4; | + | int trigger=A4; |
− | int Tsop1=A0; | + | int Tsop1=A0; |
− | int Tsop2=A1; | + | int Tsop2=A1; |
− | int Stop = 9; | + | int Stop = 9; |
− | int tsop1=digitalRead(Tsop1); | + | int tsop1=digitalRead(Tsop1); |
− | int tsop2=digitalRead(Tsop2); | + | int tsop2=digitalRead(Tsop2); |
+ | const unsigned long MEASURE_TIMEOUT = 25000UL;//variable pour le sonar | ||
+ | const float SOUND_SPEED = 340.0 / 1000;// vitesse du son dans l'air | ||
+ | int IR = 1024; | ||
+ | IRrecv irrecv(Tsop1); // create instance of 'irrecv' | ||
+ | decode_results results; // create instance of 'decode_results'//valeur du tsop a la frequence infrarouge d'une proie (inconnue pour l'instant) | ||
=partie autonomie du robot= | =partie autonomie du robot= | ||
− | + | ||
− | void tourneD() { | + | void tourneD() |
+ | { | ||
digitalWrite(MotorG1,HIGH);// gauche | digitalWrite(MotorG1,HIGH);// gauche | ||
digitalWrite(MotorG2,LOW);//gauche | digitalWrite(MotorG2,LOW);//gauche | ||
Ligne 94 : | Ligne 109 : | ||
digitalWrite(MotorD2,HIGH);// droit | digitalWrite(MotorD2,HIGH);// droit | ||
analogWrite(SpeedD,100);// vitesse droite | analogWrite(SpeedD,100);// vitesse droite | ||
− | } | + | } |
− | void tourneG() { | + | void tourneG() |
+ | { | ||
digitalWrite(MotorG1,HIGH);// gauche | digitalWrite(MotorG1,HIGH);// gauche | ||
digitalWrite(MotorG2,LOW);//gauche | digitalWrite(MotorG2,LOW);//gauche | ||
Ligne 103 : | Ligne 119 : | ||
digitalWrite(MotorD2,HIGH);// droit | digitalWrite(MotorD2,HIGH);// droit | ||
analogWrite(SpeedD,100);// vitesse droite | analogWrite(SpeedD,100);// vitesse droite | ||
− | } | + | } |
− | void ToutDroit() { | + | void ToutDroit() { |
digitalWrite(MotorD1,HIGH); | digitalWrite(MotorD1,HIGH); | ||
digitalWrite(MotorD2,LOW); | digitalWrite(MotorD2,LOW); | ||
Ligne 113 : | Ligne 129 : | ||
digitalWrite(MotorG2,LOW); | digitalWrite(MotorG2,LOW); | ||
analogWrite(SpeedG,150); | analogWrite(SpeedG,150); | ||
− | } | + | } |
− | int detectProie(){//fonction qui nous place en face d'une proie | + | int detectProie(){//fonction qui nous place en face d'une proie |
− | + | if (irrecv.decode(&results)) // have we received an IR signal? | |
− | + | ||
+ | { | ||
+ | translateIR(); | ||
+ | tsop1 = IR; | ||
+ | irrecv.resume(); // receive the next value | ||
+ | } | ||
if (tsop1 == IR && tsop2 != IR){//tourne legerement a gauche | if (tsop1 == IR && tsop2 != IR){//tourne legerement a gauche | ||
digitalWrite(Stop,HIGH); | digitalWrite(Stop,HIGH); | ||
tourneG(); | tourneG(); | ||
− | delay( | + | delay(300); |
digitalWrite(Stop,LOW); | digitalWrite(Stop,LOW); | ||
+ | tsop1 = 0; | ||
+ | tsop2 = 0; | ||
return 0; | return 0; | ||
− | + | ||
} | } | ||
else if (tsop1 != IR){//tourne legerement a droite | else if (tsop1 != IR){//tourne legerement a droite | ||
digitalWrite(Stop,HIGH); | digitalWrite(Stop,HIGH); | ||
tourneD(); | tourneD(); | ||
− | delay( | + | delay(300); |
digitalWrite(Stop,LOW); | digitalWrite(Stop,LOW); | ||
+ | tsop1 = 0; | ||
+ | tsop2 = 0; | ||
return 0; | return 0; | ||
} | } | ||
Ligne 138 : | Ligne 163 : | ||
return 1; | return 1; | ||
} | } | ||
− | } | + | } |
+ | |||
+ | float obstacle(){//fonction qui detecte un obstacle | ||
+ | digitalWrite(trigger, HIGH); | ||
+ | delay(10); | ||
+ | digitalWrite(trigger, LOW); | ||
+ | |||
+ | long measure = pulseIn(echo, HIGH, MEASURE_TIMEOUT); //temps entre le signal emis et recu | ||
+ | float distance_mm = measure / 2.0 * SOUND_SPEED;// calcul de la distance en mm | ||
+ | Serial.print(F("Distance: ")); | ||
+ | Serial.print(distance_mm); | ||
+ | Serial.print(F("mm (")); | ||
+ | Serial.print(distance_mm / 10.0, 2); | ||
+ | Serial.print(F("cm, ")); | ||
+ | Serial.print(distance_mm / 1000.0, 2); | ||
+ | Serial.println(F("m)")); | ||
+ | delay(5); | ||
+ | return distance_mm;} | ||
+ | |||
+ | |||
Ligne 144 : | Ligne 188 : | ||
− | void setup() { | + | void setup() { |
Serial.begin(115200); | Serial.begin(115200); | ||
+ | Serial.println("IR Receiver Button Decode"); | ||
+ | irrecv.enableIRIn(); // Start the receiver | ||
+ | pinMode(13,OUTPUT); | ||
+ | pinMode(12,OUTPUT); | ||
digitalWrite(Stop,HIGH); | digitalWrite(Stop,HIGH); | ||
pinMode(A0,INPUT); | pinMode(A0,INPUT); | ||
Ligne 159 : | Ligne 207 : | ||
pinMode(9,OUTPUT); | pinMode(9,OUTPUT); | ||
digitalWrite(A4,LOW);//trigger | digitalWrite(A4,LOW);//trigger | ||
− | digitalWrite(Stop,HIGH); | + | digitalWrite(Stop,HIGH);} |
− | |||
Ligne 167 : | Ligne 214 : | ||
− | |||
− | |||
− | |||
− | |||
− | |||
− | if( obstacle() > 500 ){ | + | void loop() { |
− | + | int i = 0; | |
− | + | while(detectProie() != 1 && i < 1){ | |
− | + | i++; | |
− | + | } | |
− | + | if( obstacle() > 500 ){ | |
− | + | digitalWrite(Stop,HIGH); | |
− | + | ToutDroit(); | |
− | + | delay(1000); | |
− | + | digitalWrite(Stop,LOW); | |
− | digitalWrite( | + | } |
− | } | + | else { |
+ | digitalWrite(Stop,HIGH); | ||
+ | tourneD(); | ||
+ | delay(400); | ||
+ | digitalWrite(Stop,LOW);}} | ||
+ | |||
+ | |||
+ | void translateIR() // takes action based on IR code received | ||
+ | |||
+ | // describing Remote IR codes | ||
+ | |||
+ | { | ||
+ | switch(results.value) | ||
+ | { | ||
+ | case 0x14EB18E7:digitalWrite(12,LOW); digitalWrite(13,HIGH); break; | ||
+ | case 0x14EB30CF:digitalWrite(13,LOW); digitalWrite(12,HIGH); break; | ||
+ | // ^here your hex code that you got in irdumpv2 or irdemo | ||
+ | default: | ||
+ | Serial.println(" other button "); | ||
+ | }// End Case | ||
+ | delay(100); // to not get immediate repeat} | ||
− | |||
− | |||
− | |||
=<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Circuit imprimé </div>= | =<div class="mcwiki-header" style="border-radius: 15px; padding: 15px; font-weight: bold; text-align: center; font-size: 80%; background: #0080FF; vertical-align: top; width: 98%;"> Circuit imprimé </div>= |
Version du 23 mai 2019 à 13:21
Sommaire
- 1 Introduction
- 2 Compétences et matériel utilisé
- 3 Logiciels
- 4 Système embarqué
- 5 Répartition des tâches
- 6 Programme informatique
- 7 Ajout bibliothèques
- 8 Connexion des composants aux pins du robot
- 9 partie autonomie du robot
- 10 Void Setup
- 11 Void Loop
- 12 Circuit imprimé
- 13 Différence robot proie/prédateur
Introduction
Notre projet dans ce bureau d'étude à été de fabriquer des robots dans le domaine des proies ou prédateurs.
Les prédateurs doivent repérer et rattraper des proies. Ils sont donc lourd et on besoin de moteurs puissants. Les proies émettent un signal qui permet aux prédateurs de les détecter et sont donc ainsi identifiées grâce aux tsops. Les prédateurs possèdent un système de réception infra-rouge directionnel permettant de s'orienter dans la phase de poursuite. Les prédateurs émettent aussi un signal infra-rouge permettant ainsi aux proies de savoir qu'elles sont prises en chasse. Les prédateurs n'ont pas besoin de connaître le relief de la pièce une fois la poursuite lancée. En effet, comme les proies ne savent pas voler, c'est à elle d'éviter les murs ce qui permet d’alléger le programme des robots prédateurs.
Les proies et les prédateurs doivent être clairement autonome.
La taille du robot n'est pas fixé. Mais il est préférable d'avoir un robot plus rapide pour les proies là où un robot plus massif sera conseillé pour les robots prédateurs. Nous avons choisi pour notre projet de faire un robot prédateur.
Compétences et matériel utilisé
Compétences :
- avancer et tourner ;
- s'orienter par rapport aux signaux que les tsops lui transmettent lors d'une course poursuite ;
- éventuellement émettre des signaux pour complexifier et rendre plus tacte la chasse ;
Matériel ;
- Nous avons pu nous inspirer des robots des années précédentes pour construire notre robot. Nous étions même autorisé à les détruises pour récupérer leur matos. Ces robots ne sont pas forcément totalement fonctionnels mais les parties déjà réalisées nous ont fait gagner du temps que nous avons pu consacrer à la programmation du robot.
- Pour faire le support du robot c'est à dire son châssis nous avion utilisé du plexiglas. Pour faire la découpe du support, nous avons utilisé la découpe laser.
Il faut faire attention de bien optimiser l'espace de son châssis. Dans l'absolue il vaut mieux faire trop grand et faire tenir le tout avec des ajouts non prévus que d'avoir un support trop petit et de devoir retirer du matos initialement prévu pour le robot.
Les montages photographiques ci-dessous présentent les éléments permettant de construire un robot sans trop souffrir et les composants de base pour construire un robot plus optimisé et personnalisé.
Des robots miniatures peuvent être réalisés en utilisant des servo-moteurs continus et des pièces en plexiglas ou en contreplaqué découpées à l'aide de la découpeuse laser du Fabricarium. Certaines formes plus complexes peuvent éventuellement être réalisées à l'aide des imprimantes 3D du Fabricarium. Il est possible d'imprimer des pneus avec du PLA flexible. Pour les fixations vous avez de la visserie (vis, écrous, entretoises).
Logiciels
Pour concevoir un schéma propre du câblage de notre robot, nous avons utlisé fritzing. Tous les composants de notre robot ne sont pas modélisés dans fritzing car certains ont du être rajouté en cours de route.
- détecteur ultrason : Fichier:UltrasonicSensor HCSR04.zip
- contrôleur de moteurs : Fichier:MotorDriver Pololu md08a.zip
Pour la découpe laser nous avons utilisé ce logiciel inkscape.
3D solidwork est très utilisé pour construire le support de notre robot. Mais nous ne l'avons pas utilisé. Notre programme a été realisé en C++ ce qui est relativement abordable. Il y a de nombreux site internet qui proposent de claires explication.
Pour nous aider dans la conception des circuits imprimés, nous avons utilisé fritzing. cela nous a permis de personnaliser notre circuit imprimé
Système embarqué
Il n'y a pas de télécommandes pour controler le robot. Autrement dit, il doit être 100% autonome. Il possède donc un sonar, un détecteur infrarouge et une batterie.
Répartition des tâches
Valentin a travaillé sur la strcuture du robot. Pour ma part, je me suis chargé du programme informatique.
Programme informatique
Ajout bibliothèques
#include <boarddefs.h> #include <IRremote.h> #include <IRremoteInt.h> #include <ir_Lego_PF_BitStreamEncoder.h>
Connexion des composants aux pins du robot
int MotorG1=8; int MotorG2=7; int MotorD1=4; int MotorD2=A5; int SpeedG=6; int SpeedD=10; int echo=A3; int trigger=A4; int Tsop1=A0; int Tsop2=A1; int Stop = 9; int tsop1=digitalRead(Tsop1); int tsop2=digitalRead(Tsop2); const unsigned long MEASURE_TIMEOUT = 25000UL;//variable pour le sonar const float SOUND_SPEED = 340.0 / 1000;// vitesse du son dans l'air int IR = 1024; IRrecv irrecv(Tsop1); // create instance of 'irrecv' decode_results results; // create instance of 'decode_results'//valeur du tsop a la frequence infrarouge d'une proie (inconnue pour l'instant)
partie autonomie du robot
void tourneD() { digitalWrite(MotorG1,HIGH);// gauche digitalWrite(MotorG2,LOW);//gauche analogWrite(SpeedG,100); // vitesse gauche digitalWrite(MotorD1,LOW);// droit digitalWrite(MotorD2,HIGH);// droit analogWrite(SpeedD,100);// vitesse droite }
void tourneG() { digitalWrite(MotorG1,HIGH);// gauche digitalWrite(MotorG2,LOW);//gauche analogWrite(SpeedG,100); // vitesse gauche digitalWrite(MotorD1,LOW);// droit digitalWrite(MotorD2,HIGH);// droit analogWrite(SpeedD,100);// vitesse droite }
void ToutDroit() { digitalWrite(MotorD1,HIGH); digitalWrite(MotorD2,LOW); analogWrite(SpeedD,150); digitalWrite(MotorG1,HIGH); digitalWrite(MotorG2,LOW); analogWrite(SpeedG,150); }
int detectProie(){//fonction qui nous place en face d'une proie if (irrecv.decode(&results)) // have we received an IR signal?
{ translateIR(); tsop1 = IR; irrecv.resume(); // receive the next value }
if (tsop1 == IR && tsop2 != IR){//tourne legerement a gauche digitalWrite(Stop,HIGH); tourneG(); delay(300); digitalWrite(Stop,LOW); tsop1 = 0; tsop2 = 0; return 0; } else if (tsop1 != IR){//tourne legerement a droite digitalWrite(Stop,HIGH); tourneD(); delay(300); digitalWrite(Stop,LOW); tsop1 = 0; tsop2 = 0; return 0; } else { return 1; } }
float obstacle(){//fonction qui detecte un obstacle digitalWrite(trigger, HIGH); delay(10); digitalWrite(trigger, LOW);
long measure = pulseIn(echo, HIGH, MEASURE_TIMEOUT); //temps entre le signal emis et recu float distance_mm = measure / 2.0 * SOUND_SPEED;// calcul de la distance en mm Serial.print(F("Distance: ")); Serial.print(distance_mm); Serial.print(F("mm (")); Serial.print(distance_mm / 10.0, 2); Serial.print(F("cm, ")); Serial.print(distance_mm / 1000.0, 2); Serial.println(F("m)")); delay(5); return distance_mm;}
Void Setup
void setup() { Serial.begin(115200); Serial.println("IR Receiver Button Decode"); irrecv.enableIRIn(); // Start the receiver pinMode(13,OUTPUT); pinMode(12,OUTPUT); digitalWrite(Stop,HIGH); pinMode(A0,INPUT); pinMode(A1,INPUT); pinMode(A3,INPUT); pinMode(8,OUTPUT); pinMode(7,OUTPUT); pinMode(4,OUTPUT); pinMode(6,OUTPUT); pinMode(10,OUTPUT); pinMode(A5,OUTPUT); pinMode(A4,OUTPUT); pinMode(9,OUTPUT); digitalWrite(A4,LOW);//trigger digitalWrite(Stop,HIGH);}
Void Loop
void loop() { int i = 0; while(detectProie() != 1 && i < 1){ i++; } if( obstacle() > 500 ){ digitalWrite(Stop,HIGH); ToutDroit(); delay(1000); digitalWrite(Stop,LOW); } else { digitalWrite(Stop,HIGH); tourneD(); delay(400); digitalWrite(Stop,LOW);}}
void translateIR() // takes action based on IR code received
// describing Remote IR codes
{ switch(results.value) { case 0x14EB18E7:digitalWrite(12,LOW); digitalWrite(13,HIGH); break; case 0x14EB30CF:digitalWrite(13,LOW); digitalWrite(12,HIGH); break; // ^here your hex code that you got in irdumpv2 or irdemo default: Serial.println(" other button "); }// End Case delay(100); // to not get immediate repeat}
Circuit imprimé
Différence robot proie/prédateur
Un robot proie est constitué comme suit :
- un châssis roulant, un contrôleur pour chaque paire de moteurs, un Arduino Uno ou un circuit électronique maison à base de micro-contrôleur ATMega328p ;
- des détecteurs ultrason pour éviter les collisions ;
- un récepteur infra-rouge TSOP pour décoder les signaux infra-rouges modulés ;
- un émetteur infra-rouge pour émettre un signal signalant le robot comme une proie ;
- un dispositif récepteur à courte distance pour simuler la capture par un prédateur, vous pouvez partir sur l'idée d'un capteur à effet Hall.
Dans son mode autonome, le robot se promène dans la pièce en évitant les obstacles de façon tranquille et prévisible. Quand il repère un prédateur à son signal infra-rouge, la proie se déplace plus vivement avec de brusques changements de direction. Quand le détecteur à courte distance indique que le robot proie est à portée du prédateur, il s'arrête. Faire clignoter des LED rouges serait assez à propos.
Un robot prédateur est constitué comme suit :
- un châssis roulant, un contrôleur pour chaque paire de moteurs, un Arduino Uno;
- un détecteur ultrason pour ne pas rentrer dans les obstacles ;
- des récepteurs infra-rouges TSOP pour décoder les signaux infra-rouges modulés ;
- un émetteur infra-rouge pour émettre un signal signalant le robot comme un prédateur ;
Dans son mode autonome, le robot tourne en rond à la recherche d'une proie. Dès qu'il en repère une, il se précipite vers elle en se calant sur son signal infra-rouge. Quand le prédateur pense être à porté de la proie, il lui fonce dessus. Il ne s'arrête pas et s'acharne jusqu'à en venir à bout.