def __init__(self, port, baudrate):
# Stream.__init__( self )
# self.am = Serial( **kw )
#self.am.open() # Seems to cause "permission denied" with PySerial 2.x
self.am = AM(SerialTOS(port, baudrate), serialStreamProcessorHook)
self.handlersList = []
t = Thread(target=self.startService)
t.setDaemon(True)
t.start()
# t.join(5)
self.servico = t
self.msg = ''
self.msgId = 1
self.leitura = deque(maxlen=4)
class PacketProcessor(object):
def __init__(self):
self.debug = True
self.source = getSource("serial@/dev/ttyUSB0:115200") #TODO: Re-implement.
self.am = AM(s=self.source)
def run(self):
p = None
while True:
try:
p = self.am.read(timeout=10)
except Exception as e:
self.log("Error:\t%s"%e)
raise
finally:
if p and p.type == AM_REGISTER_REQUEST:
reg_message = RegisterRequest(data=p.data)
self.log(reg_message)
def log(self, msg):
if self.debug:
print msg
class SerialStream(Stream):
""" A stream using the pyserial interface """
# def __init__( self, **kw ):
# """ Default constructor
# Creates and opens a serial port
# **kw - keyword arguments to pass into a pySerial serial port
# """
def __init__(self, port, baudrate):
# Stream.__init__( self )
# self.am = Serial( **kw )
#self.am.open() # Seems to cause "permission denied" with PySerial 2.x
self.am = AM(SerialTOS(port, baudrate), serialStreamProcessorHook)
self.handlersList = []
t = Thread(target=self.startService)
t.setDaemon(True)
t.start()
# t.join(5)
self.servico = t
self.msg = ''
self.msgId = 1
self.leitura = deque(maxlen=4)
def startService(self):
msgId = 0
str_list = []
print 'iniciando servico'
while True:
time.sleep(0.02)
msgRead = self.read()
if msgRead:
msgs = msgRead.split('\n')
for msg in msgs:
if (msg):
# msg = ''.join(i for i in msg if ord(i)<128)
# print "servico:" + self.msg
msgId += 1
obj = {'id': msgId, 'msg': msg}
print "startService:" + msg
if (obj not in self.leitura):
self.leitura.append(obj)
for handler in self.handlersList:
handler(self.msgId, self.msg)
#obs deve implementar chegouMsg
def subscribe(self, handler):
if handler not in self.handlersList:
self.handlersList.append(handler)
def last_msg(self):
obj = None
if self.leitura:
# print "last_msg:" + str(self.leitura)
obj = self.leitura[-1]
# print obj
return obj
def flush(self):
""" Flush the port """
self.am.flush()
def read(self):
""" Read up to count bytes
count - maximum number of bytes to read
throws TimeoutException if read returns empty or None
"""
buf = self.am.read()
print 'Read: ', buf
return buf
def write(self, buf):
""" Write buf to the port
buf - string or list of bytes
"""
if isinstance(buf, list):
buf = ''.join([chr(c) for c in buf])
self.am.write(buf)
def get_read_timeout(self):
""" Get the read timeout """
return self.am.timeout
def set_read_timeout(self, value):
""" Set the read timeout """
self.am.timeout = value
def get_write_timeout(self):
""" Get the write timeout """
return self.am.writeTimeout
def set_write_timeout(self, value):
""" Set the write timeout """
self.am.writeTimeout = value
def close(self):
self.am.close()
def __init__(self):
self.debug = True
self.source = getSource("serial@/dev/ttyUSB0:115200") #TODO: Re-implement.
self.am = AM(s=self.source)
