Sensor de ver com Arduino e Sensor Ultrassônico (3 / 5 paso)

Paso 3: Codigo hacer Arduino

Codigo projeto para o Arduino

#include

#define bluetoothTx 2 / / TX-O pin de bluetooth mate, Arduino D2 #define bluetoothRx 3 / / RX-I pin de bluetooth mate, Arduino D3

SoftwareSerial bluetooth (bluetoothTx, bluetoothRx); RX, tx

const trigPin int = 12; const echoPin int = 11; const int trigPinb = 7; const int echoPinb = 6;

void setup() {Serial.begin(9600); / / Inicializa o serie monitor em 9600bps pinMode (trigPinb, salida); pinMode (echoPinb, entrada); pinMode (trigPin, salida); pinMode (echoPin, entrada);

Bluetooth.Begin(115200); O Bluetooth inicia un conexão em 115200bps bluetooth.print("$"); 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 CMD bluetooth.println("U,9600,N"); Altera o velocidad en baudios para 9600, sem paridade. 115200 pode ser muito rápido para uso com SoftwareSerial bluetooth.begin(9600); Iniciar bluetooth em serie 9600}

void loop() {duración larga, durationb, cm, cmb, cmPerto;

El PING))) es accionado por un pulso alto de 2 o más microsegundos. Dar un breve impulso de baja previamente para asegurar un pulso limpio alto:

digitalWrite (trigPin, LOW); delayMicroseconds(2); digitalWrite (trigPin, HIGH); delayMicroseconds(5); digitalWrite (trigPin, LOW); duración = pulseIn (echoPin, HIGH);

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

Si (> 200 cm || cm == 0) {cm = 200;} si (cmb > 200 || cmb == 0) {cmb = 200;} si (cmb > cm) {Serial.print(cm); EnviaBluetooth(cm); } else if (cmb < cm) {Serial.print(cmb); EnviaBluetooth(cmb); } else if (cm == cmb) {Serial.print(cmb); EnviaBluetooth(cmb); }

Serial.println();

Delay(1000); }

largo microsecondsToCentimeters (largo microsegundos) {/ / la velocidad del sonido es 340 m/s o 29 microsegundos por centímetro. / / el ping viaja hacia fuera y hacia atrás, para encontrar la distancia del / / objeto tomamos la mitad de la distancia recorrida. volver microsegundos / 29 / 2;}

void EnviaBluetooth (int mortajas) {if(Serial.available()) {/ / Se algo foi digitado e enviado no serie Monitor / / Envia o caracter para o Módulo Bluetooth bluetooth.print(dados);}}