Abstract: Systems and methods for trajectory planning for an autonomous vehicle, may include: computing features for each of the plurality of candidate trajectories; computing scores for the features of the candidate trajectories, wherein the scores are based on parameter values associated with their corresponding final trajectories; determining, based on the computed scores, a trajectory of the candidate trajectories to be used as a warm-start trajectory for trajectory optimization and applying the warm-start trajectory to develop a final trajectory for the vehicle; and autonomously operating the autonomous vehicle in accordance with the final trajectory.

Abstract: System, methods, and other embodiments described herein relate to vehicle maneuvering using predictive control with automated driving and contingency planning to preserve safety and increase comfort. In one embodiment, a method includes receiving, by a controller, an operator command associated with a vehicle maneuver while automated driving is engaged. The method also includes adjusting a motion command associated with the vehicle maneuver by applying a predictive control according to motion estimates outputted from the automated driving and the operator command, the predictive control using motion constraints that are constant between time intervals for the vehicle maneuver. The method also includes controlling, by the controller, a vehicle using the motion command for a time step during the time intervals.

Abstract: System, methods, and other embodiments described herein relate to lane keeping in a vehicle. In one embodiment, a method includes determining lane boundaries according to at least the sensor data and a map. The method includes defining a reference system over a lane defined by the lane boundaries. The method includes evaluating vehicle boundary points within the reference system as a cost in optimizing a trajectory of the vehicle and using an R-function that defines geometric relationships between the vehicle boundary points and the reference system. The method includes providing an indicator about the trajectory to control the vehicle.

Abstract: A vehicle includes a lane generator that is configured to receive information that describes a first lane portion and a second lane portion and determine that a discontinuity is present. The lane generator obtains a sensor output and detects presence of a nearby vehicle in the first lane portion. A classification for the nearby vehicle is identified by analyzing the sensor output, and is used to select a vehicle kinematics model. The lane generator determines paths for a simulated vehicle from the first lane portion to the second lane portion using the vehicle kinematics model. A third lane portion is determined based on the paths such that the third lane portion defines a traversable route from the first lane portion to the second lane portion in accordance with the vehicle kinematics model. An automated vehicle control system generates control outputs based in part on the third lane portion.

Abstract: Systems and methods for trajectory planning for an autonomous vehicle, may include: computing features for each of the plurality of candidate trajectories; computing scores for the features of the candidate trajectories, wherein the scores are based on parameter values associated with their corresponding final trajectories; determining, based on the computed scores, a trajectory of the candidate trajectories to be used as a warm-start trajectory for trajectory optimization and applying the warm-start trajectory to develop a final trajectory for the vehicle; and autonomously operating the autonomous vehicle in accordance with the final trajectory.

Abstract: System, methods, and other embodiments described herein relate to lane keeping in a vehicle. In one embodiment, a method includes determining lane boundaries according to at least the sensor data and a map. The method includes defining a reference system over a lane defined by the lane boundaries. The method includes evaluating vehicle boundary points within the reference system as a cost in optimizing a trajectory of the vehicle and using an R-function that defines geometric relationships between the vehicle boundary points and the reference system. The method includes providing an indicator about the trajectory to control the vehicle.

Abstract: A control system for a vehicle includes a plurality of vehicle actuators that are operable to affect actual chassis-level accelerations, a vehicle intelligence unit that determines a motion plan, a vehicle motion control unit that determines a chassis-level motion request based on the motion plan, and a chassis control unit that determines actuator commands for the plurality of vehicle actuators based on the chassis-level motion request and actuator identity information that describes presently available actuators from the plurality of vehicle actuators.

Abstract: A control system for a vehicle includes a plurality of vehicle actuators that are operable to affect actual chassis-level accelerations, a vehicle intelligence unit that determines a motion plan, a vehicle motion control unit that determines a chassis-level motion request based on the motion plan, and a chassis control unit that determines actuator commands for the plurality of vehicle actuators based on the chassis-level motion request.