Publishing joint trajectory.
Fix publication of pose trajectories.
Merge pull request #3 from olivier-stasse/master

Publish joint trajectories