como guardar el recorrido que realice mi robot?

hola a todos. Estoy programando un robot que resuelve laberintos y me gustaria ponerle un algoritmo para que después de resolver el laberinto el robot sepa el camino mas corto para resolverlo y la siguiente vez que vaya a recorrer el laberinto lo haga por el camino mas corto, asi de esta manera ya no tomaria los otros caminos. por cierto estoy utilizando un arduino UNO. De antemano muchas gracias por responder.

Y porque creas un nuevo hilo si esta relacionado con tu PROYECTO de un robot que sigue el camino con 3 sensores ultrasónicos? porque no lo planteas en el mismo sitio?

SOLUCION POSIBLE A TU PROBLEMA: si tu robot se desplaza a Velocidad cte, entonces con medir el tiempo sabes que camino es el mas corto. Menos tiempo menos distancia.