A figura abaixo mostra o esquema de posicionamento dos sensores no robô:
O algoritmo utilizado para realizar o percurso desejado é mostrado a seguir:
Programa utilizado. Programa