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

See #566