Versions Compared

Key

  • This line was added.
  • This line was removed.
  • Formatting was changed.

...

When both the speed profile and the path are given, they can be combined to form the trajectory. This is done in two places in the implementation, here for the planning, and here and here for the execution of the plan.

The trajectory must contain the vehicle velocity vector (see Vehicle Commands for details). The velocity vector is calculated from the direction vector and the speed, with the equation:

[velocity_x, velocity_y] = [speed * direction_x, speed * direction_y] = [speed * cos(yaw), speed * sin(yaw)]

The direction vector is given for every path node in the graph.

Collision Test

TODO

Collision Avoidance

...