aruco_map: fix visualization markers' orientation

Was by mistake uninitialized
This commit is contained in:
Oleg Kalachev
2022-10-30 23:16:03 +06:00
parent 0b62f677af
commit 2c07bbffe3
2 changed files with 32 additions and 2 deletions

View File

@@ -503,7 +503,7 @@ publish_debug:
vis_marker.pose.position.x = x;
vis_marker.pose.position.y = y;
vis_marker.pose.position.z = z;
tf::quaternionTFToMsg(q, marker.pose.orientation);
tf::quaternionTFToMsg(q, vis_marker.pose.orientation);
vis_marker.frame_locked = true;
vis_array_.markers.push_back(vis_marker);