Heap implemented enough to start working on Dijkstra algorithm.