Fixed generate_work_pose