optimal trajectory generation for dynamic street scenarios in a frenet frame .
rapidly - exploring random trees : a new tool for path planning .