Trajectory: Improvements for trajGetMatch function

[ybeyer]

Matching should be designed more cleverly in the future. It was actually once thought that with the trajSetMatch the two fields active_section and current_time in the traj struct can be updated and that the next matching takes into account the state of these two fields (or alternatively in Simulink - depending on the structuring - via unit delay feedback of these two variables). In addition, one can of course implement many other improvements.