fix testlaikago and pd_controller_stable

This commit is contained in:
bla committed 2019-06-06 21:54:22 +00:00
1 parent 093986f1ee
commit 6ab09fe06e
2 files changed
+12 -7

No files matched your search

@@ -227,6 +227,6 @@ class PDControllerStable(object):
qddot = np.linalg.solve(A, b)
tau = p + d - Kd.dot(qddot) * timeStep
maxF = np.array(maxForces)
forces = np.clip(tau, -maxF, maxF)
tau = np.clip(tau, -maxF, maxF)
#print("c=",c)
return tau