[hrplib/hrpModel/ForwardDynamicsCBM.cpp] check equation num in solveU…

…nknownAccels
fkanehiro · Jun 20, 2021 · bf8fce0 · bf8fce0
1 parent 5efda83
commit bf8fce0
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/hrplib/hrpModel/ForwardDynamicsCBM.cpp b/hrplib/hrpModel/ForwardDynamicsCBM.cpp
@@ -707,7 +707,10 @@ void ForwardDynamicsMM::solveUnknownAccels(const Vector3& fext, const Vector3& t
         c1 -= d1;
 	c1 -= b1.col(0);
 
-        dvector a(M11.colPivHouseholderQr().solve(c1));
+        dvector a;
+        if(c1.size()!=0) {
+            a = M11.colPivHouseholderQr().solve(c1);
+        }
 
 	if(unknown_rootDof){
 		Link* root = body->rootLink();