Ask Your Question

Revision history [back]

Assuming that the "planning_scene" object has been updated to reflect the current state of the environment then you can use the checkCollision method, by setting the CollisionRequest.distance = true. The returned CollisionResult struct contains a map with the objects that collided and the shortest distance. Alternatively, you can use the distanceToCollision method.