| CPC B60W 60/0011 (2020.02) [B60W 40/10 (2013.01); B60W 60/0013 (2020.02); B60W 60/0015 (2020.02); B60W 60/0027 (2020.02)] | 29 Claims |

|
1. A method comprising:
determining, with at least one processor, a plurality of dynamic homotopy constraints associated with a scenario involving a vehicle in an environment;
embedding, with the at least one processor, the plurality of dynamic homotopy constraints in a plurality of continuously-differentiable, spatio-temporal grids a plurality of times for each timestep of a prediction horizon, where each spatio-temporal grid includes individual grids for each timestep of a prediction horizon;
generating, with the at least one processor, a plurality of trajectories based on the plurality of dynamic homotopy constraints embedded in the plurality of spatio-temporal grids;
selecting, with the at least one processor, a particular trajectory from among the plurality of trajectories generated; and
controlling, with a control circuit of the vehicle, the vehicle in the environment based on the particular trajectory selected from among the plurality of trajectories.
|