def getRelDestination(self): relDestination = wrt( self.destination, (0.0, 0.0, 0.0), self.robot_rel) if self.destination != None else (0.0, 0.0, 0.0) return relDestination
def setRelDestination(self, relDestination): self.destination = wrt(relDestination, self.robot_rel, (0.0,0.0,0.0))
def getRelDestination(self): relDestination = wrt(self.destination, (0.0,0.0,0.0), self.robot_rel) if self.destination != None else (0.0,0.0,0.0) return relDestination
def setRelDestination(self, relDestination): self.destination = wrt(relDestination, self.robot_rel, (0.0, 0.0, 0.0))