File tree Expand file tree Collapse file tree 1 file changed +0
-7
lines changed
include/pinocchio/algorithm Expand file tree Collapse file tree 1 file changed +0
-7
lines changed Original file line number Diff line number Diff line change @@ -279,9 +279,6 @@ namespace pinocchio
279279 data.a_gf [i] = jdata.c () + (data.v [i] ^ jdata.v ());
280280 data.a_gf [i] += jdata.S () * jmodel.jointVelocitySelector (a_r);
281281 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];
285282
286283 // model.inertias[i].__mult__(data.v_r[i], data.h[i]); // option 1
287284 data.B [i] = model.inertias [i].variation (Scalar (0.5 ) * data.v [i]);
@@ -291,10 +288,6 @@ namespace pinocchio
291288 model.inertias [i].__mult__ (data.a_gf [i], data.f [i]);
292289 // data.f[i] += data.v[i].cross(data.h[i]); // option 1
293290 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();
298291 }
299292
300293 template <typename ForceDerived, typename M6>
You can’t perform that action at this time.
0 commit comments