BUG: Debugging collision
Fixes the issue with the collision between capsules and surface meshes. Also, the haptic grasping example is updated to be more medically relevant, and the visual test for SurfaceMeshToCapsuleCD was modified to catch more cases.