dynamixel_servo: fixed infinity mode