Optimal Trajectory Generation Using an Improved Probabilistic Road Map Algorithm for Autonomous Driving