SELECTING TRAJECTORIES FOR CONTROLLING AUTONOMOUS VEHICLES

Systems and methods for controlling an autonomous vehicle are described. A trajectory planner module provides a first trajectory to a trajectory control module. The trajectory control module determines parameters of the first trajectory. The trajectory control module compares the parameters to a respective threshold value. The trajectory control module obtains one or more alternative trajectories, determines parameters of each alternative trajectory, and compares the parameters of the alternative trajectory to a respective threshold value. The trajectory control module selects a trajectory for controlling the autonomous vehicle that has parameters which are within a range defined by the threshold values and controls the autonomous vehicle based on the selected trajectory. Thus, before handing back control to a driver, the trajectory control module selects from alternate trajectories for controlling the autonomous vehicle.