Publishing joint trajectory.
Fix publication of pose trajectories.