Update calibrate_servos.ino

Added basic functionality --> test pending