Use ConstraintDynamics in World
Some speed improvements in ConstraintDynamics