Add tests for non-ros segment constructor.
Add joint reordering on ROS message traj init.

- When creating joint trajectories from ROS messages, it is now (optionally)
  possible to provide a vector of expected joint names, so expected joint count and
  names can be checked. Also, resulting trajectories are ordered as the expected
  joints vector, and not like the ROS message.

- Update unit tests.