Allow >0 collision safety margin for check robot vs task
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.
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.