Feature/waypoints trajectorie

[fguecker]

Queued but not ready for merge to main. Upcoming changes add missing documentation and align differences in Simulink library blocks.

• When these are done, it will be announced here.