""" streams ======= Package for asynchronous serial IO. """ import asyncio import logging import sys import threading import serial from serial.tools.list_ports import comports Log = logging.getLogger(__name__) class SerialStream: @classmethod def devices_matching(cls, vid=None, pid=None, serial=None): for port in comports(): if (vid is None or vid == port.vid) and (pid is None or pid == port.pid) and (serial is None or serial == port.serial_number): yield port.device @classmethod def stream_matching(cls, vid=None, pid=None, serial=None, **kwargs): for device in cls.devices_matching(vid, pid, serial): return SerialStream(device, **kwargs) raise RuntimeError("No matching serial device") def __init__(self, device, use_threads=None, loop=None, **kwargs): self._device = device self._use_threads = sys.platform == 'win32' if use_threads is None else use_threads self._connection = serial.Serial(self._device, **kwargs) if self._use_threads else \ serial.Serial(self._device, timeout=0, write_timeout=0, **kwargs) Log.debug(f"Opened SerialStream on {device}") self._loop = loop if loop is not None else asyncio.get_event_loop() self._output_buffer = bytes() self._output_buffer_empty = None self._output_buffer_lock = threading.Lock() if self._use_threads else None def __repr__(self): return f'<{self.__class__.__name__}:{self._device}>' def close(self): if self._connection is not None: self._connection.close() self._connection = None def write(self, data): if self._use_threads: with self._output_buffer_lock: self._output_buffer += data if self._output_buffer_empty is None: self._output_buffer_empty = self._loop.run_in_executor(None, self._write_blocking) return if not self._output_buffer: try: n = self._connection.write(data) except serial.SerialTimeoutException: n = 0 except Exception: Log.exception("Error writing to stream") raise if n: Log.debug(f"Write {data[:n]!r}") self._output_buffer = data[n:] else: self._output_buffer += data if self._output_buffer and self._output_buffer_empty is None: self._output_buffer_empty = self._loop.create_future() self._loop.add_writer(self._connection, self._feed_data) async def drain(self): if self._output_buffer_empty is not None: await self._output_buffer_empty def _feed_data(self): try: n = self._connection.write(self._output_buffer) except serial.SerialTimeoutException: n = 0 except Exception as e: Log.exception("Error writing to stream") self._output_buffer_empty.set_exception(e) self._loop.remove_writer(self._connection) if n: Log.debug(f"Write {self._output_buffer[:n]!r}") self._output_buffer = self._output_buffer[n:] if not self._output_buffer: self._loop.remove_writer(self._connection) self._output_buffer_empty.set_result(None) self._output_buffer_empty = None def _write_blocking(self): with self._output_buffer_lock: while self._output_buffer: data = bytes(self._output_buffer) self._output_buffer_lock.release() try: n = self._connection.write(data) finally: self._output_buffer_lock.acquire() Log.debug(f"Write {self._output_buffer[:n]!r}") self._output_buffer = self._output_buffer[n:] self._output_buffer_empty = None async def read(self, n=None): if self._use_threads: return await self._loop.run_in_executor(None, self._read_blocking, n) while True: w = self._connection.in_waiting if w: data = self._connection.read(w if n is None else min(n, w)) Log.debug(f"Read {data!r}") return data else: future = self._loop.create_future() self._loop.add_reader(self._connection, future.set_result, None) try: await future finally: self._loop.remove_reader(self._connection) def _read_blocking(self, n=None): data = self._connection.read(1) w = self._connection.in_waiting if w and (n is None or n > 1): data += self._connection.read(w if n is None else min(n-1, w)) Log.debug(f"Read {data!r}") return data async def readexactly(self, n): data = b'' while len(data) < n: data += await self.read(n-len(data)) return data