[Feature]: Finish Overtake behavior

[samuelkuehnel]

Description

Finish the overtake behavior and integrate with the overtake trajectory planning.

Definition of Done

• Behavior can trigger, check and finish the overtake process