tested : rewritten eXtended Path finding algorithms (Dijkstra & Bellman)