     Serial.print("|");
     Serial.print(pos);
     Serial.print("|");
-    Serial.println(distance);
+    Serial.print(distance);
+    Serial.print("|");
+    Serial.println(servoRotationAngle);
 }
 
 


    if(servoMovement == right)
    {
        servoPos += servoRotationAngel;
    }
    else
    {
        servoPos -= servoRotationAngel;
    }

    if(servoPos <= 0) { servoPos = 0; }

// Servo
Servo ServoMotor;
const uint8_t servoPin = 6;
uint8_t servoRotationAngle = 5;
const uint8_t servoRotationAngleFast = 10;
const uint8_t servoRotationAngleMedium = 5;
const uint8_t servoRotationAngleDetailed = 1;

const uint8_t seroRotationDurationPerAngle = 2;

