Added program for calibrating servo