Added python function to set joint_pose_msg