DP and QP Based Decision-making and Planning for Autonomous Vehicle