Route improvement heuristic