diff --git a/hrplib/hrpModel/ForwardDynamicsCBM.cpp b/hrplib/hrpModel/ForwardDynamicsCBM.cpp index 80b3428d8..d4639da55 100644 --- a/hrplib/hrpModel/ForwardDynamicsCBM.cpp +++ b/hrplib/hrpModel/ForwardDynamicsCBM.cpp @@ -695,6 +695,8 @@ void ForwardDynamicsMM::solveUnknownAccels(Link* link, const Vector3& fext, cons void ForwardDynamicsMM::solveUnknownAccels(const Vector3& fext, const Vector3& tauext) { + if(isNoUnknownAccelMode){ return ; } + if(unknown_rootDof){ c1.head(3) = fext; c1.segment(3,3) = tauext;