Planning: changes for follow algorithm. (1) make sure acceleration is < 0 when the adc is between the front car and follow fence; (2) only add follow reference point when the point is behind reference line; (3) added parameter follow_drag_distance to adjust following behavior.