Flexible unit A-star trajectory planning for autonomous vehicles on structured road maps
rapidly - exploring random trees : a new tool for path planning .