From 38a4e6b659b1bf88405003fbc4fce9fb91f9c43e Mon Sep 17 00:00:00 2001
From: Ale <alessandroassirell98@gmail.com>
Date: Fri, 22 Jul 2022 15:58:16 +0200
Subject: [PATCH] 1KHz mpc (reduced model) Closed loop Still target Impedance +
FeedForward
---
python/quadruped_reactive_walking/Controller.py | 4 ++--
1 file changed, 2 insertions(+), 2 deletions(-)
diff --git a/python/quadruped_reactive_walking/Controller.py b/python/quadruped_reactive_walking/Controller.py
index 0b624794..680a689a 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 + [0] * 3 + [5]*6)
+ self.result.P = np.array([5] * 3 + [3] * 3 + [5]*6)
#self.result.D = np.array(self.params.Kd_main.tolist() * 4)
- self.result.D = np.array([0.3] * 3 + [0] * 3 + [0.3]*6)
+ self.result.D = np.array([0.3] * 3 + [0.5] * 3 + [0.3]*6)
tauFF = self.mpc_result.u[0]
self.result.FF = self.params.Kff_main * np.array([0] * 3 + list(tauFF) + [0]*6)
--
GitLab