Voici un programme codé en Lua qui montre le fonctionnement de l'algorithme de recherche le plus rapide et très efficace, l'algorithme Astar (A*). Ce n'est pas le plus optimisé mais c'est tout le but de l'algorithme :

"L'algorithme A* est un algorithme de recherche de chemin dans un graphe entre un nœud initial et un nœud final. Il utilise une évaluation heuristique sur chaque nœud pour estimer le meilleur chemin y passant, et visite ensuite les nœuds par ordre de cette évaluation heuristique. C'est un algorithme simple, ne nécessitant pas de prétraitement, et ne consommant que peu de mémoire." (définition Wikipédia)