Rough Shortest Path implementation