Sensor de estacionamento com Arduino e Sensor Ultrassônico (3 / 5 steg)
Steg 3: Codigo göra Arduino
CODIGO gör projeto para o Arduino
#include
#define bluetoothTx 2 / / TX-O pin av bluetooth mate, Arduino D2 #define bluetoothRx 3 / / RX-jag pin av 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 seriell övervaka em 9600bps pinMode (trigPinb, produktionen), pinMode (echoPinb, ingång), pinMode (trigPin, produktionen); pinMode (echoPin, ingång);
Bluetooth.BEGIN(115200); O Bluetooth inicia en conexão em 115200bps bluetooth.print("$"); DEVE-utskottet 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 baudvärde para 9600, sem paridade. 115200 pode ser muito rápido para uso com SoftwareSerial bluetooth.begin(9600); Iniciar bluetooth seriell em 9600}
void loop() {lång varaktighet, durationb, cm, cmb, cmPerto;
PING))) utlöses av en hög puls av 2 eller fler mikrosekunder. Ge en kort låg puls förhand för att säkerställa en ren hög puls:
digitalWrite (trigPin, låg); delayMicroseconds(2); digitalWrite (trigPin, hög); delayMicroseconds(5); digitalWrite (trigPin, låg); längd = pulseIn (echoPin, hög);
digitalWrite (trigPinb, låg); delayMicroseconds(2); digitalWrite (trigPinb, hög); delayMicroseconds(5); digitalWrite (trigPinb, låg); durationb = pulseIn (echoPinb, hög); CMB = microsecondsToCentimeters(durationb); cm = microsecondsToCentimeters(duration);
om (cm > 200 || cm == 0) {cm = 200;} om (cmb > 200 || cmb == 0) {cmb = 200;} om (cmb > cm) {Serial.print(cm); EnviaBluetooth(cm); } else om (cmb < cm) {Serial.print(cmb); EnviaBluetooth(cmb); } else om (cm == cmb) {Serial.print(cmb); EnviaBluetooth(cmb); }
Serial.println();
Delay(1000); }
långa microsecondsToCentimeters (lång mikrosekunder) {/ / ljudets hastighet är 340 m/s eller 29 mikrosekunder per centimeter. / / ping reser ut och tillbaka, så för att hitta distansera av den / / objekt vi tar hälften av den tillryggalagda. återvända mikrosekunder / 29 / 2;}
void EnviaBluetooth (int dados) {if(Serial.available()) {/ / Se algo foi digitado e enviado Nej Följetong Monitor / / Envia o caracter para o Módulo Bluetooth bluetooth.print(dados);}}