fix(lane_change): consider max velocity during path planning (#6615) …

fix(lane_change): consider max velocity during path planning (#6615) … #1024