Obstacle avoidance of autonomous vehicles with CQP-based model predictive control
RRT-connect: An efficient approach to single-query path planning