CICV_Highway_planning_control