def acceleration(self,q,v,a,index, update_acceleration = True): if update_acceleration: se3.dynamics(self.model,self.data,q,v,a) return self.data.a[index]
def dynamics(self,q,v,a): se3.dynamics(self.model, self.data, q, v, a)