Starting over with Dijkstra
C++ version of dijkstra search algorith.  Uses a binary heap to find shortest current path.