Ask Your Question

Allow contacts for motion planning

asked 2012-06-21 15:06:01 -0600

updated 2012-06-22 13:16:47 -0600

In the MoveArmGoal message, the planning diff field allow for the specification of contacts. I tried adding a box to allow a gripper to hit an obstacle. However when I specify all the links of the PR2 gripper (there's several!) all the nodes that use the planning scene complain that:

Allowed collision specification has link_names size 5 while the only supported size is 2

If I use only two links (in this case "r_wrist_flex_link" and "r_wrist_roll_link"), IK returns with error -33 (I bet it's a collision check failing).

Are there examples on using allowed contact specifications in an arm navigation setting that I can have a look at? Is this feature being used?

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2012-06-22 00:33:14 -0600

dornhege gravatar image

My guess would be that the semantics is: allowed contacts between a link-pair. In that case you would have to input all pairs, but I've never used that.

The errors are defined in ArmNavigationErrorCodes: int32 IK_LINK_IN_COLLISION=-33

edit flag offensive delete link more


Hi Christian, I knew you'd be around for an answer! As far as I understand these contacts are between a link and something else, like an object. Anyway I've read the collision_space node code, and found no reference to the allowed contacts part of the message!.So my question still holds

Lorenzo Riano gravatar image Lorenzo Riano  ( 2012-06-22 12:56:08 -0600 )edit

I've digged around and you can find the code (I think) in planning_environment, model_utils.cpp. They are assigning body_name_1 and ..._2, so they can only be used pairwise.

dornhege gravatar image dornhege  ( 2012-06-25 03:15:46 -0600 )edit

I've looked at the collision_space package. The code for collision checking seems to be there. However I couldn't find how to tell the overall collision checking system to ignore some areas of the collision map! Any suggestion?

Lorenzo Riano gravatar image Lorenzo Riano  ( 2012-06-25 08:53:38 -0600 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

1 follower


Asked: 2012-06-21 15:06:01 -0600

Seen: 135 times

Last updated: Jun 22 '12