Move
Reset last segment time when computing safe interval

To ensure the full acceleration time is given to the first point
Merge remote-tracking branch 'origin/pvt_segment_mode' into sbpl
Cleanup and loading config data into the right namespace