def mass(self,q): return se3.crba(self.model,self.data,q)
def mass(self, q): return se3.crba(self.model, self.data, q)