Upgrade smooth planner