调整pose Z方向的朝向
2026/9/13 7:17:01 网站建设 项目流程

pose_to_hom_mat3d (Pose, HomMat3D)
affine_trans_point_3d (HomMat3D, [0, 0], [0, 0], [0, 1], Qx, Qy, Qz)

halcon是这么做的


if (Qz[1] - Qz[0] > 0)
Pose[4] := Pose[4] + 180
Pose[5] := -Pose[5]
endif

另外一种容易理解的方式

if (Qz[1] - Qz[0] > 0)
create_pose (0, 0, 0, 0, 180, 0, 'Rp+T', 'gba', 'point', Pose1)
pose_compose (Pose, Pose1, PoseCompose)
endif

结果是一样的。绕自身旋转轴旋转的方式,更容易理解和记住。

需要专业的网站建设服务?

联系我们获取免费的网站建设咨询和方案报价,让我们帮助您实现业务目标

立即咨询