“Лабиринт: туда и обратно“. Оптимизация массива для кратчайшего пути

Как написать программу для возвращения более кратким путем. Как оптимизировать массив в среде программирования Lego Mindstorms Ev3