diff --git a/src/engine/engine_derivative.c b/src/engine/engine_derivative.c index 12523e2e..13ef24fd 100644 --- a/src/engine/engine_derivative.c +++ b/src/engine/engine_derivative.c @@ -1209,13 +1209,7 @@ void mjd_ellipsoidFluid(const mjModel* m, mjData* d, int bodyid) { // make B symmetric if integrator is IMPLICITFAST if (m->opt.integrator == mjINT_IMPLICITFAST) { - for (int i=0; i<5; i++) { - for (int k=i+1; k<6; k++) { - mjtNum tmp = 0.5 * (B[6 * i + k] + B[6 * k + i]); - B[6 * i + k] = tmp; - B[6 * k + i] = tmp; - } - } + mju_symmetrize(B, B, 6); } if (mj_isSparse(m)) {