посещённые: множество = пустое_множество
текущие: список = начальные_вершины

шаг = 0

пока текущие не пусты:
   шаг = шаг + 1
   новые: список = пустой_список
   для каждой вершины из текущие:
      для каждого соседа вершины:
         если сосед == конечная_точка:
            вернуть шаг
            всё_приехали_конец
         если сосед не в посещённые:
            добавить соседа в посещённые
            добавить соседа в новые
   текущие = новые

вернуть путь_не_найден
всё_приехали_конец