Console Output

 按照pnc的要求，倒车情况下，way_points结果从当前点开始