1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
|
#
# 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 <http://www.gnu.org/licenses/>.
#
"""
Code to run the discovery port
"""
from __future__ import print_function
from multiprocessing import Process
import socket
from builtins import bytes
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)]
)
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(b"\0") == b"MPM-DISC":
log.info("Sending discovery response to %s port: %d",
sender[0], sender[1])
send_data = bytes(create_response_string(), 'ascii')
log.info(send_data)
send_sock.sendto(send_data, sender)
elif data.strip(b"\0").startswith(b"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()
|
