Update route planner
Fix bug