Projektet L.U.V.I.A (låg kostnad ultraljud synskada stöd) (4 / 6 steg)
Steg 4: Program:
Koden för en öppen källkod ultraljud synskada stöd enhet
CONST int TRIG = 8.
CONST int ECHO = 7.
CONST int BUZZ = 5;
CONST int LED1 = 12.
CONST int LED2 = 13.
void setup() {
pinMode (TRIG, OUTPUT);
pinMode (ECHO, indata);
pinMode (BUZZ, OUTPUT);
pinMode (LED1, OUTPUT);
pinMode (LED2, OUTPUT);
Serial.BEGIN(9600);
}
void loop() {
lång varaktighet, tum, cm;
digitalWrite (TRIG, låg);
delayMicroseconds(2);
digitalWrite (TRIG, hög);
delayMicroseconds(10);
digitalWrite (TRIG, låg);
längd = pulseIn (ECHO, hög);
inches = varaktighet / 74 / 2;
cm = varaktighet / 29 / 2;
Serial.Print(inches);
Serial.Print ("in");
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
om (cm < 80) {
tonen (BUZZ, (80 - cm) * 75, 25);
digitalWrite (LED1, hög);
digitalWrite (LED2, låg);
} annat {
tonen (BUZZ, 0, 50);
digitalWrite (LED1, låg);
digitalWrite (LED2, hög);
}
Delay(100);
}