 const uint8_t rangeLimit_Warning3 = 25;
 const uint8_t rangeLimit_Stop = 15;
 
-const uint16_t rangeLimit_RotateFor = 250;
+const uint16_t rangeLimit_RotateFor = 500;
 unsigned long rangeLimit_Timestamp = 0;
 
 bool wheelSpinCompleted = true;

    return servoPos;
}


void loop()
{

        return;
    }

    SetLightByRange(range);


    // obstacle is further away than X cm
    if(wheelSpinCompleted && range > rangeLimit_Stop)
    {
        // drive
        SetMotor(motorPin1_1, motorPin1_2, 255);
        SetMotor(motorPin2_1, motorPin2_2, 255);

        rangeLimit_Timestamp = millis();
    }
