Servo Roboter

#include <Servo.h> // das ist die Servo Bibliothek

// Servo-Objekt Nummer 1 erstellen (Name kann frei gewählt werden auch "Servo Blume123;"):
Servo servo_links;
Servo servo_rechts;


void setup() {
  Serial.begin(9600);
  servo_links.attach(9);
  servo_rechts.attach(6);

}



void loop() {
  kollisionsvermeidung();
  servo_links.write(160); // vorwärts
  servo_rechts.write(160); // vorwärts
  delay(3000);
  servo_links.write(0); // rückwärts
  servo_rechts.write(0); // rückwärts
  delay(2000);

  // Drehung:
  servo_links.write(90);
  servo_rechts.write(0);
  delay(500);

  servo_links.write(90); // stop servo
  servo_rechts.write(90);

 while(1) {delay(500);}


  
  

}



void kollisionsvermeidung() {
  while(1) {
    servo_links.write(160); // vorwärts
    servo_rechts.write(0); // vorwärts
    int abstand = analogRead(A0);
    Serial.println(abstand);
    if (abstand < 300) {
      // Drehung:
      servo_links.write(0);
      servo_rechts.write(0);
      delay(1500);
      servo_links.write(90); //stop
      servo_rechts.write(90); //stop
      delay(250);
    }



  } // ende while(1)


}