Fonctions utiles aux Pathfinder toutes crées.
Algo du Pathfinder codé, reste à l'améliorer (quitter le multiset pour un container plus intelligent)
Modification de la fonction de comparaison pour le multiset (semble valide)
Reste à tester l'algo, mettre au propre.