import json import logging from spade.agent import Agent from spade.behaviour import CyclicBehaviour import zmq from control_backend.core.config import settings from control_backend.core.zmq_context import context from control_backend.schemas.message import Message logger = logging.getLogger(__name__) class RICommandAgent(Agent): subsocket: zmq.Socket pubsocket: zmq.Socket address = "" bind = False def __init__(self, jid: str, password: str, port: int = 5222, verify_security: bool = False, address = "tcp://localhost:0000", bind = False): super().__init__(jid, password, port, verify_security) self.address = address self.bind = bind class SendCommandsBehaviour(CyclicBehaviour): async def run(self): assert self.agent is not None # Get a message internally (with topic command) topic, body = await self.agent.subsocket.recv_multipart() # Try to get body try: message_json = json.loads(body.decode("utf-8")) message = Message.model_validate(message_json) logger.info("Received message \"%s\"", message.message) # Send to the robot. await self.agent.pubsocket.send_json(message) except Exception as e: logger.error("Error processing message: %s", e) async def setup(self): logger.info("Setting up %s", self.jid) # To the robot self.pubsocket = context.socket(zmq.PUB) if self.bind: self.pubsocket.bind(self.address) else : self.pubsocket.connect(self.address) # Receive internal topics regarding commands self.subsocket = context.socket(zmq.SUB) self.subsocket.connect(settings.zmq_settings.internal_comm_address) self.subsocket.setsockopt(zmq.SUBSCRIBE, b"command") # Add behaviour to our agent commands_behaviour = self.SendCommandsBehaviour() self.add_behaviour(commands_behaviour) logger.info("Finished setting up %s", self.jid)