Adding capability of storing the shortest path tree.
Merge pull request #12 from PetterS/store_parents

Adding capability of storing the shortest path tree.
Merge pull request #13 from PetterS/master

Merge master changes into dev branch.