Added shortest path function
Merge pull request #3 from sidh0/master

Added shortest path function