Étape 3: Codigo Arduino
Código projeto para o Arduino
#include
#define bluetoothTx 2 / / TX-O pin bluetooth mate, Arduino D2 #define bluetoothRx 3 / / RX-je goupille de bluetooth mate, Arduino D3
SoftwareSerial bluetooth (bluetoothTx, bluetoothRx) ; RX, tx
const int trigPin = 12 ; const int echoPin = 11 ; const int trigPinb = 7 ; const int echoPinb = 6 ;
void setup() {Serial.begin(9600); / / Inicializa o serial monitor em 9600bps pinMode (trigPinb, sortie); pinMode (echoPinb, INPUT); pinMode (trigPin, sortie); pinMode (echoPin, entrée) ;
Bluetooth.Begin(115200) ; O Bluetooth inicia un bluetooth.print("$") de 115200bps em conexão ; DEVE ser impressos três « $» individualmente ! Bluetooth.Print("$") ; Bluetooth.Print("$") ; Para entrar em modo de comando delay(100) ; Aguarda 100 mS para entrar em modo bluetooth.println("U,9600,N") CMD ; Altera o baudrate para 9600, sem paridade. 115200 pode ser muito rápido para uso com SoftwareSerial bluetooth.begin(9600) ; Iniciar bluetooth em série 9600}
void loop() {longue durée, durationb, cm, cmb, cmPerto ;
Le PING))) est déclenché par une impulsion forte de 2 ou plusieurs microsecondes. Donner une brève impulsion faible au préalable pour s’assurer une impulsion propre élevée :
digitalWrite (trigPin, basse) ; delayMicroseconds(2) ; digitalWrite (trigPin, HIGH) ; delayMicroseconds(5) ; digitalWrite (trigPin, basse) ; durée = pulseIn (echoPin, HIGH) ;
digitalWrite (trigPinb, basse) ; delayMicroseconds(2) ; digitalWrite (trigPinb, HIGH) ; delayMicroseconds(5) ; digitalWrite (trigPinb, basse) ; durationb = pulseIn (echoPinb, HIGH) ; CMB = microsecondsToCentimeters(durationb) ; cm = microsecondsToCentimeters(duration) ;
Si (cm > 200 || cm == 0) {cm = 200;} si (cmb > 200 || cmb == 0) {cmb = 200;} si (cmb > cm) {Serial.print(cm) ; EnviaBluetooth(cm) ; } ElseIf (cmb < cm) {Serial.print(cmb) ; EnviaBluetooth(cmb) ; } ElseIf (cm == cmb) {Serial.print(cmb) ; EnviaBluetooth(cmb) ; }
Serial.println() ;
Delay(1000) ; }
long microsecondsToCentimeters (longs microsecondes) {/ / la vitesse du son est de 340 m/s ou 29 microsecondes par centimètre. / / le ping déplace dehors et en arrière, afin de trouver la distance de la / / objet nous prenons la moitié de la distance parcourue. retourner microsecondes / 29 / 2;}
void EnviaBluetooth (int dados) {if(Serial.available()) {/ / Se algo foi digitado e enviado aucune série ne moniteur / / Envia o caracter para o Módulo Bluetooth bluetooth.print(dados);}}