added servoDriver set position and speed functions