Skip to content
Snippets Groups Projects
Commit 5eff850e authored by Fabian Reister's avatar Fabian Reister
Browse files

minor fix

parent 39bc2ba6
No related branches found
No related tags found
1 merge request!470Familiar objects
Pipeline #20806 failed
...@@ -156,6 +156,9 @@ namespace armarx::familiar_objects ...@@ -156,6 +156,9 @@ namespace armarx::familiar_objects
familiarObject.points.width = familiarObject.points.points.size(); familiarObject.points.width = familiarObject.points.points.size();
familiarObject.points.height = 1; familiarObject.points.height = 1;
familiarObject.bounding_box.center.setZero();
familiarObject.bounding_box.extents.setConstant(numPoints);
data.push_back(familiarObject.toAronDTO()); data.push_back(familiarObject.toAronDTO());
} }
......
#include "Visu.h" #include "Visu.h"
#include <Eigen/src/Geometry/Transform.h>
#include <Eigen/src/Geometry/Translation.h>
#include <SimoxUtility/color/Color.h> #include <SimoxUtility/color/Color.h>
#include <SimoxUtility/math/pose.h> #include <SimoxUtility/math/pose.h>
#include <SimoxUtility/math/rescale.h> #include <SimoxUtility/math/rescale.h>
...@@ -102,10 +105,14 @@ namespace armarx::armem::server::obj::familiar_object_instance ...@@ -102,10 +105,14 @@ namespace armarx::armem::server::obj::familiar_object_instance
layerPointCloud.add(points); layerPointCloud.add(points);
} }
const Eigen::Isometry3f global_T_bb =
Eigen::Isometry3f{familiarObject.poseGlobal->pose} *
Eigen::Translation3f{familiarObject.bounding_box.center};
auto box = viz::Box(objectId.str()); auto box = viz::Box(objectId.str());
box.pose(familiarObject.poseGlobal->pose); box.pose(global_T_bb.matrix());
box.size(Eigen::Vector3f{100,100,100}); // FIXME set properly box.size(familiarObject.bounding_box.extents);
box.color(simox::Color::gray(128,alpha)); box.color(simox::Color::gray(128, alpha));
layerBox.add(box); layerBox.add(box);
} }
} }
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment