Eso ya lo he conseguido, el problema es que cuando apagas el invento y después lo vuelves a encender los motores no tienen memoria de donde se pararon, con lo que varia la zona desde la que empieza el recorrido según donde apagues el arduino.
Lo que quiero conseguir es esto aquí