🟧 拆分旋转姿态数据

功能描述

该算子可用于处理一个包含多个旋转姿态的列表,将列表中每一个旋转向量转换为一个标准的3x3旋转矩阵,并从中提取出三个正交方向的单位向量:X轴、Y轴和Z轴方向的向量。另外,还可以对这三个输出轴向量单独取反操作。

使用场景

  • 提取单一方向向量,用于后续的运动规划、姿态判断或与机器人通信等。

  • 根据提取出的某个轴向量的方向来进行筛选。例如,只保留那些Z轴方向与世界坐标系Z轴(如 [0, 0, 1])大致平行的抓取姿态,从而实现只抓取正面朝上的物体。

输入输出

输入项

抓取物姿态中的旋转信息:一个列表,其中每个元素都是一个三维旋转向量。

输出项

姿态数据分解后的X轴向量:一个列表,包含从每个输入旋转中分解出的X轴方向向量。

姿态数据分解后的Y轴向量:一个列表,包含从每个输入旋转中分解出的Y轴方向向量。

姿态数据分解后的Z轴向量:一个列表,包含从每个输入旋转中分解出的Z轴方向向量。

参数说明

X/Y/Z轴向量反向

参数说明

控制是否将输出的X轴/Y轴/Z轴向量的方向反转180度。

调参说明

  • 关闭(默认):输出原始计算出的向量。

  • 开启:将输出的向量乘以-1,使其方向完全相反。