Efficient route planning