Dijkstra/AStar up & running