Ask Your Question

Revision history [back]

click to hide/show revision 1
initial version

checkSelfCollision function checks if the links of the given joint group are in collision. Try to use checkCollision instead, or isStateColliding

Make sure that you update the planning scene with the collision object and that the AllowedCollisionMatrix of the planning scene that you use for collision checking is correctly updated.

In the first part of your code the planning scene update commands are missing.