     Serial.print(rangeRight);
     Serial.print(" - ");
     Serial.println(uptime);
-
+    */
 
     GetRange(servoPos, wheelSpinCompleted);
 
-    //SetServo(uptime, servoPos);
+    SetServo(uptime, servoPos);
 
     // Wait for initial scans before performing any actions
     if(uptime < initialDelay)

    ServoMotor.write(servoCenter);
    //ServoMotor.detach();

    Serial.begin(9600); // Starts the serial communication
}

void GetRange(int servoPos, bool rotating)

void SetServo(uint32_t uptime, uint8_t servoPos)
{
    int interval = 1000;
    int intervalRange = 200;
    if(uptime > interval+1 && servoTriggerActive && uptime % interval <= intervalRange)
    {
        servoTriggerActive = false;

