From cb6e8556d349b51a820b1068c4755a6056e79861 Mon Sep 17 00:00:00 2001 From: Christophe Geuzaine <cgeuzaine@ulg.ac.be> Date: Wed, 15 Feb 2017 15:28:46 +0000 Subject: [PATCH] fix --- utils/solvers/c++/pend.cpp | 9 ++++----- 1 file changed, 4 insertions(+), 5 deletions(-) diff --git a/utils/solvers/c++/pend.cpp b/utils/solvers/c++/pend.cpp index ea0d866ddb..15ba191302 100644 --- a/utils/solvers/c++/pend.cpp +++ b/utils/solvers/c++/pend.cpp @@ -151,11 +151,10 @@ int main(int argc, char **argv) - g*sin(phi)) ); phi_dot_dot /= ( (m1+m2)*l2 - m2*l2*(cdelta*cdelta) ); - double theta_dot = theta_dot + theta_dot_dot*dt; - double phi_dot = phi_dot + phi_dot_dot*dt; - - theta = theta + theta_dot*dt; - phi = phi + phi_dot*dt; + theta_dot += theta_dot_dot*dt; + phi_dot += phi_dot_dot*dt; + theta += theta_dot*dt; + phi += phi_dot*dt; double x1 = l1*sin(theta); double y1 = -l1*cos(theta); -- GitLab