Limit dijsktra by radius

Add a new method to limit the Dijkstra search by radius and reconstruct the corresponding shortest path tree.

Unit test included.