jroutils_publish.py
259 lines
| 8.9 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 | ||
|
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 | def pretty_floats(obj): | ||
| if isinstance(obj, float): | ||||
| return PrettyFloat(obj) | ||||
| elif isinstance(obj, dict): | ||||
| return dict((k, pretty_floats(v)) for k, v in obj.items()) | ||||
| elif isinstance(obj, (list, tuple)): | ||||
|
Juan C. Valdez
|
r860 | return map(pretty_floats, obj) | ||
|
Juan C. Valdez
|
r859 | return obj | ||
|
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 | __MAXNUMX = 100 | ||
| __MAXNUMY = 100 | ||||
|
Juan C. Valdez
|
r860 | |||
|
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') | ||||
|
Juan C. Valdez
|
r886 | if 'tcp://' in server: | ||
|
Juan C. Valdez
|
r883 | address = server | ||
| else: | ||||
| address = 'ipc:///tmp/%s' % server | ||||
| 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 | ||||
| dx = numpy.floor(xlen/self.__MAXNUMX) + 1 | ||||
| dy = numpy.floor(ylen/self.__MAXNUMY) + 1 | ||||
| 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: | ||||
| print '[Sending] {} - {}'.format(self.dataOut.type, self.dataOut.datatime) | ||||
| 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() | ||||