Use mju_symmetrize in engine_derivative.c

PiperOrigin-RevId: 519111361
Change-Id: I3125538dee70eebca7e1e9e7830bde7863be956f
This commit is contained in:
Yuval Tassa
2023-03-24 04:38:18 -07:00
committed by Copybara-Service
parent 5bc497cdf7
commit 15ec12b296
+1 -7
View File
@@ -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)) {