2023-11-01 04:57:08 +00:00
|
|
|
"""Packet streams"""
|
|
|
|
|
2017-07-29 09:54:03 +00:00
|
|
|
import logging
|
2017-05-25 10:47:01 +00:00
|
|
|
import struct
|
2017-07-30 12:08:18 +00:00
|
|
|
from asyncio import Event, Queue
|
2017-05-25 10:47:01 +00:00
|
|
|
from enum import Enum
|
2017-07-29 09:54:03 +00:00
|
|
|
from time import time
|
2018-05-06 12:55:00 +00:00
|
|
|
from math import ceil
|
2017-05-25 10:47:01 +00:00
|
|
|
|
|
|
|
import simplejson
|
2017-08-01 20:34:06 +00:00
|
|
|
|
2017-05-25 10:47:01 +00:00
|
|
|
|
2023-11-01 04:04:43 +00:00
|
|
|
logger = logging.getLogger("packet_stream")
|
2017-07-29 09:54:03 +00:00
|
|
|
|
|
|
|
|
2017-05-25 10:47:01 +00:00
|
|
|
class PSMessageType(Enum):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Available message types"""
|
|
|
|
|
2017-05-25 10:47:01 +00:00
|
|
|
BUFFER = 0
|
|
|
|
TEXT = 1
|
|
|
|
JSON = 2
|
|
|
|
|
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
class PSStreamHandler:
|
|
|
|
"""Packet stream handler"""
|
|
|
|
|
2017-07-29 09:54:03 +00:00
|
|
|
def __init__(self, req):
|
|
|
|
super(PSStreamHandler).__init__()
|
|
|
|
self.req = req
|
|
|
|
self.queue = Queue()
|
|
|
|
|
|
|
|
async def process(self, msg):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Process a pending message"""
|
|
|
|
|
2017-07-29 09:54:03 +00:00
|
|
|
await self.queue.put(msg)
|
|
|
|
|
|
|
|
async def stop(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Stop a pending request"""
|
|
|
|
|
2017-07-29 09:54:03 +00:00
|
|
|
await self.queue.put(None)
|
|
|
|
|
2023-11-01 05:03:06 +00:00
|
|
|
def __aiter__(self):
|
|
|
|
return self
|
|
|
|
|
|
|
|
async def __anext__(self):
|
|
|
|
elem = await self.queue.get()
|
|
|
|
|
|
|
|
if not elem:
|
|
|
|
raise StopAsyncIteration()
|
|
|
|
|
|
|
|
return elem
|
2017-07-29 09:54:03 +00:00
|
|
|
|
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
class PSRequestHandler:
|
|
|
|
"""Packet stream request handler"""
|
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
def __init__(self, req):
|
|
|
|
self.req = req
|
2017-07-30 12:08:18 +00:00
|
|
|
self.event = Event()
|
2017-07-30 08:14:26 +00:00
|
|
|
self._msg = None
|
|
|
|
|
|
|
|
async def process(self, msg):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Process a message request"""
|
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
self._msg = msg
|
2017-07-30 12:08:18 +00:00
|
|
|
self.event.set()
|
2017-07-30 08:14:26 +00:00
|
|
|
|
|
|
|
async def stop(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Stop a pending event request"""
|
|
|
|
|
2017-07-30 12:08:18 +00:00
|
|
|
if not self.event.is_set():
|
|
|
|
self.event.set()
|
2017-07-30 08:14:26 +00:00
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
async def __await__(self):
|
2017-07-30 12:08:18 +00:00
|
|
|
# wait until 'process' is called
|
2023-11-01 04:57:08 +00:00
|
|
|
await self.event.wait()
|
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
return self._msg
|
|
|
|
|
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
class PSMessage:
|
|
|
|
"""Packet Stream message"""
|
|
|
|
|
2017-07-29 09:54:03 +00:00
|
|
|
@classmethod
|
2017-07-30 09:51:11 +00:00
|
|
|
def from_header_body(cls, flags, req, body):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Parse a raw message"""
|
2017-07-29 09:54:03 +00:00
|
|
|
type_ = PSMessageType(flags & 0x03)
|
|
|
|
|
|
|
|
if type_ == PSMessageType.TEXT:
|
2023-11-01 04:04:43 +00:00
|
|
|
body = body.decode("utf-8")
|
2017-07-29 09:54:03 +00:00
|
|
|
elif type_ == PSMessageType.JSON:
|
|
|
|
body = simplejson.loads(body)
|
|
|
|
|
|
|
|
return cls(type_, body, bool(flags & 0x08), bool(flags & 0x04), req=req)
|
2017-05-25 10:47:01 +00:00
|
|
|
|
|
|
|
@property
|
|
|
|
def data(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""The raw message data"""
|
|
|
|
|
2017-05-25 10:47:01 +00:00
|
|
|
if self.type == PSMessageType.TEXT:
|
2023-11-01 04:04:43 +00:00
|
|
|
return self.body.encode("utf-8")
|
2023-11-01 04:57:08 +00:00
|
|
|
|
|
|
|
if self.type == PSMessageType.JSON:
|
2023-11-01 04:04:43 +00:00
|
|
|
return simplejson.dumps(self.body).encode("utf-8")
|
2023-11-01 04:57:08 +00:00
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
return self.body
|
2017-07-29 09:54:03 +00:00
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
def __init__(self, type_, body, stream, end_err, req=None): # pylint: disable=too-many-arguments
|
2017-07-29 09:54:03 +00:00
|
|
|
self.stream = stream
|
|
|
|
self.end_err = end_err
|
|
|
|
self.type = type_
|
|
|
|
self.body = body
|
|
|
|
self.req = req
|
2017-05-25 10:47:01 +00:00
|
|
|
|
|
|
|
def __repr__(self):
|
2017-07-30 09:51:11 +00:00
|
|
|
if self.type == PSMessageType.BUFFER:
|
2023-11-01 04:57:08 +00:00
|
|
|
body = f"{len(self.body)} bytes"
|
2017-07-30 09:51:11 +00:00
|
|
|
else:
|
|
|
|
body = self.body
|
2017-07-29 09:54:03 +00:00
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
req = "" if self.req is None else f" [{self.req}]"
|
|
|
|
is_stream = "~" if self.stream else ""
|
|
|
|
err = "!" if self.end_err else ""
|
|
|
|
|
|
|
|
return f"<PSMessage ({self.type.name}): {body}{req} {is_stream}{err}>"
|
|
|
|
|
|
|
|
|
|
|
|
class PacketStream:
|
|
|
|
"""SSB Packet stream"""
|
2017-05-25 10:47:01 +00:00
|
|
|
|
2018-02-04 21:18:36 +00:00
|
|
|
def __init__(self, connection):
|
|
|
|
self.connection = connection
|
2017-07-29 09:54:03 +00:00
|
|
|
self.req_counter = 1
|
2018-02-04 21:18:36 +00:00
|
|
|
self._event_map = {}
|
2023-11-01 04:57:08 +00:00
|
|
|
self._connected = False
|
2017-07-30 12:08:18 +00:00
|
|
|
|
2018-02-04 21:18:36 +00:00
|
|
|
def register_handler(self, handler):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Register an RPC handler"""
|
|
|
|
|
2018-02-04 21:18:36 +00:00
|
|
|
self._event_map[handler.req] = (time(), handler)
|
2017-07-30 12:08:18 +00:00
|
|
|
|
|
|
|
@property
|
|
|
|
def is_connected(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Check if the stream is connected"""
|
|
|
|
|
2018-02-04 21:18:36 +00:00
|
|
|
return self.connection.is_connected
|
|
|
|
|
2023-11-01 05:03:06 +00:00
|
|
|
def __aiter__(self):
|
|
|
|
return self
|
|
|
|
|
|
|
|
async def __anext__(self):
|
|
|
|
msg = await self.read()
|
|
|
|
|
|
|
|
if not msg:
|
|
|
|
raise StopAsyncIteration()
|
|
|
|
|
|
|
|
if msg.req >= 0:
|
|
|
|
return msg
|
|
|
|
|
|
|
|
return None
|
2018-02-04 21:18:36 +00:00
|
|
|
|
|
|
|
async def __await__(self):
|
|
|
|
async for data in self:
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.info("RECV: %r", data)
|
2018-02-04 21:18:36 +00:00
|
|
|
if data is None:
|
|
|
|
return
|
2017-05-25 10:47:01 +00:00
|
|
|
|
2017-07-30 20:28:42 +00:00
|
|
|
async def _read(self):
|
2017-06-04 22:27:44 +00:00
|
|
|
try:
|
|
|
|
header = await self.connection.read()
|
2023-11-01 04:04:43 +00:00
|
|
|
if not header or header == b"\x00" * 9:
|
2017-06-04 22:27:44 +00:00
|
|
|
return
|
2023-11-01 04:04:43 +00:00
|
|
|
flags, length, req = struct.unpack(">BIi", header)
|
2017-07-30 09:51:11 +00:00
|
|
|
|
2018-05-06 12:55:00 +00:00
|
|
|
n_packets = ceil(length / 4096)
|
2017-07-30 09:51:11 +00:00
|
|
|
|
2023-11-01 04:04:43 +00:00
|
|
|
body = b""
|
2023-11-01 04:57:08 +00:00
|
|
|
|
|
|
|
for _ in range(n_packets):
|
2017-07-30 09:51:11 +00:00
|
|
|
body += await self.connection.read()
|
|
|
|
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.debug("READ %s %s", header, len(body))
|
2017-07-30 09:51:11 +00:00
|
|
|
return PSMessage.from_header_body(flags, req, body)
|
2017-06-04 22:27:44 +00:00
|
|
|
except StopAsyncIteration:
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.debug("DISCONNECT")
|
2017-07-31 21:15:52 +00:00
|
|
|
self.connection.disconnect()
|
2017-06-04 22:27:44 +00:00
|
|
|
return None
|
|
|
|
|
2017-07-30 20:28:42 +00:00
|
|
|
async def read(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Read data from the packet stream"""
|
|
|
|
|
2017-07-30 20:28:42 +00:00
|
|
|
msg = await self._read()
|
|
|
|
if not msg:
|
|
|
|
return None
|
|
|
|
# check whether it's a reply and handle accordingly
|
|
|
|
if msg.req < 0:
|
2023-11-01 04:57:08 +00:00
|
|
|
_, handler = self._event_map[-msg.req]
|
2017-07-30 20:28:42 +00:00
|
|
|
await handler.process(msg)
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.info("RESPONSE [%d]: %r", -msg.req, msg)
|
2017-07-30 20:28:42 +00:00
|
|
|
if msg.end_err:
|
|
|
|
await handler.stop()
|
|
|
|
del self._event_map[-msg.req]
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.info("RESPONSE [%d]: EOS", -msg.req)
|
2017-07-30 20:28:42 +00:00
|
|
|
return msg
|
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
def _write(self, msg):
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.info("SEND [%d]: %r", msg.req, msg)
|
|
|
|
header = struct.pack(
|
|
|
|
">BIi", (int(msg.stream) << 3) | (int(msg.end_err) << 2) | msg.type.value, len(msg.data), msg.req
|
|
|
|
)
|
2017-06-04 22:27:44 +00:00
|
|
|
self.connection.write(header)
|
2017-07-30 08:14:26 +00:00
|
|
|
self.connection.write(msg.data)
|
2023-11-01 04:04:43 +00:00
|
|
|
logger.debug("WRITE HDR: %s", header)
|
|
|
|
logger.debug("WRITE DATA: %s", msg.data)
|
2017-07-29 09:54:03 +00:00
|
|
|
|
2023-11-01 04:57:08 +00:00
|
|
|
def send( # pylint: disable=too-many-arguments
|
|
|
|
self, data, msg_type=PSMessageType.JSON, stream=False, end_err=False, req=None
|
|
|
|
):
|
|
|
|
"""Send data through the packet stream"""
|
|
|
|
|
2017-07-30 08:14:26 +00:00
|
|
|
update_counter = False
|
|
|
|
if req is None:
|
|
|
|
update_counter = True
|
|
|
|
req = self.req_counter
|
|
|
|
|
|
|
|
msg = PSMessage(msg_type, data, stream=stream, end_err=end_err, req=req)
|
|
|
|
|
|
|
|
# send request
|
|
|
|
self._write(msg)
|
|
|
|
|
|
|
|
if stream:
|
|
|
|
handler = PSStreamHandler(self.req_counter)
|
|
|
|
else:
|
|
|
|
handler = PSRequestHandler(self.req_counter)
|
2017-07-29 09:54:03 +00:00
|
|
|
self.register_handler(handler)
|
2017-07-30 08:14:26 +00:00
|
|
|
|
|
|
|
if update_counter:
|
|
|
|
self.req_counter += 1
|
2017-07-29 09:54:03 +00:00
|
|
|
return handler
|
2017-05-25 10:47:01 +00:00
|
|
|
|
2017-07-30 12:08:18 +00:00
|
|
|
def disconnect(self):
|
2023-11-01 04:57:08 +00:00
|
|
|
"""Disconnect the stream"""
|
|
|
|
|
2017-07-30 12:08:18 +00:00
|
|
|
self._connected = False
|
|
|
|
self.connection.disconnect()
|