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

boundingBoxOrientaiton: optiona

parent af55f711
No related branches found
No related tags found
No related merge requests found
Pipeline #21255 failed
......@@ -53,7 +53,7 @@ Core segment type of Object/Instance.
<!-- Orientation of the bounding box in the 'sens' frame -->
<ObjectChild key="boundingBoxOrientation">
<Orientation />
<FramedOrientation optional="true" />
</ObjectChild>
<!-- bounding box in local sensFrame (see poseSensFrame) -->
......
......@@ -91,7 +91,11 @@ namespace armarx::armem::server::obj::familiar_object_instance
const Eigen::Isometry3f global_T_obj{familiarObject.poseGlobal->pose};
Eigen::Isometry3f obj_T_bb = Eigen::Isometry3f::Identity();
obj_T_bb.translation() = familiarObject.bounding_box.center;
obj_T_bb.linear() = familiarObject.boundingBoxOrientation.toRotationMatrix();
if(familiarObject.boundingBoxOrientation.has_value())
{
obj_T_bb.linear() = familiarObject.boundingBoxOrientation->orientation.toRotationMatrix();
}
const Eigen::Isometry3f global_T_bb = global_T_obj * obj_T_bb;
......
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