Added a helper class that can be used to publish robot states and trajectories