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: 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.