fixed psm_joint_publisher bug