Debugging djkstra's, fixed bugs, added methods for manip/heaps