Old algoritm for finding a road