Min distance constraint

Adds `MinDistanceConstraint`, a sub-class of `RigidBodyConstraint` that ensures that the minimum distance between any pair of eligible collision geometries is greater than some threshold.