diff --git a/src/SdfEntityCreator.cc b/src/SdfEntityCreator.cc index 2c258c1ad8..82751d29b8 100644 --- a/src/SdfEntityCreator.cc +++ b/src/SdfEntityCreator.cc @@ -539,6 +539,19 @@ Entity SdfEntityCreator::CreateEntities(const sdf::Model *_model, this->SetParent(linkEntity, modelEntity); + if (link->AutoInertia()) + { + gzdbg << "Link has auto-inertial enabled: " + << scopedName(linkEntity, *this->dataPtr->ecm, "::", false) << "\n"; + gzdbg << " pose: " << link->Inertial().Pose() << "\n"; + gzdbg << " mass: " << link->Inertial().MassMatrix().Mass() << "\n"; + gzdbg << " ixx iyy izz: " + << link->Inertial().MassMatrix().DiagonalMoments() << "\n"; + gzdbg << " ixy ixz iyz: " + << link->Inertial().MassMatrix().OffDiagonalMoments() + << std::endl; + } + if (canonicalLink == link) { this->dataPtr->ecm->CreateComponent(linkEntity,