added DynamicsCollisionConstraint constraint function and propagated this type of usage across all the planners