Abstandsanzeiger mit Ultraschall Sensor und einem Servo Motor bauen

Wie bei einer Einparkhilfe mit einem akustischen Signalgeber, hier mit einem Arduino, einem Ultraschall Sensor und einem Servo Motor einen Abstandsanzeiger erstellen.

Hardware:

Board: Elegoo UNO R3

Servo: SG90 Micro Servo Motor 9G

Ultraschall Abstand Sensor: HC-SR04

Weitere Details: https://maker-faire.de/wp-content/upl…

Quellcode:

#define trigPin 13
#define echoPin 11
#include <Servo.h>
Servo myservo;

voidsetup() {
Serial.begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
myservo.attach(6);
}

voidloop() {
intdauer,abstand,winkel;
digitalWrite(trigPin,LOW);
delayMicroseconds(2);
digitalWrite(trigPin,HIGH);
delayMicroseconds(10);
digitalWrite(trigPin,LOW);
dauer=pulseIn(echoPin,HIGH);
abstand=(dauer/2)/29.1;
winkel=abstand*1.8;
Serial.print(abstand);
Serial.println(" cm");

if(abstand<100)
{
myservo.write(winkel);
}

else{
myservo.write(180);
}
delay(500);
}