File tree 1 file changed +0
-7
lines changed
include/pinocchio/algorithm
1 file changed +0
-7
lines changed Original file line number Diff line number Diff line change @@ -279,9 +279,6 @@ namespace pinocchio
279
279
data.a_gf [i] = jdata.c () + (data.v [i] ^ jdata.v ());
280
280
data.a_gf [i] += jdata.S () * jmodel.jointVelocitySelector (a_r);
281
281
data.a_gf [i] += data.liMi [i].actInv (data.a_gf [parent]);
282
- //
283
- // data.f[i] = model.inertias[i]*data.a_gf[i];// + model.inertias[i].vxiv(data.v[i]);
284
- // // -f_ext data.h[i] = model.inertias[i]*data.v[i];
285
282
286
283
// model.inertias[i].__mult__(data.v_r[i], data.h[i]); // option 1
287
284
data.B [i] = model.inertias [i].variation (Scalar (0.5 ) * data.v [i]);
@@ -291,10 +288,6 @@ namespace pinocchio
291
288
model.inertias [i].__mult__ (data.a_gf [i], data.f [i]);
292
289
// data.f[i] += data.v[i].cross(data.h[i]); // option 1
293
290
data.f [i] += Force (data.B [i] * data.v_r [i].toVector ()); // option 3 (Christoffel-consistent factorization)
294
-
295
- // data.h[i].motionAction(data.v[i],data.f[i]);
296
- // data.f[i] = model.inertias[i].vxiv(data.v[i]);
297
- // data.f[i].setZero();
298
291
}
299
292
300
293
template <typename ForceDerived, typename M6>
You can’t perform that action at this time.
0 commit comments