Fixed the "not-so-shortest-path" bug (thanks to Cédric Jules)
Merge pull request #15 from azrafe7/master

Fixed the "not-so-shortest-path" bug (thanks to Cédric Jules)