Transfer the collision objects to new constraint solver

+ Fix #127
* Target DART version is 4.0.1