Как реализовать алгоритм поиска пути?
Вот здесь очень хорошо показан принцип работы поиска путей визуально. И его же можно использовать для поиска путей. В нем уже реализованы такие алгоритмы, как А* и другие.
Если английский у вас хороший могу накидать ссылок из онлайн курса ИИ университета в Беркли. Очень классно рассказывают, есть A* по шагам:
www.youtube.com/watch?feature=player_embedded&v=g0MJRpquEOk