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
Braun: Ground
Rot: 5 Volt
Gelb: Pin 9

Ultraschall Abstand Sensor: HC-SR04
VCC: 5Volt
Trigger: Pin 12
Echo: Pin 11
GND: Ground

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

Quellcode:

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

void setup() {
Serial.begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
myservo.attach(9);
}

void loop() {
int dauer,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);
}