Page History

...

The function LaneGraphTools::move_along_route moves the reference state along the given route by a given distance.

For example, assume that the path node distance in the above image is 0.02 m (except for the end nodes 0/3, which are in the same location). We want to move the reference state by 0.055 m.

Inputs: route = (11, 42), state = (11, 1, (0.01+0.055))

The state input is then modified to (42, 1, 0.015).

Speed Profile + Path => Trajectory

...