Merge branch 'release-4.0'
Merge branch 'origin/release-4.0'
Transfer the collision objects to new constraint solver
Merge pull request #195 from dartsim/collision_detector

Transfer the collision objects to new constraint solver