// Special Case: Servo of 1 (input, interpereter converts to 0) is wheel angle
public void SetServo(int servo, int angle)
{
if (servo == 0)
{
wheelController.SetTurnAngle(angle);
}
else if (servoEnabled)
{
servoController.SetServoPosition(servo - 1, angle);
}
}
public void SetServo(int servo, int angle)
{
servoController.SetServoPosition(servo - 1, angle);
}
