        previousMillisServo = currentMillisServo;     
        myservo.write(pos);  
        
-       
+       if(vooruitKijken){
        pos += hoekServo;
        if(pos >= 125 || pos<= 55)hoekServo = hoekServo*-1;
+       }
        
        }
      }

     previousMillisSensor = currentMillisSensor; 
     Distance(); 
     
     if (pos >= 55 && pos <= 125 && distance <= 10 && distance > 0) {
        if(pos==55){
        linksRijden==HIGH;
         Serial.println(linksRijden);
      }
        if(pos==125)rechtsRijden==HIGH;
       // if(pos==90)vooruitRijden = LOW;

     }  
     else if (pos >= 55 && pos <= 125 && distance > 10 || distance == -1) {

       vooruitRijden = HIGH;
       Serial.println("DRIVE");
     }
  }
    
  
  if(vooruitRijden){
         Snelheid = 2000;
         Stuur = 1500;
  }
  if(rechtsRijden){
      Serial.println("rechts");
      Snelheid = 2000;
      Stuur = 1300;

    }
  if(linksRijden){
    Serial.println("links");
    Snelheid = 2000;
    Stuur = 1700;

  }
  
  
  
   
    Pinkers(Stuur, currentMillis);
    //------------------------------------------------------------ Code voor RC inputs. ---------------------------------------------------------

bool achteruitRijden= LOW;
bool linksRijden = LOW;
bool rechtsRijden = LOW;
bool rondKijken = LOW;
bool vooruitKijken = HIGH;

int LmotorA= 5;  // Left  motor H bridge, input A
int LmotorB = 6;  // Left  motor H bridge, input B
