Stap 4: programma:
Code voor een open-source ultrasone visuele handicap steun apparaat
Const int TRIG = 8;
Const int ECHO = 7;
Const int BUZZ = 5;
Const int LED1 = 12;
Const int LED2 = 13;
VOID Setup {}
pinMode (TRIG, uitvoer);
pinMode (ECHO, INPUT);
pinMode (BUZZ, uitvoer);
pinMode (LED1, uitvoer);
pinMode (LED2, uitvoer);
Serial.begin(9600);
}
void loop {}
lange duur, inch, cm;
digitalWrite (TRIG, laag);
delayMicroseconds(2);
digitalWrite (TRIG, hoge);
delayMicroseconds(10);
digitalWrite (TRIG, laag);
duur = pulseIn (ECHO, hoge);
inch = duur / 74 / 2;
cm = duur / 29 / 2;
Serial.Print(inches);
Serial.Print ("in");
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
Als (cm < 80) {}
Toon (BUZZ, (80 - cm) * 75, 25);
digitalWrite (LED1, hoge);
digitalWrite (LED2, laag);
} else {}
Toon (BUZZ, 0, 50);
digitalWrite (LED1, laag);
digitalWrite (LED2, hoge);
}
delay(100);
}