Now publish back joint states