#include <Servo.h>
Servo servomotor;
#define TRIG 6 // Trigger
#define ECHO 5 // Echo
int entfernung;
int position;
long dauer;
void setup() {
Serial.begin(9600);
Serial.println("Servo");
// Eingänge und Ausgänge Zuordnen
servomotor .attach(3);
pinMode(TRIG, OUTPUT);
pinMode(ECHO, INPUT);
}
void loop() {
digitalWrite(TRIG, LOW);
delayMicroseconds(2);
digitalWrite(TRIG, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG, LOW);
dauer = pulseIn(ECHO, HIGH);
// Berechnung der Entfernung
entfernung = dauer * 0.034 / 2;
// Ausgabe der Entfernung
Serial.print("Entfernung: ");
Serial.print(entfernung);
Serial.println("cm");
position = entfernung;
position = map(position,0,1023,0,180);
servomotor.write(position);
}