trajectory_generator accepts paths and segment velocities
The trajectory_generator should not accept times. It should calculate the times.
The modifyTraj method in planner.cpp is a little weird to work with, but will be more structured once everything gets put together