General setup
Dijkstra pathfinding Fixes #73