Removed debug path storing code from shortestpath

...and increasing the speed by a lot for large shortest path queries. Got to love free speed boosts.
Merge pull request #534 from lossyrob/fix/shortestpath

Removed debug path storing code from shortestpath