const int trigPin = 9;
const int echoPin = 10;
const int buzzer = 8;
const int dioda = 13;
long czas;
int odleglosc;
void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(buzzer, OUTPUT);
pinMode(dioda, OUTPUT);
Serial.begin(9600);
}
void loop() {
// impuls do czujnika
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
// odczyt czasu powrotu
czas = pulseIn(echoPin, HIGH);
// przeliczenie na cm
odleglosc = czas * 0.034 / 2;
Serial.print("Odleglosc: ");
Serial.println(odleglosc);
// reakcja
if (odleglosc < 20) {
digitalWrite(dioda, HIGH);
tone(buzzer, 1000);
}
else {
digitalWrite(dioda, LOW);
noTone(buzzer);
}
delay(100);
}
Brak komentarzy:
Prześlij komentarz