Unit test trajectory init with different time base.

- Test initialization from ROS message when current trajectory and message
  are represented in different time bases.

- Fix bug in implementation exposed by the test :)