At this line,
the points in x seems to be transformed onto "AV" local frame.
However, At
The trajectory (already on "AV" local frame) of a certain agent is rotated by the agent's heading angle at 20th time frame, could you tell me why need to rotate the agent trajectory?