Added pathing algorithm based on Dijkstra, plus associated unit tests.