Camion Lavacontenedor

Quiero hacer lo que muestro en el vídeo, ya hago todos los demás pasos, y estoy precisamente en el que debo dejar el contenedor en el mismo sitio en el cual mi sensor midió...no se como decirlo en código...Algo como:

"Si lo tomaste a 100 cm , vuelve a dejarlo en 100 cm "