summaryrefslogtreecommitdiff
path: root/gr-zeromq/python/zeromq/probe_manager.py
blob: 98ee3bb8fb72863abb7fa8ad7f21b89e74d2071a (plain)
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
#
# Copyright 2013 Free Software Foundation, Inc.
#
# This file is part of GNU Radio.
#
# SPDX-License-Identifier: GPL-3.0-or-later
#

import time

import zmq
import numpy


class probe_manager(object):
    def __init__(self):
        self.zmq_context = zmq.Context()
        self.poller = zmq.Poller()
        self.interfaces = []

    def add_socket(self, address, data_type, callback_func):
        socket = self.zmq_context.socket(zmq.SUB)
        socket.setsockopt(zmq.SUBSCRIBE, b"")
        # Do not wait more than 5 seconds for a message
        socket.setsockopt(zmq.RCVTIMEO, 100)
        socket.connect(address)
        # use a tuple to store interface elements
        self.interfaces.append((socket, data_type, callback_func))
        self.poller.register(socket, zmq.POLLIN)
        # Give it time for the socket to be ready
        time.sleep(0.5)

    def watcher(self):
        poll = dict(self.poller.poll(1000))
        for i in self.interfaces:
            # i = (socket, data_type, callback_func)
            if poll.get(i[0]) == zmq.POLLIN:
                # receive data
                msg_packed = i[0].recv()
                # use numpy to unpack the data
                msg_unpacked = numpy.frombuffer(msg_packed, numpy.dtype(i[1]))
                # invoke callback function
                i[2](msg_unpacked)