def publishSystemStatus(text): msg = lcmbotcore.system_status_t() msg.utime = getUtime() msg.system = 5 msg.importance = 0 msg.frequency = 0 msg.value = text lcmWrapper.publish("SYSTEM_STATUS", msg)
def publishSystemStatus(text): msg = lcmbotcore.system_status_t() msg.utime = getUtime() msg.system = 5 msg.importance = 0 msg.frequency = 0 msg.value = text lcmWrapper.publish('SYSTEM_STATUS', msg)
def _newCommandMessage(self, commandName, **commandArgs): commandId = newUUID() self.sentCommands.add(commandId) commandArgs['commandId'] = commandId commandArgs['collectionId'] = self.collectionId commandArgs['command'] = commandName msg = lcmbotcore.system_status_t() msg.value = numpyjsoncoder.encode(commandArgs) msg.utime = getUtime() return msg
def publishSystemStatus(side, lcm, status): global connectPublished global activePublished if connectPublished and activePublished: return msg = bot_core.system_status_t() msg.utime = (time() * 1000000) msg.system = 4 #provided as the system level for grippers msg.importance = 0 msg.frequency = 0 if connectPublished: if status and status.activated == 1: msg.value = side.upper() + " ROBOTIQ HAND ACTIVE: Receiving status and active" lcm.publish("SYSTEM_STATUS", msg.encode()) activePublished = True else: if status: msg.value = side.upper() + " ROBOTIQ HAND ALIVE: Receiving status messages" lcm.publish("SYSTEM_STATUS", msg.encode()) connectPublished = True