diff --git a/src/static_equilibrium.cpp b/src/static_equilibrium.cpp index cd4f0ca92d6d4c59ef5f42a9b0577161db56f962..35d6b40b559055ebf470eda72c82398bc295d859 100644 --- a/src/static_equilibrium.cpp +++ b/src/static_equilibrium.cpp @@ -99,7 +99,7 @@ bool StaticEquilibrium::setNewContacts(Cref_matrixX3 contactPoints, Cref_matrixX A.bottomRows<3>() = crossMatrix(-1.0*contactPoints.row(i).transpose()); // compute generators - theta = 0.0; + theta = acos(1/sqrt(2)); for(int j=0; j<cg; j++) { G.col(j) = frictionCoefficient*sin(theta)*T1