changed to DynamicsCollisionConstraint
Merge branch 'cuong' of https://github.com/rdiankov/openrave into cuong
fixed jittering