final Matrix3 Bi = MiInv.multiply(Ji.transpose());
final Matrix3 Bangi = b1.state.inverseinertia.multiply(Jangi.transpose());
if (b1.isFixed()) {
Bi.assign(new Matrix3());
Bangi.assign(new Matrix3());
}
// final Matrix3 MjInv = Matrix3.identity().multiply(1/b2.state.mass);
final Matrix3 MjInv = b2.state.inverseanisotropicmass;
final Matrix3 Bj = MjInv.multiply(Jj.transpose());