python将四元数变换为旋转矩阵的实例 如下所示：importnumpyasnpfromautolab_coreimportRigidTransform#写上用四元数表示的orientation和xyz表示的 四元数