Combining space exploration and heuristic search in online motion planning for nonholonomic vehicles
rapidly - exploring random trees : a new tool for path planning .