A fast RRT algorithm for motion planning of autonomous road vehicles
rapidly - exploring random trees : a new tool for path planning .