Get reasonable speed for trajectories between contours
want to be as fast as possible while being safe.
Linked to #twins-planner/50
- Create a couple of trajectories to test with
- Run these on real hardware with various time multipliers to find good speed
- find good time multiplier to apply for the planner to use