本文整理汇总了Python中Transform.ev2rosq方法的典型用法代码示例。如果您正苦于以下问题:Python Transform.ev2rosq方法的具体用法?Python Transform.ev2rosq怎么用?Python Transform.ev2rosq使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Transform
的用法示例。
在下文中一共展示了Transform.ev2rosq方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: get_blob_pose
# 需要导入模块: import Transform [as 别名]
# 或者: from Transform import ev2rosq [as 别名]
def get_blob_pose(pts):
'''
computes the pose of the point cloud
arr is expected to be Nx3
return Pose
'''
pts = ru.to_array(pts);
cent = get_centroid(pts);
(x, y, z) = get_ev(pts);
pose = geometry_msgs.Pose();
pose.position = geometry_msgs.Point(*cent);
pose.orientation = tr.ev2rosq((x,y,z));
return pose;