Dijkstra funcionando, Heap funcionando. (para matriz)