посещённые: множество = пустое_множество
очередь: очередь = (начальные_вершины, шаг = 0)

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

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