Abstract: A multi-dimensional trajectory planning system is disclosed that includes planning and actuator modules. The planning module executes the planning application to: determine a first dimensionality including first dimensions for a first stage, where each of the first dimensions are active, and where the first dimensions include two or more dimensions; determine a second dimensionality including second dimensions for a second stage, where the second dimensions include the first dimensions or a subset of the first dimensions, and where the second stage has a lower level of dimensionality than the first stage; based on map data and sensor data, estimates first possible future states of the first dimensions for the first stage, and estimates second possible future states of the second dimensions for the second stage based on the first possible future states; and selects a trajectory plan based on the second possible future states.

Abstract: An autonomous drive system for a vehicle includes at least one environment perception sensor, a perception module, a location module, an intention prediction module, and a control module. The perception module is configured to receive signals from the at least one environment perception sensor and detect and track at least two remote vehicles in one or both of a current lane and a neighboring lane. The location module is configured to determine a location of the vehicle. The intention prediction module is configured to generate predicted trajectories for the at least two remote vehicles. The control module is configured to receive signals from the at least one environment perception sensor and receive the predicted trajectories from the intention prediction module. The control module determines a location and time for a lane change based on the predicted trajectories and controls the vehicle to change lanes at the determined location and time.

Abstract: An autonomous drive system for a vehicle includes at least one environment perception sensor, a perception module, a location module, an intention prediction module, and a control module. The perception module is configured to receive signals from the at least one environment perception sensor and detect and track at least two remote vehicles in one or both of a current lane and a neighboring lane. The location module is configured to determine a location of the vehicle. The intention prediction module is configured to generate predicted trajectories for the at least two remote vehicles. The control module is configured to receive signals from the at least one environment perception sensor and receive the predicted trajectories from the intention prediction module. The control module determines a location and time for a lane change based on the predicted trajectories and controls the vehicle to change lanes at the determined location and time.