 // mr <value>:     Motor Right. Value from -100 to 100. 0 is off.
 // bl <value>:     Brake Left. 0 is off, other value is on.
 // br <value>:     Break Right. 0 is off, other value is on.
-// sp <value>:     Servo Pan. Value from -180 to 180.
-// st <value>:     Servo Tilt. Value from -180 to 180.
+// sp <value>:     Servo Pan. Value from 0 - 160 (eventually 180).
+// st <value>:     Servo Tilt. Value from 0 - 160 (eventually 180).
 // ka:             Keep alive. Prevent from entering fail-safe mode. 
 // fs <value>:     Set fail-safe interval in milliseconds. Use 0 to disable fail-safe mode.
 // ef:             Exit fail safe. Once fail-safe mode is entered, you must

// Values designating the servos.
const int PAN_SERVO = 0;
const int TILT_SERVO = 1;

// Configure servo hardware.
void setup_servos()
{
    // TODO: Configure servo hardware.
}

// Set a servo to a particular setting.
// "servo" is which servo to set.
// "angle" is a value from -180 to 180, in degrees
void set_servo(int servoID, int angle)
{
    // TODO: Set servo hardware.
   
    if (servoID == PAN_SERVO) {
        log(F("Set pan servo to:"), angle);
    }
    else if (servoID == TILT_SERVO) {
        log(F("Set tilt servo to:"), angle);
    }
}

    else if (c1 == 's') {
        // "sp" - pan servo, "st" - tilt servo
        
        // Clamp value to 0 to 160 - eventually 180.
        if (value > 160 && value != 999)  // using 999 as value to return camera to home position
            value = 160;
        else if (value < 0)
            value = 0;
            
        if (c2 == 'p')
            set_servo(PAN_SERVO, value);
