0
$\begingroup$

Rosanswers logo

Hi,

I am on Ubuntu 16.04 LTS and ROS Kinetic. I am now working with the manipulator Robotis Manipulator-H standing on top of a Husky robot and I intend to do path planning with the manipulator using MoveIt! so that I can take in account the restrictions from my environment. I am just simulating my system in Gazebo. Right now I am using the laser Hokuyo UST-10LX integrated with the "occupancy_map_monitor/PointCloudOctoMapUpdater" MoveIt! plugin to map my environment and make MoveIt! aware of it in order to correctly perform path planning to my desired goals poses. In the following image you can see the octomap of the tree that I am mapping right now, after I move Husky in order to map her (the laser is the grey thing, right now I don't really care how it looks):

mappedTree.png

My goal points are already known and some of them are inside the obstacles that I identify (map) with the laser. In order to plan to those poses I am currently updating my AllowedCollisionMatrix with a small cube centered (with millimiter dimentions) in my goal position, making all collisions with that cube possible, which automatically updates my octomap and opens a small gap in it, making it possible for MoveIt! to plan to the goal position because the manipulator has now an open path to the goal pose. In this 2 following images you can see the example that I tried. I set my goal point to be inside the tree's limits (reachable for the manipulator), so naturally the manipulator can't reach it:

goalPointNotR.png

And after I update my AllowedCollisionMatrix, the octomap is automatically updated and it looks like this (the small cube can't be seen because it is really small, smaller than the axes):

goalPointReachable.png

Which means that, in fact, the octomap is being correctly updated and after that I can perform the path planned to that point without any problems, everything is fine till here. The problem is that a few seconds after the "hole" open in the octomap, I get the following error messages:

[ERROR] [1522945517.882926418, 54.358000000]: Internal error. Shape filter handle 22 not found [ERROR] [1522945518.668399924, 54.874000000]: Internal error. Shape filter handle 22 not found

I searched about them and I didn't find anything except the fact that they have something to do with the octomap generated by MoveIt!. Is this a bug that's ocorring because the octomap was "updated" because of the AllowedCollisionMatrix? If you think this is relevant, I can send you the code where I update the collision matrix. If there is a better way to do what I did, I would like you to tell me please.

I think it should also be interesting (and profitable, in my case), if I could regulate the size of the box (hole) that eliminates points from the octomap), because if the box is hole in the octomap is to big, it can eliminate objects that will actually interfere with the path to be executed.

So my questions are:

  1. Is this error something bad and I should worry?
  2. Can I resize the size of the hole (or box or w/e) that is done in the octomap? I mean, can we decide the size and form of the structure that we use to tell MoveIt! that in that stucture there will be no collisions?

Thanks in advance!


Originally posted by znbrito on ROS Answers with karma: 95 on 2018-04-05

Post score: 0


Original comments

Comment by gvdhoorn on 2018-04-05:
Please attach all images directly to your post.

Comment by znbrito on 2018-04-05:
@gvdhoorn just did it. Thanks for letting me upload photos!

$\endgroup$

1 Answer 1

0
$\begingroup$

Rosanswers logo

  1. Is this error something bad and I should worry?

Maybe. Apparently there is an error in the management of ShapeHandles somewhere in the interaction between planning_scene_monitor, point_containment_filter, and pointcloud_octomap_update Feel free to investigate. It might be that this is a cleanup problem that does not notably affect normal operation.

  1. Can I resize the size of the hole (or box or w/e) that is done in the octomap?

Yes. This corresponds to the padding_offset parameter here: http://docs.ros.org/kinetic/api/moveit_tutorials/html/doc/pr2_tutorials/planning/src/doc/perception_configuration.html


Originally posted by v4hn with karma: 2950 on 2018-04-06

This answer was ACCEPTED on the original site

Post score: 0


Original comments

Comment by znbrito on 2018-04-06:
@v4hn the padding_offset worked! I just think it is strange that a parameter from a file where I configure the collision octomap affects an operation where I insert an object that "collides" with the octomap. I was not expecting that this would have anything to do with the allowed collision matrix

Comment by znbrito on 2018-04-06:
As for the ShapeHandle, It doesn't really seem to affect anything else. However, I recorded a video of me simulating my tests for you to see when the error pops up. Should I upload it?

Comment by znbrito on 2018-04-06:
In this video I already altered the padding_offset and also the resolution of my octomap so that the points of the matrix are closer and the objects that I am mapping look more realistic

$\endgroup$

Your Answer

By clicking “Post Your Answer”, you agree to our terms of service and acknowledge you have read our privacy policy.