diff --git a/src/sot-dynamic-pinocchio.cpp b/src/sot-dynamic-pinocchio.cpp index 51cb88dbca2b2284b20e42fa0b717de79c4d653c..77d436888f3937a632ccf806e63e72137350783d 100644 --- a/src/sot-dynamic-pinocchio.cpp +++ b/src/sot-dynamic-pinocchio.cpp @@ -870,9 +870,9 @@ computeCom( dg::Vector& com,const int& time ) { sotDEBUGIN(25); - const Eigen::VectorXd& q = pinocchioPosSINTERN.access(time); forwardKinematicsSINTERN(time); - com = se3::centerOfMass(*m_model,*m_data,q,false,false); + se3::centerOfMass(*m_model,*m_data,false); + com = m_data->com[0]; sotDEBUGOUT(25); return com; }