Fix wrong path length observed by path expander in shortest path algo implementation
Merge pull request #569 from AlexanderYastrebov/566

Fix wrong path length observed by path expander in shortest path algo imlementation