[Feature]: Local trajectory planning with Frenet Trajectory planner

[samuelkuehnel]

Description

Integrate the trajectory planner into local planning. Tune trajectory planner so it creates a valid trajectory to overtake

Definition of Done

• [ ] Planner generates valid trajectory (Road width, side, ...)