//begin positie servo = 87

#include <Servo.h>

Servo myservo;

float distance1 = 10;
float distance2 = 0;
float distance3 = 45;
float pos = 90;

void setup() {
Serial.begin(9600);

}

void loop() {
  distance1 = distance1+1;
  distance2 = distance2+1;
  distance3 = distance3+1;

  //
  Serial.println(distance1);
  Serial.println(distance2);
  Serial.println(distance3);
  //
  
  if(distance3<50){
   myservo.write(30);
  }
   else if(distance1>distance2){
     pos = 90-pos*-1;
     //wat gebeurt er als tijdens de while loop de overkant te dichtbij komt??
    while(distance1>distance2&&distance3>50){
     myservo.write(pos);
     Serial.println(pos);
     pos = pos-5;
     delay(100);
 }
   }
   else if(distance1<distance2){
     pos = pos+90;
     while(distance1<distance2&&distance3>50){
      myservo.write(pos);
      Serial.println(pos);
      pos = pos+5;
      delay(100);
     }
   }
   else if(distance1&&distance2>12){
     myservo.write(150);

   }
   else{
     myservo.write(30);

   }

   
   delay(1000);
  }