Optimize route planning