 
 uint8_t GetNextServoAngle()
 {
+    // 0 - 80
+    // 80 - 100
+    // 100 - 180
+
+    if(servoPos <= 0)
+    {
+        servoLocation = left;
+        servoMovement = right;
+        servoPos = 0;
+    }
+
+    if(servoPos < 80)
+    {
+        servoLocation = left;
+    }
+
+    if(servoPos >= 80 && servoPos <= 100)
+    {
+        servoLocation = center;
+    }
+
+    if(servoPos > 100)
+    {
+        servoLocation = right;
+    }
+
     if(servoPos >= 180)
     {
-        servoDirectionRight = false;
+        servoLocation = right;
+        servoMovement = left;
         servoPos = 180;
     }
-    if(servoPos <= 0)
-    {
-        servoDirectionRight = true;
-        servoPos = 0;
-    }
-
-    if(servoDirectionRight)
+
+
+    if(servoMovement == right)
     {
         servoPos += servoRotationAngel;
     }

const uint8_t servoPin = 6;
const uint8_t servoRotationAngel = 10;

uint8_t servoPos = 90;
bool servoDirectionRight = false;
bool servoRight = false;

void setup()
{

    {
        servoPos -= servoRotationAngel;
    }

    return servoPos;
}
