本文整理匯總了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;