diff --git a/src/sot-dynamic.cpp b/src/sot-dynamic.cpp index c6fc0974f5779b8cee307ae559c8301a5d3feb72..8fa47d5e0882fb2cec01f2d8d6f62ebe0d55414a 100644 --- a/src/sot-dynamic.cpp +++ b/src/sot-dynamic.cpp @@ -576,7 +576,8 @@ void Dynamic::setInertiaMatrix(const std::string& inBodyName, "No body with name " + inBodyName + " has been added."); se3::Model::Index index = m_model.getBodyId(inBodyName); - se3::Symmetric3 symmetricMatrix(inertia3); + Eigen::Matrix3d inertia_3d(inertia3); + se3::Symmetric3 symmetricMatrix(inertia_3d); m_model.inertias[index].inertia() = symmetricMatrix; sotDEBUGOUT(15); }