jroutils_publish.py
378 lines
| 12.5 KiB
| text/x-python
|
PythonLexer
Juan C. Valdez
|
r859 | ''' | ||
| @author: Juan C. Espinoza | ||||
| ''' | ||||
| import time | ||||
| import json | ||||
| import numpy | ||||
| import paho.mqtt.client as mqtt | ||||
|
Juan C. Valdez
|
r883 | import zmq | ||
| import cPickle as pickle | ||||
| import datetime | ||||
| from zmq.utils.monitor import recv_monitor_message | ||||
| from functools import wraps | ||||
| from threading import Thread | ||||
| from multiprocessing import Process | ||||
|
Juan C. Valdez
|
r859 | |||
|
Juan C. Valdez
|
r883 | from schainpy.model.proc.jroproc_base import Operation, ProcessingUnit | ||
| r889 | MAXNUMX = 100 | |||
| MAXNUMY = 100 | ||||
|
Juan C. Valdez
|
r886 | throttle_value = 5 | ||
|
Juan C. Valdez
|
r859 | |||
| class PrettyFloat(float): | ||||
| def __repr__(self): | ||||
| return '%.2f' % self | ||||
|
Juan C. Valdez
|
r863 | def roundFloats(obj): | ||
| if isinstance(obj, list): | ||||
| return map(roundFloats, obj) | ||||
| elif isinstance(obj, float): | ||||
| return round(obj, 2) | ||||
|
Juan C. Valdez
|
r860 | |||
|
Juan C. Valdez
|
r859 | |||
|
Juan C. Valdez
|
r883 | class throttle(object): | ||
| """Decorator that prevents a function from being called more than once every | ||||
| time period. | ||||
| To create a function that cannot be called more than once a minute, but | ||||
| will sleep until it can be called: | ||||
| @throttle(minutes=1) | ||||
| def foo(): | ||||
| pass | ||||
| for i in range(10): | ||||
| foo() | ||||
| print "This function has run %s times." % i | ||||
| """ | ||||
| def __init__(self, seconds=0, minutes=0, hours=0): | ||||
| self.throttle_period = datetime.timedelta( | ||||
| seconds=seconds, minutes=minutes, hours=hours | ||||
| ) | ||||
| self.time_of_last_call = datetime.datetime.min | ||||
| def __call__(self, fn): | ||||
| @wraps(fn) | ||||
| def wrapper(*args, **kwargs): | ||||
| now = datetime.datetime.now() | ||||
| time_since_last_call = now - self.time_of_last_call | ||||
| time_left = self.throttle_period - time_since_last_call | ||||
| if time_left > datetime.timedelta(seconds=0): | ||||
| return | ||||
| self.time_of_last_call = datetime.datetime.now() | ||||
| return fn(*args, **kwargs) | ||||
| return wrapper | ||||
|
Juan C. Valdez
|
r860 | |||
|
Juan C. Valdez
|
r859 | class PublishData(Operation): | ||
|
Juan C. Valdez
|
r860 | """Clase publish.""" | ||
|
Juan C. Valdez
|
r883 | def __init__(self, **kwargs): | ||
|
Juan C. Valdez
|
r860 | """Inicio.""" | ||
|
Juan C. Valdez
|
r883 | Operation.__init__(self, **kwargs) | ||
|
Juan C. Valdez
|
r859 | self.isConfig = False | ||
|
Juan C. Valdez
|
r860 | self.client = None | ||
|
Juan C. Valdez
|
r883 | self.zeromq = None | ||
| self.mqtt = None | ||||
|
Juan C. Valdez
|
r860 | |||
| def on_disconnect(self, client, userdata, rc): | ||||
|
Juan C. Valdez
|
r859 | if rc != 0: | ||
|
Juan C. Valdez
|
r860 | print("Unexpected disconnection.") | ||
| self.connect() | ||||
| def connect(self): | ||||
| print 'trying to connect' | ||||
|
Juan C. Valdez
|
r859 | try: | ||
|
Juan C. Valdez
|
r860 | self.client.connect( | ||
| host=self.host, | ||||
| port=self.port, | ||||
| keepalive=60*10, | ||||
| bind_address='') | ||||
| print "connected" | ||||
| self.client.loop_start() | ||||
| # self.client.publish( | ||||
| # self.topic + 'SETUP', | ||||
| # json.dumps(setup), | ||||
| # retain=True | ||||
| # ) | ||||
|
Juan C. Valdez
|
r859 | except: | ||
|
Juan C. Valdez
|
r860 | print "MQTT Conection error." | ||
|
Juan C. Valdez
|
r859 | self.client = False | ||
|
Juan C. Valdez
|
r860 | |||
|
Juan C. Valdez
|
r883 | def setup(self, port=1883, username=None, password=None, clientId="user", zeromq=1, **kwargs): | ||
| self.counter = 0 | ||||
|
Juan C. Valdez
|
r859 | self.topic = kwargs.get('topic', 'schain') | ||
| self.delay = kwargs.get('delay', 0) | ||||
|
Juan C. Valdez
|
r860 | self.plottype = kwargs.get('plottype', 'spectra') | ||
|
Juan C. Valdez
|
r883 | self.host = kwargs.get('host', "10.10.10.82") | ||
| self.port = kwargs.get('port', 3000) | ||||
|
Juan C. Valdez
|
r863 | self.clientId = clientId | ||
|
Juan C. Valdez
|
r859 | self.cnt = 0 | ||
|
Juan C. Valdez
|
r883 | self.zeromq = zeromq | ||
| self.mqtt = kwargs.get('plottype', 0) | ||||
| self.client = None | ||||
|
Juan C. Valdez
|
r860 | setup = [] | ||
|
Juan C. Valdez
|
r883 | if mqtt is 1: | ||
| print 'mqqt es 1' | ||||
| self.client = mqtt.Client( | ||||
| client_id=self.clientId + self.topic + 'SCHAIN', | ||||
| clean_session=True) | ||||
| self.client.on_disconnect = self.on_disconnect | ||||
| self.connect() | ||||
| for plot in self.plottype: | ||||
| setup.append({ | ||||
| 'plot': plot, | ||||
| 'topic': self.topic + plot, | ||||
| 'title': getattr(self, plot + '_' + 'title', False), | ||||
| 'xlabel': getattr(self, plot + '_' + 'xlabel', False), | ||||
| 'ylabel': getattr(self, plot + '_' + 'ylabel', False), | ||||
| 'xrange': getattr(self, plot + '_' + 'xrange', False), | ||||
| 'yrange': getattr(self, plot + '_' + 'yrange', False), | ||||
| 'zrange': getattr(self, plot + '_' + 'zrange', False), | ||||
| }) | ||||
| if zeromq is 1: | ||||
| context = zmq.Context() | ||||
| self.zmq_socket = context.socket(zmq.PUSH) | ||||
| server = kwargs.get('server', 'zmq.pipe') | ||||
| r889 | ||||
|
Juan C. Valdez
|
r886 | if 'tcp://' in server: | ||
|
Juan C. Valdez
|
r883 | address = server | ||
| else: | ||||
| address = 'ipc:///tmp/%s' % server | ||||
| r889 | ||||
|
Juan C. Valdez
|
r883 | self.zmq_socket.connect(address) | ||
| time.sleep(1) | ||||
| print 'zeromq configured' | ||||
| def publish_data(self): | ||||
| self.dataOut.finished = False | ||||
| if self.mqtt is 1: | ||||
| yData = self.dataOut.heightList[:2].tolist() | ||||
| if self.plottype == 'spectra': | ||||
| data = getattr(self.dataOut, 'data_spc') | ||||
| z = data/self.dataOut.normFactor | ||||
| zdB = 10*numpy.log10(z) | ||||
| xlen, ylen = zdB[0].shape | ||||
| r889 | dx = int(xlen/MAXNUMX) + 1 | |||
| dy = int(ylen/MAXNUMY) + 1 | ||||
|
Juan C. Valdez
|
r883 | Z = [0 for i in self.dataOut.channelList] | ||
| for i in self.dataOut.channelList: | ||||
| Z[i] = zdB[i][::dx, ::dy].tolist() | ||||
| payload = { | ||||
| 'timestamp': self.dataOut.utctime, | ||||
| 'data': roundFloats(Z), | ||||
| 'channels': ['Ch %s' % ch for ch in self.dataOut.channelList], | ||||
| 'interval': self.dataOut.getTimeInterval(), | ||||
| 'type': self.plottype, | ||||
| 'yData': yData | ||||
| } | ||||
| # print payload | ||||
|
Juan C. Valdez
|
r860 | |||
|
Juan C. Valdez
|
r883 | elif self.plottype in ('rti', 'power'): | ||
| data = getattr(self.dataOut, 'data_spc') | ||||
| z = data/self.dataOut.normFactor | ||||
| avg = numpy.average(z, axis=1) | ||||
| avgdB = 10*numpy.log10(avg) | ||||
| xlen, ylen = z[0].shape | ||||
| dy = numpy.floor(ylen/self.__MAXNUMY) + 1 | ||||
| AVG = [0 for i in self.dataOut.channelList] | ||||
| for i in self.dataOut.channelList: | ||||
| AVG[i] = avgdB[i][::dy].tolist() | ||||
| payload = { | ||||
| 'timestamp': self.dataOut.utctime, | ||||
| 'data': roundFloats(AVG), | ||||
| 'channels': ['Ch %s' % ch for ch in self.dataOut.channelList], | ||||
| 'interval': self.dataOut.getTimeInterval(), | ||||
| 'type': self.plottype, | ||||
| 'yData': yData | ||||
| } | ||||
| elif self.plottype == 'noise': | ||||
| noise = self.dataOut.getNoise()/self.dataOut.normFactor | ||||
| noisedB = 10*numpy.log10(noise) | ||||
| payload = { | ||||
| 'timestamp': self.dataOut.utctime, | ||||
| 'data': roundFloats(noisedB.reshape(-1, 1).tolist()), | ||||
| 'channels': ['Ch %s' % ch for ch in self.dataOut.channelList], | ||||
| 'interval': self.dataOut.getTimeInterval(), | ||||
| 'type': self.plottype, | ||||
| 'yData': yData | ||||
| } | ||||
| elif self.plottype == 'snr': | ||||
| data = getattr(self.dataOut, 'data_SNR') | ||||
| avgdB = 10*numpy.log10(data) | ||||
| ylen = data[0].size | ||||
| dy = numpy.floor(ylen/self.__MAXNUMY) + 1 | ||||
| AVG = [0 for i in self.dataOut.channelList] | ||||
| for i in self.dataOut.channelList: | ||||
| AVG[i] = avgdB[i][::dy].tolist() | ||||
| payload = { | ||||
| 'timestamp': self.dataOut.utctime, | ||||
| 'data': roundFloats(AVG), | ||||
| 'channels': ['Ch %s' % ch for ch in self.dataOut.channelList], | ||||
| 'type': self.plottype, | ||||
| 'yData': yData | ||||
| } | ||||
| else: | ||||
| print "Tipo de grafico invalido" | ||||
| payload = { | ||||
| 'data': 'None', | ||||
| 'timestamp': 'None', | ||||
| 'type': None | ||||
| } | ||||
| # print 'Publishing data to {}'.format(self.host) | ||||
| self.client.publish(self.topic + self.plottype, json.dumps(payload), qos=0) | ||||
| if self.zeromq is 1: | ||||
| r889 | print '[Sending] {} - {}'.format(self.dataOut.type, self.dataOut.datatime) | |||
|
Juan C. Valdez
|
r883 | self.zmq_socket.send_pyobj(self.dataOut) | ||
| def run(self, dataOut, **kwargs): | ||||
|
Juan C. Valdez
|
r860 | self.dataOut = dataOut | ||
| if not self.isConfig: | ||||
|
Juan C. Valdez
|
r883 | self.setup(**kwargs) | ||
|
Juan C. Valdez
|
r859 | self.isConfig = True | ||
|
Juan C. Valdez
|
r860 | |||
|
Juan C. Valdez
|
r883 | self.publish_data() | ||
|
Juan C. Valdez
|
r860 | time.sleep(self.delay) | ||
|
Juan C. Valdez
|
r859 | def close(self): | ||
|
Juan C. Valdez
|
r883 | if self.zeromq is 1: | ||
| self.dataOut.finished = True | ||||
| self.zmq_socket.send_pyobj(self.dataOut) | ||||
|
Juan C. Valdez
|
r860 | if self.client: | ||
| self.client.loop_stop() | ||||
| self.client.disconnect() | ||||
| r889 | ||||
| class ReceiverData(ProcessingUnit, Process): | ||||
| def __init__(self, **kwargs): | ||||
| ProcessingUnit.__init__(self, **kwargs) | ||||
| Process.__init__(self) | ||||
| self.mp = False | ||||
| self.isConfig = False | ||||
| self.plottypes =[] | ||||
| self.connections = 0 | ||||
| server = kwargs.get('server', 'zmq.pipe') | ||||
| if 'tcp://' in server: | ||||
| address = server | ||||
| else: | ||||
| address = 'ipc:///tmp/%s' % server | ||||
| self.address = address | ||||
| self.plottypes = [s.strip() for s in kwargs.get('plottypes', 'rti').split(',')] | ||||
| self.realtime = kwargs.get('realtime', False) | ||||
| global throttle_value | ||||
| throttle_value = kwargs.get('throttle', 10) | ||||
| self.setup() | ||||
| def setup(self): | ||||
| self.data = {} | ||||
| self.data['times'] = [] | ||||
| for plottype in self.plottypes: | ||||
| self.data[plottype] = {} | ||||
| self.isConfig = True | ||||
| def event_monitor(self, monitor): | ||||
| events = {} | ||||
| for name in dir(zmq): | ||||
| if name.startswith('EVENT_'): | ||||
| value = getattr(zmq, name) | ||||
| events[value] = name | ||||
| while monitor.poll(): | ||||
| evt = recv_monitor_message(monitor) | ||||
| if evt['event'] == 32: | ||||
| self.connections += 1 | ||||
| if evt['event'] == 512: | ||||
| pass | ||||
| if self.connections == 0 and self.started is True: | ||||
| self.ended = True | ||||
| # send('ENDED') | ||||
| evt.update({'description': events[evt['event']]}) | ||||
| if evt['event'] == zmq.EVENT_MONITOR_STOPPED: | ||||
| break | ||||
| monitor.close() | ||||
| print("event monitor thread done!") | ||||
| @throttle(seconds=throttle_value) | ||||
| def sendData(self, data): | ||||
| self.send(data) | ||||
| def send(self, data): | ||||
| print '[sending] data=%s size=%s' % (data.keys(), len(data['times'])) | ||||
| self.sender.send_pyobj(data) | ||||
| def update(self): | ||||
| t = self.dataOut.ltctime | ||||
| self.data['times'].append(t) | ||||
| self.data['dataOut'] = self.dataOut | ||||
| for plottype in self.plottypes: | ||||
| if plottype == 'spc': | ||||
| z = self.dataOut.data_spc/self.dataOut.normFactor | ||||
| zdB = 10*numpy.log10(z) | ||||
| self.data[plottype] = zdB | ||||
| if plottype == 'rti': | ||||
| self.data[plottype][t] = self.dataOut.getPower() | ||||
| if plottype == 'snr': | ||||
| self.data[plottype][t] = 10*numpy.log10(self.dataOut.data_SNR) | ||||
| if plottype == 'dop': | ||||
| self.data[plottype][t] = 10*numpy.log10(self.dataOut.data_DOP) | ||||
| if plottype == 'coh': | ||||
| self.data[plottype][t] = self.dataOut.getCoherence() | ||||
| if plottype == 'phase': | ||||
| self.data[plottype][t] = self.dataOut.getCoherence(phase=True) | ||||
| def run(self): | ||||
| print '[Starting] {} from {}'.format(self.name, self.address) | ||||
| self.context = zmq.Context() | ||||
| self.receiver = self.context.socket(zmq.PULL) | ||||
| self.receiver.bind(self.address) | ||||
| monitor = self.receiver.get_monitor_socket() | ||||
| self.sender = self.context.socket(zmq.PUB) | ||||
| self.sender.bind("ipc:///tmp/zmq.plots") | ||||
| t = Thread(target=self.event_monitor, args=(monitor,)) | ||||
| t.start() | ||||
| while True: | ||||
| self.dataOut = self.receiver.recv_pyobj() | ||||
| print '[Receiving] {} - {}'.format(self.dataOut.type, | ||||
| self.dataOut.datatime.ctime()) | ||||
| self.update() | ||||
| if self.dataOut.finished is True: | ||||
| self.send(self.data) | ||||
| self.connections -= 1 | ||||
| if self.connections==0 and self.started: | ||||
| self.ended = True | ||||
| self.data['ENDED'] = True | ||||
| self.send(self.data) | ||||
| self.setup() | ||||
| else: | ||||
| if self.realtime: | ||||
| self.send(self.data) | ||||
| else: | ||||
| self.sendData(self.data) | ||||
| self.started = True | ||||
| return | ||||
