I made the ultrasonic get the average distance in test mode