Transfer the collision objects to new constraint solver

+ Fix #127