From 35e4e4b5736af359857556d33ea2a15521ff1920 Mon Sep 17 00:00:00 2001 From: Martin Pecka Date: Mon, 17 Oct 2022 19:26:14 +0200 Subject: [PATCH] Fix msgify(Pose, ...) --- src/ros_numpy/geometry.py | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/ros_numpy/geometry.py b/src/ros_numpy/geometry.py index bd9a4ec..e385041 100644 --- a/src/ros_numpy/geometry.py +++ b/src/ros_numpy/geometry.py @@ -111,14 +111,14 @@ def numpy_to_pose(arr): quat = transformations.quaternion_from_matrix(arr) return Pose( - position=Vector3(*trans), + position=Point(*trans), orientation=Quaternion(*quat) ) else: res = np.empty(shape, dtype=np.object_) for idx in np.ndindex(shape): res[idx] = Pose( - position=Vector3(*transformations.translation_from_matrix(arr[idx])), + position=Point(*transformations.translation_from_matrix(arr[idx])), orientation=Quaternion(*transformations.quaternion_from_matrix(arr[idx])) )