Added servoCalibrate() to set a false origin of the servos