 uint8_t GetNextServoAngle()
 {
     // 0 - 80 / 80 - 100 / 100 - 180
-    if(servoPos <= 0)
+    if(servoPos <= 10)
     {
         servoMovement = right;
-        servoPos = 0;
+        servoPos = 10;
     }
 
-    if(servoPos >= 180)
+    if(servoPos >= 170)
     {
         servoMovement = left;
-        servoPos = 180;
+        servoPos = 170;
     }
 
 

const uint16_t maxDistance = 300;

NewPing sonar(trigPin, echoPin, maxDistance);


long rangeData_Left[15];
long average_Left;

{
    long range = sonar.ping_cm();

    Serial.print(servoPos);
    Serial.print(" - ");
    Serial.println(range);

    if(range == 0)
    {
        //delay(5000);
    }

    long *rangeData_Current;

    // get current meassurement and add to array
