Planning: Fix init point bug
Planning: Fix init point bug

startcode/apollo,fy2462/apollo,startcode/apollo,fy2462/apollo,startcode/apollo,startcode/apollo,startcode/apollo,startcode/apollo,fy2462/apollo,fy2462/apollo,fy2462/apollo,fy2462/apollo