Skip to content

Commit

Permalink
[algo/jacobian] Fix rebasing
Browse files Browse the repository at this point in the history
  • Loading branch information
Megane Millan committed Nov 18, 2024
1 parent 9993fcb commit 3f25772
Showing 1 changed file with 2 additions and 26 deletions.
28 changes: 2 additions & 26 deletions include/pinocchio/algorithm/jacobian.hxx
Original file line number Diff line number Diff line change
@@ -1,3 +1,4 @@

//
// Copyright (c) 2015-2024 CNRS INRIA
//
Expand Down Expand Up @@ -56,17 +57,8 @@ namespace pinocchio
else
data.oMi[i] = data.liMi[i];

<<<<<<< HEAD
Matrix6xLike & J_ = J.const_cast_derived();
jmodel.jointCols(J_) = data.oMi[i].act(jdata.S());
=======
Matrix6xLike & J_ = PINOCCHIO_EIGEN_CONST_CAST(Matrix6xLike, J);
<<<<<<< HEAD
jmodel.jointVelCols(J_) = data.oMi[i].act(jdata.S());
>>>>>>> a55d3bf7 ([EtienneAr feedback] Split jointCols jointRows and jointBLock for full and reduced system)
=======
jmodel.jointJacCols(J_) = data.oMi[i].act(jdata.S());
>>>>>>> 6b22ea5e ([EtienneAr feedback] Fix joint jacobians computation for mimic)
}
};

Expand Down Expand Up @@ -198,16 +190,9 @@ namespace pinocchio
PINOCCHIO_CHECK_ARGUMENT_SIZE(Jout.rows(), 6);
PINOCCHIO_CHECK_ARGUMENT_SIZE(Jout.cols(), model.nv);

<<<<<<< HEAD
Matrix6xLikeOut & Jout_ = Jout.const_cast_derived();
=======

Matrix6xLikeOut & Jout_ = PINOCCHIO_EIGEN_CONST_CAST(Matrix6xLikeOut, Jout);
<<<<<<< HEAD
Jout_.fill(0);
>>>>>>> 6b22ea5e ([EtienneAr feedback] Fix joint jacobians computation for mimic)
=======
Jout_.setZero();
>>>>>>> 4cc92137 (Make code compile with CppAd)

typedef typename ModelTpl<Scalar, Options, JointCollectionTpl>::JointIndex JointIndex;
typedef typename Matrix6xLikeIn::ConstColXpr ConstColXprIn;
Expand Down Expand Up @@ -354,17 +339,8 @@ namespace pinocchio
data.liMi[i] = model.jointPlacements[i] * jdata.M();
data.iMf[parent] = data.liMi[i] * data.iMf[i];

<<<<<<< HEAD
Matrix6xLike & J_ = J.const_cast_derived();
jmodel.jointCols(J_) = data.iMf[i].actInv(jdata.S());
=======
Matrix6xLike & J_ = PINOCCHIO_EIGEN_CONST_CAST(Matrix6xLike, J);
<<<<<<< HEAD
jmodel.jointVelCols(J_) = data.iMf[i].actInv(jdata.S());
>>>>>>> a55d3bf7 ([EtienneAr feedback] Split jointCols jointRows and jointBLock for full and reduced system)
=======
jmodel.jointVelCols(J_) += data.iMf[i].actInv(jdata.S());
>>>>>>> 6b22ea5e ([EtienneAr feedback] Fix joint jacobians computation for mimic)
}
};

Expand Down

0 comments on commit 3f25772

Please sign in to comment.