Added Shortest Path working code