diff --git a/crocoddyl/floating_contact.py b/crocoddyl/floating_contact.py index 4cbf4120e45699db3f1cc344cbe5e019ee7f22a5..43ce0edccbbd45ae2f66174a049ba56b01f5e5ac 100644 --- a/crocoddyl/floating_contact.py +++ b/crocoddyl/floating_contact.py @@ -107,9 +107,11 @@ class DifferentialActionModelFloatingInContact(DifferentialActionModelAbstract): return data.xout,data.cost def quasiStatic(self,data,x): - nu,nq,nv = self.nx,self.nu,self.nq,self.nv - if len(x)==nq: x = np.concatenate([x,np.zero(nv)]) - else: x[nq:] = 0 + nu,nq,nv = self.nu,self.nq,self.nv + if len(x)==nq: + x = np.concatenate([x,np.zero(nv)]) + else: + x[nq:] = 0 self.calcDiff(data,x,np.zeros(nu)) return np.dot( np.linalg.pinv(np.hstack([data.actuation.Au,data.contact.J.T])),