Pathfinding redux

[aliaksei135]

• Add Djikstra to use as pathfinding option or as benchmark for heuristic based algorithms
• All PF algorithms now have path integral of risk as cost metric
• Ensure all heuristics are admissible using k value to scale h values down slightly