forked from auracaster/bumble_mirror
Refactor LE emulation with LL and Air Interface
This commit is contained in:
File diff suppressed because it is too large
Load Diff
@@ -265,12 +265,22 @@ class ExtendedAdvertisement(Advertisement):
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
class AdvertisementDataAccumulator:
|
||||
last_advertisement: Advertisement | None
|
||||
last_data: bytes
|
||||
passive: bool
|
||||
|
||||
def __init__(self, passive: bool = False):
|
||||
self.passive = passive
|
||||
self.last_advertisement = None
|
||||
self.last_data = b''
|
||||
|
||||
def update(self, report):
|
||||
def update(
|
||||
self,
|
||||
report: (
|
||||
hci.HCI_LE_Advertising_Report_Event.Report
|
||||
| hci.HCI_LE_Extended_Advertising_Report_Event.Report
|
||||
),
|
||||
) -> Advertisement | None:
|
||||
advertisement = Advertisement.from_advertising_report(report)
|
||||
if advertisement is None:
|
||||
return None
|
||||
@@ -283,10 +293,12 @@ class AdvertisementDataAccumulator:
|
||||
and not self.last_advertisement.is_scan_response
|
||||
):
|
||||
# This is the response to a scannable advertisement
|
||||
result = Advertisement.from_advertising_report(report)
|
||||
result.is_connectable = self.last_advertisement.is_connectable
|
||||
result.is_scannable = True
|
||||
result.data = AdvertisingData.from_bytes(self.last_data + report.data)
|
||||
if result := Advertisement.from_advertising_report(report):
|
||||
result.is_connectable = self.last_advertisement.is_connectable
|
||||
result.is_scannable = True
|
||||
result.data = AdvertisingData.from_bytes(
|
||||
self.last_data + report.data
|
||||
)
|
||||
self.last_data = b''
|
||||
else:
|
||||
if (
|
||||
@@ -3333,7 +3345,13 @@ class Device(utils.CompositeEventEmitter):
|
||||
return self.scanning
|
||||
|
||||
@host_event_handler
|
||||
def on_advertising_report(self, report):
|
||||
def on_advertising_report(
|
||||
self,
|
||||
report: (
|
||||
hci.HCI_LE_Advertising_Report_Event.Report
|
||||
| hci.HCI_LE_Extended_Advertising_Report_Event.Report
|
||||
),
|
||||
) -> None:
|
||||
if not (accumulator := self.advertisement_accumulators.get(report.address)):
|
||||
accumulator = AdvertisementDataAccumulator(passive=self.scanning_is_passive)
|
||||
self.advertisement_accumulators[report.address] = accumulator
|
||||
|
||||
202
bumble/link.py
202
bumble/link.py
@@ -19,9 +19,12 @@ import asyncio
|
||||
# Imports
|
||||
# -----------------------------------------------------------------------------
|
||||
import logging
|
||||
from typing import Optional
|
||||
from typing import TYPE_CHECKING, Optional
|
||||
|
||||
from bumble import controller, core, hci, lmp
|
||||
from bumble import core, hci, ll, lmp
|
||||
|
||||
if TYPE_CHECKING:
|
||||
from bumble import controller
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# Logging
|
||||
@@ -29,11 +32,6 @@ from bumble import controller, core, hci, lmp
|
||||
logger = logging.getLogger(__name__)
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# Utils
|
||||
# -----------------------------------------------------------------------------
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# TODO: add more support for various LL exchanges
|
||||
# (see Vol 6, Part B - 2.4 DATA CHANNEL PDU)
|
||||
@@ -47,7 +45,6 @@ class LocalLink:
|
||||
|
||||
def __init__(self):
|
||||
self.controllers = set()
|
||||
self.pending_connection = None
|
||||
self.pending_classic_connection = None
|
||||
|
||||
############################################################
|
||||
@@ -61,14 +58,10 @@ class LocalLink:
|
||||
def remove_controller(self, controller: controller.Controller):
|
||||
self.controllers.remove(controller)
|
||||
|
||||
def find_controller(self, address: hci.Address) -> controller.Controller | None:
|
||||
def find_le_controller(self, address: hci.Address) -> controller.Controller | None:
|
||||
for controller in self.controllers:
|
||||
if controller.random_address == address:
|
||||
return controller
|
||||
if controller.public_address == address:
|
||||
return controller
|
||||
for advertising_set in controller.advertising_sets.values():
|
||||
if advertising_set.random_address == address:
|
||||
for connection in controller.le_connections.values():
|
||||
if connection.self_address == address:
|
||||
return controller
|
||||
return None
|
||||
|
||||
@@ -80,9 +73,6 @@ class LocalLink:
|
||||
return controller
|
||||
return None
|
||||
|
||||
def get_pending_connection(self):
|
||||
return self.pending_connection
|
||||
|
||||
############################################################
|
||||
# LE handlers
|
||||
############################################################
|
||||
@@ -90,23 +80,6 @@ class LocalLink:
|
||||
def on_address_changed(self, controller):
|
||||
pass
|
||||
|
||||
def send_advertising_data(self, sender_address: hci.Address, data: bytes):
|
||||
# Send the advertising data to all controllers, except the sender
|
||||
for controller in self.controllers:
|
||||
if controller.random_address != sender_address:
|
||||
controller.on_link_advertising_data(sender_address, data)
|
||||
|
||||
def send_extended_advertising_data(
|
||||
self, sender_address: hci.Address, data: bytes, properties: int = 0
|
||||
):
|
||||
# Send the advertising data to all controllers, except the sender
|
||||
sender_controller = self.find_controller(sender_address)
|
||||
for controller in self.controllers:
|
||||
if controller != sender_controller:
|
||||
controller.on_link_extended_advertising_data(
|
||||
sender_address, data, properties
|
||||
)
|
||||
|
||||
def send_acl_data(
|
||||
self,
|
||||
sender_controller: controller.Controller,
|
||||
@@ -116,7 +89,7 @@ class LocalLink:
|
||||
):
|
||||
# Send the data to the first controller with a matching address
|
||||
if transport == core.PhysicalTransport.LE:
|
||||
destination_controller = self.find_controller(destination_address)
|
||||
destination_controller = self.find_le_controller(destination_address)
|
||||
source_address = sender_controller.random_address
|
||||
elif transport == core.PhysicalTransport.BR_EDR:
|
||||
destination_controller = self.find_classic_controller(destination_address)
|
||||
@@ -131,157 +104,30 @@ class LocalLink:
|
||||
)
|
||||
)
|
||||
|
||||
def on_connection_complete(self) -> None:
|
||||
# Check that we expect this call
|
||||
if not self.pending_connection:
|
||||
logger.warning('on_connection_complete with no pending connection')
|
||||
return
|
||||
|
||||
central_address, le_create_connection_command = self.pending_connection
|
||||
self.pending_connection = None
|
||||
|
||||
# Find the controller that initiated the connection
|
||||
if not (central_controller := self.find_controller(central_address)):
|
||||
logger.warning('!!! Initiating controller not found')
|
||||
return
|
||||
|
||||
# Connect to the first controller with a matching address
|
||||
if peripheral_controller := self.find_controller(
|
||||
le_create_connection_command.peer_address
|
||||
):
|
||||
central_controller.on_link_peripheral_connection_complete(
|
||||
le_create_connection_command, hci.HCI_SUCCESS
|
||||
)
|
||||
peripheral_controller.on_link_central_connected(
|
||||
central_address, le_create_connection_command.peer_address
|
||||
)
|
||||
return
|
||||
|
||||
# No peripheral found
|
||||
central_controller.on_link_peripheral_connection_complete(
|
||||
le_create_connection_command, hci.HCI_CONNECTION_ACCEPT_TIMEOUT_ERROR
|
||||
)
|
||||
|
||||
def connect(
|
||||
def send_advertising_pdu(
|
||||
self,
|
||||
central_address: hci.Address,
|
||||
le_create_connection_command: (
|
||||
hci.HCI_LE_Create_Connection_Command
|
||||
| hci.HCI_LE_Extended_Create_Connection_Command
|
||||
),
|
||||
sender_controller: controller.Controller,
|
||||
packet: ll.AdvertisingPdu,
|
||||
):
|
||||
logger.debug(
|
||||
f'$$$ CONNECTION {central_address} -> '
|
||||
f'{le_create_connection_command.peer_address}'
|
||||
)
|
||||
self.pending_connection = (central_address, le_create_connection_command)
|
||||
asyncio.get_running_loop().call_soon(self.on_connection_complete)
|
||||
loop = asyncio.get_running_loop()
|
||||
for c in self.controllers:
|
||||
if c != sender_controller:
|
||||
loop.call_soon(c.on_ll_advertising_pdu, packet)
|
||||
|
||||
def on_disconnection_complete(
|
||||
def send_ll_control_pdu(
|
||||
self,
|
||||
initiating_address: hci.Address,
|
||||
target_address: hci.Address,
|
||||
disconnect_command: hci.HCI_Disconnect_Command,
|
||||
sender_address: hci.Address,
|
||||
receiver_address: hci.Address,
|
||||
packet: ll.ControlPdu,
|
||||
):
|
||||
# Find the controller that initiated the disconnection
|
||||
if not (initiating_controller := self.find_controller(initiating_address)):
|
||||
logger.warning('!!! Initiating controller not found')
|
||||
return
|
||||
|
||||
# Disconnect from the first controller with a matching address
|
||||
if target_controller := self.find_controller(target_address):
|
||||
target_controller.on_link_disconnected(
|
||||
initiating_address, disconnect_command.reason
|
||||
if not (receiver_controller := self.find_le_controller(receiver_address)):
|
||||
raise core.InvalidArgumentError(
|
||||
f"Unable to find controller for address {receiver_address}"
|
||||
)
|
||||
|
||||
initiating_controller.on_link_disconnection_complete(
|
||||
disconnect_command, hci.HCI_SUCCESS
|
||||
)
|
||||
|
||||
def disconnect(
|
||||
self,
|
||||
initiating_address: hci.Address,
|
||||
target_address: hci.Address,
|
||||
disconnect_command: hci.HCI_Disconnect_Command,
|
||||
):
|
||||
logger.debug(
|
||||
f'$$$ DISCONNECTION {initiating_address} -> '
|
||||
f'{target_address}: reason = {disconnect_command.reason}'
|
||||
)
|
||||
asyncio.get_running_loop().call_soon(
|
||||
lambda: self.on_disconnection_complete(
|
||||
initiating_address, target_address, disconnect_command
|
||||
)
|
||||
lambda: receiver_controller.on_ll_control_pdu(sender_address, packet)
|
||||
)
|
||||
|
||||
def on_connection_encrypted(
|
||||
self,
|
||||
central_address: hci.Address,
|
||||
peripheral_address: hci.Address,
|
||||
rand: bytes,
|
||||
ediv: int,
|
||||
ltk: bytes,
|
||||
):
|
||||
logger.debug(f'*** ENCRYPTION {central_address} -> {peripheral_address}')
|
||||
|
||||
if central_controller := self.find_controller(central_address):
|
||||
central_controller.on_link_encrypted(peripheral_address, rand, ediv, ltk)
|
||||
|
||||
if peripheral_controller := self.find_controller(peripheral_address):
|
||||
peripheral_controller.on_link_encrypted(central_address, rand, ediv, ltk)
|
||||
|
||||
def create_cis(
|
||||
self,
|
||||
central_controller: controller.Controller,
|
||||
peripheral_address: hci.Address,
|
||||
cig_id: int,
|
||||
cis_id: int,
|
||||
) -> None:
|
||||
logger.debug(
|
||||
f'$$$ CIS Request {central_controller.random_address} -> {peripheral_address}'
|
||||
)
|
||||
if peripheral_controller := self.find_controller(peripheral_address):
|
||||
asyncio.get_running_loop().call_soon(
|
||||
peripheral_controller.on_link_cis_request,
|
||||
central_controller.random_address,
|
||||
cig_id,
|
||||
cis_id,
|
||||
)
|
||||
|
||||
def accept_cis(
|
||||
self,
|
||||
peripheral_controller: controller.Controller,
|
||||
central_address: hci.Address,
|
||||
cig_id: int,
|
||||
cis_id: int,
|
||||
) -> None:
|
||||
logger.debug(
|
||||
f'$$$ CIS Accept {peripheral_controller.random_address} -> {central_address}'
|
||||
)
|
||||
if central_controller := self.find_controller(central_address):
|
||||
loop = asyncio.get_running_loop()
|
||||
loop.call_soon(central_controller.on_link_cis_established, cig_id, cis_id)
|
||||
loop.call_soon(
|
||||
peripheral_controller.on_link_cis_established, cig_id, cis_id
|
||||
)
|
||||
|
||||
def disconnect_cis(
|
||||
self,
|
||||
initiator_controller: controller.Controller,
|
||||
peer_address: hci.Address,
|
||||
cig_id: int,
|
||||
cis_id: int,
|
||||
) -> None:
|
||||
logger.debug(
|
||||
f'$$$ CIS Disconnect {initiator_controller.random_address} -> {peer_address}'
|
||||
)
|
||||
if peer_controller := self.find_controller(peer_address):
|
||||
loop = asyncio.get_running_loop()
|
||||
loop.call_soon(
|
||||
initiator_controller.on_link_cis_disconnected, cig_id, cis_id
|
||||
)
|
||||
loop.call_soon(peer_controller.on_link_cis_disconnected, cig_id, cis_id)
|
||||
|
||||
############################################################
|
||||
# Classic handlers
|
||||
############################################################
|
||||
|
||||
200
bumble/ll.py
Normal file
200
bumble/ll.py
Normal file
@@ -0,0 +1,200 @@
|
||||
# Copyright 2021-2025 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
|
||||
# -----------------------------------------------------------------------------
|
||||
from __future__ import annotations
|
||||
|
||||
import dataclasses
|
||||
from typing import ClassVar
|
||||
|
||||
from bumble import hci
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# Advertising PDU
|
||||
# -----------------------------------------------------------------------------
|
||||
class AdvertisingPdu:
|
||||
"""Base Advertising Physical Channel PDU class.
|
||||
|
||||
See Core Spec 6.0, Volume 6, Part B, 2.3. Advertising physical channel PDU.
|
||||
|
||||
Currently these messages don't really follow the LL spec, because LL protocol is
|
||||
context-aware and we don't have real physical transport.
|
||||
"""
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class ConnectInd(AdvertisingPdu):
|
||||
initiator_address: hci.Address
|
||||
advertiser_address: hci.Address
|
||||
interval: int
|
||||
latency: int
|
||||
timeout: int
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class AdvInd(AdvertisingPdu):
|
||||
advertiser_address: hci.Address
|
||||
data: bytes
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class AdvDirectInd(AdvertisingPdu):
|
||||
advertiser_address: hci.Address
|
||||
target_address: hci.Address
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class AdvNonConnInd(AdvertisingPdu):
|
||||
advertiser_address: hci.Address
|
||||
data: bytes
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class AdvExtInd(AdvertisingPdu):
|
||||
advertiser_address: hci.Address
|
||||
data: bytes
|
||||
|
||||
target_address: hci.Address | None = None
|
||||
adi: int | None = None
|
||||
tx_power: int | None = None
|
||||
|
||||
|
||||
# -----------------------------------------------------------------------------
|
||||
# LL Control PDU
|
||||
# -----------------------------------------------------------------------------
|
||||
class ControlPdu:
|
||||
"""Base LL Control PDU Class.
|
||||
|
||||
See Core Spec 6.0, Volume 6, Part B, 2.4.2. LL Control PDU.
|
||||
|
||||
Currently these messages don't really follow the LL spec, because LL protocol is
|
||||
context-aware and we don't have real physical transport.
|
||||
"""
|
||||
|
||||
class Opcode(hci.SpecableEnum):
|
||||
LL_CONNECTION_UPDATE_IND = 0x00
|
||||
LL_CHANNEL_MAP_IND = 0x01
|
||||
LL_TERMINATE_IND = 0x02
|
||||
LL_ENC_REQ = 0x03
|
||||
LL_ENC_RSP = 0x04
|
||||
LL_START_ENC_REQ = 0x05
|
||||
LL_START_ENC_RSP = 0x06
|
||||
LL_UNKNOWN_RSP = 0x07
|
||||
LL_FEATURE_REQ = 0x08
|
||||
LL_FEATURE_RSP = 0x09
|
||||
LL_PAUSE_ENC_REQ = 0x0A
|
||||
LL_PAUSE_ENC_RSP = 0x0B
|
||||
LL_VERSION_IND = 0x0C
|
||||
LL_REJECT_IND = 0x0D
|
||||
LL_PERIPHERAL_FEATURE_REQ = 0x0E
|
||||
LL_CONNECTION_PARAM_REQ = 0x0F
|
||||
LL_CONNECTION_PARAM_RSP = 0x10
|
||||
LL_REJECT_EXT_IND = 0x11
|
||||
LL_PING_REQ = 0x12
|
||||
LL_PING_RSP = 0x13
|
||||
LL_LENGTH_REQ = 0x14
|
||||
LL_LENGTH_RSP = 0x15
|
||||
LL_PHY_REQ = 0x16
|
||||
LL_PHY_RSP = 0x17
|
||||
LL_PHY_UPDATE_IND = 0x18
|
||||
LL_MIN_USED_CHANNELS_IND = 0x19
|
||||
LL_CTE_REQ = 0x1A
|
||||
LL_CTE_RSP = 0x1B
|
||||
LL_PERIODIC_SYNC_IND = 0x1C
|
||||
LL_CLOCK_ACCURACY_REQ = 0x1D
|
||||
LL_CLOCK_ACCURACY_RSP = 0x1E
|
||||
LL_CIS_REQ = 0x1F
|
||||
LL_CIS_RSP = 0x20
|
||||
LL_CIS_IND = 0x21
|
||||
LL_CIS_TERMINATE_IND = 0x22
|
||||
LL_POWER_CONTROL_REQ = 0x23
|
||||
LL_POWER_CONTROL_RSP = 0x24
|
||||
LL_POWER_CHANGE_IND = 0x25
|
||||
LL_SUBRATE_REQ = 0x26
|
||||
LL_SUBRATE_IND = 0x27
|
||||
LL_CHANNEL_REPORTING_IND = 0x28
|
||||
LL_CHANNEL_STATUS_IND = 0x29
|
||||
LL_PERIODIC_SYNC_WR_IND = 0x2A
|
||||
LL_FEATURE_EXT_REQ = 0x2B
|
||||
LL_FEATURE_EXT_RSP = 0x2C
|
||||
LL_CS_SEC_RSP = 0x2D
|
||||
LL_CS_CAPABILITIES_REQ = 0x2E
|
||||
LL_CS_CAPABILITIES_RSP = 0x2F
|
||||
LL_CS_CONFIG_REQ = 0x30
|
||||
LL_CS_CONFIG_RSP = 0x31
|
||||
LL_CS_REQ = 0x32
|
||||
LL_CS_RSP = 0x33
|
||||
LL_CS_IND = 0x34
|
||||
LL_CS_TERMINATE_REQ = 0x35
|
||||
LL_CS_FAE_REQ = 0x36
|
||||
LL_CS_FAE_RSP = 0x37
|
||||
LL_CS_CHANNEL_MAP_IND = 0x38
|
||||
LL_CS_SEC_REQ = 0x39
|
||||
LL_CS_TERMINATE_RSP = 0x3A
|
||||
LL_FRAME_SPACE_REQ = 0x3B
|
||||
LL_FRAME_SPACE_RSP = 0x3C
|
||||
|
||||
opcode: ClassVar[Opcode]
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class TerminateInd(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_TERMINATE_IND
|
||||
|
||||
error_code: int
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class EncReq(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_ENC_REQ
|
||||
|
||||
rand: bytes
|
||||
ediv: int
|
||||
ltk: bytes
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class CisReq(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_CIS_REQ
|
||||
|
||||
cig_id: int
|
||||
cis_id: int
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class CisRsp(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_CIS_REQ
|
||||
|
||||
cig_id: int
|
||||
cis_id: int
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class CisInd(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_CIS_REQ
|
||||
|
||||
cig_id: int
|
||||
cis_id: int
|
||||
|
||||
|
||||
@dataclasses.dataclass
|
||||
class CisTerminateInd(ControlPdu):
|
||||
opcode = ControlPdu.Opcode.LL_CIS_TERMINATE_IND
|
||||
|
||||
cig_id: int
|
||||
cis_id: int
|
||||
error_code: int
|
||||
Reference in New Issue
Block a user