Move the waist pose publication directly with the JointState publication