Skip to content

Commit

Permalink
algo/rnea: remove useless lines in pasitivity RNEA
Browse files Browse the repository at this point in the history
  • Loading branch information
jcarpent authored Sep 18, 2024
1 parent 4287f6c commit 9c70ecc
Showing 1 changed file with 0 additions and 7 deletions.
7 changes: 0 additions & 7 deletions include/pinocchio/algorithm/rnea.hxx
Original file line number Diff line number Diff line change
Expand Up @@ -279,9 +279,6 @@ namespace pinocchio
data.a_gf[i] = jdata.c() + (data.v[i] ^ jdata.v());
data.a_gf[i] += jdata.S() * jmodel.jointVelocitySelector(a_r);
data.a_gf[i] += data.liMi[i].actInv(data.a_gf[parent]);
//
// data.f[i] = model.inertias[i]*data.a_gf[i];// + model.inertias[i].vxiv(data.v[i]);
// // -f_ext data.h[i] = model.inertias[i]*data.v[i];

// model.inertias[i].__mult__(data.v_r[i], data.h[i]); // option 1
data.B[i] = model.inertias[i].variation(Scalar(0.5) * data.v[i]);
Expand All @@ -291,10 +288,6 @@ namespace pinocchio
model.inertias[i].__mult__(data.a_gf[i], data.f[i]);
// data.f[i] += data.v[i].cross(data.h[i]); // option 1
data.f[i] += Force(data.B[i] * data.v_r[i].toVector()); // option 3 (Christoffel-consistent factorization)

// data.h[i].motionAction(data.v[i],data.f[i]);
// data.f[i] = model.inertias[i].vxiv(data.v[i]);
// data.f[i].setZero();
}

template<typename ForceDerived, typename M6>
Expand Down

0 comments on commit 9c70ecc

Please sign in to comment.