Waypoint prediction for vehicle motion planning

1. A method of determining trajectories of an actor in an environment in which a vehicle is operating, the method comprising:

by an object detection system of a vehicle in an environment, detecting an actor that may move within a scene in the environment;

using context of the scene to determine a reference polyline for the actor, wherein the reference polyline defines a path along which the actor may travel within the scene over a time period;

determining a kinematic history of the actor, wherein the kinematic history includes a measured path of movement of the actor;

using the kinematic history to predict a waypoint, wherein the waypoint is a predicted position of the actor at a conclusion of a waypoint time period;

identifying a segment of the reference polyline, the segment extending from a current location to a point along the reference polyline that is closest to the waypoint; and

determining a trajectory for the actor conditioned by the segment of the reference polyline.

2. The method of claim 1 , wherein using the context of the scene to determine the reference polylines for the actor comprises:

determining a plurality of lane segments along which the actor may travel; and

selecting the reference polyline, wherein the reference polyline corresponds to a lane segment in the plurality of lane segments that will not cause the actor to violate a scene context rule.

3. The method of claim 1 , further comprising, by the vehicle, using the determined trajectory to cause the vehicle to take one or more actions.

4. The method of claim 3 , wherein the one or more actions include one or more of the following:

altering a path of the vehicle;

altering a pose of the vehicle; or

altering a velocity of the vehicle.

5. A system for determining trajectories of an actor in an environment in which a vehicle is operating, the system comprising:

an object detection system configured to detect an actor that may move within a scene in an environment of a vehicle; and

a computer-readable storage medium comprising one or more programming instructions that, when executed, will cause the vehicle to:

use context of the scene to determine a reference polyline for the actor, wherein the reference polyline defines a path along which the actor may travel within the scene over a time period;

determine a kinematic history of the actor, wherein the kinematic history includes a measured path of movement of the actor;

use the kinematic history to predict a waypoint, wherein the waypoint is a predicted position of the actor at a conclusion of a waypoint time period;

identify a segment of the reference polyline, the segment extending from a current location to a point along the reference polyline that is closest to the waypoint; and

determine a trajectory for the actor conditioned by the segment of the reference polyline.

6. The system of claim 5 , wherein the instructions to use the context of the scene to determine the reference polylines for the actor comprise instructions to:

determine a plurality of lane segments along which the actor may travel; and

select the reference polyline, wherein the reference polyline corresponds to a lane segment in the plurality of lane segments that will not cause the actor to violate a scene context rule.

7. The system of claim 5 , wherein the computer-readable storage medium further includes one or more programming instructions that, when executed, will cause the vehicle to use the determined trajectory to take one or more actions.

8. The system of claim 7 , wherein the one or more actions include one or more of the following:

altering trajectory path of the vehicle;

altering a pose of the vehicle; or

altering a velocity of the vehicle.

9. A non-transitory computer-readable storage medium comprising one or more programming instructions that, when executed, will cause a processor to:

use an object detection system of a vehicle to detect an actor that may move within a scene in an environment around the vehicle;

use context of the scene to determine a reference polyline for the actor, wherein the reference polyline defines a path along which the actor may travel within the scene over a time period;

determine a kinematic history of the actor, wherein the kinematic history includes a measured path of movement of the actor;

use the kinematic history to predict a waypoint, wherein the waypoint is a predicted position of the actor at a conclusion of a waypoint time period;

identify a segment of the reference polyline, the segment extending from a current location to a point along the reference polyline that is closest to the waypoint; and

determine a trajectory for the actor conditioned by the segment of the reference polyline.

10. The non-transitory computer-readable storage medium of claim 9 , wherein the instructions to use the context of the scene to determine the reference polylines for the actor comprise instructions to:

determine a plurality of lane segments along which the actor may travel; and

select the reference polyline, wherein the reference polyline corresponds to a lane segment in the plurality of lane segments that will not cause the actor to violate a scene context rule.

11. The non-transitory computer-readable storage medium of claim 9 , further comprising additional programming instructions that, when executed, will cause the vehicle to use the determined trajectory to take one or more actions.

12. The non-transitory computer-readable storage medium of claim 11 , wherein the one or more actions include one or more of the following:

altering trajectory path of the vehicle;

altering a pose of the vehicle; or

altering a velocity of the vehicle.