Planning requests counting collisions between robot links that should be ignored?

asked 2019-07-02 12:43:32 -0500

ssnover gravatar image

I'm using Moveit in ROS Melodic and am currently attempting to have it create a trajectory for a move group. However planning is failing, here's output below:

[ INFO] [1562088292.033876171, 130.937000000]: Planning request received for MoveGroup action. Forwarding to planning pipeline.
[ INFO] [1562088292.037457241, 130.940000000]: Found a contact between 'housing_back' (type 'Robot link') and 'housing_inner' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1562088292.037527012, 130.940000000]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[ INFO] [1562088292.037581084, 130.940000000]: Start state appears to be in collision with respect to group arm
[ WARN] [1562088292.076473969, 130.978000000]: Unable to find a valid state nearby the start state (using jiggle fraction of 0.050000 and 100 sampling attempts). Passing the original planning request to the planner.
[ INFO] [1562088292.079769807, 130.981000000]: Planner configuration 'arm' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed.
[ WARN] [1562088292.080857118, 130.982000000]: RRTConnect: Skipping invalid start state (invalid state)
[ERROR] [1562088292.080920947, 130.982000000]: RRTConnect: Motion planning start tree could not be  initialized!
[ INFO] [1562088292.080951436, 130.982000000]: No solution found after 0.000269 seconds
[ WARN] [1562088292.089499438, 130.991000000]: Goal sampling thread never did any work.
[ INFO] [1562088292.089602649, 130.991000000]: Unable to solve the planning problem

It appears from the output that there is a collision between the two links specified and for this reason the start state is invalid. However, in the SRDF, I have the following line:

<disable_collisions link1="housing_back" link2="housing_inner" reason="Adjacent" />

My understanding is that this line would prevent such a collision from generating an invalid state. Am I misinterpreting the log output or have I disabled collisions between these links incorrectly?

edit retag flag offensive close merge delete