We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 7968005 commit 45b7e80Copy full SHA for 45b7e80
src/RBDyn/ZMP.cpp
@@ -49,7 +49,7 @@ Eigen::Vector3d computeCentroidalZMPComplete(MultiBodyConfig & mbc,
49
denom = mass * g - wr_external.force()(2);
50
zmp(0) = com(0) - ((com(2) - altitude) * comA(0) * (mass * g / denom)) / (comA(2)) + wr_external.couple()(1) / denom
51
+ com(2) * wr_external.force()(0) / denom;
52
- zmp(1) = com(1) - ((com(2) - altitude) * comA(1) * (mass * g / denom)) / (comA(2)) - wr_external.couple()(0) / denom
+ zmp(1) = com(1) - ((com(2) - altitude) * comA(1) * (mass * g / denom)) / (comA(2))-wr_external.couple()(0) / denom
53
+ com(2) * wr_external.force()(1) / denom;
54
zmp(2) = altitude;
55
return zmp;
0 commit comments