Systems and methods for determining deceleration controls
Systems and techniques for determining deceleration controls to use in a trajectory for use in stopping a vehicle are described. A vehicle control system may determine if a stopping point is represented in a spatially-generated trajectory (e.g., controls to be commanded at particular locations) and, if so, whether the points in the trajectory approaching the stopping point meet near-stop conditions. If so, the system operated the vehicle in stop vehicle control mode, generating temporally-based controls to slow the vehicle more comfortably. Otherwise, the system operates the vehicle as normal, using spatially-based controls for controlling the vehicle.
1 . A system comprising:
one or more processors; and
one or more non-transitory computer-readable media storing instructions executable by the one or more processors, wherein the instructions, when executed, cause the system to perform operations comprising:
receiving, from a trajectory determination system, a trajectory for a vehicle to traverse through an environment, the trajectory determined based at least in part on a plurality of spatial points, a first spatial point of the plurality of spatial points indicative of a first location for implementing a first vehicle control and a second spatial point of the plurality of spatial points indicative of a second location for implementing a second vehicle control;
causing the vehicle to be controlled by implementing the first vehicle control at the first location and the second vehicle control at the second location;
determining that a first velocity associated with a third spatial point of the plurality of spatial points meets or falls below a velocity threshold;
determining that a first acceleration associated with the third spatial point meets or falls below an acceleration threshold;
determining that a subset of the plurality of spatial points is associated with a stopping maneuver;
based at least in part on determining that the first velocity meets or falls below the velocity threshold, the first acceleration meets or falls below the acceleration threshold, and the subset of the plurality of spatial points being associated with the stopping maneuver, determining a plurality of temporal points along the trajectory, a first temporal point of the plurality of temporal points indicative of a first time for implementing a third vehicle control and a second temporal point of the plurality of temporal points indicative of a second time, subsequent to the first time, for implementing a fourth vehicle control; and
causing the vehicle to be controlled by implementing the third vehicle control at the first time and the fourth vehicle control at the second time.
2 . The system of claim 1 , wherein the operations further comprise:
determining a distance between a third location of a predicted vehicle stopping point and a fourth location associated with the stopping maneuver; and
modifying one or more controls associated with the plurality of temporal points based at least in part on the distance.
3 . The system of claim 2 , wherein modifying the one or more controls based at least in part on the distance comprises determining that the distance is greater than a threshold distance.
4 . The system of claim 2 , wherein modifying the one or more controls based at least in part on the distance comprises decreasing an acceleration control associated with the first temporal point.
5 . The system of claim 1 , wherein determining that the subset of the plurality of spatial points is associated with a stopping maneuver comprises determining that a fourth spatial point of the plurality of spatial points is associated with a zero velocity.
6 . One or more non-transitory computer-readable media storing instructions that, when executed by one or more processors, perform operations comprising:
receiving a trajectory for controlling a vehicle comprising a plurality of spatial points, a first spatial point of the plurality of spatial points indicative of a first spatial location for implementing a first vehicle control;
controlling the vehicle in a spatial vehicle control mode based at least in part on the trajectory by implementing the first vehicle control at the first spatial location;
determining that a velocity parameter associated with a second spatial point of the plurality of spatial points meets or falls below a velocity threshold;
determining that a third spatial point of the plurality of spatial points is associated with a zero velocity;
based at least in part on determining that the velocity parameter meets or falls below the velocity threshold and that the third spatial point is associated with the zero velocity, determining a temporal point along the trajectory indicative of a time for implementing a second vehicle control; and
controlling the vehicle by implementing the second vehicle control at the time.
7 . The one or more non-transitory computer-readable media of claim 6 , wherein controlling the vehicle by implementing the second vehicle control at the time comprises:
transmitting the second vehicle control to a velocity controller at the time.
8 . The one or more non-transitory computer-readable media of claim 6 , wherein the operations further comprise:
determining that a current spatial location of the vehicle is at the third spatial point; and
based at least in part on determining that the current spatial location of the vehicle is at the third spatial point, controlling the vehicle to remain stationary.
9 . The one or more non-transitory computer-readable media of claim 8 , wherein determining that the current spatial location of the vehicle is at the third spatial point comprises determining that a distance between the current spatial location and the third spatial point is less than a threshold distance.
10 . The one or more non-transitory computer-readable media of claim 6 , wherein the operations further comprise determining a plurality of controls corresponding to a plurality of times between a current time and a projected time associated with the third spatial point.
11 . The one or more non-transitory computer-readable media of claim 10 , wherein the plurality of controls comprises at least one of an acceleration control or a velocity control.
12 . The one or more non-transitory computer-readable media of claim 6 , wherein determining that the third spatial point is associated with the zero velocity comprises determining that no points spatially subsequent to the third spatial point are associated with a non-zero velocity.
13 . The one or more non-transitory computer-readable media of claim 6 , wherein the operations further comprise:
receiving a second trajectory for controlling the vehicle;
determining a second plurality of spatial points along the second trajectory, a third spatial point of the second plurality of spatial points indicative of a second spatial location for implementing a third vehicle control;
determining that no velocity parameter associated with the second plurality of spatial points meets or falls below the velocity threshold; and
controlling the vehicle in accordance with the second trajectory.
14 . The one or more non-transitory computer-readable media of claim 6 , wherein the operations further comprise modifying the trajectory to include the temporal point.
15 . A method comprising:
receiving a trajectory for controlling a vehicle comprising a plurality of spatial points, a first spatial point of the plurality of spatial points indicative of a first location for implementing a first vehicle control;
controlling the vehicle based at least in part on the trajectory by implementing the first vehicle control at the first location;
determining that a velocity parameter associated with a second spatial point of the plurality of spatial points meets or falls below a threshold;
determining that a third spatial point of the plurality of spatial points is associated with a zero velocity;
based at least in part on determining that the velocity parameter meets or falls below the threshold and that the third spatial point is associated with the zero velocity, determining a temporal point along the trajectory indicative of a time for implementing a second vehicle control; and
controlling the vehicle by implementing the second vehicle control at the time.
16 . The method of claim 15 , wherein the second vehicle control excludes lateral controls.
17 . The method of claim 15 , further comprising determining that an acceleration parameter associated with the second spatial point meets or falls below a second threshold, wherein the time is further determined based at least on part on determining that the acceleration parameter meets or falls below a second threshold.
18 . The method of claim 15 , further comprising determining a plurality of controls corresponding to a plurality of times between a current time and a projected time associated with the third spatial point.
19 . The method of claim 18 , further comprising modifying the trajectory to include the third spatial point based at least in part on sensor data.
20 . The method of claim 18 , further comprising modifying the trajectory to include the third spatial point based at least in part on detection of an object.