                 // twelve servo objects can be created on most boards
  
 int pos = 90;    // variable to store the servo position 
+int count = 0;
 
 //pinkers
 int Lpinker = 4; // Linker pinker

         Stuur = 1500;
  }
  
  if(rondKijken) {
    pos += hoekServoRondkijken;
       if(pos >= 180 || pos<= 0)hoekServoRondkijken = hoekServoRondkijken*-1;
       //if (pos == 90 && distance > 10 || distance == -1) vooruitKijken = HIGH;
       //if (pos == 0 && distance > 10 || distance == -1) { Stuur = 2000; Snelheid = 1500;}
    }
    
   
    Pinkers(Stuur, currentMillis);

       previousMillisServo = currentMillisServo;     
       myservo.write(pos);  
       
       if(vooruitKijken)
       {         
         pos += hoekServo;
         if(pos >= 125 || pos <= 55) hoekServo = hoekServo*-1;
       }       
     }
     
   if (currentMillisSensor - previousMillisSensor >= intervalSensor) {
     previousMillisSensor = currentMillisSensor; 
     Distance(); 
     
     if (pos >= 55 && pos <= 125 && distance <= 10 && distance > 0) {
       count += 1;       
       vooruitRijden = LOW;       
       if (count >= 5) rechtsKijken = HIGH;
       
       Serial.println("STOP");
       
      }
       
     else if (pos >= 55 && pos <= 125 && distance > 10 || distance == -1) {
        count = 0;
       vooruitRijden = HIGH;
       //rondKijken = LOW;
       Serial.println("DRIVE");
     }
     }
     }
    
  
  if(vooruitRijden){
