Use separated straight_line_planner