Parking Sensor con Bluetooth (2 / 4 paso)

Paso 2: Desenvolvendo o programa

Na plataforma de desenvolvimento para arduíno, utilizar ese código:

* Não esqueça de verificar como entradas trig, echo dos sensores *

 #include 

 #define bluetoothTx 2 #define bluetoothRx 3 

 SoftwareSerial bluetooth(bluetoothTx, bluetoothRx); //rx, tx 

 const int trigPin = 12; const int echoPin = 13; const int trigPinb = 8; const int echoPinb = 9; 

 void setup() { Serial.begin(9600); pinMode(trigPinb, OUTPUT); pinMode(echoPinb, INPUT); pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); 

 bluetooth.begin(115200); bluetooth.print("$"); bluetooth.print("$"); bluetooth.print("$"); 

 delay(100); 

 bluetooth.println("U,9600,N"); bluetooth.begin(9600); } 

 void loop() { long duration, durationb, cm, cmb, cmPerto; 

 digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(5); digitalWrite(trigPin, LOW); duration = pulseIn(echoPin, HIGH); 

 digitalWrite(trigPinb, LOW); delayMicroseconds(2); digitalWrite(trigPinb, HIGH); delayMicroseconds(5); digitalWrite(trigPinb, LOW); durationb = pulseIn(echoPinb, HIGH); cmb = microsecondsToCentimeters(durationb); cm = microsecondsToCentimeters(duration); 

 if (cmb > cm){ Serial.print(cm); EnviaBluetooth(cm); } else if (cmb < cm){ Serial.print(cmb); EnviaBluetooth(cmb); } else{ Serial.print(cmb); EnviaBluetooth(cmb); } 

 Serial.println(); 

 delay(1000); } 

 long microsecondsToCentimeters(long microseconds) { return microseconds / 29 / 2; } 

 void EnviaBluetooth(int dados) { bluetooth.print(dados); }