added servoIRMeasure and servoIRMove functions