Allow >0 collision safety margin for check robot vs task

Matthias Mayer requested to merge dev/collision_security_margin into main

Add an option to increase minimum spacing between robot and task obstacles to increase margin for later steps, such as motion planning, that only verify collisions at discrete points.

Merge request reports