Sensor de estacionamento com Arduino e Sensor Ultrassônico (3 / 5 stap)

Stap 3: Codigo doen Arduino

Codigo doen projeto para o Arduino

#include

#define bluetoothTx 2 / / TX-O pin van bluetooth metgezel, Arduino D2 #define bluetoothRx 3 / / RX-ik pin van bluetooth metgezel, 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 seriële monitor em 9600bps pinMode (trigPinb, OUTPUT); pinMode (echoPinb, INPUT); pinMode (trigPin, OUTPUT); pinMode (echoPin, INPUT);

Bluetooth.begin(115200); O Bluetooth inicia een 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 baudrate para 9600, sem paridade. 115200 pode ser muito rápido para uso com SoftwareSerial bluetooth.begin(9600); Iniciar bluetooth seriële em 9600}

void loop {lange duur, durationb, cm, cmb, cmPerto;

De PING))) wordt geactiveerd door een hoge pols van 2 of meer microseconden. Geef een korte lage puls vooraf om een schoon hoog puls:

digitalWrite (trigPin, laag); delayMicroseconds(2); digitalWrite (trigPin, hoge); delayMicroseconds(5); digitalWrite (trigPin, laag); duur = pulseIn (echoPin, hoge);

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

Als (cm > 200 || cm == 0) {cm = 200;} als (cmb > 200 || cmb == 0) {cmb = 200;} als (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); }

lang microsecondsToCentimeters (lange microseconden) {/ / de snelheid van het geluid is 340 m/s of 29 microseconden per centimeter. / / de ping reist uit en terug, zo vind je de afstand van de / / object nemen we de helft van de afgelegde afstand. keren microseconden / 29 / 2;}

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