AABB optimization
computing the mass used for solve once and not in the iteration loop