3D位姿排序
步骤说明
按照指定的规则对 3D 位姿进行排序.
使用场景
通用的位姿排序步骤,排序后的位姿可用于后续处理或作为抓取位姿使用。
输入
位姿:待排序的位姿。
输出
排序后的位姿:按照指定规则排序后的位姿。
映射索引:反应位姿排序顺序的索引列表。
参数说明
排序方法
不排序
不对输入的位姿进行排序。
“S” 形平面排序
根据指定的参考位姿、行方向与列方向,对位姿进行行列排序(优先按“行方向”排序)。相邻行的排序方向交替反转,行末直接衔接下一行,整体轨迹呈 “S” 形蛇形,常用于整齐垛下料或拆垛场景。
“Z” 形平面排序
根据指定的参考位姿、行方向与列方向,对位姿进行行列排序(优先按“行方向”排序)。每一行按同一方向排序,行末切换到下一行起点,整体轨迹呈 “Z” 字折返,常用于整齐垛下料或拆垛场景。
按位姿 X 值排序
按位姿的 X 值对所有位姿进行排序。
按位姿 Y 值排序
按位姿的 Y 值对所有位姿进行排序。
按位姿 Z 值排序
按位姿的 Z 值对所有位姿进行排序。
按位姿与参考位姿的距离排序
计算所有输入位姿到参考位姿的距离,并按距离远近排序。
按位姿与参考位姿在 XY 平面上的距离排序
计算输入位姿与参考位姿在 XY 平面投影后的距离,并按距离远近排序。
按位姿置信度排序
根据输入的置信度值对位姿进行排序。
按位姿与参考位姿的坐标轴投影距离排序
将位姿投影到参考位姿的坐标轴上,计算投影距离,并按距离远近排序。
按长方体对角线长度排序
计算每个位姿对应长方体的对角线长度,并按长度大小排序。该排序方法常用于纸箱拆垛场景。
行方向/列方向/行间隔
仅适用于“S”形平面排序和“Z”形平面排序。
行方向:设置排序时“行”的方向。默认值:X 轴正方向。
列方向:设置排序时“列”的方向。默认值:Y 轴正方向。
行间隔:设置每行之间的间隔,单位为毫米(mm)。默认值:100.000 mm。
按升序排列
除“不排序”/“S” 形平面排序/“Z” 形平面排序外,其余排序方法均支持该参数。
勾选后按从小到大排序;不勾选则按从大到小排序。默认值:勾选。
参考方向
仅适用于“按位姿与参考位姿的坐标轴投影距离排序”。
选择参考位姿的坐标轴及其方向。默认值:X 轴正方向。
在选定坐标系下显示点云
选择在机器人或相机坐标系下显示点云。