//*****************************************************************************
// Programme Arduino : NanoRobotCD5cmMoteursJaune3xSonar
//*****************************************************************************
// Nom du programme pour l'afficher sur le terminal série et/ou de l'écran LCD.
const char NOM_DU_PROGRAMME [34] = "NanoRobotCD5cmMoteursJaune3xSonar";
/*
Écrit par : René Ross
Date : 2016-09-14
Ce code source est sous licence publique générale GNU (GNU General Public
Licence "GPL"), désignation « open source », ou « code source ouvert ».
Référence : https://www.fsffrance.org/index.fr.html
Ce programme est un logiciel libre; vous pouvez le redistribuer et / ou le
modifier selon les termes de la licence GNU V2. Ce programme est distribué
dans l'espoir qu'il sera utile, mais SANS AUCUNE GARANTIE, sans même la
garantie implicite de COMMERCIALISATION ou D'ADAPTATION À UN USAGE
PARTICULIER. Voir la GNU General Public License, Version 2 pour plus de
détails.
Ce code source se veut didactique, c'est pourquoi les commentaires y prennent
une très grande place. Mais cela ne doit pas vous effrayez, au contraire, cela
devrait vous rassurez en facilitant la compréhension du code source.
*/
//*****************************************************************************
// Que fait ce programme ?
//*****************************************************************************
/*
Ce programme contrôle un véhicule robot a deux roues motrices et une série de
capteurs pour se déplacer intelligemment en évitant les obstacles. Il utilise
des moteurs à courant continu et 3 capteurs de distances à ultrason HR-SC04
pour détecter son environnement. Une télécommande et un capteur infrarouge
permettent de le contrôler à distance et de modifier plusieurs de ses
paramètres. Il est aussi activé par un bouton directement sur le véhicule. Sur
le moniteur série (s'il est connecté par câble USB à l'ordinateur), il affiche
des informations de base en tempps réel. Une touche de la télécommande permet
d'activer l'affichage sur le moniteur série (voir la "FONCTION
GererBoutonTeleCommande", plus bas dans le présant code source). Pour ce qui
est de la plage d'utilisation des moteurs qui est en fonction de la pile
utilisée (6V,9V ou 12V), les paramètres des vitesses moteurs (Min., Max. et
point mort de roulement) permet un usage progressif de la puissance des
moteurs et selon les données des capteurs.
*/
//*****************************************************************************
//*****************************************************************************
// Matériel requis ?
//*****************************************************************************
/*
Testé avec : l'éditeur compilateur Arduino 1.6.10
Liste alphabétique des composantes d'électroniques
1 x Arduino Nano 328 V3.0 avec bouclier de connexion :
https://www.dx.com/fr/p/mini-usb-nano-3-0-atmega328p-development-board-w-usb-cable-nano-io-extension-board-for-arduino-378838
https://www.dx.com/fr/p/keyes-eb0057-nano-io-expansion-board-shield-for-arduino-red-green-368288
https://arduino.cc/en/Main/ArduinoBoardNano
https://www.dx.com/p/arduino-nano-v3-0-81877
https://www.dx.com/fr/p/nano-3-0-atmel-atmega328p-mini-usb-board-w-usb-cable-for-arduino-152052
https://dx.com/p/nano-v3-0-avr-atmega328-p-20au-module-board-usb-cable-for-arduino-118037
1 x Base tructurel du robot est un boitier de 25 DVDs vide qui se clipe en 1/10
de tour et fait un diamètre du haut de 13cm et a sa base 14cm et 5cm de haut.
2 x Bout de bois de 6x3x2cm pour fixer les moteurs et la roulette de queue.
1 x Bouton-poussoir 2 pattes, noir, "Push Button Switches" (03120181), 250V/5A :
https://www.dx.com/p/bonatech-2-pin-metal-holder-button-switch-without-lock-black-silver-10-pcs-295327
1 x Buzzer actif 5V noir de 3.5V à 5.5V Current 25mA; Fréquence de 500Hz à 2300Hz SKU-381747
https://www.dx.com/fr/p/5v-active-buzzers-black-10-pcs-381747
1 x Capteur infra-rouge VS1838B (TSOP1838) :
https://www.dipmicro.com/store/VS1838B
https://dx.com/p/hx1838-pc638-diy-universal-electronic-component-infrared-receiver-silver-20-pcs-158341
https://www.electrodragon.com/product/infrared-dev-kit-controllernec-type-and-hx1838-receiver/
https://www.amazon.com/NEOMART-Raspberry-Infrared-Control-Receiver/dp/B00CW8WUGA
3 x Capteur ultrason (émetteur/récepteur) HR-SC04.
https://dx.com/p/hc-sr04-ultrasonic-sensor-distance-measuring-module-133696
https://www.dx.com/fr/p/hc-sr04-ultrasonic-sensor-distance-measuring-modules-blue-4-pcs-400214
https://www.robotshop.com/ca/fr/module-sonar-hc-sr04.html
1 x Connecteur à Prise Baril 2.1mm, 30V/0.3A, femelle 3 brins fileté 1.0 cm avec écrou :
https://www.dx.com/p/dc-jack-adapters-10-piece-pack-122746
1 x Connecteur avec fils pour pile 9V SKU-141262
https://www.dx.com/fr/p/9v-safe-pu-leather-stainless-material-battery-buckle-black-red-5-piece-pack-141262
https://www.robotshop.com/ca/fr/connecteur-batterie-9v-bh-06.html
https://www.dx.com/p/9v-safe-pu-leather-stainless-steel-battery-buckle-black-red-10-pack-142018
1 x Contrôleur moteur L298N (H-Bridge) pour 2 moteurs CC ou 1 moteur Pas-A-Pas SKU-149662 :
https://dx.com/p/l298n-stepper-motor-driver-controller-board-module-blue-149662
https://www.robotshop.com/ca/fr/controleur-deux-moteurs-dc-l298.html
https://www.datasheetarchive.com/dlmain/Datasheets-5/DSA-95443.pdf
https://www.datasheetarchive.com/dlmain/Datasheets-25/DSA-480678.pdf
1 x Interrupteur "Switch" 6 pattes On/Off/On :
https://www.dx.com/fr/p/electrical-diy-power-control-6-pin-toggle-switch-red-silver-5-piece-pack-146106
2 x Moteur DC à deux axes avec ratio de 1:48, 3V~6V, 100rpm avec ses roues jaunes
https://www.dx.com/fr/p/tt-02-diy-car-model-tt-motor-encoder-w-wheel-black-yellow-257135
https://www.dx.com/p/dual-axis-reducer-motor-for-smart-tt-car-yellow-silver-dc-3-6v-185017
https://www.dx.com/p/diy-tt-motor-wheel-for-four-wheel-drive-car-model-yellow-black-66mm-diameter-4-pcs-222634
https://www.dx.com/fr/p/tt-02-diy-car-model-tt-motor-encoder-w-wheel-black-yellow-257135
1 x Pile 9V 6LR61 :
https://www.dx.com/p/duracell-9v-mn1604-6lr61-alkaline-battery-gold-black-101015
1 x Planche d'expérimentation « BreadBoard » Micro (170 trous) ZY-107 :
https://www.robotshop.com/ca/fr/sfe-mini-planch-essais-170-points.html
https://www.dx.com/p/mini-prototype-printed-circuit-board-breadboard-for-arduino-5-pcs-148443
1 x Radiateurs thermique en aluminium bleu (1.5 cm x 1.5 cm x 0.8 cm) SKU-376917
https://www.dx.com/fr/p/aluminum-flash-memory-heat-dissipation-heatsinks-blue-8-pcs-376917
1 x Roulette à Bille Pololu 3/8 po. avec Bille en Métal Code de Produit : RB-pol-91
https://www.robotshop.com/ca/fr/roulette-bille-pololu-0375-po-metal.html
1 x Télécommande type Mini MP3 :
https://dx.com/p/ir-remote-control-diy-kit-for-arduino-1-x-cr2025-136284
Et des petits câbles électriques et connecteurs appropriés (Réf. : MB-940,
MB-910, MB-900, MB-102J, LS-MMPJ-6, LS-FFPJ-6, etc.).
Condensateurs céramiques baige 18 x 10 pièces 50V SKU-303275
https://www.dx.com/fr/p/hongyang-20pf-105-1uf-50v-leaded-multilayer-ceramic-capacitor-10-x18-pcs-303275
Condensateurs céramiques bleu 10 x 10 pièces 2KV SKU-354587
https://www.dx.com/fr/p/2-pin-ceramic-capacitors-set-blue-1100-pcs-354587
Fils de raccordement mâle/femelle 20cm (600 pièces, 6 couleurs x 100) :
https://www.dx.com/fr/p/tenying-1-pin-male-to-female-jumper-wire-dupont-cable-for-arduino-random-color-600-pcs-20cm-312541
Fils de raccordement mâle/mâle 20cm (600 pièces, 6 couleurs x 100) :
https://www.dx.com/fr/p/tenying-1-pin-male-to-male-jumper-wire-dupont-cable-for-arduino-random-color-600-pcs-20cm-312963
Paquet de 70 fils mâle/mâle de couleurs diverses(50x12cm, 10x15cm, 5x20cm, 5x24cm) :
https://dx.com/p/breadboard-jumper-wires-for-electronic-diy-70-cable-pack-80208
Fils de raccordement femelle/femelle 20cm (nappe de 10 couleurs, 40 fils)) :
https://dx.com/p/dupont-line-1p-1p-40-pack-20cm-length-121338
Fils de raccordement femelle/femelle 20cm (nappe de 10 couleurs, 40 fils)) :
https://dx.com/p/male-to-female-dupont-breadboard-jumper-wires-for-arduino-40-piece-pack-20cm-length-146935
Tête de connecteurs 2,54mm 1x40 Pin Breakaway, têtes droites (10 pièces x 40 broches) :
https://www.dx.com/p/2-54mm-1x40-pin-breakaway-straight-male-header-10-piece-pack-144191
Résistance de 1/4 Watt/1%, 1400 pièces (200 x : 10Ω, 47Ω, 100Ω, 150Ω, 220Ω, 470Ω, 330Ω:
https://www.dx.com/fr/p/1-4w-resistance-aluminum-film-resistors-multicolored-1400-pcs-298169
Résistance de 1/4 Watt/5% 270 pièces, 10 x 27 types : 100Ω, 110Ω, 130Ω, 160Ω,
180Ω, 200Ω, 220Ω, 240Ω, 270Ω, 300Ω, 330Ω, 360Ω, 390Ω, 430Ω, 510Ω, 560Ω, 680Ω, 750Ω,
820Ω, 910Ω, 1KΩ, 1.2KΩ, 1.5KΩ, 1.8KΩ, 2KΩ, 2.2KΩ, 2.4KΩ :
https://dx.com/p/jtron-1-4w-colored-ring-resistor-pack-100-ohm-2k-27-kinds-10-pcs-blue-sliver-270-pcs-288760
Autres liens en rapport avec le sujet :
https://www.mon-club-elec.fr/pmwiki_mon_club_elec/pmwiki.php?n=MAIN.ArduinoExpertSerie2
https://www.mon-club-elec.fr/pmwiki_mon_club_elec/pmwiki.php?n=MAIN.ArduinoExpertSerieCanTerminalPC
*/
//*****************************************************************************
//*****************************************************************************
// Circuit à réaliser.
//*****************************************************************************
/*
Dans cette section, toutes les connexions des composantes du montage sont
listées, qu'ils soient utilisés ou non, et cela pour éviter tout oublie et
rendre le copier / coller par bloc complet pour une pièce, plus facile d'un
montage à l'autre. Le plus souvent possible le libellé de la pièce précédé du
nom court de la pièce est utilisé, par exemple « ARDUINO_A3 », pour la broche
analogique A3 d'une carte contrôleur Arduino Uno R3.
Plaque d'expérimentation « BreanBoard » :
Pour identifier les trous d'une plaque d'expérimentation « BreanBoard », c'est
comme dans le jeu de bataille navale "Battle Ship". Les lignes sont identifiées
pas des numéros. Pour un BreanBoard MB-104, les lignes vont de 1 à 63 et les
colonnes sont identifiées par les lettres "a" a "j" plus deux colonnes avec les
signes « + » et « - » à gauche (G) et à droite (D). Donc (i10) indique le trou
à l'intersection de la colonne « i » avec la ligne numéro « 10 ». Pour une
broche des colonnes négatives ou GND, c'est par exemple (-51G) pour la colonne
du négatif à gauche et sur la ligne 51 et c'est (+51D) pour la colonne du
positif à droit et sur la ligne 51. Dans des situation simple ou évidnte on
utilise aussi pour une broche des colonnes négatives ou GND, par exemple (-5V)
et c'est (+5V) dans le cas ou c'est du courant 5 Volts qui allimante ces
colonnes. Les parenthèses « ( » et « ) », c'est pour bien spécifier une
position de trou de la planche d'expérimentation.
*/
/*
Le circuit : (Voir la page Web :...)
Câblage de l'Arduino Nano R3.0 à une planche d'expérimentation MB-104 :
ARDUINO_USB = Câble USB à l'ordinateur;
ARDUINO_13_SCK_DEL = DEL_1_VIN;
ARDUINO_3_3V =
ARDUINO_AREF =
ARDUINO_A0 = SONAR_1_TRIG
ARDUINO_A1 = SONAR_1_ECHO
ARDUINO_A2 = SONAR_2_TRIG
ARDUINO_A3 = SONAR_2_ECHO
ARDUINO_A4_SDA = SONAR_3_TRIG
ARDUINO_A5_SCL = SONAR_3_ECHO
ARDUINO_A6 =
ARDUINO_A7 =
ARDUINO_5V =
ARDUINO_RST2 = ARDUINO_4_T0_XCK
ARDUINO_GND2 = (c2), (e2) -- (f2), (g2) -- (i13)
ARDUINO_VIN = (c1), (j1) -- (j4), (i4) -- (i11)
ARDUINO_GND =
ARDUINO_OC2A_MOSI =
ARDUINO_5V =
ARDUINO_MISO =
ARDUINO_SCK =
ARDUINO_RESET =
ARDUINO_1_TX =
ARDUINO_0_RX =
ARDUINO_RST1 =
ARDUINO_GND1 =
ARDUINO_2_INT1 = (g6), (f6) -- BOUTON_1_OUT
ARDUINO_3_INT2_OC2B_PWM = CAPTEUR_IR_0_OUT
ARDUINO_4_T0_XCK = ARDUINO_RST2
ARDUINO_5_T1_OC0B_PWM = CONTROLE_MOTEUR_1_ENA
ARDUINO_6_AIN0_OC0A_PWM = CONTROLE_MOTEUR_1_ENB
ARDUINO_7_AIN1 = CONTROLE_MOTEUR_1_IN1
ARDUINO_8_CLK0_ICP1 = CONTROLE_MOTEUR_1_IN2
ARDUINO_9_OC1A_PWM = CONTROLE_MOTEUR_1_IN3
ARDUINO_10_OC1B_SS_PWM = CONTROLE_MOTEUR_1_IN4
ARDUINO_11_OC2_MOSI_PWM =
ARDUINO_12_MISO = BUZZER_1_VIN
Câblage pour une pile de 6V~9V sur la planche d'expérimentation :
BATTERIE_9V_PLUS = INTERRUPTEUR_1_2
BATTERIE_9V_MOINS = CONTROLE_MOTEUR_1_GND
Câblage pour le bouton 4 pattes sur la planche d'expérimentation :
BOUTON_1_OUT_1 = (f4)
BOUTON_1_OUT_2 = (f6); (g6) -- ARDUINO_2_INT1
Résistance_100_Ohm_1_1 = (i3)
Résistance_100_Ohm_1_2 = (i6)
Câblage pour le Buzzer sur la planche d'expérimentation et l'Arduino :
BUZZER_1_VIN = ARDUINO_12_MISO
BUZZER_1_GND = (g8)
Résistance_100_Ohm_2_1 = (h8)
Résistance_100_Ohm_2_2 = (h3)
Câblage pour le capteur infra-rouge utiliser avec la télécommande, sur la
planche d'expérimentation :
CAPTEUR_IR_0_OUT = ARDUINO_3_INT2_OC2B_PWM
CAPTEUR_IR_0_GND = (f3)
CAPTEUR_IR_0_VIN = (g9)
Résistance_100_Ohm_3_1 = (h9)
Résistance_100_Ohm_3_2 = (h4)
// Pour éviter une trop grande baisse de tension du au servomoteur :
Condensateur 2200uF 16V + = (f11)
Condensateur 2200uF 16V - = (f13)
Câblage pour le connecteur d'un transformateur 6V~12V de la planche d'expérimentation :
CONNECTEUR_2.1MM_PLUS = INTERRUPTEUR_1_4
CONNECTEUR_2.1MM_MOINS = (a2)
Câblage pour les deux Moteur DC a deux axe avec un ratio de 1:48, 3V~6V, 100RPM
sur la planche d'expérimentation :
CONTROLE_MOTEUR_1_VIN = (b1); +6V~12V
CONTROLE_MOTEUR_1_GND = (b2); BATTERIE_9V_MOINS
CONTROLE_MOTEUR_1_5V = (f1)
CONTROLE_MOTEUR_1_ENA = ARDUINO_5_T1_OC0B_PWM
CONTROLE_MOTEUR_1_IN1 = ARDUINO_7_AIN1
CONTROLE_MOTEUR_1_IN2 = ARDUINO_8_CLK0_ICP1
CONTROLE_MOTEUR_1_ENB = ARDUINO_6_AIN0_OC0A_PWM
CONTROLE_MOTEUR_1_IN3 = ARDUINO_9_OC1A_PWM
CONTROLE_MOTEUR_1_IN4 = ARDUINO_10_OC1B_SS_PWM
CONTROLE_MOTEUR_1_OUT1 = Moteur1_VIN
CONTROLE_MOTEUR_1_OUT2 = Moteur1_GND
CONTROLE_MOTEUR_1_OUT3 = Moteur2_VIN
CONTROLE_MOTEUR_1_OUT4 = Moteur2_GND
Câblage pour l'interrupteur 3 positions de la planche d'expérimentation :
INTERRUPTEUR_1_1 = BATTERIE_9V_PLUS
INTERRUPTEUR_1_2 = (a1); INTERRUPTEUR_1_3
INTERRUPTEUR_1_3 = (a1); INTERRUPTEUR_1_2
INTERRUPTEUR_1_4 = CONNECTEUR_2.1MM_PLUS
INTERRUPTEUR_1_5 =
INTERRUPTEUR_1_6 =
INTERRUPTEUR_1_7 =
INTERRUPTEUR_1_8 =
Câblage pour le module a ultrason 1 à l'Arduino et la BreanBoard :
SONAR_1_VCC = (i1)
SONAR_1_TRIG = ARDUINO_A0
SONAR_1_ECHO = ARDUINO_A1
SONAR_1_GND = (i2)
Câblage pour le module a ultrason 2 à l'Arduino et la BreanBoard :
SONAR_2_VCC = (h1)
SONAR_2_TRIG = ARDUINO_A2
SONAR_2_ECHO = ARDUINO_A3
SONAR_2_GND = (h2)
Câblage pour le module a ultrason 2 à l'Arduino et la BreanBoard :
SONAR_3_VCC = (g1)
SONAR_3_TRIG = ARDUINO_A4_SDA
SONAR_3_ECHO = ARDUINO_A5_SCL
SONAR_3_GND = (g2)
*/
//*****************************************************************************
//*****************************************************************************
// Inclusion des librairies utilisées.
//*****************************************************************************
#include "IRremote.h"
/*
Il s'agit de la bibliothèque irRemote pour télécommande avec l'Arduino.
Pour télécharger depuis github :
https://github.com/shirriff/Arduino-IRremote
Cliquez sur le lien "Télécharger" en haut à droite, cliquez sur « Télécharger
au format Zip", pour obtenir un fichier zip. Décompressez-le et renommez le
répertoire « Shirriff-Arduino-irRemote-NNN » pour « irRemote ». Pour
l'installer, déplacer le répertoire de irRemote téléchargée dans votre dossier
des bibliothèque Arduino « ~/Arduino/libraries/IRremote ». Pour avoir accès à la
nouvelle bibliothèque, vous devez redémarrer l'éditeur Arduino. Pour plus de
détails sur la bibliothèque voir le wiki sur github ou le poste :
https://arcfn.com/2009/08/multi-protocol-infrared-remote-library.html blog
Copyright 2009-2012 Ken Shirriff
Merci à cette personne pour sa contribution !
*/
#include "NotesDeMusique.h"
/*
Fichier contenant les définitions de notes de musique.
*/
#include "TelecommandeValeurBoutons.h"
/*
Fichier contenant la valeur envoyée pour chaque boutons de la télécommande.
*/
//*****************************************************************************
//*****************************************************************************
// Déclaration des constantes de base pour franciser le code source.
//*****************************************************************************
/*
Par convention, pour nommer une constante, nous utiliserons des noms écrits
tout en majuscule, en capitale, ce qui facilitera leur repérage et rendra le
code plus facilement compréhensible. Le mot devant notre nom de constante
indique à l'Arduino l'espace mémoire à réserver pour stocker cette donnée.
Après le nom de notre constante, on lui attribue sa valeur.
*/
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « ENTREE » est l'équivalent du paramètre « INPUT ». Ce paramètre est
pour prépare l'Arduino a recevoir une tension électrique pour ce connecteur, sur
ce port de communication, sur ce "pin".
*/
const byte ENTREE = INPUT;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « ENTREE_ET_RESISTENCE_INTERNE » est l'équivalent du paramètre
« INPUT_PULLUP ». Ce paramètre est pour prépare l'Arduino en activant sa
résistance interne et a recevoir une tension électrique pour ce connecteur,
sur ce port de communication, sur ce "pin".
*/
const byte ENTREE_ET_RESISTENCE_INTERNE = INPUT_PULLUP;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « SORTIE » est l'équivalent du paramètre « OUTPUT ». Ce paramètre
est pour prépare l'Arduino a émettre une tension électrique pour ce connecteur,
sur ce port de communication, sur ce "pin".
*/
const byte SORTIE = OUTPUT;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « HAUT » est l'équivalent du paramètre « HIGH ». Ce paramètre fait
que l'Arduino maintiendra un voltage haut sur ce connecteur, soit 3.3 Volts,
soit 5 Volts, selon sa propre tension d'alimentation. En électronique, cela
correspondra aux valeurs logiques « 1 », « Oui », ou « Vrai », etc.
*/
const byte HAUT = HIGH;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « BAS » est l'équivalent du paramètre « LOW ». Ce paramètre fait
que l'Arduino maintiendra un voltage bas sur ce connecteur, soit 0 Volt. En
électronique, cela correspondra aux valeurs logiques « 0 », « Non », ou
« Faut », etc.
*/
const byte BAS = LOW;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « NON » est l'équivalent du paramètre « false », cela
correspondra aux valeurs logiques « 0 », « Non », ou « Faut », etc.
*/
const byte NON = false;
/*
Constante pour franciser le code source du programme. Ici nous définissons que
la constante « OUI » est l'équivalent du paramètre « true », cela
correspondra aux valeurs logiques « 1 », « Oui », ou « Vrai », etc.
*/
const byte OUI = true;
//*****************************************************************************
//*****************************************************************************
// Déclaration des constantes des connecteurs Arduino.
//*****************************************************************************
// En prévision d'un ARDUINO_RESET par télécommande.
const byte ARDUINO_RESET = 4;
// Pour gérer l'action d'humains le bouton de la planche d'expérimentation.
const byte BOUTON_1_OUT = 2;
// Câblage pour le Buzzer sur la planche d'expérimentation et l'Arduino :
const byte BUZZER_1_VIN = 12;
// Broche d'Arduino pour recevoir le signale du capteur infrarouge de télécom.
const byte CAPTEUR_IR_0_1_OUT = 3;
// Broche d'Arduino pour le controleur moteur 1 (double Pont en H).
const byte CONTROLE_MOTEUR_1_ENA = 5;
const byte CONTROLE_MOTEUR_1_ENB = 6;
const byte CONTROLE_MOTEUR_1_IN1 = 7;
const byte CONTROLE_MOTEUR_1_IN2 = 8;
const byte CONTROLE_MOTEUR_1_IN3 = 9;
const byte CONTROLE_MOTEUR_1_IN4 = 10;
// Câblage pour la DEL verte sur la planche d'expérimentation et l'Arduino
const byte DEL_1_VIN = 13;
// Broche d'Arduino pour le capteur a ultrason 1, le sonar.
const byte SONAR_1_TRIG = A0;
const byte SONAR_1_ECHO = A1;
// Broche d'Arduino pour le capteur a ultrason 2, le sonar.
const byte SONAR_2_TRIG = A2;
const byte SONAR_2_ECHO = A3;
// Broche d'Arduino pour le capteur a ultrason 3, le sonar.
const byte SONAR_3_TRIG = A4;
const byte SONAR_3_ECHO = A5;
//*****************************************************************************
//*****************************************************************************
// Déclaration des autres constantes de travail.
//*****************************************************************************
// 1.0 est le maximum, il ne faut pas dépasser 255 pour les moteur, etc.
const float MOTEURS_VITESSE_ECART_TYPE = 1.0;
const word MOTEUR_1_VITESSE_MINIMUM = 110;// C'est le plus bas possible.
const word MOTEUR_1_VITESSE_MAXIMUM = 255;// 255 est le plus haut possible.
const word MOTEUR_2_VITESSE_MINIMUM = int (MOTEUR_1_VITESSE_MINIMUM *
MOTEURS_VITESSE_ECART_TYPE);
const word MOTEUR_2_VITESSE_MAXIMUM = int (MOTEUR_1_VITESSE_MAXIMUM *
MOTEURS_VITESSE_ECART_TYPE);
/*
// 1.0 est le maximum, il ne faut pas dépasser 255 pour les moteur, etc.
const float MOTEURS_VITESSE_ECART_TYPE = 0.9;
const word MOTEUR_2_VITESSE_MINIMUM = 130;// C'est le plus bas possible.
const word MOTEUR_2_VITESSE_MAXIMUM = 255;// 255 est le plus haut possible.
const word MOTEUR_1_VITESSE_MINIMUM = int (MOTEUR_2_VITESSE_MINIMUM *
MOTEURS_VITESSE_ECART_TYPE);
const word MOTEUR_1_VITESSE_MAXIMUM = int (MOTEUR_2_VITESSE_MAXIMUM *
MOTEURS_VITESSE_ECART_TYPE);
*/
//*****************************************************************************
//*****************************************************************************
// Déclaration des variables globales.
//*****************************************************************************
/*
Par convention, pour nommer une variable, nous utiliserons des noms écrits
avec un majuscule pour la première lettre de chaque mot composant le nom de la
variable, ce qui facilitera leur repérage et rendra le code plus facilement
compréhensible. Le mot devant notre nom de variable indique à l'Arduino l'espace
mémoire à réserver pour stocker cette donnée. Après le nom de notre variable, on
lui attribue sa valeur.
*/
// Afficher les données dans le moniteur série d'Arduino (débogage).
boolean AfficherMoniteurSerie = NON;
/*
Ici, nous définissons la variable qui controlera la grande boucle principale,
qui s'active avec le bouton « Power » de la télécommande. Par défaut, le robot
ne fait rien a l'exeption d'initialiser ses périphériques.
*/
boolean Boucler = NON;
// Délai pour réduire la vitesse de réaction entre les lectues des boutons.
int BoutonTempsRebon = 9;
// Recoit la valeur indicant la condition de déplacement en cours.
byte CodeSituation = 0;
// Contiend la vitesse moteur a applique et donc aussi la vitesse courante.
byte Moteur_1_PointMort = MOTEUR_1_VITESSE_MINIMUM;
byte Moteur_2_PointMort = MOTEUR_2_VITESSE_MINIMUM;
byte Moteur_1_Vitesse = 0;
byte Moteur_2_Vitesse = 0;
// Dernière valeur fournit par le sonar.
float Sonar_1_DistanceActuele = 0.0;
float Sonar_2_DistanceActuele = 0.0;
float Sonar_3_DistanceActuele = 0.0;
// Distance limite pour la fiabilité des mesure du sonar.
float Sonar_1_DistanceValideMaximum = 400.0;
float Sonar_2_DistanceValideMaximum = 400.0;
float Sonar_3_DistanceValideMaximum = 400.0;
// Variables pour établir la durée de la commande ping. Le résultat donnera la
// distance en pouces et/ou en centimètres :
float Sonar_1_DureeEchoSonar = 0.0;
float Sonar_2_DureeEchoSonar = 0.0;
float Sonar_3_DureeEchoSonar = 0.0;
// Variable des distances conditionnant les mouvements du robot.
float Distance1 = 15.0;
// Pour contenir la valeur du dernier bouton pressé sur la télécommande.
unsigned long TelecommandeBoutonValeur = 0;
// Pour la fonction « delay », qui compte le temps en milliseconde.
const int UneSeconde = 1000;
//*****************************************************************************
//*****************************************************************************
// Création en mémoire des objet pour les interfaces des périphériques.
//*****************************************************************************
// Pour le capteur infrarouge crée un objet sur la broche voulue.
IRrecv Capteur_IR_0 (CAPTEUR_IR_0_1_OUT);
decode_results Capteur_IR_0_Results;
//*****************************************************************************
//*****************************************************************************
// FONCTION AjusterVitesseDesMoteurs
//*****************************************************************************
void AjusterVitesseDesMoteurs ()
{
// Modifier la vitesse des moteurs CC selon la distance devant le véhicule.
Moteur_1_Vitesse = map (Sonar_1_DistanceActuele, 0, Sonar_1_DistanceValideMaximum,
Moteur_1_PointMort, MOTEUR_1_VITESSE_MAXIMUM);
Moteur_2_Vitesse = map (Sonar_1_DistanceActuele, 0, Sonar_1_DistanceValideMaximum,
Moteur_2_PointMort, MOTEUR_2_VITESSE_MAXIMUM);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementAvancer
//*****************************************************************************
void DeplacementAvancer ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementArret
//*****************************************************************************
void DeplacementArreter ()
{
Moteur_1_Vitesse = 0;
Moteur_2_Vitesse = 0;
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementReculer
//*****************************************************************************
void DeplacementReculer ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementAvancerDroite
//*****************************************************************************
void DeplacementAvancerDroite ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementAvancerGauche
//*****************************************************************************
void DeplacementAvancerGauche ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementReculerDroite
//*****************************************************************************
void DeplacementReculerDroite ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementReculerGauche
//*****************************************************************************
void DeplacementReculerGauche ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementPivoterGauche
//*****************************************************************************
void DeplacementPivoterGauche ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN2, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN4, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION DeplacementPivoterDroite
//*****************************************************************************
void DeplacementPivoterDroite ()
{
// Pour le moteur 1.
digitalWrite (CONTROLE_MOTEUR_1_IN1, HAUT);
digitalWrite (CONTROLE_MOTEUR_1_IN2, BAS);
analogWrite (CONTROLE_MOTEUR_1_ENA, Moteur_1_Vitesse);
// Pour le moteur 2.
digitalWrite (CONTROLE_MOTEUR_1_IN3, BAS);
digitalWrite (CONTROLE_MOTEUR_1_IN4, HAUT);
analogWrite (CONTROLE_MOTEUR_1_ENB, Moteur_2_Vitesse);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION UneNoteDeMusique
//*****************************************************************************
void UneNoteDeMusique (int BUZZER_1_VIN, float noteFrequency, long noteDuration)
{
int x;
// Convertir la fréquence en microsecondes.
float microsecondsPerWave = 1000000 / noteFrequency;
// Calculez combien de cycles HAUT / BAS il ya par milliseconde.
float millisecondsPerCycle = 1000 / (microsecondsPerWave * 2);
// Multipliez noteDuration en nombre de cycles * par milliseconde.
float loopTime = noteDuration * millisecondsPerCycle;
// Jouez la note pour la boucle calculé.
for (x = 0; x < loopTime ; x = x + 1)
{
digitalWrite (BUZZER_1_VIN, HAUT);
delayMicroseconds (microsecondsPerWave);
digitalWrite (BUZZER_1_VIN, BAS);
delayMicroseconds (microsecondsPerWave);
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION Bip_1
//*****************************************************************************
void Bip_1 ()
{
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
}
//*****************************************************************************
//*****************************************************************************
// FONCTION BiBip_1
//*****************************************************************************
void BiBip_1 ()
{
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
UneNoteDeMusique (BUZZER_1_VIN, Note_A7, 100);// Note de musique A
}
//*****************************************************************************
//*****************************************************************************
// FONCTION BiBiBi_1
//*****************************************************************************
void BiBiBi_1 ()
{
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
delay (100);
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
delay (100);
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
}
//*****************************************************************************
//*****************************************************************************
// FONCTION R2D2_1
//*****************************************************************************
void R2D2_1 ()
{
UneNoteDeMusique (BUZZER_1_VIN, Note_A7, 100);// Note de musique A
UneNoteDeMusique (BUZZER_1_VIN, Note_E7, 100);// Note de musique E
UneNoteDeMusique (BUZZER_1_VIN, Note_C7, 100);// Note de musique C
UneNoteDeMusique (BUZZER_1_VIN, Note_D7, 100);// Note de musique D
UneNoteDeMusique (BUZZER_1_VIN, Note_B7, 100);// Note de musique B
UneNoteDeMusique (BUZZER_1_VIN, Note_F7, 100);// Note de musique F
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererAfficherMoniteurSerie
//*****************************************************************************
void GererAfficherMoniteurSerie ()
{
// Écriture dans le moniteur série de l'IDE d'Arduino des valeurs lues.
Serial.println ("***********************************");
Serial.print ("* Sonar_1_DistanceActuele = ");
Serial.println (Sonar_1_DistanceActuele);
Serial.print ("* Sonar_2_DistanceActuele = ");
Serial.println (Sonar_2_DistanceActuele);
Serial.print ("* Sonar_3_DistanceActuele = ");
Serial.println (Sonar_3_DistanceActuele);
Serial.print ("* Moteur_1_Vitesse = ");
Serial.println (Moteur_1_Vitesse);
Serial.print ("* Moteur_2_Vitesse = ");
Serial.println (Moteur_2_Vitesse);
Serial.print ("* CodeSituation = ");
Serial.print (CodeSituation);
Serial.println ();
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererAffichages
//*****************************************************************************
void GererAffichages ()
{
if (AfficherMoniteurSerie)
{
GererAfficherMoniteurSerie ();
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererBoutonMarcheArret
//*****************************************************************************
void GererBoutonMarcheArret ()
/*
Gestion de l'utilisation d'un bouton sur la planche d'expérimentation.
*/
{
int EtatBouton = digitalRead (BOUTON_1_OUT);
if (EtatBouton == HAUT)
{
if (Boucler == OUI)
{
CodeSituation = 74;
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
DeplacementArreter ();
GererAffichages ();
R2D2_1 ();
// Configurer le port Arduino pour un RESET par télécommande.
pinMode (ARDUINO_RESET, SORTIE);
// Activer la broche ARDUINO_RESET.
digitalWrite (ARDUINO_RESET, BAS);
delay (UneSeconde);
}
else
{
// Allumer la DEL de l'Arduino.
CodeSituation = 75;
Boucler = OUI;
digitalWrite (DEL_1_VIN, Boucler);
Bip_1 ();
}
while (EtatBouton == HAUT)
{
delay (BoutonTempsRebon);// Pour absorber les micro-coupures des rebonds.
EtatBouton = digitalRead (BOUTON_1_OUT);
}
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererBoutonTeleCommande
//*****************************************************************************
void GererBoutonTeleCommande ()
/*
Gérer l'utilisation d'une télécommande type MP3 avec capteur infrarouge.
Ici tous les boutons de la télécommande sont listés et la majorité ont un
effet sur le déroulement de de la boucle principale ou sur les paramètres de
fonctionnement du moteur ou les deux la fois et la touche « Mode » est
l'actionneur de la broche RESET de la carte Arduino, donc du redémarrage du
Système complet.
En synthèse les boutons font :
Power : Active/désactive la boucle principale du programme, arrêt moteur.
Mode : Bouton kamikaze qui utilise la broche RESET de la carte Arduino.
Son :
PlayPause : Fait une pause des moteurs, comme un arrêt sur image.
Debut :
Fin :
EQ : Inversé l'état de cette variable, basculer On/Off Off/On.
Moins : Diminuer Moteur_1_PointMort et Moteur_2_PointMort de 10.
Plus : Ogmenter Moteur_1_PointMort et Moteur_2_PointMort de 10.
0 :
Recycle :
U_SD :
1 : Déplacement, Avancer en tournant à Gauche, une roue tourne.
2 : Déplacement, Avancer en ligne droite, les deux roues tournent.
3 : Déplacement, Avancer en tournant à Droit, une roue tourne.
4 : Déplacement, Pivoter en tournant à Gauche, les deux roues tournent.
5 : Déplacement, Arrêt sur place les deux roues s'arrêtent.
6 : Déplacement, Pivoter en tournant à Droit, les deux roues tournent.
7 : Déplacement, Reculer en tournant à Gauche, une roue tourne.
8 : Déplacement, Reculer en ligne droite, une roue tourne.
9 : Déplacement, Reculer en tournant à Droit, une roue tourne.
default : Une télécommande génère beaucoup d'autres codes qui sont inutiles ici.
*/
{
if (Capteur_IR_0.decode (&Capteur_IR_0_Results))
{
// Récupérer la valeur de la touche de la télécommande.
TelecommandeBoutonValeur = Capteur_IR_0_Results.value;
Capteur_IR_0.resume ();
switch (TelecommandeBoutonValeur)
{
case TelecommandeBoutonPower:
Serial.print ("* TelecommandeBoutonPower = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
Bip_1 ();
if (Boucler == OUI)
{
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
CodeSituation = 75;
DeplacementArreter ();
}
else
{
Boucler = OUI;
digitalWrite (DEL_1_VIN, Boucler);
CodeSituation = 76;
}
break;
case TelecommandeBoutonMode:
Serial.print ("* TelecommandeBoutonMode = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 77;
DeplacementArreter ();
GererAffichages ();
R2D2_1 ();
// Configurer le port Arduino pour un RESET par télécommande.
pinMode (ARDUINO_RESET, SORTIE);
// Activer la broche ARDUINO_RESET.
digitalWrite (ARDUINO_RESET, BAS);
delay (UneSeconde);
break;
case TelecommandeBoutonSon:
Serial.print ("* TelecommandeBoutonSon = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 78;
Bip_1 ();
break;
case TelecommandeBoutonPlayPause:
Serial.print ("* TelecommandeBoutonPlayPause = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
Bip_1 ();
if (Boucler == OUI)
{
DeplacementArreter ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
Serial.print ("* En attente d'une action d'humaine");
Serial.println ();
CodeSituation = 79;
}
else
{
Boucler = OUI;
digitalWrite (DEL_1_VIN, Boucler);
Serial.print ("* Poursuite du programme");
Serial.println ();
CodeSituation = 80;
}
break;
case TelecommandeBoutonDebut:
Serial.print ("* TelecommandeBoutonDebut = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 81;
Bip_1 ();
break;
case TelecommandeBoutonFin:
Serial.print ("* TelecommandeBoutonFin = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 82;
Bip_1 ();
break;
case TelecommandeBoutonEQ:
Serial.print ("* TelecommandeBoutonEQ = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 83;
// Inversé l'état de cette variable, basculer On/Off Off/On.
AfficherMoniteurSerie = AfficherMoniteurSerie - 1;
Bip_1 ();
break;
case TelecommandeBoutonMoins:
Serial.print ("* TelecommandeBoutonMoins = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 84;
Moteur_1_PointMort = Moteur_1_PointMort - 10;
Moteur_2_PointMort = Moteur_2_PointMort - 10;
Bip_1 ();
break;
case TelecommandeBoutonPlus:
Serial.print ("* TelecommandeBoutonPlus = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 85;
Moteur_1_PointMort = Moteur_1_PointMort + 10;
Moteur_2_PointMort = Moteur_2_PointMort + 10;
Bip_1 ();
break;
case TelecommandeBouton0:
Serial.print ("* TelecommandeBouton0 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 86;
Bip_1 ();
break;
case TelecommandeBoutonRecycle:
Serial.print ("* TelecommandeBoutonRecycle = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 87;
Bip_1 ();
break;
case TelecommandeBoutonU_SD:
Serial.print ("* TelecommandeBoutonU_SD = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 88;
Bip_1 ();
break;
case TelecommandeBouton1:
Serial.print ("* TelecommandeBouton1 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 89;
Bip_1 ();
DeplacementAvancerGauche ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton2:
Serial.print ("* TelecommandeBouton2 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 90;
Bip_1 ();
DeplacementAvancer ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton3:
Serial.print ("* TelecommandeBouton3 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 91;
Bip_1 ();
DeplacementAvancerDroite ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton4:
Serial.print ("* TelecommandeBouton4 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 92;
Bip_1 ();
DeplacementPivoterGauche ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton5:
Serial.print ("* TelecommandeBouton5 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 93;
Bip_1 ();
DeplacementArreter ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton6:
Serial.print ("* TelecommandeBouton6 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 94;
Bip_1 ();
DeplacementPivoterDroite ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton7:
Serial.print ("* TelecommandeBouton7 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 95;
Bip_1 ();
DeplacementReculerGauche ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton8:
Serial.print ("* TelecommandeBouton8 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 96;
Bip_1 ();
DeplacementReculer ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
case TelecommandeBouton9:
Serial.print ("* TelecommandeBouton9 = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 97;
Bip_1 ();
DeplacementReculerDroite ();
Boucler = NON;
digitalWrite (DEL_1_VIN, Boucler);
break;
default:
Serial.print ("* Code de telecommande infrarouge inconnu = ");
Serial.print (TelecommandeBoutonValeur);
Serial.println ();
CodeSituation = 98;
BiBip_1 ();
;
}
}
while (Capteur_IR_0.decode (&Capteur_IR_0_Results))
{
// Pour absorber les micro-coupures des rebonds).
delay (TelecommandeTempsRebon);
// Récupérer la valeur de la touche de la télécommande.
TelecommandeBoutonValeur = Capteur_IR_0_Results.value;
Capteur_IR_0.resume ();
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererBoutons
//*****************************************************************************
void GererBoutons ()
{
GererBoutonMarcheArret (); // Un bouton sur planche d'expérimentation.
GererBoutonTeleCommande ();// 21 boutons d'une télécommande type MP3.
}
//*****************************************************************************
//*****************************************************************************
// FONCTION ConvertionMicrosecondsEnCentimetres
//*****************************************************************************
float ConvertionMicrosecondsEnCentimetres (float microseconds)
{
/*
La vitesse du son est de 340 metres par seconde ou 29 microsecondes par
centimètre. Le ping voyage aller et retour, de sorte à trouver la distance de
l'objet, nous prenons la moitié de la distance parcourue. Voir:
https://www.parallax.com/dl/docs/prod/acc/28015-PING-v1.3.pdf
*/
return microseconds / 29 / 2;
}
//*****************************************************************************
//*****************************************************************************
// FONCTION CapteurUltrasonUneLecture
//*****************************************************************************
void CapteurUltrasonUneLecture ()
{
/* Le capteur est déclenché par une impulsion haute d'au moins
10 microsecondes. Donne une courte impulsion basse à l'avance pour assurer
une impulsion HAUT propre:
*/
// Lecture echo sonar 1
delayMicroseconds (2);
digitalWrite (SONAR_1_TRIG, HAUT);
delayMicroseconds (10);
digitalWrite (SONAR_1_TRIG, BAS);
Sonar_1_DureeEchoSonar = pulseIn (SONAR_1_ECHO, HAUT);
// convertir le temps en une distance
Sonar_1_DistanceActuele = ConvertionMicrosecondsEnCentimetres
(Sonar_1_DureeEchoSonar);
// Limiter la distance mesurée a la valeur de Sonar_1_DistanceValideMaximum.
if (Sonar_1_DistanceActuele > Sonar_1_DistanceValideMaximum)
{
Sonar_1_DistanceActuele = Sonar_1_DistanceValideMaximum;
}
else if (Sonar_1_DistanceActuele < 0)
{
Sonar_1_DistanceActuele = 0;
}
delayMicroseconds (10);
// Lecture echo sonar 2
delayMicroseconds (2);
digitalWrite (SONAR_2_TRIG, HAUT);
delayMicroseconds (10);
digitalWrite (SONAR_2_TRIG, BAS);
Sonar_2_DureeEchoSonar = pulseIn (SONAR_2_ECHO, HAUT);
// convertir le temps en une distance
Sonar_2_DistanceActuele = ConvertionMicrosecondsEnCentimetres
(Sonar_2_DureeEchoSonar);
// Limiter la distance mesurée a la valeur de Sonar_1_DistanceValideMaximum.
if (Sonar_2_DistanceActuele > Sonar_2_DistanceValideMaximum)
{
Sonar_2_DistanceActuele = Sonar_2_DistanceValideMaximum;
}
else if (Sonar_2_DistanceActuele < 0)
{
Sonar_2_DistanceActuele = 0;
}
delayMicroseconds (10);
// Lecture echo sonar 3
delayMicroseconds (2);
digitalWrite (SONAR_3_TRIG, HAUT);
delayMicroseconds (10);
digitalWrite (SONAR_3_TRIG, BAS);
Sonar_3_DureeEchoSonar = pulseIn (SONAR_3_ECHO, HAUT);
// convertir le temps en une distance
Sonar_3_DistanceActuele = ConvertionMicrosecondsEnCentimetres
(Sonar_3_DureeEchoSonar);
// Limiter la distance mesurée a la valeur de Sonar_3_DistanceValideMaximum.
if (Sonar_3_DistanceActuele > Sonar_3_DistanceValideMaximum)
{
Sonar_3_DistanceActuele = Sonar_3_DistanceValideMaximum;
}
else if (Sonar_3_DistanceActuele < 0)
{
Sonar_3_DistanceActuele = 0;
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION GererDeplacements
//*****************************************************************************
void GererDeplacements ()
{
CapteurUltrasonUneLecture ();
AjusterVitesseDesMoteurs ();
if ((Sonar_1_DistanceActuele < Distance1) and
(Sonar_2_DistanceActuele < Distance1) and
(Sonar_3_DistanceActuele < Distance1))
{
if (Sonar_1_DistanceActuele > Sonar_3_DistanceActuele)
{
CodeSituation = 1;
DeplacementPivoterGauche ();
}
else
{
CodeSituation = 2;
DeplacementPivoterDroite ();
}
}
else if ((Sonar_1_DistanceActuele >= Distance1) and
(Sonar_2_DistanceActuele < Distance1) and
(Sonar_3_DistanceActuele < Distance1))
{
CodeSituation = 3;
DeplacementPivoterGauche ();
}
else if ((Sonar_1_DistanceActuele < Distance1) and
(Sonar_2_DistanceActuele >= Distance1) and
(Sonar_3_DistanceActuele < Distance1))
{
CodeSituation = 4;
DeplacementAvancer ();
}
else if ((Sonar_1_DistanceActuele < Distance1) and
(Sonar_2_DistanceActuele < Distance1) and
(Sonar_3_DistanceActuele >= Distance1))
{
CodeSituation = 5;
DeplacementPivoterDroite ();
}
else if ((Sonar_1_DistanceActuele >= Distance1) and
(Sonar_2_DistanceActuele < Distance1) and
(Sonar_3_DistanceActuele >= Distance1))
{
if (Sonar_1_DistanceActuele > Sonar_3_DistanceActuele)
{
CodeSituation = 6;
DeplacementAvancerGauche ();
}
else
{
CodeSituation = 7;
DeplacementAvancerDroite ();
}
}
else if ((Sonar_1_DistanceActuele >= Distance1) and
(Sonar_2_DistanceActuele >= Distance1) and
(Sonar_3_DistanceActuele < Distance1))
{
CodeSituation = 8;
DeplacementPivoterGauche ();
}
else if ((Sonar_1_DistanceActuele < Distance1) and
(Sonar_2_DistanceActuele >= Distance1) and
(Sonar_3_DistanceActuele >= Distance1))
{
CodeSituation = 9;
DeplacementPivoterDroite ();
}
else if (Sonar_1_DistanceActuele >= Distance1 and
Sonar_2_DistanceActuele >= Distance1 and
Sonar_3_DistanceActuele >= Distance1)
{
CodeSituation = 10;
DeplacementAvancer ();
}
else
{
CodeSituation = 99;
BiBip_1 ();
DeplacementArreter ();
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION SETUP = Code d'initialisation.
//*****************************************************************************
/*
La fonction setup() est exécutée en premier et 1 seule fois, au démarrage du
programme. Pour éviter de mettre des composantes sous tension avec la dernière
version du programme chargé dans l'Arduino, Nous utilisant une boucle « while »,
tant qu'une première action n'est pas accompli par l'utilisateur, on ne fait
rien (Télécommande, bouton, etc.).
L'activation du rappel au + interne des connecteurs en entrée si nécessaire.
L'instruction « digitalWrite (pin, HAUT); » écrit la valeur HAUT, qui vaux 1
sur le connecteur en entrée, ce qui active la résistance de "rappel au +"
(pullup) au plus de ce connecteur. L'utilisation de cette résistance interne
est une protection minimale pour l'intégrité physique pour la puce principale.
*/
void setup ()
{
// Ici les instructions à exécuter au démarrage.
// IMPORTANT : régler le terminal côté PC avec la même valeur de
// transmission.
Serial.begin (115200);
Serial.println ();
Serial.println ();
Serial.print (NOM_DU_PROGRAMME);
Serial.println ();
// Le minimum de connecteurs en entrées et sorties d'activé par sécurité
// en cas de changement des port de connexion.
// Pour le bouton Marche/Arrêt sur la planche d'expérimentation.
// Configurer le port Arduino en entrée pour le bouton.
pinMode (BOUTON_1_OUT, ENTREE);
// Activer la résistance au plus PULLUP.
digitalWrite (BOUTON_1_OUT, HAUT);
// Configurer le port Arduino en entrée pour le capteur infrarouge.
pinMode (CAPTEUR_IR_0_1_OUT, ENTREE);
// Initialisation et début de la réception du capteur infrarouge.
Capteur_IR_0.enableIRIn ();
// Fixer le BUZZER_1_VIN en sortie.
pinMode (BUZZER_1_VIN, SORTIE);
Bip_1 ();
// Active la DEL de l'Arduino.
pinMode (DEL_1_VIN, SORTIE);
digitalWrite (DEL_1_VIN, Boucler);
// Boucle pour éviter qu'un ancien programme chargé ne s'exécute avec un
// nouveau montage installé, en attente du chargement du nouveau programme.
// Jusqu'ici, c'est le minimum qui est activé, le reste des connexions
// seront activé après la boucle d'attente.
while (Boucler == NON)
{
GererBoutons ();
}
digitalWrite (DEL_1_VIN, Boucler);
// Pour les moteurs de déplacement du véhicule sur les port de l'Arduino.
// Ajustement initial de la vitesse moteur 1 et 2, a l'arret.
// Moteur a l'arret, au cas ou.
pinMode (CONTROLE_MOTEUR_1_ENA, SORTIE);
pinMode (CONTROLE_MOTEUR_1_ENB, SORTIE);
pinMode (CONTROLE_MOTEUR_1_IN1, SORTIE);
pinMode (CONTROLE_MOTEUR_1_IN2, SORTIE);
pinMode (CONTROLE_MOTEUR_1_IN3, SORTIE);
pinMode (CONTROLE_MOTEUR_1_IN4, SORTIE);
// Pour le sonar 1, 2, et 3, activation des port de l'Arduino.
pinMode (SONAR_1_TRIG, SORTIE);
pinMode (SONAR_1_ECHO, ENTREE);
pinMode (SONAR_2_TRIG, SORTIE);
pinMode (SONAR_2_ECHO, ENTREE);
pinMode (SONAR_3_TRIG, SORTIE);
pinMode (SONAR_3_ECHO, ENTREE);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION LOOP = Boucle sans fin = coeur du programme.
//*****************************************************************************
// La fonction loop() s'exécute sans fin en boucle aussi longtemps que
// l'Arduino est sous tension.
void loop()
{
// Ici les instructions à exécuter par le programme principal.
GererAffichages ();
GererBoutons ();
if (Boucler == OUI)
{
GererDeplacements ();
}
}
//*****************************************************************************