add distance constraints, add collision MassScale, but has iusses in motion constraints