[Feature]: Tune Pure-Pursuit Steering Algorithm to work with new leaderboard

[hellschwalex]

Description

The PP-Controller uses the current position and heading and the planned trajectory to create a vector from actual to target point. It then calculates the angle of this vector and with that determines the heading-error with the vector-angle (target-angle) and the current heading (actual-angle).

To determine the target-point it "looks ahead" on the trajectory by a TUNEABLE distance "look-ahead-distance", best tuned depending on current speed.

Problem with #151 since the current heading is very important to the steering controller!!!

Definition of Done

No response

[hellschwalex]

Switching the published "current_heading" to just publish the LMUs yaw works wonders here!