Skip to content

Commit

Permalink
Merge ign-physics5 ➡️ main (#398)
Browse files Browse the repository at this point in the history
Signed-off-by: Louise Poubel <louise@openrobotics.org>
  • Loading branch information
chapulina authored Aug 1, 2022
2 parents 791296b + 030012e commit 58b3df4
Show file tree
Hide file tree
Showing 2 changed files with 2 additions and 9 deletions.
1 change: 1 addition & 0 deletions coverage.ignore.in
Original file line number Diff line number Diff line change
@@ -0,0 +1 @@
tpe/lib/src/aabb_tree/*
10 changes: 1 addition & 9 deletions dartsim/src/SDFFeatures.cc
Original file line number Diff line number Diff line change
Expand Up @@ -591,15 +591,7 @@ Identity SDFFeatures::ConstructSdfLink(
const gz::math::Inertiald &sdfInertia = _sdfLink.Inertial();
bodyProperties.mInertia.setMass(sdfInertia.MassMatrix().Mass());

// TODO(addisu) Resolve the pose of inertials when frame information is
// availabile for gz::math::Inertial
const Eigen::Matrix3d R_inertial{
math::eigen3::convert(sdfInertia.Pose().Rot())};

const Eigen::Matrix3d I_link =
R_inertial
* math::eigen3::convert(sdfInertia.Moi())
* R_inertial.inverse();
const Eigen::Matrix3d I_link = math::eigen3::convert(sdfInertia.Moi());

bodyProperties.mInertia.setMoment(I_link);

Expand Down

0 comments on commit 58b3df4

Please sign in to comment.