Fixed minor bugs with moving head to initial position for calibration