Fixing shortest path function and adding to unit test