A MPC Combined Decision Making and Trajectory Planning for Autonomous Vehicle Collision Avoidance