Reloading robot model about robot_body_filter

[peci1]

Hi. The field should contain the contents of the URDF file, not the path to it. Give it a try and let me know if it works.

[Patrick-Lascombe]

It works, thanks!
And I had another questions concerning the inner working of the node, and I didn't knew if it was better to open a new issue or to post it here.

When I'm working with cloudpoints2, are the points compared to the actual shapes of the urdf or are they compared to the bounding spheres around these shapes. I dug into the code but didn't find a clear answer to this.

[peci1]

The logic is implemented in

robot_body_filter/src/RayCastingShapeMask.cpp

Line 188 in 25014c2

void RayCastingShapeMask::classifyPointNoLock(const Eigen::Vector3d& data,

.

If you enable shadow filtering, then all points have to be processed. If you only enable containment tests, there can be lots of computations saved.

Each shape, when you construct the model, constructs its bounding sphere. At the time of filtering, the model is "arranged" according to the TFs and all bounding spheres are merged. First, each point is compared to this "big sphere" (which is quite a cheap computation). Only points inside this big sphere are then passed for more detail analysis which decides whether the point lies inside the shape or not. Even in this detailed analysis, the point is first tested for being inside the shape's bounding sphere.