From c1df68e0a208688524013f17afd5dbf9b5b9821a Mon Sep 17 00:00:00 2001
From: Ale <alessandroassirell98@gmail.com>
Date: Wed, 27 Jul 2022 12:37:30 +0200
Subject: [PATCH] 1KHz mpc (reduced model) Open loop EndEff reach point Only
impedance
---
python/quadruped_reactive_walking/Controller.py | 10 +++++-----
1 file changed, 5 insertions(+), 5 deletions(-)
diff --git a/python/quadruped_reactive_walking/Controller.py b/python/quadruped_reactive_walking/Controller.py
index 1d1d16a1..e07c02c0 100644
--- a/python/quadruped_reactive_walking/Controller.py
+++ b/python/quadruped_reactive_walking/Controller.py
@@ -96,13 +96,13 @@ class Controller:
self.point_target = self.target.evaluate_in_t(1)[self.pd.rfFootId]
try:
- self.mpc.solve(self.k, m["x_m"], self.guess) # Closed loop mpc
+ #self.mpc.solve(self.k, m["x_m"], self.guess) # Closed loop mpc
## Trajectory tracking
- #if self.initialized:
- # self.mpc.solve(self.k, self.mpc_result.x[1], self.guess)
- #else:
- # self.mpc.solve(self.k, m["x_m"], self.guess)
+ if self.initialized:
+ self.mpc.solve(self.k, self.mpc_result.x[1], self.guess)
+ else:
+ self.mpc.solve(self.k, m["x_m"], self.guess)
### ONLY IF YOU WANT TO STORE THE FIRST SOLUTION TO WARMSTART THE INITIAL Problem ###
#if not self.initialized:
--
GitLab