forked from auracaster/bumble_mirror
L2CAP: Enhanced Retransmission Mode
This commit is contained in:
@@ -2068,6 +2068,10 @@ class DeviceConfiguration:
|
||||
io_capability: int = pairing.PairingDelegate.IoCapability.NO_OUTPUT_NO_INPUT
|
||||
gap_service_enabled: bool = True
|
||||
gatt_service_enabled: bool = True
|
||||
enhanced_retransmission_supported: bool = False
|
||||
l2cap_extended_features: Sequence[int] = (
|
||||
l2cap.L2CAP_Information_Request.ExtendedFeatures.FIXED_CHANNELS,
|
||||
)
|
||||
|
||||
def __post_init__(self) -> None:
|
||||
self.gatt_services: list[dict[str, Any]] = []
|
||||
@@ -2337,6 +2341,10 @@ class Device(utils.CompositeEventEmitter):
|
||||
) -> None:
|
||||
super().__init__()
|
||||
|
||||
# Use the initial config or a default
|
||||
config = config or DeviceConfiguration()
|
||||
self.config = config
|
||||
|
||||
self._host = None
|
||||
self.powered_on = False
|
||||
self.auto_restart_inquiry = True
|
||||
@@ -2344,7 +2352,7 @@ class Device(utils.CompositeEventEmitter):
|
||||
self.gatt_server = gatt_server.Server(self)
|
||||
self.sdp_server = sdp.Server(self)
|
||||
self.l2cap_channel_manager = l2cap.ChannelManager(
|
||||
[l2cap.L2CAP_Information_Request.EXTENDED_FEATURE_FIXED_CHANNELS]
|
||||
config.l2cap_extended_features
|
||||
)
|
||||
self.advertisement_accumulators = {} # Accumulators, by address
|
||||
self.periodic_advertising_syncs = []
|
||||
@@ -2375,10 +2383,6 @@ class Device(utils.CompositeEventEmitter):
|
||||
# Own address type cache
|
||||
self.connect_own_address_type = None
|
||||
|
||||
# Use the initial config or a default
|
||||
config = config or DeviceConfiguration()
|
||||
self.config = config
|
||||
|
||||
self.name = config.name
|
||||
self.public_address = hci.Address.ANY
|
||||
self.random_address = config.address
|
||||
|
||||
548
bumble/l2cap.py
548
bumble/l2cap.py
@@ -36,6 +36,8 @@ from typing import (
|
||||
Union,
|
||||
)
|
||||
|
||||
from typing_extensions import override
|
||||
|
||||
from bumble import hci, utils
|
||||
from bumble.colors import color
|
||||
from bumble.core import (
|
||||
@@ -69,7 +71,12 @@ L2CAP_MIN_LE_MTU = 23
|
||||
L2CAP_MIN_BR_EDR_MTU = 48
|
||||
L2CAP_MAX_BR_EDR_MTU = 65535
|
||||
|
||||
L2CAP_DEFAULT_MTU = 2048 # Default value for the MTU we are willing to accept
|
||||
L2CAP_DEFAULT_MTU = 2048 # Default value for the MTU we are willing to accept
|
||||
L2CAP_DEFAULT_MPS = 1010 # Default value for the MPS we are willing to accept
|
||||
DEFAULT_TX_WINDOW_SIZE = 10
|
||||
DEFAULT_MAX_RETRANSMISSION = 10
|
||||
DEFAULT_RETRANSMISSION_TIMEOUT = 2.0
|
||||
DEFAULT_MONITOR_TIMEOUT = 12.0
|
||||
|
||||
L2CAP_DEFAULT_CONNECTIONLESS_MTU = 1024
|
||||
|
||||
@@ -133,14 +140,20 @@ L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU = 2048
|
||||
L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MPS = 2048
|
||||
L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_INITIAL_CREDITS = 256
|
||||
|
||||
L2CAP_MAXIMUM_TRANSMISSION_UNIT_CONFIGURATION_OPTION_TYPE = 0x01
|
||||
|
||||
L2CAP_MTU_CONFIGURATION_PARAMETER_TYPE = 0x01
|
||||
|
||||
# fmt: on
|
||||
# pylint: enable=line-too-long
|
||||
|
||||
|
||||
class TransmissionMode(utils.OpenIntEnum):
|
||||
'''See Bluetooth spec @ Vol 3, Part A - 5.4. Retransmission and Flow Control option'''
|
||||
|
||||
BASIC = 0x00
|
||||
RETRANSMISSION = 0x01
|
||||
FLOW_CONTROL = 0x02
|
||||
ENHANCED_RETRANSMISSION = 0x03
|
||||
STREAMING = 0x04
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# Classes
|
||||
# -----------------------------------------------------------------------------
|
||||
@@ -149,8 +162,31 @@ L2CAP_MTU_CONFIGURATION_PARAMETER_TYPE = 0x01
|
||||
|
||||
@dataclasses.dataclass
|
||||
class ClassicChannelSpec:
|
||||
'''Spec of L2CAP Channel over Classic Transport.
|
||||
|
||||
Attributes:
|
||||
psm: PSM of channel. This is optional for server, and when it is None, a PSM
|
||||
will be allocated.
|
||||
mtu: Maximum Transmission Unit.
|
||||
mps: Maximum PDU payload Size.
|
||||
tx_window_size: The size of the transmission window for Flow Control mode,
|
||||
Retransmission mode, and Enhanced Retransmission mode.
|
||||
max_retransmission: The number of transmissions of a single I-frame that L2CAP
|
||||
is allowed to try in Retransmission mode and Enhanced Retransmission mode.
|
||||
retransmission_timeout: The timeout of retransmission in seconds.
|
||||
monitor_timeout: The interval at which S-frames should be transmitted on the
|
||||
return channel when no frames are received on the forward channel.
|
||||
mode: The transmission mode to use.
|
||||
'''
|
||||
|
||||
psm: Optional[int] = None
|
||||
mtu: int = L2CAP_DEFAULT_MTU
|
||||
mps: int = L2CAP_DEFAULT_MTU
|
||||
tx_window_size: int = DEFAULT_TX_WINDOW_SIZE
|
||||
max_retransmission: int = DEFAULT_MAX_RETRANSMISSION
|
||||
retransmission_timeout: float = DEFAULT_RETRANSMISSION_TIMEOUT
|
||||
monitor_timeout: float = DEFAULT_MONITOR_TIMEOUT
|
||||
mode: TransmissionMode = TransmissionMode.BASIC
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
@@ -206,6 +242,120 @@ class L2CAP_PDU:
|
||||
return f'{color("L2CAP", "green")} [CID={self.cid}]: {self.payload.hex()}'
|
||||
|
||||
|
||||
class ControlField:
|
||||
'''
|
||||
See Bluetooth spec @ Vol 3, Part A - 3.3.2 Control field.
|
||||
'''
|
||||
|
||||
class FieldType(utils.OpenIntEnum):
|
||||
I_FRAME = 0x00
|
||||
S_FRAME = 0x01
|
||||
|
||||
class SegmentationAndReassembly(utils.OpenIntEnum):
|
||||
UNSEGMENTED = 0x00
|
||||
START = 0x01
|
||||
END = 0x02
|
||||
CONTINUATION = 0x03
|
||||
|
||||
class SupervisoryFunction(utils.OpenIntEnum):
|
||||
# Receiver Ready
|
||||
RR = 0
|
||||
# Reject
|
||||
REJ = 1
|
||||
# Receiver Not Ready
|
||||
RNR = 2
|
||||
# Select Reject
|
||||
SREJ = 3
|
||||
|
||||
class RetransmissionBit(utils.OpenIntEnum):
|
||||
NORMAL = 0x00
|
||||
RETRANSMISSION = 0x01
|
||||
|
||||
req_seq: int
|
||||
frame_type: ClassVar[FieldType]
|
||||
|
||||
def __bytes__(self) -> bytes:
|
||||
raise NotImplementedError()
|
||||
|
||||
|
||||
class EnhancedControlField(ControlField):
|
||||
"""Base control field used in Enhanced Retransmission and Streaming Mode."""
|
||||
|
||||
final: int
|
||||
|
||||
@classmethod
|
||||
def from_bytes(cls, data: bytes) -> EnhancedControlField:
|
||||
frame_type = data[0] & 0x01
|
||||
if frame_type == cls.FieldType.I_FRAME:
|
||||
return InformationEnhancedControlField.from_bytes(data)
|
||||
elif frame_type == cls.FieldType.S_FRAME:
|
||||
return SupervisoryEnhancedControlField.from_bytes(data)
|
||||
else:
|
||||
raise InvalidArgumentError(f'Invalid frame type: {frame_type}')
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class InformationEnhancedControlField(EnhancedControlField):
|
||||
tx_seq: int = 0
|
||||
req_seq: int = 0
|
||||
segmentation_and_reassembly: int = (
|
||||
EnhancedControlField.SegmentationAndReassembly.UNSEGMENTED
|
||||
)
|
||||
final: int = 1
|
||||
|
||||
frame_type = EnhancedControlField.FieldType.I_FRAME
|
||||
|
||||
@classmethod
|
||||
def from_bytes(cls, data: bytes) -> EnhancedControlField:
|
||||
return cls(
|
||||
tx_seq=(data[0] >> 1) & 0b0111111,
|
||||
final=(data[0] >> 7) & 0b1,
|
||||
req_seq=(data[1] & 0b001111111),
|
||||
segmentation_and_reassembly=(data[1] >> 6) & 0b11,
|
||||
)
|
||||
|
||||
def __bytes__(self) -> bytes:
|
||||
return bytes(
|
||||
[
|
||||
self.frame_type | (self.tx_seq << 1) | (self.final << 7),
|
||||
self.req_seq | (self.segmentation_and_reassembly << 6),
|
||||
]
|
||||
)
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class SupervisoryEnhancedControlField(EnhancedControlField):
|
||||
|
||||
supervision_function: int = ControlField.SupervisoryFunction.RR
|
||||
poll: int = 0
|
||||
req_seq: int = 0
|
||||
final: int = 0
|
||||
|
||||
frame_type = EnhancedControlField.FieldType.S_FRAME
|
||||
|
||||
@classmethod
|
||||
def from_bytes(cls, data: bytes) -> EnhancedControlField:
|
||||
return cls(
|
||||
supervision_function=(data[0] >> 2) & 0b11,
|
||||
poll=(data[0] >> 4) & 0b1,
|
||||
final=(data[0] >> 7) & 0b1,
|
||||
req_seq=(data[1] & 0b1111111),
|
||||
)
|
||||
|
||||
def __bytes__(self) -> bytes:
|
||||
return bytes(
|
||||
[
|
||||
(
|
||||
self.frame_type
|
||||
| (self.supervision_function << 2)
|
||||
| self.poll << 7
|
||||
| (self.final << 7)
|
||||
),
|
||||
self.req_seq,
|
||||
]
|
||||
)
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
@dataclasses.dataclass
|
||||
class L2CAP_Control_Frame:
|
||||
@@ -248,14 +398,16 @@ class L2CAP_Control_Frame:
|
||||
return frame
|
||||
|
||||
@staticmethod
|
||||
def decode_configuration_options(data: bytes) -> list[tuple[int, bytes]]:
|
||||
def decode_configuration_options(
|
||||
data: bytes,
|
||||
) -> list[tuple[L2CAP_Configure_Request.ParameterType, bytes]]:
|
||||
options = []
|
||||
while len(data) >= 2:
|
||||
value_type = data[0]
|
||||
length = data[1]
|
||||
value = data[2 : 2 + length]
|
||||
data = data[2 + length :]
|
||||
options.append((value_type, value))
|
||||
options.append((L2CAP_Configure_Request.ParameterType(value_type), value))
|
||||
|
||||
return options
|
||||
|
||||
@@ -398,6 +550,15 @@ class L2CAP_Configure_Request(L2CAP_Control_Frame):
|
||||
See Bluetooth spec @ Vol 3, Part A - 4.4 CONFIGURATION REQUEST
|
||||
'''
|
||||
|
||||
class ParameterType(utils.OpenIntEnum):
|
||||
MTU = 0x01
|
||||
FLUSH_TIMEOUT = 0x02
|
||||
QOS = 0x03
|
||||
RETRANSMISSION_AND_FLOW_CONTROL = 0x04
|
||||
FCS = 0x05
|
||||
EXTENDED_FLOW_SPEC = 0x06
|
||||
EXTENDED_WINDOW_SIZE = 0x07
|
||||
|
||||
destination_cid: int = dataclasses.field(metadata=hci.metadata(2))
|
||||
flags: int = dataclasses.field(metadata=hci.metadata(2))
|
||||
options: bytes = dataclasses.field(metadata=hci.metadata('*'))
|
||||
@@ -484,17 +645,18 @@ class L2CAP_Information_Request(L2CAP_Control_Frame):
|
||||
EXTENDED_FEATURES_SUPPORTED = 0x0002
|
||||
FIXED_CHANNELS_SUPPORTED = 0x0003
|
||||
|
||||
EXTENDED_FEATURE_FLOW_MODE_CONTROL = 0x0001
|
||||
EXTENDED_FEATURE_RETRANSMISSION_MODE = 0x0002
|
||||
EXTENDED_FEATURE_BIDIRECTIONAL_QOS = 0x0004
|
||||
EXTENDED_FEATURE_ENHANCED_RETRANSMISSION_MODE = 0x0008
|
||||
EXTENDED_FEATURE_STREAMING_MODE = 0x0010
|
||||
EXTENDED_FEATURE_FCS_OPTION = 0x0020
|
||||
EXTENDED_FEATURE_EXTENDED_FLOW_SPEC = 0x0040
|
||||
EXTENDED_FEATURE_FIXED_CHANNELS = 0x0080
|
||||
EXTENDED_FEATURE_EXTENDED_WINDOW_SIZE = 0x0100
|
||||
EXTENDED_FEATURE_UNICAST_CONNECTIONLESS_DATA = 0x0200
|
||||
EXTENDED_FEATURE_ENHANCED_CREDIT_BASE_FLOW_CONTROL = 0x0400
|
||||
class ExtendedFeatures(hci.SpecableFlag):
|
||||
FLOW_MODE_CONTROL = 0x0001
|
||||
RETRANSMISSION_MODE = 0x0002
|
||||
BIDIRECTIONAL_QOS = 0x0004
|
||||
ENHANCED_RETRANSMISSION_MODE = 0x0008
|
||||
STREAMING_MODE = 0x0010
|
||||
FCS_OPTION = 0x0020
|
||||
EXTENDED_FLOW_SPEC = 0x0040
|
||||
FIXED_CHANNELS = 0x0080
|
||||
EXTENDED_WINDOW_SIZE = 0x0100
|
||||
UNICAST_CONNECTIONLESS_DATA = 0x0200
|
||||
ENHANCED_CREDIT_BASE_FLOW_CONTROL = 0x0400
|
||||
|
||||
info_type: int = dataclasses.field(metadata=InfoType.type_metadata(2))
|
||||
|
||||
@@ -702,6 +864,212 @@ class L2CAP_Credit_Based_Reconfigure_Response(L2CAP_Control_Frame):
|
||||
result: int = dataclasses.field(metadata=Result.type_metadata(2))
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
class BaseProcessor:
|
||||
def __init__(self, channel: ClassicChannel) -> None:
|
||||
self.channel = channel
|
||||
|
||||
def send_sdu(self, sdu: bytes) -> None:
|
||||
self.channel.send_pdu(sdu)
|
||||
|
||||
def on_pdu(self, pdu: bytes) -> None:
|
||||
self.channel.on_sdu(pdu)
|
||||
|
||||
|
||||
# TODO: Handle retransmission
|
||||
class EnhancedRetransmissionProcessor(BaseProcessor):
|
||||
|
||||
MAX_SEQ_NUM = 64
|
||||
|
||||
@dataclasses.dataclass
|
||||
class _PendingPdu:
|
||||
payload: bytes
|
||||
tx_seq: int
|
||||
req_seq: int = 0
|
||||
|
||||
def __bytes__(self) -> bytes:
|
||||
return (
|
||||
bytes(
|
||||
InformationEnhancedControlField(
|
||||
tx_seq=self.tx_seq, req_seq=self.req_seq
|
||||
)
|
||||
)
|
||||
+ self.payload
|
||||
)
|
||||
|
||||
_expected_ack_seq: int = 0
|
||||
_next_tx_seq: int = 0
|
||||
_last_tx_seq: int = 0
|
||||
_req_seq_num: int = 0
|
||||
_next_seq_num: int = 0
|
||||
_remote_is_busy: bool = False
|
||||
|
||||
_num_receiver_ready_polls_sent: int = 0
|
||||
_pending_pdus: list[_PendingPdu]
|
||||
_monitor_handle: Optional[asyncio.TimerHandle] = None
|
||||
_receiver_ready_poll_handle: Optional[asyncio.TimerHandle] = None
|
||||
|
||||
# Timeout, in seconds.
|
||||
monitor_timeout: float
|
||||
retransmission_timeout: float
|
||||
|
||||
@classmethod
|
||||
def _num_frames_between(cls, low: int, high: int) -> int:
|
||||
if high < low:
|
||||
high += cls.MAX_SEQ_NUM + 1
|
||||
return high - low
|
||||
|
||||
def __init__(self, channel: ClassicChannel):
|
||||
spec = channel.spec
|
||||
self.mps = spec.mps
|
||||
self.peer_mps = 0
|
||||
self.tx_window_size = spec.tx_window_size
|
||||
self._pending_pdus = []
|
||||
self.monitor_timeout = spec.monitor_timeout
|
||||
self.channel = channel
|
||||
self.retransmission_timeout = spec.retransmission_timeout
|
||||
self.max_retransmission = spec.max_retransmission
|
||||
|
||||
def _monitor(self) -> None:
|
||||
if (
|
||||
self.max_retransmission <= 0
|
||||
or self._num_receiver_ready_polls_sent < self.max_retransmission
|
||||
):
|
||||
self._send_receiver_ready_poll()
|
||||
self._start_monitor()
|
||||
else:
|
||||
logger.error("Max retransmission exceeded")
|
||||
|
||||
def _receiver_ready_poll(self) -> None:
|
||||
self._send_receiver_ready_poll()
|
||||
self._start_monitor()
|
||||
|
||||
def _start_monitor(self) -> None:
|
||||
if self._monitor_handle:
|
||||
self._monitor_handle.cancel()
|
||||
self._monitor_handle = asyncio.get_running_loop().call_later(
|
||||
self.monitor_timeout, self._monitor
|
||||
)
|
||||
|
||||
def _start_receiver_ready_poll(self) -> None:
|
||||
if self._receiver_ready_poll_handle:
|
||||
self._receiver_ready_poll_handle.cancel()
|
||||
self._num_receiver_ready_polls_sent = 0
|
||||
|
||||
self._receiver_ready_poll_handle = asyncio.get_running_loop().call_later(
|
||||
self.retransmission_timeout, self._receiver_ready_poll
|
||||
)
|
||||
|
||||
def _send_receiver_ready_poll(self) -> None:
|
||||
self._num_receiver_ready_polls_sent += 1
|
||||
self.channel.send_pdu(
|
||||
SupervisoryEnhancedControlField(
|
||||
supervision_function=SupervisoryEnhancedControlField.SupervisoryFunction.RR,
|
||||
final=1,
|
||||
req_seq=self._next_seq_num,
|
||||
)
|
||||
)
|
||||
|
||||
def _get_next_tx_seq(self) -> int:
|
||||
seq_num = self._next_tx_seq
|
||||
self._next_tx_seq = (self._next_tx_seq + 1) % self.MAX_SEQ_NUM
|
||||
return seq_num
|
||||
|
||||
@override
|
||||
def send_sdu(self, sdu: bytes) -> None:
|
||||
if len(sdu) > self.peer_mps:
|
||||
raise InvalidArgumentError(
|
||||
f'SDU size({len(sdu)}) exceeds channel MPS {self.peer_mps}'
|
||||
)
|
||||
pdu = self._PendingPdu(payload=sdu, tx_seq=self._get_next_tx_seq())
|
||||
self._pending_pdus.append(pdu)
|
||||
self._process_output()
|
||||
|
||||
@override
|
||||
def on_pdu(self, pdu: bytes) -> None:
|
||||
control_field = EnhancedControlField.from_bytes(pdu)
|
||||
self._update_ack_seq(control_field.req_seq, control_field.final != 0)
|
||||
if isinstance(control_field, InformationEnhancedControlField):
|
||||
if control_field.tx_seq != self._next_seq_num:
|
||||
return
|
||||
self._next_seq_num = (self._next_seq_num + 1) % self.MAX_SEQ_NUM
|
||||
self._req_seq_num = self._next_seq_num
|
||||
|
||||
ack_frame = SupervisoryEnhancedControlField(
|
||||
supervision_function=SupervisoryEnhancedControlField.SupervisoryFunction.RR,
|
||||
req_seq=self._next_seq_num,
|
||||
)
|
||||
self.channel.send_pdu(ack_frame)
|
||||
self.channel.on_sdu(pdu[2:])
|
||||
elif isinstance(control_field, SupervisoryEnhancedControlField):
|
||||
self._remote_is_busy = (
|
||||
control_field.supervision_function
|
||||
== SupervisoryEnhancedControlField.SupervisoryFunction.RNR
|
||||
)
|
||||
|
||||
if control_field.supervision_function in (
|
||||
SupervisoryEnhancedControlField.SupervisoryFunction.RR,
|
||||
SupervisoryEnhancedControlField.SupervisoryFunction.RNR,
|
||||
):
|
||||
if control_field.poll:
|
||||
self.channel.send_pdu(
|
||||
SupervisoryEnhancedControlField(
|
||||
supervision_function=SupervisoryEnhancedControlField.SupervisoryFunction.RR,
|
||||
final=1,
|
||||
req_seq=self._next_seq_num,
|
||||
)
|
||||
)
|
||||
else:
|
||||
# TODO: Handle Retransmission.
|
||||
pass
|
||||
|
||||
def _process_output(self) -> None:
|
||||
if self._remote_is_busy or self._monitor_handle:
|
||||
return
|
||||
|
||||
for pdu in self._pending_pdus:
|
||||
if self._num_unacked_frames >= self.tx_window_size:
|
||||
return
|
||||
self._send_pdu(pdu)
|
||||
self._last_tx_seq = pdu.tx_seq
|
||||
|
||||
@property
|
||||
def _num_unacked_frames(self) -> int:
|
||||
if not self._pending_pdus:
|
||||
return 0
|
||||
return self._num_frames_between(self._expected_ack_seq, self._last_tx_seq + 1)
|
||||
|
||||
def _send_pdu(self, pdu: _PendingPdu) -> None:
|
||||
pdu.req_seq = self._req_seq_num
|
||||
|
||||
self._start_receiver_ready_poll()
|
||||
self.channel.send_pdu(bytes(pdu))
|
||||
|
||||
def _update_ack_seq(self, new_seq: int, is_poll_response: bool) -> None:
|
||||
num_frames_acked = self._num_frames_between(self._expected_ack_seq, new_seq)
|
||||
if num_frames_acked > self._num_unacked_frames:
|
||||
logger.error(
|
||||
"Received acknowledgment for %d frames but only %d frames are pending",
|
||||
num_frames_acked,
|
||||
self._num_unacked_frames,
|
||||
)
|
||||
return
|
||||
if is_poll_response and self._monitor_handle:
|
||||
self._monitor_handle.cancel()
|
||||
self._monitor_handle = None
|
||||
|
||||
del self._pending_pdus[:num_frames_acked]
|
||||
self._expected_ack_seq = new_seq
|
||||
if (
|
||||
self._expected_ack_seq == self._next_tx_seq
|
||||
and self._receiver_ready_poll_handle
|
||||
):
|
||||
self._receiver_ready_poll_handle.cancel()
|
||||
self._receiver_ready_poll_handle = None
|
||||
|
||||
self._process_output()
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
class ClassicChannel(utils.EventEmitter):
|
||||
class State(enum.IntEnum):
|
||||
@@ -739,6 +1107,7 @@ class ClassicChannel(utils.EventEmitter):
|
||||
connection: Connection
|
||||
mtu: int
|
||||
peer_mtu: int
|
||||
processor: BaseProcessor
|
||||
|
||||
def __init__(
|
||||
self,
|
||||
@@ -747,14 +1116,14 @@ class ClassicChannel(utils.EventEmitter):
|
||||
signaling_cid: int,
|
||||
psm: int,
|
||||
source_cid: int,
|
||||
mtu: int,
|
||||
spec: ClassicChannelSpec,
|
||||
) -> None:
|
||||
super().__init__()
|
||||
self.manager = manager
|
||||
self.connection = connection
|
||||
self.signaling_cid = signaling_cid
|
||||
self.state = self.State.CLOSED
|
||||
self.mtu = mtu
|
||||
self.mtu = spec.mtu
|
||||
self.peer_mtu = L2CAP_MIN_BR_EDR_MTU
|
||||
self.psm = psm
|
||||
self.source_cid = source_cid
|
||||
@@ -762,11 +1131,21 @@ class ClassicChannel(utils.EventEmitter):
|
||||
self.connection_result = None
|
||||
self.disconnection_result = None
|
||||
self.sink = None
|
||||
self.spec = spec
|
||||
if spec.mode == TransmissionMode.BASIC:
|
||||
self.processor = BaseProcessor(self)
|
||||
elif spec.mode == TransmissionMode.ENHANCED_RETRANSMISSION:
|
||||
self.processor = EnhancedRetransmissionProcessor(self)
|
||||
else:
|
||||
raise InvalidArgumentError(f"Mode {spec.mode} is not supported")
|
||||
|
||||
def _change_state(self, new_state: State) -> None:
|
||||
logger.debug(f'{self} state change -> {color(new_state.name, "cyan")}')
|
||||
self.state = new_state
|
||||
|
||||
def write(self, sdu: bytes) -> None:
|
||||
self.processor.send_sdu(sdu)
|
||||
|
||||
def send_pdu(self, pdu: Union[SupportsBytes, bytes]) -> None:
|
||||
if self.state != self.State.OPEN:
|
||||
raise InvalidStateError('channel not open')
|
||||
@@ -776,12 +1155,15 @@ class ClassicChannel(utils.EventEmitter):
|
||||
self.manager.send_control_frame(self.connection, self.signaling_cid, frame)
|
||||
|
||||
def on_pdu(self, pdu: bytes) -> None:
|
||||
self.processor.on_pdu(pdu)
|
||||
|
||||
def on_sdu(self, sdu: bytes) -> None:
|
||||
if self.sink:
|
||||
# pylint: disable=not-callable
|
||||
self.sink(pdu)
|
||||
self.sink(sdu)
|
||||
else:
|
||||
logger.warning(
|
||||
color('received pdu without a pending request or sink', 'red')
|
||||
color('received sdu without a pending request or sink', 'red')
|
||||
)
|
||||
|
||||
async def connect(self) -> None:
|
||||
@@ -835,20 +1217,33 @@ class ClassicChannel(utils.EventEmitter):
|
||||
self.emit(self.EVENT_CLOSE)
|
||||
|
||||
def send_configure_request(self) -> None:
|
||||
options = L2CAP_Control_Frame.encode_configuration_options(
|
||||
[
|
||||
options: list[tuple[int, bytes]] = [
|
||||
(
|
||||
L2CAP_Configure_Request.ParameterType.MTU,
|
||||
struct.pack('<H', self.mtu),
|
||||
)
|
||||
]
|
||||
if isinstance(self.processor, EnhancedRetransmissionProcessor):
|
||||
options.append(
|
||||
(
|
||||
L2CAP_MAXIMUM_TRANSMISSION_UNIT_CONFIGURATION_OPTION_TYPE,
|
||||
struct.pack('<H', self.mtu),
|
||||
L2CAP_Configure_Request.ParameterType.RETRANSMISSION_AND_FLOW_CONTROL,
|
||||
struct.pack(
|
||||
'<BBBHHH',
|
||||
TransmissionMode.ENHANCED_RETRANSMISSION,
|
||||
self.processor.tx_window_size,
|
||||
self.processor.max_retransmission,
|
||||
int(self.processor.retransmission_timeout * 1000),
|
||||
int(self.processor.monitor_timeout * 1000),
|
||||
self.processor.mps,
|
||||
),
|
||||
)
|
||||
]
|
||||
)
|
||||
)
|
||||
self.send_control_frame(
|
||||
L2CAP_Configure_Request(
|
||||
identifier=self.manager.next_identifier(self.connection),
|
||||
destination_cid=self.destination_cid,
|
||||
flags=0x0000,
|
||||
options=options,
|
||||
options=L2CAP_Control_Frame.encode_configuration_options(options),
|
||||
)
|
||||
)
|
||||
|
||||
@@ -903,20 +1298,85 @@ class ClassicChannel(utils.EventEmitter):
|
||||
|
||||
# Decode the options
|
||||
options = L2CAP_Control_Frame.decode_configuration_options(request.options)
|
||||
# Result to options
|
||||
replied_options = list[tuple[int, bytes]]()
|
||||
result = L2CAP_Configure_Response.Result.SUCCESS
|
||||
for option in options:
|
||||
if option[0] == L2CAP_MTU_CONFIGURATION_PARAMETER_TYPE:
|
||||
if option[0] == L2CAP_Configure_Request.ParameterType.MTU:
|
||||
self.peer_mtu = struct.unpack('<H', option[1])[0]
|
||||
logger.debug(f'peer MTU = {self.peer_mtu}')
|
||||
logger.debug('Peer MTU = %d', self.peer_mtu)
|
||||
replied_options.append(option)
|
||||
elif (
|
||||
option[0]
|
||||
== L2CAP_Configure_Request.ParameterType.RETRANSMISSION_AND_FLOW_CONTROL
|
||||
):
|
||||
(
|
||||
mode,
|
||||
peer_tx_window_size,
|
||||
peer_max_retransmission,
|
||||
peer_retransmission_timeout,
|
||||
peer_monitor_timeout,
|
||||
peer_mps,
|
||||
) = struct.unpack_from('<BBBHHH', option[1])
|
||||
logger.debug(
|
||||
'Peer requests Retransmission or Flow Control: mode=%s, tx_window_size=%s, retransmission_timeout=%s, monitor_timeout=%s, mps=%s',
|
||||
TransmissionMode(mode).name,
|
||||
peer_tx_window_size,
|
||||
peer_max_retransmission,
|
||||
peer_retransmission_timeout,
|
||||
peer_monitor_timeout,
|
||||
peer_mps,
|
||||
)
|
||||
if mode == TransmissionMode.BASIC:
|
||||
self.processor = BaseProcessor(self)
|
||||
replied_options.append(option)
|
||||
elif mode == TransmissionMode.ENHANCED_RETRANSMISSION:
|
||||
if (
|
||||
L2CAP_Information_Request.ExtendedFeatures.ENHANCED_RETRANSMISSION_MODE
|
||||
in self.manager.extended_features
|
||||
):
|
||||
self.processor = EnhancedRetransmissionProcessor(self)
|
||||
self.processor.peer_mps = peer_mps
|
||||
replied_options.append(option)
|
||||
else:
|
||||
logger.error("Enhanced Retransmission Mode is not enabled")
|
||||
result = L2CAP_Configure_Response.Result.FAILURE_REJECTED
|
||||
replied_options.clear()
|
||||
replied_options.append(option)
|
||||
break
|
||||
else:
|
||||
logger.error(
|
||||
"Mode %s is not supported", TransmissionMode(mode).name
|
||||
)
|
||||
result = (
|
||||
L2CAP_Configure_Response.Result.FAILURE_UNACCEPTABLE_PARAMETERS
|
||||
)
|
||||
replied_options.clear()
|
||||
replied_options.append(option)
|
||||
break
|
||||
else:
|
||||
logger.debug(
|
||||
"Reject unimplemented option %s[%s]",
|
||||
option[0].name,
|
||||
option[1].hex(),
|
||||
)
|
||||
result = L2CAP_Configure_Response.Result.FAILURE_UNKNOWN_OPTIONS
|
||||
replied_options.clear()
|
||||
replied_options.append(option)
|
||||
break
|
||||
|
||||
self.send_control_frame(
|
||||
L2CAP_Configure_Response(
|
||||
identifier=request.identifier,
|
||||
source_cid=self.destination_cid,
|
||||
flags=0x0000,
|
||||
result=L2CAP_Configure_Response.Result.SUCCESS,
|
||||
options=request.options, # TODO: don't accept everything blindly
|
||||
result=result,
|
||||
options=L2CAP_Control_Frame.encode_configuration_options(
|
||||
replied_options
|
||||
),
|
||||
)
|
||||
)
|
||||
|
||||
if self.state == self.State.WAIT_CONFIG:
|
||||
self._change_state(self.State.WAIT_SEND_CONFIG)
|
||||
self.send_configure_request()
|
||||
@@ -1383,13 +1843,13 @@ class ClassicChannelServer(utils.EventEmitter):
|
||||
manager: ChannelManager,
|
||||
psm: int,
|
||||
handler: Optional[Callable[[ClassicChannel], Any]],
|
||||
mtu: int,
|
||||
spec: ClassicChannelSpec,
|
||||
) -> None:
|
||||
super().__init__()
|
||||
self.manager = manager
|
||||
self.handler = handler
|
||||
self.psm = psm
|
||||
self.mtu = mtu
|
||||
self.spec = spec
|
||||
|
||||
def on_connection(self, channel: ClassicChannel) -> None:
|
||||
self.emit(self.EVENT_CONNECTION, channel)
|
||||
@@ -1462,7 +1922,7 @@ class ChannelManager:
|
||||
) # LE CoC channels, mapped by connection and destination cid
|
||||
self.le_coc_servers = {} # LE CoC - Servers accepting connections, by PSM
|
||||
self.le_coc_requests = {} # LE CoC connection requests, by identifier
|
||||
self.extended_features = extended_features
|
||||
self.extended_features = set(extended_features)
|
||||
self.connectionless_mtu = connectionless_mtu
|
||||
self.connection_parameters_update_response = None
|
||||
|
||||
@@ -1566,7 +2026,7 @@ class ChannelManager:
|
||||
raise InvalidArgumentError('invalid PSM')
|
||||
check >>= 8
|
||||
|
||||
self.servers[spec.psm] = ClassicChannelServer(self, spec.psm, handler, spec.mtu)
|
||||
self.servers[spec.psm] = ClassicChannelServer(self, spec.psm, handler, spec)
|
||||
|
||||
return self.servers[spec.psm]
|
||||
|
||||
@@ -1729,7 +2189,7 @@ class ChannelManager:
|
||||
f'creating server channel with cid={source_cid} for psm {request.psm}'
|
||||
)
|
||||
channel = ClassicChannel(
|
||||
self, connection, cid, request.psm, source_cid, server.mtu
|
||||
self, connection, cid, request.psm, source_cid, server.spec
|
||||
)
|
||||
connection_channels[source_cid] = channel
|
||||
|
||||
@@ -2187,12 +2647,12 @@ class ChannelManager:
|
||||
f'creating client channel with cid={source_cid} for psm {spec.psm}'
|
||||
)
|
||||
channel = ClassicChannel(
|
||||
self,
|
||||
connection,
|
||||
L2CAP_SIGNALING_CID,
|
||||
spec.psm,
|
||||
source_cid,
|
||||
spec.mtu,
|
||||
manager=self,
|
||||
connection=connection,
|
||||
signaling_cid=L2CAP_SIGNALING_CID,
|
||||
psm=spec.psm,
|
||||
source_cid=source_cid,
|
||||
spec=spec,
|
||||
)
|
||||
connection_channels[source_cid] = channel
|
||||
|
||||
|
||||
Reference in New Issue
Block a user