Fixed a number of little bugs related to trajectories and mappings. CRS-planner2 now compiles with dynamic planning function.