modified the pose update procedure, shadow the cMo = p_cMo step