simple path and imdijkstra

Created a simple diagonal path algorithm and modded imdijkstra to use
it.