An Effective Algorithm for Finding Shortest Paths in Tubular Spaces