Gracias por tu ayuda le coloqué un delay de 10ms después del cálculo de la distancia y empezó a medir adentro del tubo aunque con una incerteza de 2 a 3 centímetros lo que considero aceptable porque la incerteza que nos permiten es de 4, perdón por no explicar antes de que consiste el proyecto debemos mantener un cilndro, esfera o cualquier otra forma a la altura que nos pidan levantándolo con un ventilador y un controlador pid por eso es que las distancias debe estarlas midiendo constantemente pero gracias a tu ayuda ya pude resolver el problema.