#include <Servo.h>

//Sensor
//TRIG
int Starter = 28;
//ECHO
int Ausgabe = 26;

//servo
Servo mservo;
int winkel;

void setup() {
//Sensor
Serial.begin(115200);
pinMode(LED_BUILTIN, OUTPUT);
pinMode(Starter, OUTPUT);
pinMode(Ausgabe, INPUT);

//servo
mservo.attach(22);
}

void loop(){
  delay(1); // this speeds up the simulation

  Sensor();
  delay(500);
  servo();
}

void Sensor() {
  digitalWrite(Starter, HIGH);
  delayMicroseconds(10);
  digitalWrite(Starter, LOW);

  //auslesen
  int distanz = (pulseIn(Ausgabe, HIGH) / 58);
  Serial.print("cm: ");
  Serial.println(distanz);
  delay(10);
}

void servo() {
  winkel = Serial.parseInt();
  mservo.write(winkel);
  Serial.println(winkel);
}