| # Copyright 2021-2022 Google LLC |
| # |
| # Licensed under the Apache License, Version 2.0 (the "License"); |
| # you may not use this file except in compliance with the License. |
| # You may obtain a copy of the License at |
| # |
| # https://www.apache.org/licenses/LICENSE-2.0 |
| # |
| # Unless required by applicable law or agreed to in writing, software |
| # distributed under the License is distributed on an "AS IS" BASIS, |
| # WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| # See the License for the specific language governing permissions and |
| # limitations under the License. |
| |
| # ----------------------------------------------------------------------------- |
| # Imports |
| # ----------------------------------------------------------------------------- |
| import asyncio |
| import logging |
| import struct |
| |
| from collections import deque |
| from colors import color |
| from pyee import EventEmitter |
| |
| from .core import BT_CENTRAL_ROLE, InvalidStateError, ProtocolError |
| from .hci import ( |
| HCI_LE_Connection_Update_Command, |
| HCI_Object, |
| key_with_value, |
| name_or_number, |
| ) |
| |
| # ----------------------------------------------------------------------------- |
| # Logging |
| # ----------------------------------------------------------------------------- |
| logger = logging.getLogger(__name__) |
| |
| |
| # ----------------------------------------------------------------------------- |
| # Constants |
| # ----------------------------------------------------------------------------- |
| # fmt: off |
| # pylint: disable=line-too-long |
| |
| L2CAP_SIGNALING_CID = 0x01 |
| L2CAP_LE_SIGNALING_CID = 0x05 |
| |
| L2CAP_MIN_LE_MTU = 23 |
| L2CAP_MIN_BR_EDR_MTU = 48 |
| |
| L2CAP_DEFAULT_MTU = 2048 # Default value for the MTU we are willing to accept |
| |
| L2CAP_DEFAULT_CONNECTIONLESS_MTU = 1024 |
| |
| # See Bluetooth spec @ Vol 3, Part A - Table 2.1: CID name space on ACL-U, ASB-U, and AMP-U logical links |
| L2CAP_ACL_U_DYNAMIC_CID_RANGE_START = 0x0040 |
| L2CAP_ACL_U_DYNAMIC_CID_RANGE_END = 0xFFFF |
| |
| # See Bluetooth spec @ Vol 3, Part A - Table 2.2: CID name space on LE-U logical link |
| L2CAP_LE_U_DYNAMIC_CID_RANGE_START = 0x0040 |
| L2CAP_LE_U_DYNAMIC_CID_RANGE_END = 0x007F |
| |
| # PSM Range - See Bluetooth spec @ Vol 3, Part A / Table 4.5: PSM ranges and usage |
| L2CAP_PSM_DYNAMIC_RANGE_START = 0x1001 |
| L2CAP_PSM_DYNAMIC_RANGE_END = 0xFFFF |
| |
| # LE PSM Ranges - See Bluetooth spec @ Vol 3, Part A / Table 4.19: LE Credit Based Connection Request LE_PSM ranges |
| L2CAP_LE_PSM_DYNAMIC_RANGE_START = 0x0080 |
| L2CAP_LE_PSM_DYNAMIC_RANGE_END = 0x00FF |
| |
| # Frame types |
| L2CAP_COMMAND_REJECT = 0x01 |
| L2CAP_CONNECTION_REQUEST = 0x02 |
| L2CAP_CONNECTION_RESPONSE = 0x03 |
| L2CAP_CONFIGURE_REQUEST = 0x04 |
| L2CAP_CONFIGURE_RESPONSE = 0x05 |
| L2CAP_DISCONNECTION_REQUEST = 0x06 |
| L2CAP_DISCONNECTION_RESPONSE = 0x07 |
| L2CAP_ECHO_REQUEST = 0x08 |
| L2CAP_ECHO_RESPONSE = 0x09 |
| L2CAP_INFORMATION_REQUEST = 0x0A |
| L2CAP_INFORMATION_RESPONSE = 0x0B |
| L2CAP_CREATE_CHANNEL_REQUEST = 0x0C |
| L2CAP_CREATE_CHANNEL_RESPONSE = 0x0D |
| L2CAP_MOVE_CHANNEL_REQUEST = 0x0E |
| L2CAP_MOVE_CHANNEL_RESPONSE = 0x0F |
| L2CAP_MOVE_CHANNEL_CONFIRMATION = 0x10 |
| L2CAP_MOVE_CHANNEL_CONFIRMATION_RESPONSE = 0x11 |
| L2CAP_CONNECTION_PARAMETER_UPDATE_REQUEST = 0x12 |
| L2CAP_CONNECTION_PARAMETER_UPDATE_RESPONSE = 0x13 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_REQUEST = 0x14 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_RESPONSE = 0x15 |
| L2CAP_LE_FLOW_CONTROL_CREDIT = 0x16 |
| |
| L2CAP_CONTROL_FRAME_NAMES = { |
| L2CAP_COMMAND_REJECT: 'L2CAP_COMMAND_REJECT', |
| L2CAP_CONNECTION_REQUEST: 'L2CAP_CONNECTION_REQUEST', |
| L2CAP_CONNECTION_RESPONSE: 'L2CAP_CONNECTION_RESPONSE', |
| L2CAP_CONFIGURE_REQUEST: 'L2CAP_CONFIGURE_REQUEST', |
| L2CAP_CONFIGURE_RESPONSE: 'L2CAP_CONFIGURE_RESPONSE', |
| L2CAP_DISCONNECTION_REQUEST: 'L2CAP_DISCONNECTION_REQUEST', |
| L2CAP_DISCONNECTION_RESPONSE: 'L2CAP_DISCONNECTION_RESPONSE', |
| L2CAP_ECHO_REQUEST: 'L2CAP_ECHO_REQUEST', |
| L2CAP_ECHO_RESPONSE: 'L2CAP_ECHO_RESPONSE', |
| L2CAP_INFORMATION_REQUEST: 'L2CAP_INFORMATION_REQUEST', |
| L2CAP_INFORMATION_RESPONSE: 'L2CAP_INFORMATION_RESPONSE', |
| L2CAP_CREATE_CHANNEL_REQUEST: 'L2CAP_CREATE_CHANNEL_REQUEST', |
| L2CAP_CREATE_CHANNEL_RESPONSE: 'L2CAP_CREATE_CHANNEL_RESPONSE', |
| L2CAP_MOVE_CHANNEL_REQUEST: 'L2CAP_MOVE_CHANNEL_REQUEST', |
| L2CAP_MOVE_CHANNEL_RESPONSE: 'L2CAP_MOVE_CHANNEL_RESPONSE', |
| L2CAP_MOVE_CHANNEL_CONFIRMATION: 'L2CAP_MOVE_CHANNEL_CONFIRMATION', |
| L2CAP_MOVE_CHANNEL_CONFIRMATION_RESPONSE: 'L2CAP_MOVE_CHANNEL_CONFIRMATION_RESPONSE', |
| L2CAP_CONNECTION_PARAMETER_UPDATE_REQUEST: 'L2CAP_CONNECTION_PARAMETER_UPDATE_REQUEST', |
| L2CAP_CONNECTION_PARAMETER_UPDATE_RESPONSE: 'L2CAP_CONNECTION_PARAMETER_UPDATE_RESPONSE', |
| L2CAP_LE_CREDIT_BASED_CONNECTION_REQUEST: 'L2CAP_LE_CREDIT_BASED_CONNECTION_REQUEST', |
| L2CAP_LE_CREDIT_BASED_CONNECTION_RESPONSE: 'L2CAP_LE_CREDIT_BASED_CONNECTION_RESPONSE', |
| L2CAP_LE_FLOW_CONTROL_CREDIT: 'L2CAP_LE_FLOW_CONTROL_CREDIT' |
| } |
| |
| L2CAP_CONNECTION_PARAMETERS_ACCEPTED_RESULT = 0x0000 |
| L2CAP_CONNECTION_PARAMETERS_REJECTED_RESULT = 0x0001 |
| |
| L2CAP_COMMAND_NOT_UNDERSTOOD_REASON = 0x0000 |
| L2CAP_SIGNALING_MTU_EXCEEDED_REASON = 0x0001 |
| L2CAP_INVALID_CID_IN_REQUEST_REASON = 0x0002 |
| |
| L2CAP_LE_CREDIT_BASED_CONNECTION_MAX_CREDITS = 65535 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_MIN_MTU = 23 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_MIN_MPS = 23 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_MAX_MPS = 65533 |
| L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU = 2046 |
| 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 |
| |
| |
| # ----------------------------------------------------------------------------- |
| # Classes |
| # ----------------------------------------------------------------------------- |
| # pylint: disable=invalid-name |
| |
| |
| class L2CAP_PDU: |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 3 DATA PACKET FORMAT |
| ''' |
| |
| @staticmethod |
| def from_bytes(data): |
| # Sanity check |
| if len(data) < 4: |
| raise ValueError('not enough data for L2CAP header') |
| |
| _, l2cap_pdu_cid = struct.unpack_from('<HH', data, 0) |
| l2cap_pdu_payload = data[4:] |
| |
| return L2CAP_PDU(l2cap_pdu_cid, l2cap_pdu_payload) |
| |
| def to_bytes(self): |
| header = struct.pack('<HH', len(self.payload), self.cid) |
| return header + self.payload |
| |
| def __init__(self, cid, payload): |
| self.cid = cid |
| self.payload = payload |
| |
| def __bytes__(self): |
| return self.to_bytes() |
| |
| def __str__(self): |
| return f'{color("L2CAP", "green")} [CID={self.cid}]: {self.payload.hex()}' |
| |
| |
| # ----------------------------------------------------------------------------- |
| class L2CAP_Control_Frame: |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4 SIGNALING PACKET FORMATS |
| ''' |
| |
| classes = {} |
| code = 0 |
| name = None |
| |
| @staticmethod |
| def from_bytes(pdu): |
| code = pdu[0] |
| |
| cls = L2CAP_Control_Frame.classes.get(code) |
| if cls is None: |
| instance = L2CAP_Control_Frame(pdu) |
| instance.name = L2CAP_Control_Frame.code_name(code) |
| instance.code = code |
| return instance |
| self = cls.__new__(cls) |
| L2CAP_Control_Frame.__init__(self, pdu) |
| self.identifier = pdu[1] |
| length = struct.unpack_from('<H', pdu, 2)[0] |
| if length + 4 != len(pdu): |
| logger.warning( |
| color( |
| f'!!! length mismatch: expected {len(pdu) - 4} but got {length}', |
| 'red', |
| ) |
| ) |
| if hasattr(self, 'fields'): |
| self.init_from_bytes(pdu, 4) |
| return self |
| |
| @staticmethod |
| def code_name(code): |
| return name_or_number(L2CAP_CONTROL_FRAME_NAMES, code) |
| |
| @staticmethod |
| def decode_configuration_options(data): |
| 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)) |
| |
| return options |
| |
| @staticmethod |
| def encode_configuration_options(options): |
| return b''.join( |
| [bytes([option[0], len(option[1])]) + option[1] for option in options] |
| ) |
| |
| @staticmethod |
| def subclass(fields): |
| def inner(cls): |
| cls.name = cls.__name__.upper() |
| cls.code = key_with_value(L2CAP_CONTROL_FRAME_NAMES, cls.name) |
| if cls.code is None: |
| raise KeyError( |
| f'Control Frame name {cls.name} ' |
| 'not found in L2CAP_CONTROL_FRAME_NAMES' |
| ) |
| cls.fields = fields |
| |
| # Register a factory for this class |
| L2CAP_Control_Frame.classes[cls.code] = cls |
| |
| return cls |
| |
| return inner |
| |
| def __init__(self, pdu=None, **kwargs): |
| self.identifier = kwargs.get('identifier', 0) |
| if hasattr(self, 'fields') and kwargs: |
| HCI_Object.init_from_fields(self, self.fields, kwargs) |
| if pdu is None: |
| data = HCI_Object.dict_to_bytes(kwargs, self.fields) |
| pdu = ( |
| bytes([self.code, self.identifier]) |
| + struct.pack('<H', len(data)) |
| + data |
| ) |
| self.pdu = pdu |
| |
| def init_from_bytes(self, pdu, offset): |
| return HCI_Object.init_from_bytes(self, pdu, offset, self.fields) |
| |
| def to_bytes(self): |
| return self.pdu |
| |
| def __bytes__(self): |
| return self.to_bytes() |
| |
| def __str__(self): |
| result = f'{color(self.name, "yellow")} [ID={self.identifier}]' |
| if fields := getattr(self, 'fields', None): |
| result += ':\n' + HCI_Object.format_fields(self.__dict__, fields, ' ') |
| else: |
| if len(self.pdu) > 1: |
| result += f': {self.pdu.hex()}' |
| return result |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| # pylint: disable=unnecessary-lambda |
| [ |
| ( |
| 'reason', |
| {'size': 2, 'mapper': lambda x: L2CAP_Command_Reject.reason_name(x)}, |
| ), |
| ('data', '*'), |
| ] |
| ) |
| class L2CAP_Command_Reject(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.1 COMMAND REJECT |
| ''' |
| |
| COMMAND_NOT_UNDERSTOOD = 0x0000 |
| SIGNALING_MTU_EXCEEDED = 0x0001 |
| INVALID_CID_IN_REQUEST = 0x0002 |
| |
| REASON_NAMES = { |
| COMMAND_NOT_UNDERSTOOD: 'COMMAND_NOT_UNDERSTOOD', |
| SIGNALING_MTU_EXCEEDED: 'SIGNALING_MTU_EXCEEDED', |
| INVALID_CID_IN_REQUEST: 'INVALID_CID_IN_REQUEST', |
| } |
| |
| @staticmethod |
| def reason_name(reason): |
| return name_or_number(L2CAP_Command_Reject.REASON_NAMES, reason) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| # pylint: disable=unnecessary-lambda |
| [ |
| ( |
| 'psm', |
| { |
| 'parser': lambda data, offset: L2CAP_Connection_Request.parse_psm( |
| data, offset |
| ), |
| 'serializer': lambda value: L2CAP_Connection_Request.serialize_psm( |
| value |
| ), |
| }, |
| ), |
| ('source_cid', 2), |
| ] |
| ) |
| class L2CAP_Connection_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.2 CONNECTION REQUEST |
| ''' |
| |
| @staticmethod |
| def parse_psm(data, offset=0): |
| psm_length = 2 |
| psm = data[offset] | data[offset + 1] << 8 |
| |
| # The PSM field extends until the first even octet (inclusive) |
| while data[offset + psm_length - 1] % 2 == 1: |
| psm |= data[offset + psm_length] << (8 * psm_length) |
| psm_length += 1 |
| |
| return offset + psm_length, psm |
| |
| @staticmethod |
| def serialize_psm(psm): |
| serialized = struct.pack('<H', psm & 0xFFFF) |
| psm >>= 16 |
| while psm: |
| serialized += bytes([psm & 0xFF]) |
| psm >>= 8 |
| |
| return serialized |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| # pylint: disable=unnecessary-lambda |
| [ |
| ('destination_cid', 2), |
| ('source_cid', 2), |
| ( |
| 'result', |
| {'size': 2, 'mapper': lambda x: L2CAP_Connection_Response.result_name(x)}, |
| ), |
| ('status', 2), |
| ] |
| ) |
| class L2CAP_Connection_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.3 CONNECTION RESPONSE |
| ''' |
| |
| CONNECTION_SUCCESSFUL = 0x0000 |
| CONNECTION_PENDING = 0x0001 |
| CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED = 0x0002 |
| CONNECTION_REFUSED_SECURITY_BLOCK = 0x0003 |
| CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE = 0x0004 |
| CONNECTION_REFUSED_INVALID_SOURCE_CID = 0x0006 |
| CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED = 0x0007 |
| CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS = 0x000B |
| |
| # pylint: disable=line-too-long |
| RESULT_NAMES = { |
| CONNECTION_SUCCESSFUL: 'CONNECTION_SUCCESSFUL', |
| CONNECTION_PENDING: 'CONNECTION_PENDING', |
| CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED: 'CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED', |
| CONNECTION_REFUSED_SECURITY_BLOCK: 'CONNECTION_REFUSED_SECURITY_BLOCK', |
| CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE: 'CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE', |
| CONNECTION_REFUSED_INVALID_SOURCE_CID: 'CONNECTION_REFUSED_INVALID_SOURCE_CID', |
| CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED: 'CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED', |
| CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS: 'CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS', |
| } |
| |
| @staticmethod |
| def result_name(result): |
| return name_or_number(L2CAP_Connection_Response.RESULT_NAMES, result) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('destination_cid', 2), ('flags', 2), ('options', '*')]) |
| class L2CAP_Configure_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.4 CONFIGURATION REQUEST |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| # pylint: disable=unnecessary-lambda |
| [ |
| ('source_cid', 2), |
| ('flags', 2), |
| ( |
| 'result', |
| {'size': 2, 'mapper': lambda x: L2CAP_Configure_Response.result_name(x)}, |
| ), |
| ('options', '*'), |
| ] |
| ) |
| class L2CAP_Configure_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.5 CONFIGURATION RESPONSE |
| ''' |
| |
| SUCCESS = 0x0000 |
| FAILURE_UNACCEPTABLE_PARAMETERS = 0x0001 |
| FAILURE_REJECTED = 0x0002 |
| FAILURE_UNKNOWN_OPTIONS = 0x0003 |
| PENDING = 0x0004 |
| FAILURE_FLOW_SPEC_REJECTED = 0x0005 |
| |
| RESULT_NAMES = { |
| SUCCESS: 'SUCCESS', |
| FAILURE_UNACCEPTABLE_PARAMETERS: 'FAILURE_UNACCEPTABLE_PARAMETERS', |
| FAILURE_REJECTED: 'FAILURE_REJECTED', |
| FAILURE_UNKNOWN_OPTIONS: 'FAILURE_UNKNOWN_OPTIONS', |
| PENDING: 'PENDING', |
| FAILURE_FLOW_SPEC_REJECTED: 'FAILURE_FLOW_SPEC_REJECTED', |
| } |
| |
| @staticmethod |
| def result_name(result): |
| return name_or_number(L2CAP_Configure_Response.RESULT_NAMES, result) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('destination_cid', 2), ('source_cid', 2)]) |
| class L2CAP_Disconnection_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.6 DISCONNECTION REQUEST |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('destination_cid', 2), ('source_cid', 2)]) |
| class L2CAP_Disconnection_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.7 DISCONNECTION RESPONSE |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('data', '*')]) |
| class L2CAP_Echo_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.8 ECHO REQUEST |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('data', '*')]) |
| class L2CAP_Echo_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.9 ECHO RESPONSE |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| [ |
| ( |
| 'info_type', |
| { |
| 'size': 2, |
| # pylint: disable-next=unnecessary-lambda |
| 'mapper': lambda x: L2CAP_Information_Request.info_type_name(x), |
| }, |
| ) |
| ] |
| ) |
| class L2CAP_Information_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.10 INFORMATION REQUEST |
| ''' |
| |
| CONNECTIONLESS_MTU = 0x0001 |
| 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 |
| |
| INFO_TYPE_NAMES = { |
| CONNECTIONLESS_MTU: 'CONNECTIONLESS_MTU', |
| EXTENDED_FEATURES_SUPPORTED: 'EXTENDED_FEATURES_SUPPORTED', |
| FIXED_CHANNELS_SUPPORTED: 'FIXED_CHANNELS_SUPPORTED', |
| } |
| |
| @staticmethod |
| def info_type_name(info_type): |
| return name_or_number(L2CAP_Information_Request.INFO_TYPE_NAMES, info_type) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| [ |
| ('info_type', {'size': 2, 'mapper': L2CAP_Information_Request.info_type_name}), |
| ( |
| 'result', |
| # pylint: disable-next=unnecessary-lambda |
| {'size': 2, 'mapper': lambda x: L2CAP_Information_Response.result_name(x)}, |
| ), |
| ('data', '*'), |
| ] |
| ) |
| class L2CAP_Information_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.11 INFORMATION RESPONSE |
| ''' |
| |
| SUCCESS = 0x00 |
| NOT_SUPPORTED = 0x01 |
| |
| RESULT_NAMES = {SUCCESS: 'SUCCESS', NOT_SUPPORTED: 'NOT_SUPPORTED'} |
| |
| @staticmethod |
| def result_name(result): |
| return name_or_number(L2CAP_Information_Response.RESULT_NAMES, result) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| [('interval_min', 2), ('interval_max', 2), ('latency', 2), ('timeout', 2)] |
| ) |
| class L2CAP_Connection_Parameter_Update_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.20 CONNECTION PARAMETER UPDATE REQUEST |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('result', 2)]) |
| class L2CAP_Connection_Parameter_Update_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.21 CONNECTION PARAMETER UPDATE RESPONSE |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| [('le_psm', 2), ('source_cid', 2), ('mtu', 2), ('mps', 2), ('initial_credits', 2)] |
| ) |
| class L2CAP_LE_Credit_Based_Connection_Request(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.22 LE CREDIT BASED CONNECTION REQUEST |
| (CODE 0x14) |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass( |
| # pylint: disable=unnecessary-lambda,line-too-long |
| [ |
| ('destination_cid', 2), |
| ('mtu', 2), |
| ('mps', 2), |
| ('initial_credits', 2), |
| ( |
| 'result', |
| { |
| 'size': 2, |
| 'mapper': lambda x: L2CAP_LE_Credit_Based_Connection_Response.result_name( |
| x |
| ), |
| }, |
| ), |
| ] |
| ) |
| class L2CAP_LE_Credit_Based_Connection_Response(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.23 LE CREDIT BASED CONNECTION RESPONSE |
| (CODE 0x15) |
| ''' |
| |
| CONNECTION_SUCCESSFUL = 0x0000 |
| CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED = 0x0002 |
| CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE = 0x0004 |
| CONNECTION_REFUSED_INSUFFICIENT_AUTHENTICATION = 0x0005 |
| CONNECTION_REFUSED_INSUFFICIENT_AUTHORIZATION = 0x0006 |
| CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION_KEY_SIZE = 0x0007 |
| CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION = 0x0008 |
| CONNECTION_REFUSED_INVALID_SOURCE_CID = 0x0009 |
| CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED = 0x000A |
| CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS = 0x000B |
| |
| # pylint: disable=line-too-long |
| RESULT_NAMES = { |
| CONNECTION_SUCCESSFUL: 'CONNECTION_SUCCESSFUL', |
| CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED: 'CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED', |
| CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE: 'CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE', |
| CONNECTION_REFUSED_INSUFFICIENT_AUTHENTICATION: 'CONNECTION_REFUSED_INSUFFICIENT_AUTHENTICATION', |
| CONNECTION_REFUSED_INSUFFICIENT_AUTHORIZATION: 'CONNECTION_REFUSED_INSUFFICIENT_AUTHORIZATION', |
| CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION_KEY_SIZE: 'CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION_KEY_SIZE', |
| CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION: 'CONNECTION_REFUSED_INSUFFICIENT_ENCRYPTION', |
| CONNECTION_REFUSED_INVALID_SOURCE_CID: 'CONNECTION_REFUSED_INVALID_SOURCE_CID', |
| CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED: 'CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED', |
| CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS: 'CONNECTION_REFUSED_UNACCEPTABLE_PARAMETERS', |
| } |
| |
| @staticmethod |
| def result_name(result): |
| return name_or_number( |
| L2CAP_LE_Credit_Based_Connection_Response.RESULT_NAMES, result |
| ) |
| |
| |
| # ----------------------------------------------------------------------------- |
| @L2CAP_Control_Frame.subclass([('cid', 2), ('credits', 2)]) |
| class L2CAP_LE_Flow_Control_Credit(L2CAP_Control_Frame): |
| ''' |
| See Bluetooth spec @ Vol 3, Part A - 4.24 LE FLOW CONTROL CREDIT (CODE 0x16) |
| ''' |
| |
| |
| # ----------------------------------------------------------------------------- |
| class Channel(EventEmitter): |
| # States |
| CLOSED = 0x00 |
| WAIT_CONNECT = 0x01 |
| WAIT_CONNECT_RSP = 0x02 |
| OPEN = 0x03 |
| WAIT_DISCONNECT = 0x04 |
| WAIT_CREATE = 0x05 |
| WAIT_CREATE_RSP = 0x06 |
| WAIT_MOVE = 0x07 |
| WAIT_MOVE_RSP = 0x08 |
| WAIT_MOVE_CONFIRM = 0x09 |
| WAIT_CONFIRM_RSP = 0x0A |
| |
| # CONFIG substates |
| WAIT_CONFIG = 0x10 |
| WAIT_SEND_CONFIG = 0x11 |
| WAIT_CONFIG_REQ_RSP = 0x12 |
| WAIT_CONFIG_RSP = 0x13 |
| WAIT_CONFIG_REQ = 0x14 |
| WAIT_IND_FINAL_RSP = 0x15 |
| WAIT_FINAL_RSP = 0x16 |
| WAIT_CONTROL_IND = 0x17 |
| |
| STATE_NAMES = { |
| CLOSED: 'CLOSED', |
| WAIT_CONNECT: 'WAIT_CONNECT', |
| WAIT_CONNECT_RSP: 'WAIT_CONNECT_RSP', |
| OPEN: 'OPEN', |
| WAIT_DISCONNECT: 'WAIT_DISCONNECT', |
| WAIT_CREATE: 'WAIT_CREATE', |
| WAIT_CREATE_RSP: 'WAIT_CREATE_RSP', |
| WAIT_MOVE: 'WAIT_MOVE', |
| WAIT_MOVE_RSP: 'WAIT_MOVE_RSP', |
| WAIT_MOVE_CONFIRM: 'WAIT_MOVE_CONFIRM', |
| WAIT_CONFIRM_RSP: 'WAIT_CONFIRM_RSP', |
| WAIT_CONFIG: 'WAIT_CONFIG', |
| WAIT_SEND_CONFIG: 'WAIT_SEND_CONFIG', |
| WAIT_CONFIG_REQ_RSP: 'WAIT_CONFIG_REQ_RSP', |
| WAIT_CONFIG_RSP: 'WAIT_CONFIG_RSP', |
| WAIT_CONFIG_REQ: 'WAIT_CONFIG_REQ', |
| WAIT_IND_FINAL_RSP: 'WAIT_IND_FINAL_RSP', |
| WAIT_FINAL_RSP: 'WAIT_FINAL_RSP', |
| WAIT_CONTROL_IND: 'WAIT_CONTROL_IND', |
| } |
| |
| def __init__(self, manager, connection, signaling_cid, psm, source_cid, mtu): |
| super().__init__() |
| self.manager = manager |
| self.connection = connection |
| self.signaling_cid = signaling_cid |
| self.state = Channel.CLOSED |
| self.mtu = mtu |
| self.psm = psm |
| self.source_cid = source_cid |
| self.destination_cid = 0 |
| self.response = None |
| self.connection_result = None |
| self.disconnection_result = None |
| self.sink = None |
| |
| def change_state(self, new_state): |
| logger.debug( |
| f'{self} state change -> {color(Channel.STATE_NAMES[new_state], "cyan")}' |
| ) |
| self.state = new_state |
| |
| def send_pdu(self, pdu): |
| self.manager.send_pdu(self.connection, self.destination_cid, pdu) |
| |
| def send_control_frame(self, frame): |
| self.manager.send_control_frame(self.connection, self.signaling_cid, frame) |
| |
| async def send_request(self, request): |
| # Check that there isn't already a request pending |
| if self.response: |
| raise InvalidStateError('request already pending') |
| if self.state != Channel.OPEN: |
| raise InvalidStateError('channel not open') |
| |
| self.response = asyncio.get_running_loop().create_future() |
| self.send_pdu(request) |
| return await self.response |
| |
| def on_pdu(self, pdu): |
| if self.response: |
| self.response.set_result(pdu) |
| self.response = None |
| elif self.sink: |
| # pylint: disable=not-callable |
| self.sink(pdu) |
| else: |
| logger.warning( |
| color('received pdu without a pending request or sink', 'red') |
| ) |
| |
| async def connect(self): |
| if self.state != Channel.CLOSED: |
| raise InvalidStateError('invalid state') |
| |
| # Check that we can start a new connection |
| if self.connection_result: |
| raise RuntimeError('connection already pending') |
| |
| self.change_state(Channel.WAIT_CONNECT_RSP) |
| self.send_control_frame( |
| L2CAP_Connection_Request( |
| identifier=self.manager.next_identifier(self.connection), |
| psm=self.psm, |
| source_cid=self.source_cid, |
| ) |
| ) |
| |
| # Create a future to wait for the state machine to get to a success or error |
| # state |
| self.connection_result = asyncio.get_running_loop().create_future() |
| |
| # Wait for the connection to succeed or fail |
| try: |
| return await self.connection_result |
| finally: |
| self.connection_result = None |
| |
| async def disconnect(self): |
| if self.state != Channel.OPEN: |
| raise InvalidStateError('invalid state') |
| |
| self.change_state(Channel.WAIT_DISCONNECT) |
| self.send_control_frame( |
| L2CAP_Disconnection_Request( |
| identifier=self.manager.next_identifier(self.connection), |
| destination_cid=self.destination_cid, |
| source_cid=self.source_cid, |
| ) |
| ) |
| |
| # Create a future to wait for the state machine to get to a success or error |
| # state |
| self.disconnection_result = asyncio.get_running_loop().create_future() |
| return await self.disconnection_result |
| |
| def send_configure_request(self): |
| options = L2CAP_Control_Frame.encode_configuration_options( |
| [ |
| ( |
| L2CAP_MAXIMUM_TRANSMISSION_UNIT_CONFIGURATION_OPTION_TYPE, |
| struct.pack('<H', L2CAP_DEFAULT_MTU), |
| ) |
| ] |
| ) |
| self.send_control_frame( |
| L2CAP_Configure_Request( |
| identifier=self.manager.next_identifier(self.connection), |
| destination_cid=self.destination_cid, |
| flags=0x0000, |
| options=options, |
| ) |
| ) |
| |
| def on_connection_request(self, request): |
| self.destination_cid = request.source_cid |
| self.change_state(Channel.WAIT_CONNECT) |
| self.send_control_frame( |
| L2CAP_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=self.source_cid, |
| source_cid=self.destination_cid, |
| result=L2CAP_Connection_Response.CONNECTION_SUCCESSFUL, |
| status=0x0000, |
| ) |
| ) |
| self.change_state(Channel.WAIT_CONFIG) |
| self.send_configure_request() |
| self.change_state(Channel.WAIT_CONFIG_REQ_RSP) |
| |
| def on_connection_response(self, response): |
| if self.state != Channel.WAIT_CONNECT_RSP: |
| logger.warning(color('invalid state', 'red')) |
| return |
| |
| if response.result == L2CAP_Connection_Response.CONNECTION_SUCCESSFUL: |
| self.destination_cid = response.destination_cid |
| self.change_state(Channel.WAIT_CONFIG) |
| self.send_configure_request() |
| self.change_state(Channel.WAIT_CONFIG_REQ_RSP) |
| elif response.result == L2CAP_Connection_Response.CONNECTION_PENDING: |
| pass |
| else: |
| self.change_state(Channel.CLOSED) |
| self.connection_result.set_exception( |
| ProtocolError( |
| response.result, |
| 'l2cap', |
| L2CAP_Connection_Response.result_name(response.result), |
| ) |
| ) |
| self.connection_result = None |
| |
| def on_configure_request(self, request): |
| if self.state not in ( |
| Channel.WAIT_CONFIG, |
| Channel.WAIT_CONFIG_REQ, |
| Channel.WAIT_CONFIG_REQ_RSP, |
| ): |
| logger.warning(color('invalid state', 'red')) |
| return |
| |
| # Decode the options |
| options = L2CAP_Control_Frame.decode_configuration_options(request.options) |
| for option in options: |
| if option[0] == L2CAP_MTU_CONFIGURATION_PARAMETER_TYPE: |
| self.mtu = struct.unpack('<H', option[1])[0] |
| logger.debug(f'MTU = {self.mtu}') |
| |
| self.send_control_frame( |
| L2CAP_Configure_Response( |
| identifier=request.identifier, |
| source_cid=self.destination_cid, |
| flags=0x0000, |
| result=L2CAP_Configure_Response.SUCCESS, |
| options=request.options, # TODO: don't accept everything blindly |
| ) |
| ) |
| if self.state == Channel.WAIT_CONFIG: |
| self.change_state(Channel.WAIT_SEND_CONFIG) |
| self.send_configure_request() |
| self.change_state(Channel.WAIT_CONFIG_RSP) |
| elif self.state == Channel.WAIT_CONFIG_REQ: |
| self.change_state(Channel.OPEN) |
| if self.connection_result: |
| self.connection_result.set_result(None) |
| self.connection_result = None |
| self.emit('open') |
| elif self.state == Channel.WAIT_CONFIG_REQ_RSP: |
| self.change_state(Channel.WAIT_CONFIG_RSP) |
| |
| def on_configure_response(self, response): |
| if response.result == L2CAP_Configure_Response.SUCCESS: |
| if self.state == Channel.WAIT_CONFIG_REQ_RSP: |
| self.change_state(Channel.WAIT_CONFIG_REQ) |
| elif self.state in (Channel.WAIT_CONFIG_RSP, Channel.WAIT_CONTROL_IND): |
| self.change_state(Channel.OPEN) |
| if self.connection_result: |
| self.connection_result.set_result(None) |
| self.connection_result = None |
| self.emit('open') |
| else: |
| logger.warning(color('invalid state', 'red')) |
| elif ( |
| response.result == L2CAP_Configure_Response.FAILURE_UNACCEPTABLE_PARAMETERS |
| ): |
| # Re-configure with what's suggested in the response |
| self.send_control_frame( |
| L2CAP_Configure_Request( |
| identifier=self.manager.next_identifier(self.connection), |
| destination_cid=self.destination_cid, |
| flags=0x0000, |
| options=response.options, |
| ) |
| ) |
| else: |
| logger.warning( |
| color( |
| '!!! configuration rejected: ' |
| f'{L2CAP_Configure_Response.result_name(response.result)}', |
| 'red', |
| ) |
| ) |
| # TODO: decide how to fail gracefully |
| |
| def on_disconnection_request(self, request): |
| if self.state in (Channel.OPEN, Channel.WAIT_DISCONNECT): |
| self.send_control_frame( |
| L2CAP_Disconnection_Response( |
| identifier=request.identifier, |
| destination_cid=request.destination_cid, |
| source_cid=request.source_cid, |
| ) |
| ) |
| self.change_state(Channel.CLOSED) |
| self.emit('close') |
| self.manager.on_channel_closed(self) |
| else: |
| logger.warning(color('invalid state', 'red')) |
| |
| def on_disconnection_response(self, response): |
| if self.state != Channel.WAIT_DISCONNECT: |
| logger.warning(color('invalid state', 'red')) |
| return |
| |
| if ( |
| response.destination_cid != self.destination_cid |
| or response.source_cid != self.source_cid |
| ): |
| logger.warning('unexpected source or destination CID') |
| return |
| |
| self.change_state(Channel.CLOSED) |
| if self.disconnection_result: |
| self.disconnection_result.set_result(None) |
| self.disconnection_result = None |
| self.emit('close') |
| self.manager.on_channel_closed(self) |
| |
| def __str__(self): |
| return ( |
| f'Channel({self.source_cid}->{self.destination_cid}, ' |
| f'PSM={self.psm}, ' |
| f'MTU={self.mtu}, ' |
| f'state={Channel.STATE_NAMES[self.state]})' |
| ) |
| |
| |
| # ----------------------------------------------------------------------------- |
| class LeConnectionOrientedChannel(EventEmitter): |
| """ |
| LE Credit-based Connection Oriented Channel |
| """ |
| |
| INIT = 0 |
| CONNECTED = 1 |
| CONNECTING = 2 |
| DISCONNECTING = 3 |
| DISCONNECTED = 4 |
| CONNECTION_ERROR = 5 |
| |
| STATE_NAMES = { |
| INIT: 'INIT', |
| CONNECTED: 'CONNECTED', |
| CONNECTING: 'CONNECTING', |
| DISCONNECTING: 'DISCONNECTING', |
| DISCONNECTED: 'DISCONNECTED', |
| CONNECTION_ERROR: 'CONNECTION_ERROR', |
| } |
| |
| @staticmethod |
| def state_name(state): |
| return name_or_number(LeConnectionOrientedChannel.STATE_NAMES, state) |
| |
| def __init__( |
| self, |
| manager, |
| connection, |
| le_psm, |
| source_cid, |
| destination_cid, |
| mtu, |
| mps, |
| credits, # pylint: disable=redefined-builtin |
| peer_mtu, |
| peer_mps, |
| peer_credits, |
| connected, |
| ): |
| super().__init__() |
| self.manager = manager |
| self.connection = connection |
| self.le_psm = le_psm |
| self.source_cid = source_cid |
| self.destination_cid = destination_cid |
| self.mtu = mtu |
| self.mps = mps |
| self.credits = credits |
| self.peer_mtu = peer_mtu |
| self.peer_mps = peer_mps |
| self.peer_credits = peer_credits |
| self.peer_max_credits = self.peer_credits |
| self.peer_credits_threshold = self.peer_max_credits // 2 |
| self.in_sdu = None |
| self.in_sdu_length = 0 |
| self.out_queue = deque() |
| self.out_sdu = None |
| self.sink = None |
| self.connected = False |
| self.connection_result = None |
| self.disconnection_result = None |
| self.drained = asyncio.Event() |
| |
| self.drained.set() |
| |
| if connected: |
| self.state = LeConnectionOrientedChannel.CONNECTED |
| else: |
| self.state = LeConnectionOrientedChannel.INIT |
| |
| def change_state(self, new_state): |
| logger.debug( |
| f'{self} state change -> {color(self.state_name(new_state), "cyan")}' |
| ) |
| self.state = new_state |
| |
| if new_state == self.CONNECTED: |
| self.emit('open') |
| elif new_state == self.DISCONNECTED: |
| self.emit('close') |
| |
| def send_pdu(self, pdu): |
| self.manager.send_pdu(self.connection, self.destination_cid, pdu) |
| |
| def send_control_frame(self, frame): |
| self.manager.send_control_frame(self.connection, L2CAP_LE_SIGNALING_CID, frame) |
| |
| async def connect(self): |
| # Check that we're in the right state |
| if self.state != self.INIT: |
| raise InvalidStateError('not in a connectable state') |
| |
| # Check that we can start a new connection |
| identifier = self.manager.next_identifier(self.connection) |
| if identifier in self.manager.le_coc_requests: |
| raise RuntimeError('too many concurrent connection requests') |
| |
| self.change_state(self.CONNECTING) |
| request = L2CAP_LE_Credit_Based_Connection_Request( |
| identifier=identifier, |
| le_psm=self.le_psm, |
| source_cid=self.source_cid, |
| mtu=self.mtu, |
| mps=self.mps, |
| initial_credits=self.peer_credits, |
| ) |
| self.manager.le_coc_requests[identifier] = request |
| self.send_control_frame(request) |
| |
| # Create a future to wait for the response |
| self.connection_result = asyncio.get_running_loop().create_future() |
| |
| # Wait for the connection to succeed or fail |
| return await self.connection_result |
| |
| async def disconnect(self): |
| # Check that we're connected |
| if self.state != self.CONNECTED: |
| raise InvalidStateError('not connected') |
| |
| self.change_state(self.DISCONNECTING) |
| self.flush_output() |
| self.send_control_frame( |
| L2CAP_Disconnection_Request( |
| identifier=self.manager.next_identifier(self.connection), |
| destination_cid=self.destination_cid, |
| source_cid=self.source_cid, |
| ) |
| ) |
| |
| # Create a future to wait for the state machine to get to a success or error |
| # state |
| self.disconnection_result = asyncio.get_running_loop().create_future() |
| return await self.disconnection_result |
| |
| def on_pdu(self, pdu): |
| if self.sink is None: |
| logger.warning('received pdu without a sink') |
| return |
| |
| if self.state != self.CONNECTED: |
| logger.warning('received PDU while not connected, dropping') |
| |
| # Manage the peer credits |
| if self.peer_credits == 0: |
| logger.warning('received LE frame when peer out of credits') |
| else: |
| self.peer_credits -= 1 |
| if self.peer_credits <= self.peer_credits_threshold: |
| # The credits fell below the threshold, replenish them to the max |
| self.send_control_frame( |
| L2CAP_LE_Flow_Control_Credit( |
| identifier=self.manager.next_identifier(self.connection), |
| cid=self.source_cid, |
| credits=self.peer_max_credits - self.peer_credits, |
| ) |
| ) |
| self.peer_credits = self.peer_max_credits |
| |
| # Check if this starts a new SDU |
| if self.in_sdu is None: |
| # Start a new SDU |
| self.in_sdu = pdu |
| else: |
| # Continue an SDU |
| self.in_sdu += pdu |
| |
| # Check if the SDU is complete |
| if self.in_sdu_length == 0: |
| # We don't know the size yet, check if we have received the header to |
| # compute it |
| if len(self.in_sdu) >= 2: |
| self.in_sdu_length = struct.unpack_from('<H', self.in_sdu, 0)[0] |
| if self.in_sdu_length == 0: |
| # We'll compute it later |
| return |
| if len(self.in_sdu) < 2 + self.in_sdu_length: |
| # Not complete yet |
| logger.debug( |
| f'SDU: {len(self.in_sdu) - 2} of {self.in_sdu_length} bytes received' |
| ) |
| return |
| if len(self.in_sdu) != 2 + self.in_sdu_length: |
| # Overflow |
| logger.warning( |
| f'SDU overflow: sdu_length={self.in_sdu_length}, ' |
| f'received {len(self.in_sdu) - 2}' |
| ) |
| # TODO: we should disconnect |
| self.in_sdu = None |
| self.in_sdu_length = 0 |
| return |
| |
| # Send the SDU to the sink |
| logger.debug(f'SDU complete: 2+{len(self.in_sdu) - 2} bytes') |
| self.sink(self.in_sdu[2:]) # pylint: disable=not-callable |
| |
| # Prepare for a new SDU |
| self.in_sdu = None |
| self.in_sdu_length = 0 |
| |
| def on_connection_response(self, response): |
| # Look for a matching pending response result |
| if self.connection_result is None: |
| logger.warning( |
| f'received unexpected connection response (id={response.identifier})' |
| ) |
| return |
| |
| if ( |
| response.result |
| == L2CAP_LE_Credit_Based_Connection_Response.CONNECTION_SUCCESSFUL |
| ): |
| self.destination_cid = response.destination_cid |
| self.peer_mtu = response.mtu |
| self.peer_mps = response.mps |
| self.credits = response.initial_credits |
| self.connected = True |
| self.connection_result.set_result(self) |
| self.change_state(self.CONNECTED) |
| else: |
| self.connection_result.set_exception( |
| ProtocolError( |
| response.result, |
| 'l2cap', |
| L2CAP_LE_Credit_Based_Connection_Response.result_name( |
| response.result |
| ), |
| ) |
| ) |
| self.change_state(self.CONNECTION_ERROR) |
| |
| # Cleanup |
| self.connection_result = None |
| |
| def on_credits(self, credits): # pylint: disable=redefined-builtin |
| self.credits += credits |
| logger.debug(f'received {credits} credits, total = {self.credits}') |
| |
| # Try to send more data if we have any queued up |
| self.process_output() |
| |
| def on_disconnection_request(self, request): |
| self.send_control_frame( |
| L2CAP_Disconnection_Response( |
| identifier=request.identifier, |
| destination_cid=request.destination_cid, |
| source_cid=request.source_cid, |
| ) |
| ) |
| self.change_state(self.DISCONNECTED) |
| self.flush_output() |
| |
| def on_disconnection_response(self, response): |
| if self.state != self.DISCONNECTING: |
| logger.warning(color('invalid state', 'red')) |
| return |
| |
| if ( |
| response.destination_cid != self.destination_cid |
| or response.source_cid != self.source_cid |
| ): |
| logger.warning('unexpected source or destination CID') |
| return |
| |
| self.change_state(self.DISCONNECTED) |
| if self.disconnection_result: |
| self.disconnection_result.set_result(None) |
| self.disconnection_result = None |
| |
| def flush_output(self): |
| self.out_queue.clear() |
| self.out_sdu = None |
| |
| def process_output(self): |
| while self.credits > 0: |
| if self.out_sdu is not None: |
| # Finish the current SDU |
| packet = self.out_sdu[: self.peer_mps] |
| self.send_pdu(packet) |
| self.credits -= 1 |
| logger.debug(f'sent {len(packet)} bytes, {self.credits} credits left') |
| if len(packet) == len(self.out_sdu): |
| # We sent everything |
| self.out_sdu = None |
| else: |
| # Keep what's still left to send |
| self.out_sdu = self.out_sdu[len(packet) :] |
| continue |
| |
| if self.out_queue: |
| # Create the next SDU (2 bytes header plus up to MTU bytes payload) |
| logger.debug( |
| f'assembling SDU from {len(self.out_queue)} packets in output queue' |
| ) |
| payload = b'' |
| while self.out_queue and len(payload) < self.peer_mtu: |
| # We can add more data to the payload |
| chunk = self.out_queue[0][: self.peer_mtu - len(payload)] |
| payload += chunk |
| self.out_queue[0] = self.out_queue[0][len(chunk) :] |
| if len(self.out_queue[0]) == 0: |
| # We consumed the entire buffer, remove it |
| self.out_queue.popleft() |
| logger.debug( |
| f'packet completed, {len(self.out_queue)} left in queue' |
| ) |
| |
| # Construct the SDU with its header |
| assert len(payload) != 0 |
| logger.debug(f'SDU complete: {len(payload)} payload bytes') |
| self.out_sdu = struct.pack('<H', len(payload)) + payload |
| else: |
| # Nothing left to send for now |
| self.drained.set() |
| return |
| |
| def write(self, data): |
| if self.state != self.CONNECTED: |
| logger.warning('not connected, dropping data') |
| return |
| |
| # Queue the data |
| self.out_queue.append(data) |
| self.drained.clear() |
| logger.debug( |
| f'{len(data)} bytes packet queued, {len(self.out_queue)} packets in queue' |
| ) |
| |
| # Send what we can |
| self.process_output() |
| |
| async def drain(self): |
| await self.drained.wait() |
| |
| def pause_reading(self): |
| # TODO: not implemented yet |
| pass |
| |
| def resume_reading(self): |
| # TODO: not implemented yet |
| pass |
| |
| def __str__(self): |
| return ( |
| f'CoC({self.source_cid}->{self.destination_cid}, ' |
| f'State={self.state_name(self.state)}, ' |
| f'PSM={self.le_psm}, ' |
| f'MTU={self.mtu}/{self.peer_mtu}, ' |
| f'MPS={self.mps}/{self.peer_mps}, ' |
| f'credits={self.credits}/{self.peer_credits})' |
| ) |
| |
| |
| # ----------------------------------------------------------------------------- |
| class ChannelManager: |
| def __init__( |
| self, extended_features=(), connectionless_mtu=L2CAP_DEFAULT_CONNECTIONLESS_MTU |
| ): |
| self._host = None |
| self.identifiers = {} # Incrementing identifier values by connection |
| self.channels = {} # All channels, mapped by connection and source cid |
| self.fixed_channels = { # Fixed channel handlers, mapped by cid |
| L2CAP_SIGNALING_CID: None, |
| L2CAP_LE_SIGNALING_CID: None, |
| } |
| self.servers = {} # Servers accepting connections, by PSM |
| self.le_coc_channels = ( |
| {} |
| ) # 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.connectionless_mtu = connectionless_mtu |
| |
| @property |
| def host(self): |
| return self._host |
| |
| @host.setter |
| def host(self, host): |
| if self._host is not None: |
| self._host.remove_listener('disconnection', self.on_disconnection) |
| self._host = host |
| if host is not None: |
| host.on('disconnection', self.on_disconnection) |
| |
| def find_channel(self, connection_handle, cid): |
| if connection_channels := self.channels.get(connection_handle): |
| return connection_channels.get(cid) |
| |
| return None |
| |
| def find_le_coc_channel(self, connection_handle, cid): |
| if connection_channels := self.le_coc_channels.get(connection_handle): |
| return connection_channels.get(cid) |
| |
| return None |
| |
| @staticmethod |
| def find_free_br_edr_cid(channels): |
| # Pick the smallest valid CID that's not already in the list |
| # (not necessarily the most efficient algorithm, but the list of CID is |
| # very small in practice) |
| for cid in range( |
| L2CAP_ACL_U_DYNAMIC_CID_RANGE_START, L2CAP_ACL_U_DYNAMIC_CID_RANGE_END + 1 |
| ): |
| if cid not in channels: |
| return cid |
| |
| raise RuntimeError('no free CID available') |
| |
| @staticmethod |
| def find_free_le_cid(channels): |
| # Pick the smallest valid CID that's not already in the list |
| # (not necessarily the most efficient algorithm, but the list of CID is |
| # very small in practice) |
| for cid in range( |
| L2CAP_LE_U_DYNAMIC_CID_RANGE_START, L2CAP_LE_U_DYNAMIC_CID_RANGE_END + 1 |
| ): |
| if cid not in channels: |
| return cid |
| |
| raise RuntimeError('no free CID') |
| |
| @staticmethod |
| def check_le_coc_parameters(max_credits, mtu, mps): |
| if ( |
| max_credits < 1 |
| or max_credits > L2CAP_LE_CREDIT_BASED_CONNECTION_MAX_CREDITS |
| ): |
| raise ValueError('max credits out of range') |
| if mtu < L2CAP_LE_CREDIT_BASED_CONNECTION_MIN_MTU: |
| raise ValueError('MTU too small') |
| if ( |
| mps < L2CAP_LE_CREDIT_BASED_CONNECTION_MIN_MPS |
| or mps > L2CAP_LE_CREDIT_BASED_CONNECTION_MAX_MPS |
| ): |
| raise ValueError('MPS out of range') |
| |
| def next_identifier(self, connection): |
| identifier = (self.identifiers.setdefault(connection.handle, 0) + 1) % 256 |
| self.identifiers[connection.handle] = identifier |
| return identifier |
| |
| def register_fixed_channel(self, cid, handler): |
| self.fixed_channels[cid] = handler |
| |
| def deregister_fixed_channel(self, cid): |
| if cid in self.fixed_channels: |
| del self.fixed_channels[cid] |
| |
| def register_server(self, psm, server): |
| if psm == 0: |
| # Find a free PSM |
| for candidate in range( |
| L2CAP_PSM_DYNAMIC_RANGE_START, L2CAP_PSM_DYNAMIC_RANGE_END + 1, 2 |
| ): |
| if (candidate >> 8) % 2 == 1: |
| continue |
| if candidate in self.servers: |
| continue |
| psm = candidate |
| break |
| else: |
| raise InvalidStateError('no free PSM') |
| else: |
| # Check that the PSM isn't already in use |
| if psm in self.servers: |
| raise ValueError('PSM already in use') |
| |
| # Check that the PSM is valid |
| if psm % 2 == 0: |
| raise ValueError('invalid PSM (not odd)') |
| check = psm >> 8 |
| while check: |
| if check % 2 != 0: |
| raise ValueError('invalid PSM') |
| check >>= 8 |
| |
| self.servers[psm] = server |
| |
| return psm |
| |
| def register_le_coc_server( |
| self, |
| psm, |
| server, |
| max_credits=L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_INITIAL_CREDITS, |
| mtu=L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU, |
| mps=L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MPS, |
| ): |
| self.check_le_coc_parameters(max_credits, mtu, mps) |
| |
| if psm == 0: |
| # Find a free PSM |
| for candidate in range( |
| L2CAP_LE_PSM_DYNAMIC_RANGE_START, L2CAP_LE_PSM_DYNAMIC_RANGE_END + 1 |
| ): |
| if candidate in self.le_coc_servers: |
| continue |
| psm = candidate |
| break |
| else: |
| raise InvalidStateError('no free PSM') |
| else: |
| # Check that the PSM isn't already in use |
| if psm in self.le_coc_servers: |
| raise ValueError('PSM already in use') |
| |
| self.le_coc_servers[psm] = ( |
| server, |
| max_credits or L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_INITIAL_CREDITS, |
| mtu or L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU, |
| mps or L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MPS, |
| ) |
| |
| return psm |
| |
| def on_disconnection(self, connection_handle, _reason): |
| logger.debug(f'disconnection from {connection_handle}, cleaning up channels') |
| if connection_handle in self.channels: |
| del self.channels[connection_handle] |
| if connection_handle in self.le_coc_channels: |
| del self.le_coc_channels[connection_handle] |
| if connection_handle in self.identifiers: |
| del self.identifiers[connection_handle] |
| |
| def send_pdu(self, connection, cid, pdu): |
| pdu_str = pdu.hex() if isinstance(pdu, bytes) else str(pdu) |
| logger.debug( |
| f'{color(">>> Sending L2CAP PDU", "blue")} ' |
| f'on connection [0x{connection.handle:04X}] (CID={cid}) ' |
| f'{connection.peer_address}: {pdu_str}' |
| ) |
| self.host.send_l2cap_pdu(connection.handle, cid, bytes(pdu)) |
| |
| def on_pdu(self, connection, cid, pdu): |
| if cid in (L2CAP_SIGNALING_CID, L2CAP_LE_SIGNALING_CID): |
| # Parse the L2CAP payload into a Control Frame object |
| control_frame = L2CAP_Control_Frame.from_bytes(pdu) |
| |
| self.on_control_frame(connection, cid, control_frame) |
| elif cid in self.fixed_channels: |
| self.fixed_channels[cid](connection.handle, pdu) |
| else: |
| if (channel := self.find_channel(connection.handle, cid)) is None: |
| logger.warning( |
| color( |
| f'channel not found for 0x{connection.handle:04X}:{cid}', 'red' |
| ) |
| ) |
| return |
| |
| channel.on_pdu(pdu) |
| |
| def send_control_frame(self, connection, cid, control_frame): |
| logger.debug( |
| f'{color(">>> Sending L2CAP Signaling Control Frame", "blue")} ' |
| f'on connection [0x{connection.handle:04X}] (CID={cid}) ' |
| f'{connection.peer_address}:\n{control_frame}' |
| ) |
| self.host.send_l2cap_pdu(connection.handle, cid, bytes(control_frame)) |
| |
| def on_control_frame(self, connection, cid, control_frame): |
| logger.debug( |
| f'{color("<<< Received L2CAP Signaling Control Frame", "green")} ' |
| f'on connection [0x{connection.handle:04X}] (CID={cid}) ' |
| f'{connection.peer_address}:\n{control_frame}' |
| ) |
| |
| # Find the handler method |
| handler_name = f'on_{control_frame.name.lower()}' |
| handler = getattr(self, handler_name, None) |
| if handler: |
| try: |
| handler(connection, cid, control_frame) |
| except Exception as error: |
| logger.warning(f'{color("!!! Exception in handler:", "red")} {error}') |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Command_Reject( |
| identifier=control_frame.identifier, |
| reason=L2CAP_COMMAND_NOT_UNDERSTOOD_REASON, |
| data=b'', |
| ), |
| ) |
| raise error |
| else: |
| logger.error(color('Channel Manager command not handled???', 'red')) |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Command_Reject( |
| identifier=control_frame.identifier, |
| reason=L2CAP_COMMAND_NOT_UNDERSTOOD_REASON, |
| data=b'', |
| ), |
| ) |
| |
| def on_l2cap_command_reject(self, _connection, _cid, packet): |
| logger.warning(f'{color("!!! Command rejected:", "red")} {packet.reason}') |
| |
| def on_l2cap_connection_request(self, connection, cid, request): |
| # Check if there's a server for this PSM |
| server = self.servers.get(request.psm) |
| if server: |
| # Find a free CID for this new channel |
| connection_channels = self.channels.setdefault(connection.handle, {}) |
| source_cid = self.find_free_br_edr_cid(connection_channels) |
| if source_cid is None: # Should never happen! |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=request.source_cid, |
| source_cid=0, |
| # pylint: disable=line-too-long |
| result=L2CAP_Connection_Response.CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE, |
| status=0x0000, |
| ), |
| ) |
| return |
| |
| # Create a new channel |
| logger.debug( |
| f'creating server channel with cid={source_cid} for psm {request.psm}' |
| ) |
| channel = Channel( |
| self, connection, cid, request.psm, source_cid, L2CAP_MIN_BR_EDR_MTU |
| ) |
| connection_channels[source_cid] = channel |
| |
| # Notify |
| server(channel) |
| channel.on_connection_request(request) |
| else: |
| logger.warning( |
| f'No server for connection 0x{connection.handle:04X} ' |
| f'on PSM {request.psm}' |
| ) |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=request.source_cid, |
| source_cid=0, |
| # pylint: disable=line-too-long |
| result=L2CAP_Connection_Response.CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED, |
| status=0x0000, |
| ), |
| ) |
| |
| def on_l2cap_connection_response(self, connection, cid, response): |
| if ( |
| channel := self.find_channel(connection.handle, response.source_cid) |
| ) is None: |
| logger.warning( |
| color( |
| f'channel {response.source_cid} not found for ' |
| f'0x{connection.handle:04X}:{cid}', |
| 'red', |
| ) |
| ) |
| return |
| |
| channel.on_connection_response(response) |
| |
| def on_l2cap_configure_request(self, connection, cid, request): |
| if ( |
| channel := self.find_channel(connection.handle, request.destination_cid) |
| ) is None: |
| logger.warning( |
| color( |
| f'channel {request.destination_cid} not found for ' |
| f'0x{connection.handle:04X}:{cid}', |
| 'red', |
| ) |
| ) |
| return |
| |
| channel.on_configure_request(request) |
| |
| def on_l2cap_configure_response(self, connection, cid, response): |
| if ( |
| channel := self.find_channel(connection.handle, response.source_cid) |
| ) is None: |
| logger.warning( |
| color( |
| f'channel {response.source_cid} not found for ' |
| f'0x{connection.handle:04X}:{cid}', |
| 'red', |
| ) |
| ) |
| return |
| |
| channel.on_configure_response(response) |
| |
| def on_l2cap_disconnection_request(self, connection, cid, request): |
| if ( |
| channel := self.find_channel(connection.handle, request.destination_cid) |
| ) is None: |
| logger.warning( |
| color( |
| f'channel {request.destination_cid} not found for ' |
| f'0x{connection.handle:04X}:{cid}', |
| 'red', |
| ) |
| ) |
| return |
| |
| channel.on_disconnection_request(request) |
| |
| def on_l2cap_disconnection_response(self, connection, cid, response): |
| if ( |
| channel := self.find_channel(connection.handle, response.source_cid) |
| ) is None: |
| logger.warning( |
| color( |
| f'channel {response.source_cid} not found for ' |
| f'0x{connection.handle:04X}:{cid}', |
| 'red', |
| ) |
| ) |
| return |
| |
| channel.on_disconnection_response(response) |
| |
| def on_l2cap_echo_request(self, connection, cid, request): |
| logger.debug(f'<<< Echo request: data={request.data.hex()}') |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Echo_Response(identifier=request.identifier, data=request.data), |
| ) |
| |
| def on_l2cap_echo_response(self, _connection, _cid, response): |
| logger.debug(f'<<< Echo response: data={response.data.hex()}') |
| # TODO notify listeners |
| |
| def on_l2cap_information_request(self, connection, cid, request): |
| if request.info_type == L2CAP_Information_Request.CONNECTIONLESS_MTU: |
| result = L2CAP_Information_Response.SUCCESS |
| data = self.connectionless_mtu.to_bytes(2, 'little') |
| elif request.info_type == L2CAP_Information_Request.EXTENDED_FEATURES_SUPPORTED: |
| result = L2CAP_Information_Response.SUCCESS |
| data = sum(self.extended_features).to_bytes(4, 'little') |
| elif request.info_type == L2CAP_Information_Request.FIXED_CHANNELS_SUPPORTED: |
| result = L2CAP_Information_Response.SUCCESS |
| data = sum(1 << cid for cid in self.fixed_channels).to_bytes(8, 'little') |
| else: |
| result = L2CAP_Information_Response.NOT_SUPPORTED |
| |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Information_Response( |
| identifier=request.identifier, |
| info_type=request.info_type, |
| result=result, |
| data=data, |
| ), |
| ) |
| |
| def on_l2cap_connection_parameter_update_request(self, connection, cid, request): |
| if connection.role == BT_CENTRAL_ROLE: |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Connection_Parameter_Update_Response( |
| identifier=request.identifier, |
| result=L2CAP_CONNECTION_PARAMETERS_ACCEPTED_RESULT, |
| ), |
| ) |
| self.host.send_command_sync( |
| HCI_LE_Connection_Update_Command( |
| connection_handle=connection.handle, |
| connection_interval_min=request.interval_min, |
| connection_interval_max=request.interval_max, |
| max_latency=request.latency, |
| supervision_timeout=request.timeout, |
| min_ce_length=0, |
| max_ce_length=0, |
| ) |
| ) |
| else: |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_Connection_Parameter_Update_Response( |
| identifier=request.identifier, |
| result=L2CAP_CONNECTION_PARAMETERS_REJECTED_RESULT, |
| ), |
| ) |
| |
| def on_l2cap_connection_parameter_update_response(self, connection, cid, response): |
| # TODO: check response |
| pass |
| |
| def on_l2cap_le_credit_based_connection_request(self, connection, cid, request): |
| if request.le_psm in self.le_coc_servers: |
| (server, max_credits, mtu, mps) = self.le_coc_servers[request.le_psm] |
| |
| # Check that the CID isn't already used |
| le_connection_channels = self.le_coc_channels.setdefault( |
| connection.handle, {} |
| ) |
| if request.source_cid in le_connection_channels: |
| logger.warning(f'source CID {request.source_cid} already in use') |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_LE_Credit_Based_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=0, |
| mtu=mtu, |
| mps=mps, |
| initial_credits=0, |
| # pylint: disable=line-too-long |
| result=L2CAP_LE_Credit_Based_Connection_Response.CONNECTION_REFUSED_SOURCE_CID_ALREADY_ALLOCATED, |
| ), |
| ) |
| return |
| |
| # Find a free CID for this new channel |
| connection_channels = self.channels.setdefault(connection.handle, {}) |
| source_cid = self.find_free_le_cid(connection_channels) |
| if source_cid is None: # Should never happen! |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_LE_Credit_Based_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=0, |
| mtu=mtu, |
| mps=mps, |
| initial_credits=0, |
| # pylint: disable=line-too-long |
| result=L2CAP_LE_Credit_Based_Connection_Response.CONNECTION_REFUSED_NO_RESOURCES_AVAILABLE, |
| ), |
| ) |
| return |
| |
| # Create a new channel |
| logger.debug( |
| f'creating LE CoC server channel with cid={source_cid} for psm ' |
| f'{request.le_psm}' |
| ) |
| channel = LeConnectionOrientedChannel( |
| self, |
| connection, |
| request.le_psm, |
| source_cid, |
| request.source_cid, |
| mtu, |
| mps, |
| request.initial_credits, |
| request.mtu, |
| request.mps, |
| max_credits, |
| True, |
| ) |
| connection_channels[source_cid] = channel |
| le_connection_channels[request.source_cid] = channel |
| |
| # Respond |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_LE_Credit_Based_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=source_cid, |
| mtu=mtu, |
| mps=mps, |
| initial_credits=max_credits, |
| # pylint: disable=line-too-long |
| result=L2CAP_LE_Credit_Based_Connection_Response.CONNECTION_SUCCESSFUL, |
| ), |
| ) |
| |
| # Notify |
| server(channel) |
| else: |
| logger.info( |
| f'No LE server for connection 0x{connection.handle:04X} ' |
| f'on PSM {request.le_psm}' |
| ) |
| self.send_control_frame( |
| connection, |
| cid, |
| L2CAP_LE_Credit_Based_Connection_Response( |
| identifier=request.identifier, |
| destination_cid=0, |
| mtu=L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU, |
| mps=L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MPS, |
| initial_credits=0, |
| # pylint: disable=line-too-long |
| result=L2CAP_LE_Credit_Based_Connection_Response.CONNECTION_REFUSED_LE_PSM_NOT_SUPPORTED, |
| ), |
| ) |
| |
| def on_l2cap_le_credit_based_connection_response(self, connection, _cid, response): |
| # Find the pending request by identifier |
| request = self.le_coc_requests.get(response.identifier) |
| if request is None: |
| logger.warning(color('!!! received response for unknown request', 'red')) |
| return |
| del self.le_coc_requests[response.identifier] |
| |
| # Find the channel for this request |
| channel = self.find_channel(connection.handle, request.source_cid) |
| if channel is None: |
| logger.warning( |
| color( |
| 'received connection response for an unknown channel ' |
| f'(cid={request.source_cid})', |
| 'red', |
| ) |
| ) |
| return |
| |
| # Process the response |
| channel.on_connection_response(response) |
| |
| def on_l2cap_le_flow_control_credit(self, connection, _cid, credit): |
| channel = self.find_le_coc_channel(connection.handle, credit.cid) |
| if channel is None: |
| logger.warning(f'received credits for an unknown channel (cid={credit.cid}') |
| return |
| |
| channel.on_credits(credit.credits) |
| |
| def on_channel_closed(self, channel): |
| connection_channels = self.channels.get(channel.connection.handle) |
| if connection_channels: |
| if channel.source_cid in connection_channels: |
| del connection_channels[channel.source_cid] |
| |
| async def open_le_coc(self, connection, psm, max_credits, mtu, mps): |
| self.check_le_coc_parameters(max_credits, mtu, mps) |
| |
| # Find a free CID for the new channel |
| connection_channels = self.channels.setdefault(connection.handle, {}) |
| source_cid = self.find_free_le_cid(connection_channels) |
| if source_cid is None: # Should never happen! |
| raise RuntimeError('all CIDs already in use') |
| |
| # Create the channel |
| logger.debug(f'creating coc channel with cid={source_cid} for psm {psm}') |
| channel = LeConnectionOrientedChannel( |
| manager=self, |
| connection=connection, |
| le_psm=psm, |
| source_cid=source_cid, |
| destination_cid=0, |
| mtu=mtu, |
| mps=mps, |
| credits=0, |
| peer_mtu=0, |
| peer_mps=0, |
| peer_credits=max_credits, |
| connected=False, |
| ) |
| connection_channels[source_cid] = channel |
| |
| # Connect |
| try: |
| await channel.connect() |
| except Exception as error: |
| logger.warning(f'connection failed: {error}') |
| del connection_channels[source_cid] |
| raise |
| |
| # Remember the channel by source CID and destination CID |
| le_connection_channels = self.le_coc_channels.setdefault(connection.handle, {}) |
| le_connection_channels[channel.destination_cid] = channel |
| |
| return channel |
| |
| async def connect(self, connection, psm): |
| # NOTE: this implementation hard-codes BR/EDR |
| |
| # Find a free CID for a new channel |
| connection_channels = self.channels.setdefault(connection.handle, {}) |
| source_cid = self.find_free_br_edr_cid(connection_channels) |
| if source_cid is None: # Should never happen! |
| raise RuntimeError('all CIDs already in use') |
| |
| # Create the channel |
| logger.debug(f'creating client channel with cid={source_cid} for psm {psm}') |
| channel = Channel( |
| self, connection, L2CAP_SIGNALING_CID, psm, source_cid, L2CAP_MIN_BR_EDR_MTU |
| ) |
| connection_channels[source_cid] = channel |
| |
| # Connect |
| try: |
| await channel.connect() |
| except Exception: |
| del connection_channels[source_cid] |
| |
| return channel |
