# # Copyright 2017 Ettus Research (National Instruments) # # This program is free software: you can redistribute it and/or modify # it under the terms of the GNU General Public License as published by # the Free Software Foundation, either version 3 of the License, or # (at your option) any later version. # # This program is distributed in the hope that it will be useful, # but WITHOUT ANY WARRANTY; without even the implied warranty of # MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the # GNU General Public License for more details. # # You should have received a copy of the GNU General Public License # along with this program. If not, see . # """ Code to run the discovery port """ from __future__ import print_function from multiprocessing import Process import socket from six import iteritems from usrp_mpm.mpmtypes import MPM_DISCOVERY_PORT from .mpmlog import get_main_logger RESPONSE_PREAMBLE = "USRP-MPM" RESPONSE_SEP = ";" RESPONSE_CLAIMED_KEY = "claimed" def spawn_discovery_process(device_info, shared_state): """ Returns a process that contains the device discovery. Arguments: device_info -- A dictionary of type string -> string. All of these items will be included in the response string. """ # claim_status = Value(ctypes.c_bool, False) proc = Process(target=_discovery_process, args=(device_info, shared_state)) proc.start() return proc def _discovery_process(device_info, state): """ The actual process for device discovery. Is spawned by spawn_discovery_process(). """ def create_response_string(): " Generate the string that gets sent back to the requester. " return RESPONSE_SEP.join( [RESPONSE_PREAMBLE] + \ ["{k}={v}".format(k=k, v=v) for k, v in iteritems(device_info)] + \ ["{k}={v}".format(k=RESPONSE_CLAIMED_KEY, v=state.claim_status.value)] + \ ["{k}={v}".format(k="token", v=state.claim_token.value)] ) log = get_main_logger().getChild('discovery') sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM) sock.bind((("0.0.0.0", MPM_DISCOVERY_PORT))) send_sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM) # try: while True: data, sender = sock.recvfrom(8000) log.info("Got poked by: %s", sender[0]) if data.strip("\0") == "MPM-DISC": log.info("Sending discovery response to %s port: %d", sender[0], sender[1]) send_data = create_response_string() send_sock.sendto(send_data, sender) elif data.strip("\0").startswith("MPM-ECHO"): log.info("Received echo request from {sender}".format(sender=sender[0])) send_data = data send_sock.sendto(send_data, sender) # except Exception as err: # log.info("Error: %s", err) # log.info("Error type: %s", type(err)) # sock.close() # send_sock.close()