diff --git a/python/quadruped_reactive_walking/Controller.py b/python/quadruped_reactive_walking/Controller.py index b0b45f2e6cfc8ebbfbd8585935a4227d902c7406..f0b0725c83cfa84dca5d55fd5940d4b1e1c45c68 100644 --- a/python/quadruped_reactive_walking/Controller.py +++ b/python/quadruped_reactive_walking/Controller.py @@ -108,9 +108,9 @@ class Controller: self.mpc_result, self.mpc_cost = self.mpc.get_latest_result() #self.result.P = np.array(self.params.Kp_main.tolist() * 4) - self.result.P = np.array([5] * 3 + [3] * 3 + [5]*6) + self.result.P = np.array([5] * 3 + [0] * 3 + [5]*6) #self.result.D = np.array(self.params.Kd_main.tolist() * 4) - self.result.D = np.array([0.3] * 3 + [0.5] * 3 + [0.3]*6) + self.result.D = np.array([0.3] * 3 + [0] * 3 + [0.3]*6) tauFF = self.mpc_result.u[0] + np.dot(self.mpc_result.K[0], self.mpc.ocp.state.diff(m["x_m"], self.mpc_result.x[0])) self.result.FF = self.params.Kff_main * np.array([0] * 3 + list(tauFF) + [0]*6)