From 54d2eb335eb0a935c544ff52cadf7004e42f8ea8 Mon Sep 17 00:00:00 2001
From: Piotr Dobrowolski <admin@tastycode.pl>
Date: Fri, 18 Oct 2019 16:11:45 +0200
Subject: [PATCH] py9b/link/bleak: asyncio & bleak-based link implementation

---
 py9b/link/bleak.py | 85 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 85 insertions(+)
 create mode 100644 py9b/link/bleak.py

diff --git a/py9b/link/bleak.py b/py9b/link/bleak.py
new file mode 100644
index 0000000..f2d1c33
--- /dev/null
+++ b/py9b/link/bleak.py
@@ -0,0 +1,85 @@
+import asyncio
+
+from bleak import discover, BleakClient
+from py9b.link.base import BaseLink
+from threading import Thread
+
+_rx_char_uuid = '6e400002-b5a3-f393-e0a9-e50e24dcca9e'
+_tx_char_uuid = '6e400003-b5a3-f393-e0a9-e50e24dcca9e'
+
+try:
+    import queue
+except ImportError:
+    import Queue as queue
+
+class Fifo():
+    def __init__(self):
+        self.q = queue.Queue()
+
+    def write(self, data): # put bytes
+        for b in data:
+            self.q.put(b)
+
+    def read(self, size=1, timeout=None): # but read string
+        res = bytearray()
+        for i in range(size):
+            res.append(self.q.get(True, timeout))
+        return res
+
+
+def run_worker(loop):
+    print('Starting event loop', loop)
+    asyncio.set_event_loop(loop)
+    loop.run_forever()
+
+class BleakLink(BaseLink):
+    def __init__(self, device='hci0', loop=None, *args, **kwargs):
+        self.device = device
+        self.timeout = 5
+        self.loop = loop or asyncio.get_event_loop()
+        self._rx_fifo = Fifo()
+        self._client = None
+
+    def __enter__(self):
+        self._th = Thread(target=run_worker, args=(self.loop,))
+        self._th.daemon = True
+        self._th.start()
+
+        return self
+
+    def __exit__(self, exc_type, exc_value, traceback):
+        if self._client:
+            asyncio.run_coroutine_threadsafe(self._client.disconnect(), self.loop).result(10)
+
+    def scan(self, timeout=1):
+        future = asyncio.run_coroutine_threadsafe(discover(timeout=timeout, device=self.device), self.loop)
+        return [(dev.name, dev.address) for dev in future.result(timeout*2) if dev.name.startswith(('MISc', 'NBSc'))]
+
+    def open(self, port):
+        fut = asyncio.run_coroutine_threadsafe(self._connect(port), self.loop)
+        fut.result(10)
+
+    async def _connect(self, port):
+        self._client = BleakClient(port[1], device=self.device)
+        await self._client.connect()
+        print('connected')
+        await self._client.start_notify(_tx_char_uuid, self._data_received)
+        print('services:', await self._client.get_services())
+
+    def _data_received(self, sender, data):
+        print('<<', ' '.join(map(lambda b: '%02x' % b, data)))
+        self._rx_fifo.write(data)
+
+    def write(self, data):
+        print('>>', ' '.join(map(lambda b: '%02x' % b, data)))
+        fut = asyncio.run_coroutine_threadsafe(self._client.write_gatt_char(_rx_char_uuid, bytearray(data), False), self.loop)
+        return fut.result(3)
+
+    def read(self, size):
+        try:
+            data = self._rx_fifo.read(size, timeout=self.timeout)
+        except queue.Empty:
+            raise LinkTimeoutException
+        return data
+
+