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