    Serial.println("-1");
    digitalWrite(timeOutPin, LOW);
  }
-   else {
+ else {
  /* Send the distance to the computer using Serial protocol, and
  turn LED OFF to indicate successful reading. */
    Serial.println(distance);
-   }
-   digitalWrite(timeOutPin, HIGH);
+ }
+  digitalWrite(timeOutPin, HIGH);
 }
  
  void Pinkers(int Stuur, unsigned long currentMillis){ 

     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. ---------------------------------------------------------

int LledState = LOW;

int hoekServo = 35;
int hoekServoRondkijken = 90;

#define echoPin A0 // Echo Pin
#define trigPin A1 // Trigger Pin
