fix: Track actual lane position in PathControlUnit

GetLaneId would not always return a coherent lane id

It would get the lane id of the last point that Ego went through in the traverser list, which does not necessarily correspond to the lane the entity is actually on

This quick fix recomputes a lane id in UpdateEntity from the actual entity's position

Merge request reports

Loading
Loading