Find the shortest path between two points on a weighted graph!  Written in C++