Fix bug in reading initial trajectory from command line + minor fixes.

Add const to display method.
Remove display in parsing initial method.
Add ostream operator<< to timestamp class.
[tools] Add queue of trajectories in joint-trajectory-entity.
This is necessary to ensure synchronization when receiving trajectories.
[cmake] Remove debug message in src/CMakeLists.txt