Moving servo and read ultrasonic at the same time