то графовый вширь и в глубь не очень красиво выходит, для игровой логики если що, желательно щобы разжевали и в рот положили
гугли муравьиные алгоритмы, они весьма несложные, в ютубе много видео
Скорее всего тебе подойдёт A* https://ru.wikipedia.org/wiki/A*
Обсуждают сегодня