3 changed files with 109 additions and 36 deletions
@ -0,0 +1,69 @@ |
|||
import asyncio |
|||
import logging |
|||
|
|||
from a2s.exceptions import BrokenMessageError |
|||
from a2s.a2sfragment import decode_fragment |
|||
|
|||
|
|||
|
|||
HEADER_SIMPLE = b"\xFF\xFF\xFF\xFF" |
|||
HEADER_MULTI = b"\xFE\xFF\xFF\xFF" |
|||
|
|||
logger = logging.getLogger("a2s") |
|||
|
|||
class A2SProtocol: |
|||
def __init__(self): |
|||
self.recv_queue = asyncio.Queue() |
|||
self.error_event = asyncio.Event() |
|||
self.error = None |
|||
self.fragment_buf = [] |
|||
|
|||
def connection_made(self, transport): |
|||
self.transport = transport |
|||
|
|||
def datagram_received(self, packet, addr): |
|||
header = packet[:4] |
|||
payload = packet[4:] |
|||
if header == HEADER_SIMPLE: |
|||
logger.debug("Received single packet: %r", payload) |
|||
self.recv_queue.put_nowait(payload) |
|||
elif header == HEADER_MULTI: |
|||
self.fragment_buf.append(decode_fragment(payload)) |
|||
if len(self.fragment_buf) < self.fragment_buf[0].fragment_count: |
|||
return # Wait for more packets to arrive |
|||
self.fragment_buf.sort(key=lambda f: f.fragment_id) |
|||
reassembled = b"".join( |
|||
fragment.payload for fragment in self.fragment_buf) |
|||
logger.debug("Received %s part packet with content: %r", |
|||
len(fragments), reassembled) |
|||
self.recv_queue.put_nowait(reassembled) |
|||
self.fragment_buf = [] |
|||
else: |
|||
self.error = BrokenMessageError( |
|||
"Invalid packet header: " + repr(header)) |
|||
self.error_event.set() |
|||
|
|||
def error_received(self, exc): |
|||
self.error = exc |
|||
self.error_event.set() |
|||
|
|||
def send(self, payload): |
|||
packet = HEADER_SIMPLE + payload |
|||
self.transport.sendto(packet) |
|||
|
|||
async def recv(self, timeout): |
|||
queue_task = asyncio.create_task(self.recv_queue.get()) |
|||
error_task = asyncio.create_task(self.error_event.wait()) |
|||
done, pending = await asyncio.wait({queue_task, error_task}, |
|||
timeout=timeout, return_when=FIRST_COMPLETED) |
|||
|
|||
for task in pending: task.cancel() |
|||
if error_task in done: |
|||
error = self.error |
|||
self.error = None |
|||
self.error_event.clear() |
|||
raise error |
|||
if not done: |
|||
raise asyncio.TimeoutError() |
|||
|
|||
return queue_task.result() |
@ -0,0 +1,39 @@ |
|||
import bz2 |
|||
import io |
|||
|
|||
from a2s.byteio import ByteReader |
|||
|
|||
|
|||
|
|||
class A2SFragment: |
|||
def __init__(self, message_id, fragment_count, fragment_id, mtu, |
|||
decompressed_size=0, crc=0, payload=b""): |
|||
self.message_id = message_id |
|||
self.fragment_count = fragment_count |
|||
self.fragment_id = fragment_id |
|||
self.mtu = mtu |
|||
self.decompressed_size = decompressed_size |
|||
self.crc = crc |
|||
self.payload = payload |
|||
|
|||
@property |
|||
def is_compressed(self): |
|||
return bool(self.message_id & (1 << 15)) |
|||
|
|||
def decode_fragment(data): |
|||
reader = ByteReader( |
|||
io.BytesIO(data), endian="<", encoding="utf-8") |
|||
frag = A2SFragment( |
|||
message_id=reader.read_uint32(), |
|||
fragment_count=reader.read_uint8(), |
|||
fragment_id=reader.read_uint8(), |
|||
mtu=reader.read_uint16() |
|||
) |
|||
if frag.is_compressed: |
|||
frag.decompressed_size = reader.read_uint32() |
|||
frag.crc = reader.read_uint32() |
|||
frag.payload = bz2.decompress(reader.read()) |
|||
else: |
|||
frag.payload = reader.read() |
|||
|
|||
return frag |
Loading…
Reference in new issue