ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
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.