mpc example updated.

This commit is contained in:
Rooholla-KhorramBakht 2025-03-08 02:45:17 +00:00
parent 7ed925c48a
commit d1df87fe26
2 changed files with 1068 additions and 11743 deletions

View File

@ -369,8 +369,8 @@ class Go2Sim:
else:
assert q0.shape == (self.nq,), f'Invalid q0 shape. The shape should be ({self.nq},)'
self.q_nominal = q0
self.data.qpos = self.q_nominal
self.data.qvel = np.zeros(self.nv)
self.data.qpos[:] = self.q_nominal
self.data.qvel[:] = np.zeros(self.nv)
self.ex_sum=0
self.ey_sum=0
self.e_omega_sum=0

File diff suppressed because one or more lines are too long