位姿筛选

计算输入位姿 Z 向与参考方向的夹角，小于设定角度阈值的位姿将被保留，大于设定角度阈值的位姿将被滤除。

此步骤为旧版，请替换为新版步骤 根据与参考方向的夹角判断位姿是否有效 ，旧版步骤只能计算 Z 轴的夹角，新版支持通过任意轴的夹角进行过滤。