fails. fixed init point printout bug.

Planning: Fixed bugs for high speed cruising; updated unit tests; added a TODO for a potential pointer crash in math.

* The default gflag value would work

qp_spline_path for safety. Changed enable_trajectory_check to true in default but do
not fail even if trajectory does not pass the check.

Planning: removed low velocity threshold. Planning will report the idea trajectory and control will set a cut off number in its own algorithm.

planning: adjust slowdown profile parameters and allow em planner to return slowdown trajectory in case of error.