heap: Commented heap. Improved heap.
graph: Implemented Dijkstra. For some reason it is not working correctly -> heap is not working as it should.
Fix it.