diff --git a/src/engine/engine_derivative_fd.c b/src/engine/engine_derivative_fd.c index d1ab7d83..e53736a0 100644 --- a/src/engine/engine_derivative_fd.c +++ b/src/engine/engine_derivative_fd.c @@ -122,7 +122,7 @@ static void clampedStateDiff(const mjModel* m, mjtNum* ds, const mjtNum* s, cons stateDiff(m, ds, s_minus, s_plus, 2*h); } else { // differencing failed, write zeros - mju_zero(ds, m->nq + m->nv + m->na); + mju_zero(ds, 2*m->nv + m->na); } }