forked from auracaster/bumble_mirror
Compare commits
177 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 412fd0f78a | |||
| ee494a6543 | |||
| 2cd4f84800 | |||
| c67ca4a09e | |||
| 94506220d3 | |||
| dbd865a484 | |||
| 9d2f3e932a | |||
| 49d32f5b5b | |||
| f7b74c0bcb | |||
| c75cb0c7b7 | |||
| a63b335149 | |||
| d8517ce407 | |||
| ad13b11464 | |||
| 99bc92d53d | |||
| 72199f5615 | |||
| 78b8b50082 | |||
| 3ab64ce00d | |||
| 651e44e0b6 | |||
| 963fa41a49 | |||
| 493f4f8b95 | |||
| fc1bf36ace | |||
| 5ddee17411 | |||
| 5ce353bcde | |||
| 16d33199eb | |||
| e02303a448 | |||
| 36fc966ad6 | |||
| 644f74400d | |||
| b7cd451ddb | |||
| 88392efca4 | |||
| 907f2acc7e | |||
| 6616477bcf | |||
| 5b173cb879 | |||
| dc6b466a42 | |||
| 8b04161da3 | |||
| 5a85765360 | |||
| 333940919b | |||
| b9476be9ad | |||
| 704c60491c | |||
| 4a8e612c6e | |||
| 5e5c9c2580 | |||
| 4e71ec5738 | |||
| 7255a09705 | |||
| c2bf6b5f13 | |||
| d8e699b588 | |||
| 3e4d4705f5 | |||
| c8b2804446 | |||
| e732f2589f | |||
| aec5543081 | |||
| e03d90ca57 | |||
| 495ce62d9c | |||
| fbc3959a5a | |||
| 246b11925c | |||
| dfa9131192 | |||
| 88c801b4c2 | |||
| a1b55b94e0 | |||
| 80db9e2e2f | |||
| ce74690420 | |||
| 50de4dfb5d | |||
| 9bcdf860f4 | |||
| 511ab4b630 | |||
| 6f2b623e3c | |||
| fa12165cd3 | |||
| c0c6f3329d | |||
| 406a932467 | |||
| cc96d4245f | |||
| c6cdca8923 | |||
| 7e331c2944 | |||
| 10347765cb | |||
| c12dee4e76 | |||
| 772c188674 | |||
| 7c1a3bb8f9 | |||
| 8c3c0b1e13 | |||
| 1ad84ad51c | |||
| 64937c3f77 | |||
| 50fd2218fa | |||
| 4c29a16271 | |||
| 762d3e92de | |||
| 2f97531d78 | |||
| f6c7cae661 | |||
| f1777a5bd2 | |||
| 78a06ae8cf | |||
| d290df4aa9 | |||
| e559744f32 | |||
| 67418e649a | |||
| 5adf9fab53 | |||
| 2491b686fa | |||
| efd02b2f3e | |||
| 3b14078646 | |||
| eb9d5632bc | |||
| 45f60edbb6 | |||
| 393ea6a7bb | |||
| 6ec6f1efe5 | |||
| 5d9598ea51 | |||
| 0d36d99a73 | |||
| d8a9f5a724 | |||
| 2c66e1a042 | |||
| d5eccdb00f | |||
| 32626573a6 | |||
| caa82b8f7e | |||
| 5af347b499 | |||
| 4ed5bb5a9e | |||
| 2478d45673 | |||
| 1bc7d94111 | |||
| 6432414cd5 | |||
| 179064ba15 | |||
| 783b2d70a5 | |||
| 80824f3fc1 | |||
| f39f5f531c | |||
| 56139c622f | |||
| da02f6a39b | |||
| 548d5597c0 | |||
| 7fd65d2412 | |||
| 05a54a4af9 | |||
| 1e00c8f456 | |||
| 90d165aa01 | |||
| 01603ca9e4 | |||
| a1b6eb61f2 | |||
| 25f300d3ec | |||
| 41fe63df06 | |||
| b312170d5f | |||
| cf7f2e8f44 | |||
| d292083ed1 | |||
| 9b11142b45 | |||
| acdbc4d7b9 | |||
| 838d10a09d | |||
| 3852aa056b | |||
| ae77e4528f | |||
| 9303f4fc5b | |||
| 8be9f4cb0e | |||
| 1ea12b1bf7 | |||
| 65e6d68355 | |||
| 9732eb8836 | |||
| 5ae668bc70 | |||
| fd4d1bcca3 | |||
| 0a251c9f8e | |||
| 351d77be59 | |||
| 0e2fc80509 | |||
| 8f3fdecb93 | |||
| 249a205d8e | |||
| 7485801222 | |||
| 4678e59737 | |||
| 952d351c00 | |||
| 901eb55b0e | |||
| 727586e40e | |||
| 3aa678a58e | |||
| fc7c1a8113 | |||
| f62a0bbe75 | |||
| 7341172739 | |||
| 91b9fbe450 | |||
| e6b566b848 | |||
| 2527a711dc | |||
| 5fba6b1cae | |||
| 43e632f83c | |||
| 623298b0e9 | |||
| 85a61dc39d | |||
| 6e8c44b5e6 | |||
| ec4dcc174e | |||
| b247aca3b4 | |||
| 6226bfd196 | |||
| 71e11b7cf8 | |||
| 800c62fdb6 | |||
| 640b9cd53a | |||
| f4add16aea | |||
| 2bfec3c4ed | |||
| 9963b51c04 | |||
| 2af3494d8c | |||
| fe28473ba8 | |||
| 53d66bc74a | |||
| e2c1ad5342 | |||
| 6399c5fb04 | |||
| 784cf4f26a | |||
| 0301b1a999 | |||
| 3ab2cd5e71 | |||
| 6ea669531a | |||
| cbbada4748 | |||
| 152b8d1233 | |||
| bdad225033 |
@@ -14,6 +14,10 @@ jobs:
|
|||||||
check:
|
check:
|
||||||
name: Check Code
|
name: Check Code
|
||||||
runs-on: ubuntu-latest
|
runs-on: ubuntu-latest
|
||||||
|
strategy:
|
||||||
|
matrix:
|
||||||
|
python-version: ["3.8", "3.9", "3.10", "3.11"]
|
||||||
|
fail-fast: false
|
||||||
|
|
||||||
steps:
|
steps:
|
||||||
- name: Check out from Git
|
- name: Check out from Git
|
||||||
|
|||||||
@@ -0,0 +1,43 @@
|
|||||||
|
name: Python Avatar
|
||||||
|
|
||||||
|
on:
|
||||||
|
push:
|
||||||
|
branches: [ main ]
|
||||||
|
pull_request:
|
||||||
|
branches: [ main ]
|
||||||
|
|
||||||
|
permissions:
|
||||||
|
contents: read
|
||||||
|
|
||||||
|
jobs:
|
||||||
|
test:
|
||||||
|
name: Avatar [${{ matrix.shard }}]
|
||||||
|
runs-on: ubuntu-latest
|
||||||
|
strategy:
|
||||||
|
matrix:
|
||||||
|
shard: [
|
||||||
|
1/24, 2/24, 3/24, 4/24,
|
||||||
|
5/24, 6/24, 7/24, 8/24,
|
||||||
|
9/24, 10/24, 11/24, 12/24,
|
||||||
|
13/24, 14/24, 15/24, 16/24,
|
||||||
|
17/24, 18/24, 19/24, 20/24,
|
||||||
|
21/24, 22/24, 23/24, 24/24,
|
||||||
|
]
|
||||||
|
steps:
|
||||||
|
- uses: actions/checkout@v3
|
||||||
|
- name: Set Up Python 3.11
|
||||||
|
uses: actions/setup-python@v4
|
||||||
|
with:
|
||||||
|
python-version: 3.11
|
||||||
|
- name: Install
|
||||||
|
run: |
|
||||||
|
python -m pip install --upgrade pip
|
||||||
|
python -m pip install .[avatar]
|
||||||
|
- name: Rootcanal
|
||||||
|
run: nohup python -m rootcanal > rootcanal.log &
|
||||||
|
- name: Test
|
||||||
|
run: |
|
||||||
|
avatar --list | grep -Ev '^=' > test-names.txt
|
||||||
|
timeout 5m avatar --test-beds bumble.bumbles --tests $(split test-names.txt -n l/${{ matrix.shard }})
|
||||||
|
- name: Rootcanal Logs
|
||||||
|
run: cat rootcanal.log
|
||||||
@@ -12,10 +12,10 @@ permissions:
|
|||||||
|
|
||||||
jobs:
|
jobs:
|
||||||
build:
|
build:
|
||||||
|
runs-on: ${{ matrix.os }}
|
||||||
runs-on: ubuntu-latest
|
|
||||||
strategy:
|
strategy:
|
||||||
matrix:
|
matrix:
|
||||||
|
os: ['ubuntu-latest', 'macos-latest', 'windows-latest']
|
||||||
python-version: ["3.8", "3.9", "3.10", "3.11"]
|
python-version: ["3.8", "3.9", "3.10", "3.11"]
|
||||||
fail-fast: false
|
fail-fast: false
|
||||||
|
|
||||||
@@ -41,11 +41,13 @@ jobs:
|
|||||||
run: |
|
run: |
|
||||||
inv build
|
inv build
|
||||||
inv build.mkdocs
|
inv build.mkdocs
|
||||||
|
|
||||||
build-rust:
|
build-rust:
|
||||||
runs-on: ubuntu-latest
|
runs-on: ubuntu-latest
|
||||||
strategy:
|
strategy:
|
||||||
matrix:
|
matrix:
|
||||||
python-version: [ "3.8", "3.9", "3.10" ]
|
python-version: [ "3.8", "3.9", "3.10", "3.11" ]
|
||||||
|
rust-version: [ "1.70.0", "stable" ]
|
||||||
fail-fast: false
|
fail-fast: false
|
||||||
steps:
|
steps:
|
||||||
- name: Check out from Git
|
- name: Check out from Git
|
||||||
@@ -62,9 +64,17 @@ jobs:
|
|||||||
uses: actions-rust-lang/setup-rust-toolchain@v1
|
uses: actions-rust-lang/setup-rust-toolchain@v1
|
||||||
with:
|
with:
|
||||||
components: clippy,rustfmt
|
components: clippy,rustfmt
|
||||||
- name: Rust Lints
|
toolchain: ${{ matrix.rust-version }}
|
||||||
run: cd rust && cargo fmt --check && cargo clippy --all-targets -- --deny warnings
|
- name: Check License Headers
|
||||||
|
run: cd rust && cargo run --features dev-tools --bin file-header check-all
|
||||||
- name: Rust Build
|
- name: Rust Build
|
||||||
run: cd rust && cargo build --all-targets
|
run: cd rust && cargo build --all-targets && cargo build --all-features --all-targets
|
||||||
|
# Lints after build so what clippy needs is already built
|
||||||
|
- name: Rust Lints
|
||||||
|
run: cd rust && cargo fmt --check && cargo clippy --all-targets -- --deny warnings && cargo clippy --all-features --all-targets -- --deny warnings
|
||||||
- name: Rust Tests
|
- name: Rust Tests
|
||||||
run: cd rust && cargo test
|
run: cd rust && cargo test
|
||||||
|
# At some point, hook up publishing the binary. For now, just make sure it builds.
|
||||||
|
# Once we're ready to publish binaries, this should be built with `--release`.
|
||||||
|
- name: Build Bumble CLI
|
||||||
|
run: cd rust && cargo build --features bumble-tools --bin bumble
|
||||||
Vendored
+3
@@ -39,12 +39,15 @@
|
|||||||
"libusb",
|
"libusb",
|
||||||
"MITM",
|
"MITM",
|
||||||
"NDIS",
|
"NDIS",
|
||||||
|
"netsim",
|
||||||
"NONBLOCK",
|
"NONBLOCK",
|
||||||
"NONCONN",
|
"NONCONN",
|
||||||
"OXIMETER",
|
"OXIMETER",
|
||||||
"popleft",
|
"popleft",
|
||||||
|
"protobuf",
|
||||||
"psms",
|
"psms",
|
||||||
"pyee",
|
"pyee",
|
||||||
|
"Pyodide",
|
||||||
"pyusb",
|
"pyusb",
|
||||||
"rfcomm",
|
"rfcomm",
|
||||||
"ROHC",
|
"ROHC",
|
||||||
|
|||||||
+17
-13
@@ -24,6 +24,7 @@ import time
|
|||||||
|
|
||||||
import click
|
import click
|
||||||
|
|
||||||
|
from bumble import l2cap
|
||||||
from bumble.core import (
|
from bumble.core import (
|
||||||
BT_BR_EDR_TRANSPORT,
|
BT_BR_EDR_TRANSPORT,
|
||||||
BT_LE_TRANSPORT,
|
BT_LE_TRANSPORT,
|
||||||
@@ -85,6 +86,7 @@ DEFAULT_LINGER_TIME = 1.0
|
|||||||
|
|
||||||
DEFAULT_RFCOMM_CHANNEL = 8
|
DEFAULT_RFCOMM_CHANNEL = 8
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Utils
|
# Utils
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -197,6 +199,7 @@ class PacketType(enum.IntEnum):
|
|||||||
|
|
||||||
PACKET_FLAG_LAST = 1
|
PACKET_FLAG_LAST = 1
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Sender
|
# Sender
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -659,17 +662,19 @@ class L2capClient(StreamedPacketIO):
|
|||||||
self.mps = mps
|
self.mps = mps
|
||||||
self.ready = asyncio.Event()
|
self.ready = asyncio.Event()
|
||||||
|
|
||||||
async def on_connection(self, connection):
|
async def on_connection(self, connection: Connection) -> None:
|
||||||
connection.on('disconnection', self.on_disconnection)
|
connection.on('disconnection', self.on_disconnection)
|
||||||
|
|
||||||
# Connect a new L2CAP channel
|
# Connect a new L2CAP channel
|
||||||
print(color(f'>>> Opening L2CAP channel on PSM = {self.psm}', 'yellow'))
|
print(color(f'>>> Opening L2CAP channel on PSM = {self.psm}', 'yellow'))
|
||||||
try:
|
try:
|
||||||
l2cap_channel = await connection.open_l2cap_channel(
|
l2cap_channel = await connection.create_l2cap_channel(
|
||||||
psm=self.psm,
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
max_credits=self.max_credits,
|
psm=self.psm,
|
||||||
mtu=self.mtu,
|
max_credits=self.max_credits,
|
||||||
mps=self.mps,
|
mtu=self.mtu,
|
||||||
|
mps=self.mps,
|
||||||
|
)
|
||||||
)
|
)
|
||||||
print(color('*** L2CAP channel:', 'cyan'), l2cap_channel)
|
print(color('*** L2CAP channel:', 'cyan'), l2cap_channel)
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
@@ -695,7 +700,7 @@ class L2capClient(StreamedPacketIO):
|
|||||||
class L2capServer(StreamedPacketIO):
|
class L2capServer(StreamedPacketIO):
|
||||||
def __init__(
|
def __init__(
|
||||||
self,
|
self,
|
||||||
device,
|
device: Device,
|
||||||
psm=DEFAULT_L2CAP_PSM,
|
psm=DEFAULT_L2CAP_PSM,
|
||||||
max_credits=DEFAULT_L2CAP_MAX_CREDITS,
|
max_credits=DEFAULT_L2CAP_MAX_CREDITS,
|
||||||
mtu=DEFAULT_L2CAP_MTU,
|
mtu=DEFAULT_L2CAP_MTU,
|
||||||
@@ -706,12 +711,11 @@ class L2capServer(StreamedPacketIO):
|
|||||||
self.ready = asyncio.Event()
|
self.ready = asyncio.Event()
|
||||||
|
|
||||||
# Listen for incoming L2CAP CoC connections
|
# Listen for incoming L2CAP CoC connections
|
||||||
device.register_l2cap_channel_server(
|
device.create_l2cap_server(
|
||||||
psm=psm,
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
server=self.on_l2cap_channel,
|
psm=psm, mtu=mtu, mps=mps, max_credits=max_credits
|
||||||
max_credits=max_credits,
|
),
|
||||||
mtu=mtu,
|
handler=self.on_l2cap_channel,
|
||||||
mps=mps,
|
|
||||||
)
|
)
|
||||||
print(color(f'### Listening for CoC connection on PSM {psm}', 'yellow'))
|
print(color(f'### Listening for CoC connection on PSM {psm}', 'yellow'))
|
||||||
|
|
||||||
|
|||||||
+1
-1
@@ -1172,7 +1172,7 @@ class ScanResult:
|
|||||||
name = ''
|
name = ''
|
||||||
|
|
||||||
# Remove any '/P' qualifier suffix from the address string
|
# Remove any '/P' qualifier suffix from the address string
|
||||||
address_str = str(self.address).replace('/P', '')
|
address_str = self.address.to_string(with_type_qualifier=False)
|
||||||
|
|
||||||
# RSSI bar
|
# RSSI bar
|
||||||
bar_string = rssi_bar(self.rssi)
|
bar_string = rssi_bar(self.rssi)
|
||||||
|
|||||||
@@ -63,7 +63,8 @@ async def get_classic_info(host):
|
|||||||
if command_succeeded(response):
|
if command_succeeded(response):
|
||||||
print()
|
print()
|
||||||
print(
|
print(
|
||||||
color('Classic Address:', 'yellow'), response.return_parameters.bd_addr
|
color('Classic Address:', 'yellow'),
|
||||||
|
response.return_parameters.bd_addr.to_string(False),
|
||||||
)
|
)
|
||||||
|
|
||||||
if host.supports_command(HCI_READ_LOCAL_NAME_COMMAND):
|
if host.supports_command(HCI_READ_LOCAL_NAME_COMMAND):
|
||||||
|
|||||||
+8
-2
@@ -21,6 +21,7 @@ import struct
|
|||||||
import logging
|
import logging
|
||||||
import click
|
import click
|
||||||
|
|
||||||
|
from bumble import l2cap
|
||||||
from bumble.colors import color
|
from bumble.colors import color
|
||||||
from bumble.device import Device, Peer
|
from bumble.device import Device, Peer
|
||||||
from bumble.core import AdvertisingData
|
from bumble.core import AdvertisingData
|
||||||
@@ -204,7 +205,7 @@ class GattlinkHubBridge(GattlinkL2capEndpoint, Device.Listener):
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class GattlinkNodeBridge(GattlinkL2capEndpoint, Device.Listener):
|
class GattlinkNodeBridge(GattlinkL2capEndpoint, Device.Listener):
|
||||||
def __init__(self, device):
|
def __init__(self, device: Device):
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.device = device
|
self.device = device
|
||||||
self.peer = None
|
self.peer = None
|
||||||
@@ -218,7 +219,12 @@ class GattlinkNodeBridge(GattlinkL2capEndpoint, Device.Listener):
|
|||||||
|
|
||||||
# Listen for incoming L2CAP CoC connections
|
# Listen for incoming L2CAP CoC connections
|
||||||
psm = 0xFB
|
psm = 0xFB
|
||||||
device.register_l2cap_channel_server(0xFB, self.on_coc)
|
device.create_l2cap_server(
|
||||||
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
|
psm=0xFB,
|
||||||
|
),
|
||||||
|
handler=self.on_coc,
|
||||||
|
)
|
||||||
print(f'### Listening for CoC connection on PSM {psm}')
|
print(f'### Listening for CoC connection on PSM {psm}')
|
||||||
|
|
||||||
# Setup the Gattlink service
|
# Setup the Gattlink service
|
||||||
|
|||||||
+16
-13
@@ -20,6 +20,7 @@ import logging
|
|||||||
import os
|
import os
|
||||||
import click
|
import click
|
||||||
|
|
||||||
|
from bumble import l2cap
|
||||||
from bumble.colors import color
|
from bumble.colors import color
|
||||||
from bumble.transport import open_transport_or_link
|
from bumble.transport import open_transport_or_link
|
||||||
from bumble.device import Device
|
from bumble.device import Device
|
||||||
@@ -47,14 +48,13 @@ class ServerBridge:
|
|||||||
self.tcp_host = tcp_host
|
self.tcp_host = tcp_host
|
||||||
self.tcp_port = tcp_port
|
self.tcp_port = tcp_port
|
||||||
|
|
||||||
async def start(self, device):
|
async def start(self, device: Device) -> None:
|
||||||
# Listen for incoming L2CAP CoC connections
|
# Listen for incoming L2CAP CoC connections
|
||||||
device.register_l2cap_channel_server(
|
device.create_l2cap_server(
|
||||||
psm=self.psm,
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
server=self.on_coc,
|
psm=self.psm, mtu=self.mtu, mps=self.mps, max_credits=self.max_credits
|
||||||
max_credits=self.max_credits,
|
),
|
||||||
mtu=self.mtu,
|
handler=self.on_coc,
|
||||||
mps=self.mps,
|
|
||||||
)
|
)
|
||||||
print(color(f'### Listening for CoC connection on PSM {self.psm}', 'yellow'))
|
print(color(f'### Listening for CoC connection on PSM {self.psm}', 'yellow'))
|
||||||
|
|
||||||
@@ -105,7 +105,7 @@ class ServerBridge:
|
|||||||
asyncio.create_task(self.pipe.l2cap_channel.disconnect())
|
asyncio.create_task(self.pipe.l2cap_channel.disconnect())
|
||||||
|
|
||||||
def data_received(self, data):
|
def data_received(self, data):
|
||||||
print(f'<<< Received on TCP: {len(data)}')
|
print(color(f'<<< [TCP DATA]: {len(data)} bytes', 'blue'))
|
||||||
self.pipe.l2cap_channel.write(data)
|
self.pipe.l2cap_channel.write(data)
|
||||||
|
|
||||||
try:
|
try:
|
||||||
@@ -123,6 +123,7 @@ class ServerBridge:
|
|||||||
await self.l2cap_channel.disconnect()
|
await self.l2cap_channel.disconnect()
|
||||||
|
|
||||||
def on_l2cap_close(self):
|
def on_l2cap_close(self):
|
||||||
|
print(color('*** L2CAP channel closed', 'red'))
|
||||||
self.l2cap_channel = None
|
self.l2cap_channel = None
|
||||||
if self.tcp_transport is not None:
|
if self.tcp_transport is not None:
|
||||||
self.tcp_transport.close()
|
self.tcp_transport.close()
|
||||||
@@ -194,11 +195,13 @@ class ClientBridge:
|
|||||||
# Connect a new L2CAP channel
|
# Connect a new L2CAP channel
|
||||||
print(color(f'>>> Opening L2CAP channel on PSM = {self.psm}', 'yellow'))
|
print(color(f'>>> Opening L2CAP channel on PSM = {self.psm}', 'yellow'))
|
||||||
try:
|
try:
|
||||||
l2cap_channel = await connection.open_l2cap_channel(
|
l2cap_channel = await connection.create_l2cap_channel(
|
||||||
psm=self.psm,
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
max_credits=self.max_credits,
|
psm=self.psm,
|
||||||
mtu=self.mtu,
|
max_credits=self.max_credits,
|
||||||
mps=self.mps,
|
mtu=self.mtu,
|
||||||
|
mps=self.mps,
|
||||||
|
)
|
||||||
)
|
)
|
||||||
print(color('*** L2CAP channel:', 'cyan'), l2cap_channel)
|
print(color('*** L2CAP channel:', 'cyan'), l2cap_channel)
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
|
|||||||
+1
-1
@@ -306,6 +306,7 @@ async def pair(
|
|||||||
# Expose a GATT characteristic that can be used to trigger pairing by
|
# Expose a GATT characteristic that can be used to trigger pairing by
|
||||||
# responding with an authentication error when read
|
# responding with an authentication error when read
|
||||||
if mode == 'le':
|
if mode == 'le':
|
||||||
|
device.le_enabled = True
|
||||||
device.add_service(
|
device.add_service(
|
||||||
Service(
|
Service(
|
||||||
'50DB505C-8AC4-4738-8448-3B1D9CC09CC5',
|
'50DB505C-8AC4-4738-8448-3B1D9CC09CC5',
|
||||||
@@ -326,7 +327,6 @@ async def pair(
|
|||||||
# Select LE or Classic
|
# Select LE or Classic
|
||||||
if mode == 'classic':
|
if mode == 'classic':
|
||||||
device.classic_enabled = True
|
device.classic_enabled = True
|
||||||
device.le_enabled = False
|
|
||||||
device.classic_smp_enabled = ctkd
|
device.classic_smp_enabled = ctkd
|
||||||
|
|
||||||
# Get things going
|
# Get things going
|
||||||
|
|||||||
+25
-4
@@ -1,8 +1,10 @@
|
|||||||
import asyncio
|
import asyncio
|
||||||
import click
|
import click
|
||||||
import logging
|
import logging
|
||||||
|
import json
|
||||||
|
|
||||||
from bumble.pandora import PandoraDevice, serve
|
from bumble.pandora import PandoraDevice, Config, serve
|
||||||
|
from typing import Dict, Any
|
||||||
|
|
||||||
BUMBLE_SERVER_GRPC_PORT = 7999
|
BUMBLE_SERVER_GRPC_PORT = 7999
|
||||||
ROOTCANAL_PORT_CUTTLEFISH = 7300
|
ROOTCANAL_PORT_CUTTLEFISH = 7300
|
||||||
@@ -18,12 +20,31 @@ ROOTCANAL_PORT_CUTTLEFISH = 7300
|
|||||||
help='HCI transport',
|
help='HCI transport',
|
||||||
default=f'tcp-client:127.0.0.1:<rootcanal-port>',
|
default=f'tcp-client:127.0.0.1:<rootcanal-port>',
|
||||||
)
|
)
|
||||||
def main(grpc_port: int, rootcanal_port: int, transport: str) -> None:
|
@click.option(
|
||||||
|
'--config',
|
||||||
|
help='Bumble json configuration file',
|
||||||
|
)
|
||||||
|
def main(grpc_port: int, rootcanal_port: int, transport: str, config: str) -> None:
|
||||||
if '<rootcanal-port>' in transport:
|
if '<rootcanal-port>' in transport:
|
||||||
transport = transport.replace('<rootcanal-port>', str(rootcanal_port))
|
transport = transport.replace('<rootcanal-port>', str(rootcanal_port))
|
||||||
device = PandoraDevice({'transport': transport})
|
|
||||||
|
bumble_config = retrieve_config(config)
|
||||||
|
bumble_config.setdefault('transport', transport)
|
||||||
|
device = PandoraDevice(bumble_config)
|
||||||
|
|
||||||
|
server_config = Config()
|
||||||
|
server_config.load_from_dict(bumble_config.get('server', {}))
|
||||||
|
|
||||||
logging.basicConfig(level=logging.DEBUG)
|
logging.basicConfig(level=logging.DEBUG)
|
||||||
asyncio.run(serve(device, port=grpc_port))
|
asyncio.run(serve(device, config=server_config, port=grpc_port))
|
||||||
|
|
||||||
|
|
||||||
|
def retrieve_config(config: str) -> Dict[str, Any]:
|
||||||
|
if not config:
|
||||||
|
return {}
|
||||||
|
|
||||||
|
with open(config, 'r') as f:
|
||||||
|
return json.load(f)
|
||||||
|
|
||||||
|
|
||||||
if __name__ == '__main__':
|
if __name__ == '__main__':
|
||||||
|
|||||||
+13
-2
@@ -102,9 +102,21 @@ class SnoopPacketReader:
|
|||||||
default='h4',
|
default='h4',
|
||||||
help='Format of the input file',
|
help='Format of the input file',
|
||||||
)
|
)
|
||||||
|
@click.option(
|
||||||
|
'--vendors',
|
||||||
|
type=click.Choice(['android', 'zephyr']),
|
||||||
|
multiple=True,
|
||||||
|
help='Support vendor-specific commands (list one or more)',
|
||||||
|
)
|
||||||
@click.argument('filename')
|
@click.argument('filename')
|
||||||
# pylint: disable=redefined-builtin
|
# pylint: disable=redefined-builtin
|
||||||
def main(format, filename):
|
def main(format, vendors, filename):
|
||||||
|
for vendor in vendors:
|
||||||
|
if vendor == 'android':
|
||||||
|
import bumble.vendor.android.hci
|
||||||
|
elif vendor == 'zephyr':
|
||||||
|
import bumble.vendor.zephyr.hci
|
||||||
|
|
||||||
input = open(filename, 'rb')
|
input = open(filename, 'rb')
|
||||||
if format == 'h4':
|
if format == 'h4':
|
||||||
packet_reader = PacketReader(input)
|
packet_reader = PacketReader(input)
|
||||||
@@ -124,7 +136,6 @@ def main(format, filename):
|
|||||||
if packet is None:
|
if packet is None:
|
||||||
break
|
break
|
||||||
tracer.trace(hci.HCI_Packet.from_bytes(packet), direction)
|
tracer.trace(hci.HCI_Packet.from_bytes(packet), direction)
|
||||||
|
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
print(color(f'!!! {error}', 'red'))
|
print(color(f'!!! {error}', 'red'))
|
||||||
|
|
||||||
|
|||||||
@@ -56,7 +56,7 @@ body, h1, h2, h3, h4, h5, h6 {
|
|||||||
border-radius: 4px;
|
border-radius: 4px;
|
||||||
padding: 4px;
|
padding: 4px;
|
||||||
margin: 6px;
|
margin: 6px;
|
||||||
margin-left: 0px;
|
margin-left: 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
th, td {
|
th, td {
|
||||||
@@ -65,7 +65,7 @@ th, td {
|
|||||||
}
|
}
|
||||||
|
|
||||||
.properties td:nth-child(even) {
|
.properties td:nth-child(even) {
|
||||||
background-color: #D6EEEE;
|
background-color: #d6eeee;
|
||||||
font-family: monospace;
|
font-family: monospace;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -2,7 +2,7 @@
|
|||||||
<html>
|
<html>
|
||||||
<head>
|
<head>
|
||||||
<title>Bumble Speaker</title>
|
<title>Bumble Speaker</title>
|
||||||
<script type="text/javascript" src="speaker.js"></script>
|
<script src="speaker.js"></script>
|
||||||
<link rel="stylesheet" href="speaker.css">
|
<link rel="stylesheet" href="speaker.css">
|
||||||
</head>
|
</head>
|
||||||
<body>
|
<body>
|
||||||
|
|||||||
+8
-18
@@ -195,7 +195,7 @@ class WebSocketOutput(QueuedOutput):
|
|||||||
except HCI_StatusError:
|
except HCI_StatusError:
|
||||||
pass
|
pass
|
||||||
peer_name = '' if connection.peer_name is None else connection.peer_name
|
peer_name = '' if connection.peer_name is None else connection.peer_name
|
||||||
peer_address = str(connection.peer_address).replace('/P', '')
|
peer_address = connection.peer_address.to_string(False)
|
||||||
await self.send_message(
|
await self.send_message(
|
||||||
'connection',
|
'connection',
|
||||||
peer_address=peer_address,
|
peer_address=peer_address,
|
||||||
@@ -228,10 +228,11 @@ class FfplayOutput(QueuedOutput):
|
|||||||
subprocess: Optional[asyncio.subprocess.Process]
|
subprocess: Optional[asyncio.subprocess.Process]
|
||||||
ffplay_task: Optional[asyncio.Task]
|
ffplay_task: Optional[asyncio.Task]
|
||||||
|
|
||||||
def __init__(self) -> None:
|
def __init__(self, codec: str) -> None:
|
||||||
super().__init__(AacAudioExtractor())
|
super().__init__(AudioExtractor.create(codec))
|
||||||
self.subprocess = None
|
self.subprocess = None
|
||||||
self.ffplay_task = None
|
self.ffplay_task = None
|
||||||
|
self.codec = codec
|
||||||
|
|
||||||
async def start(self):
|
async def start(self):
|
||||||
if self.started:
|
if self.started:
|
||||||
@@ -240,7 +241,7 @@ class FfplayOutput(QueuedOutput):
|
|||||||
await super().start()
|
await super().start()
|
||||||
|
|
||||||
self.subprocess = await asyncio.create_subprocess_shell(
|
self.subprocess = await asyncio.create_subprocess_shell(
|
||||||
'ffplay -acodec aac pipe:0',
|
f'ffplay -f {self.codec} pipe:0',
|
||||||
stdin=asyncio.subprocess.PIPE,
|
stdin=asyncio.subprocess.PIPE,
|
||||||
stdout=asyncio.subprocess.PIPE,
|
stdout=asyncio.subprocess.PIPE,
|
||||||
stderr=asyncio.subprocess.PIPE,
|
stderr=asyncio.subprocess.PIPE,
|
||||||
@@ -375,7 +376,7 @@ class UiServer:
|
|||||||
if connection := self.speaker().connection:
|
if connection := self.speaker().connection:
|
||||||
await self.send_message(
|
await self.send_message(
|
||||||
'connection',
|
'connection',
|
||||||
peer_address=str(connection.peer_address).replace('/P', ''),
|
peer_address=connection.peer_address.to_string(False),
|
||||||
peer_name=connection.peer_name,
|
peer_name=connection.peer_name,
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -419,7 +420,7 @@ class Speaker:
|
|||||||
self.outputs = []
|
self.outputs = []
|
||||||
for output in outputs:
|
for output in outputs:
|
||||||
if output == '@ffplay':
|
if output == '@ffplay':
|
||||||
self.outputs.append(FfplayOutput())
|
self.outputs.append(FfplayOutput(codec))
|
||||||
continue
|
continue
|
||||||
|
|
||||||
# Default to FileOutput
|
# Default to FileOutput
|
||||||
@@ -640,7 +641,7 @@ class Speaker:
|
|||||||
self.device.on('connection', self.on_bluetooth_connection)
|
self.device.on('connection', self.on_bluetooth_connection)
|
||||||
|
|
||||||
# Create a listener to wait for AVDTP connections
|
# Create a listener to wait for AVDTP connections
|
||||||
self.listener = Listener(Listener.create_registrar(self.device))
|
self.listener = Listener.for_device(self.device)
|
||||||
self.listener.on('connection', self.on_avdtp_connection)
|
self.listener.on('connection', self.on_avdtp_connection)
|
||||||
|
|
||||||
print(f'Speaker ready to play, codec={color(self.codec, "cyan")}')
|
print(f'Speaker ready to play, codec={color(self.codec, "cyan")}')
|
||||||
@@ -708,17 +709,6 @@ def speaker(
|
|||||||
):
|
):
|
||||||
"""Run the speaker."""
|
"""Run the speaker."""
|
||||||
|
|
||||||
# ffplay only works with AAC for now
|
|
||||||
if codec != 'aac' and '@ffplay' in output:
|
|
||||||
print(
|
|
||||||
color(
|
|
||||||
f'{codec} not supported with @ffplay output, '
|
|
||||||
'@ffplay output will be skipped',
|
|
||||||
'yellow',
|
|
||||||
)
|
|
||||||
)
|
|
||||||
output = list(filter(lambda x: x != '@ffplay', output))
|
|
||||||
|
|
||||||
if '@ffplay' in output:
|
if '@ffplay' in output:
|
||||||
# Check if ffplay is installed
|
# Check if ffplay is installed
|
||||||
try:
|
try:
|
||||||
|
|||||||
@@ -0,0 +1,85 @@
|
|||||||
|
# Copyright 2023 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.
|
||||||
|
|
||||||
|
from typing import List, Union
|
||||||
|
|
||||||
|
|
||||||
|
def tokenize_parameters(buffer: bytes) -> List[bytes]:
|
||||||
|
"""Split input parameters into tokens.
|
||||||
|
Removes space characters outside of double quote blocks:
|
||||||
|
T-rec-V-25 - 5.2.1 Command line general format: "Space characters (IA5 2/0)
|
||||||
|
are ignored [..], unless they are embedded in numeric or string constants"
|
||||||
|
Raises ValueError in case of invalid input string."""
|
||||||
|
|
||||||
|
tokens = []
|
||||||
|
in_quotes = False
|
||||||
|
token = bytearray()
|
||||||
|
for b in buffer:
|
||||||
|
char = bytearray([b])
|
||||||
|
|
||||||
|
if in_quotes:
|
||||||
|
token.extend(char)
|
||||||
|
if char == b'\"':
|
||||||
|
in_quotes = False
|
||||||
|
tokens.append(token[1:-1])
|
||||||
|
token = bytearray()
|
||||||
|
else:
|
||||||
|
if char == b' ':
|
||||||
|
pass
|
||||||
|
elif char == b',' or char == b')':
|
||||||
|
tokens.append(token)
|
||||||
|
tokens.append(char)
|
||||||
|
token = bytearray()
|
||||||
|
elif char == b'(':
|
||||||
|
if len(token) > 0:
|
||||||
|
raise ValueError("open_paren following regular character")
|
||||||
|
tokens.append(char)
|
||||||
|
elif char == b'"':
|
||||||
|
if len(token) > 0:
|
||||||
|
raise ValueError("quote following regular character")
|
||||||
|
in_quotes = True
|
||||||
|
token.extend(char)
|
||||||
|
else:
|
||||||
|
token.extend(char)
|
||||||
|
|
||||||
|
tokens.append(token)
|
||||||
|
return [bytes(token) for token in tokens if len(token) > 0]
|
||||||
|
|
||||||
|
|
||||||
|
def parse_parameters(buffer: bytes) -> List[Union[bytes, list]]:
|
||||||
|
"""Parse the parameters using the comma and parenthesis separators.
|
||||||
|
Raises ValueError in case of invalid input string."""
|
||||||
|
|
||||||
|
tokens = tokenize_parameters(buffer)
|
||||||
|
accumulator: List[list] = [[]]
|
||||||
|
current: Union[bytes, list] = bytes()
|
||||||
|
|
||||||
|
for token in tokens:
|
||||||
|
if token == b',':
|
||||||
|
accumulator[-1].append(current)
|
||||||
|
current = bytes()
|
||||||
|
elif token == b'(':
|
||||||
|
accumulator.append([])
|
||||||
|
elif token == b')':
|
||||||
|
if len(accumulator) < 2:
|
||||||
|
raise ValueError("close_paren without matching open_paren")
|
||||||
|
accumulator[-1].append(current)
|
||||||
|
current = accumulator.pop()
|
||||||
|
else:
|
||||||
|
current = token
|
||||||
|
|
||||||
|
accumulator[-1].append(current)
|
||||||
|
if len(accumulator) > 1:
|
||||||
|
raise ValueError("missing close_paren")
|
||||||
|
return accumulator[0]
|
||||||
+75
-49
@@ -23,13 +23,14 @@
|
|||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
from __future__ import annotations
|
from __future__ import annotations
|
||||||
|
import enum
|
||||||
import functools
|
import functools
|
||||||
import struct
|
import struct
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
from typing import Dict, Type, TYPE_CHECKING
|
from typing import Dict, Type, List, Protocol, Union, Optional, Any, TYPE_CHECKING
|
||||||
|
|
||||||
from bumble.core import UUID, name_or_number, get_dict_key_by_value, ProtocolError
|
from bumble.core import UUID, name_or_number, ProtocolError
|
||||||
from bumble.hci import HCI_Object, key_with_value, HCI_Constant
|
from bumble.hci import HCI_Object, key_with_value
|
||||||
from bumble.colors import color
|
from bumble.colors import color
|
||||||
|
|
||||||
if TYPE_CHECKING:
|
if TYPE_CHECKING:
|
||||||
@@ -182,6 +183,7 @@ UUID_2_FIELD_SPEC = lambda x, y: UUID.parse_uuid_2(x, y) # noqa: E731
|
|||||||
# pylint: enable=line-too-long
|
# pylint: enable=line-too-long
|
||||||
# pylint: disable=invalid-name
|
# pylint: disable=invalid-name
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Exceptions
|
# Exceptions
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -209,7 +211,7 @@ class ATT_PDU:
|
|||||||
|
|
||||||
pdu_classes: Dict[int, Type[ATT_PDU]] = {}
|
pdu_classes: Dict[int, Type[ATT_PDU]] = {}
|
||||||
op_code = 0
|
op_code = 0
|
||||||
name = None
|
name: str
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def from_bytes(pdu):
|
def from_bytes(pdu):
|
||||||
@@ -719,48 +721,68 @@ class ATT_Handle_Value_Confirmation(ATT_PDU):
|
|||||||
'''
|
'''
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
class ConnectionValue(Protocol):
|
||||||
|
def read(self, connection) -> bytes:
|
||||||
|
...
|
||||||
|
|
||||||
|
def write(self, connection, value: bytes) -> None:
|
||||||
|
...
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Attribute(EventEmitter):
|
class Attribute(EventEmitter):
|
||||||
# Permission flags
|
class Permissions(enum.IntFlag):
|
||||||
READABLE = 0x01
|
READABLE = 0x01
|
||||||
WRITEABLE = 0x02
|
WRITEABLE = 0x02
|
||||||
READ_REQUIRES_ENCRYPTION = 0x04
|
READ_REQUIRES_ENCRYPTION = 0x04
|
||||||
WRITE_REQUIRES_ENCRYPTION = 0x08
|
WRITE_REQUIRES_ENCRYPTION = 0x08
|
||||||
READ_REQUIRES_AUTHENTICATION = 0x10
|
READ_REQUIRES_AUTHENTICATION = 0x10
|
||||||
WRITE_REQUIRES_AUTHENTICATION = 0x20
|
WRITE_REQUIRES_AUTHENTICATION = 0x20
|
||||||
READ_REQUIRES_AUTHORIZATION = 0x40
|
READ_REQUIRES_AUTHORIZATION = 0x40
|
||||||
WRITE_REQUIRES_AUTHORIZATION = 0x80
|
WRITE_REQUIRES_AUTHORIZATION = 0x80
|
||||||
|
|
||||||
PERMISSION_NAMES = {
|
@classmethod
|
||||||
READABLE: 'READABLE',
|
def from_string(cls, permissions_str: str) -> Attribute.Permissions:
|
||||||
WRITEABLE: 'WRITEABLE',
|
try:
|
||||||
READ_REQUIRES_ENCRYPTION: 'READ_REQUIRES_ENCRYPTION',
|
return functools.reduce(
|
||||||
WRITE_REQUIRES_ENCRYPTION: 'WRITE_REQUIRES_ENCRYPTION',
|
lambda x, y: x | Attribute.Permissions[y],
|
||||||
READ_REQUIRES_AUTHENTICATION: 'READ_REQUIRES_AUTHENTICATION',
|
permissions_str.replace('|', ',').split(","),
|
||||||
WRITE_REQUIRES_AUTHENTICATION: 'WRITE_REQUIRES_AUTHENTICATION',
|
Attribute.Permissions(0),
|
||||||
READ_REQUIRES_AUTHORIZATION: 'READ_REQUIRES_AUTHORIZATION',
|
)
|
||||||
WRITE_REQUIRES_AUTHORIZATION: 'WRITE_REQUIRES_AUTHORIZATION',
|
except TypeError as exc:
|
||||||
}
|
# The check for `p.name is not None` here is needed because for InFlag
|
||||||
|
# enums, the .name property can be None, when the enum value is 0,
|
||||||
|
# so the type hint for .name is Optional[str].
|
||||||
|
enum_list: List[str] = [p.name for p in cls if p.name is not None]
|
||||||
|
enum_list_str = ",".join(enum_list)
|
||||||
|
raise TypeError(
|
||||||
|
f"Attribute::permissions error:\nExpected a string containing any of the keys, separated by commas: {enum_list_str }\nGot: {permissions_str}"
|
||||||
|
) from exc
|
||||||
|
|
||||||
@staticmethod
|
# Permission flags(legacy-use only)
|
||||||
def string_to_permissions(permissions_str: str):
|
READABLE = Permissions.READABLE
|
||||||
try:
|
WRITEABLE = Permissions.WRITEABLE
|
||||||
return functools.reduce(
|
READ_REQUIRES_ENCRYPTION = Permissions.READ_REQUIRES_ENCRYPTION
|
||||||
lambda x, y: x | get_dict_key_by_value(Attribute.PERMISSION_NAMES, y),
|
WRITE_REQUIRES_ENCRYPTION = Permissions.WRITE_REQUIRES_ENCRYPTION
|
||||||
permissions_str.split(","),
|
READ_REQUIRES_AUTHENTICATION = Permissions.READ_REQUIRES_AUTHENTICATION
|
||||||
0,
|
WRITE_REQUIRES_AUTHENTICATION = Permissions.WRITE_REQUIRES_AUTHENTICATION
|
||||||
)
|
READ_REQUIRES_AUTHORIZATION = Permissions.READ_REQUIRES_AUTHORIZATION
|
||||||
except TypeError as exc:
|
WRITE_REQUIRES_AUTHORIZATION = Permissions.WRITE_REQUIRES_AUTHORIZATION
|
||||||
raise TypeError(
|
|
||||||
f"Attribute::permissions error:\nExpected a string containing any of the keys, separated by commas: {','.join(Attribute.PERMISSION_NAMES.values())}\nGot: {permissions_str}"
|
|
||||||
) from exc
|
|
||||||
|
|
||||||
def __init__(self, attribute_type, permissions, value=b''):
|
value: Union[str, bytes, ConnectionValue]
|
||||||
|
|
||||||
|
def __init__(
|
||||||
|
self,
|
||||||
|
attribute_type: Union[str, bytes, UUID],
|
||||||
|
permissions: Union[str, Attribute.Permissions],
|
||||||
|
value: Union[str, bytes, ConnectionValue] = b'',
|
||||||
|
) -> None:
|
||||||
EventEmitter.__init__(self)
|
EventEmitter.__init__(self)
|
||||||
self.handle = 0
|
self.handle = 0
|
||||||
self.end_group_handle = 0
|
self.end_group_handle = 0
|
||||||
if isinstance(permissions, str):
|
if isinstance(permissions, str):
|
||||||
self.permissions = self.string_to_permissions(permissions)
|
self.permissions = Attribute.Permissions.from_string(permissions)
|
||||||
else:
|
else:
|
||||||
self.permissions = permissions
|
self.permissions = permissions
|
||||||
|
|
||||||
@@ -778,22 +800,26 @@ class Attribute(EventEmitter):
|
|||||||
else:
|
else:
|
||||||
self.value = value
|
self.value = value
|
||||||
|
|
||||||
def encode_value(self, value):
|
def encode_value(self, value: Any) -> bytes:
|
||||||
return value
|
return value
|
||||||
|
|
||||||
def decode_value(self, value_bytes):
|
def decode_value(self, value_bytes: bytes) -> Any:
|
||||||
return value_bytes
|
return value_bytes
|
||||||
|
|
||||||
def read_value(self, connection: Connection):
|
def read_value(self, connection: Optional[Connection]) -> bytes:
|
||||||
if (
|
if (
|
||||||
self.permissions & self.READ_REQUIRES_ENCRYPTION
|
(self.permissions & self.READ_REQUIRES_ENCRYPTION)
|
||||||
) and not connection.encryption:
|
and connection is not None
|
||||||
|
and not connection.encryption
|
||||||
|
):
|
||||||
raise ATT_Error(
|
raise ATT_Error(
|
||||||
error_code=ATT_INSUFFICIENT_ENCRYPTION_ERROR, att_handle=self.handle
|
error_code=ATT_INSUFFICIENT_ENCRYPTION_ERROR, att_handle=self.handle
|
||||||
)
|
)
|
||||||
if (
|
if (
|
||||||
self.permissions & self.READ_REQUIRES_AUTHENTICATION
|
(self.permissions & self.READ_REQUIRES_AUTHENTICATION)
|
||||||
) and not connection.authenticated:
|
and connection is not None
|
||||||
|
and not connection.authenticated
|
||||||
|
):
|
||||||
raise ATT_Error(
|
raise ATT_Error(
|
||||||
error_code=ATT_INSUFFICIENT_AUTHENTICATION_ERROR, att_handle=self.handle
|
error_code=ATT_INSUFFICIENT_AUTHENTICATION_ERROR, att_handle=self.handle
|
||||||
)
|
)
|
||||||
@@ -803,9 +829,9 @@ class Attribute(EventEmitter):
|
|||||||
error_code=ATT_INSUFFICIENT_AUTHORIZATION_ERROR, att_handle=self.handle
|
error_code=ATT_INSUFFICIENT_AUTHORIZATION_ERROR, att_handle=self.handle
|
||||||
)
|
)
|
||||||
|
|
||||||
if read := getattr(self.value, 'read', None):
|
if hasattr(self.value, 'read'):
|
||||||
try:
|
try:
|
||||||
value = read(connection) # pylint: disable=not-callable
|
value = self.value.read(connection)
|
||||||
except ATT_Error as error:
|
except ATT_Error as error:
|
||||||
raise ATT_Error(
|
raise ATT_Error(
|
||||||
error_code=error.error_code, att_handle=self.handle
|
error_code=error.error_code, att_handle=self.handle
|
||||||
@@ -815,7 +841,7 @@ class Attribute(EventEmitter):
|
|||||||
|
|
||||||
return self.encode_value(value)
|
return self.encode_value(value)
|
||||||
|
|
||||||
def write_value(self, connection: Connection, value_bytes):
|
def write_value(self, connection: Connection, value_bytes: bytes) -> None:
|
||||||
if (
|
if (
|
||||||
self.permissions & self.WRITE_REQUIRES_ENCRYPTION
|
self.permissions & self.WRITE_REQUIRES_ENCRYPTION
|
||||||
) and not connection.encryption:
|
) and not connection.encryption:
|
||||||
@@ -836,9 +862,9 @@ class Attribute(EventEmitter):
|
|||||||
|
|
||||||
value = self.decode_value(value_bytes)
|
value = self.decode_value(value_bytes)
|
||||||
|
|
||||||
if write := getattr(self.value, 'write', None):
|
if hasattr(self.value, 'write'):
|
||||||
try:
|
try:
|
||||||
write(connection, value) # pylint: disable=not-callable
|
self.value.write(connection, value) # pylint: disable=not-callable
|
||||||
except ATT_Error as error:
|
except ATT_Error as error:
|
||||||
raise ATT_Error(
|
raise ATT_Error(
|
||||||
error_code=error.error_code, att_handle=self.handle
|
error_code=error.error_code, att_handle=self.handle
|
||||||
|
|||||||
+303
-177
File diff suppressed because it is too large
Load Diff
+813
-173
File diff suppressed because it is too large
Load Diff
+10
-5
@@ -15,6 +15,8 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
|
|
||||||
import logging
|
import logging
|
||||||
import asyncio
|
import asyncio
|
||||||
import itertools
|
import itertools
|
||||||
@@ -58,8 +60,10 @@ from bumble.hci import (
|
|||||||
HCI_Packet,
|
HCI_Packet,
|
||||||
HCI_Role_Change_Event,
|
HCI_Role_Change_Event,
|
||||||
)
|
)
|
||||||
from typing import Optional, Union, Dict
|
from typing import Optional, Union, Dict, TYPE_CHECKING
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from bumble.transport.common import TransportSink, TransportSource
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
@@ -104,7 +108,7 @@ class Controller:
|
|||||||
self,
|
self,
|
||||||
name,
|
name,
|
||||||
host_source=None,
|
host_source=None,
|
||||||
host_sink=None,
|
host_sink: Optional[TransportSink] = None,
|
||||||
link=None,
|
link=None,
|
||||||
public_address: Optional[Union[bytes, str, Address]] = None,
|
public_address: Optional[Union[bytes, str, Address]] = None,
|
||||||
):
|
):
|
||||||
@@ -188,6 +192,8 @@ class Controller:
|
|||||||
if link:
|
if link:
|
||||||
link.add_controller(self)
|
link.add_controller(self)
|
||||||
|
|
||||||
|
self.terminated = asyncio.get_running_loop().create_future()
|
||||||
|
|
||||||
@property
|
@property
|
||||||
def host(self):
|
def host(self):
|
||||||
return self.hci_sink
|
return self.hci_sink
|
||||||
@@ -288,10 +294,9 @@ class Controller:
|
|||||||
if self.host:
|
if self.host:
|
||||||
self.host.on_packet(packet.to_bytes())
|
self.host.on_packet(packet.to_bytes())
|
||||||
|
|
||||||
# This method allow the controller to emulate the same API as a transport source
|
# This method allows the controller to emulate the same API as a transport source
|
||||||
async def wait_for_termination(self):
|
async def wait_for_termination(self):
|
||||||
# For now, just wait forever
|
await self.terminated
|
||||||
await asyncio.get_running_loop().create_future()
|
|
||||||
|
|
||||||
############################################################
|
############################################################
|
||||||
# Link connections
|
# Link connections
|
||||||
|
|||||||
+18
-6
@@ -78,7 +78,13 @@ def get_dict_key_by_value(dictionary, value):
|
|||||||
class BaseError(Exception):
|
class BaseError(Exception):
|
||||||
"""Base class for errors with an error code, error name and namespace"""
|
"""Base class for errors with an error code, error name and namespace"""
|
||||||
|
|
||||||
def __init__(self, error_code, error_namespace='', error_name='', details=''):
|
def __init__(
|
||||||
|
self,
|
||||||
|
error_code: Optional[int],
|
||||||
|
error_namespace: str = '',
|
||||||
|
error_name: str = '',
|
||||||
|
details: str = '',
|
||||||
|
):
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.error_code = error_code
|
self.error_code = error_code
|
||||||
self.error_namespace = error_namespace
|
self.error_namespace = error_namespace
|
||||||
@@ -90,12 +96,14 @@ class BaseError(Exception):
|
|||||||
namespace = f'{self.error_namespace}/'
|
namespace = f'{self.error_namespace}/'
|
||||||
else:
|
else:
|
||||||
namespace = ''
|
namespace = ''
|
||||||
if self.error_name:
|
error_text = {
|
||||||
name = f'{self.error_name} [0x{self.error_code:X}]'
|
(True, True): f'{self.error_name} [0x{self.error_code:X}]',
|
||||||
else:
|
(True, False): self.error_name,
|
||||||
name = f'0x{self.error_code:X}'
|
(False, True): f'0x{self.error_code:X}',
|
||||||
|
(False, False): '',
|
||||||
|
}[(self.error_name != '', self.error_code is not None)]
|
||||||
|
|
||||||
return f'{type(self).__name__}({namespace}{name})'
|
return f'{type(self).__name__}({namespace}{error_text})'
|
||||||
|
|
||||||
|
|
||||||
class ProtocolError(BaseError):
|
class ProtocolError(BaseError):
|
||||||
@@ -134,6 +142,10 @@ class ConnectionError(BaseError): # pylint: disable=redefined-builtin
|
|||||||
self.peer_address = peer_address
|
self.peer_address = peer_address
|
||||||
|
|
||||||
|
|
||||||
|
class ConnectionParameterUpdateError(BaseError):
|
||||||
|
"""Connection Parameter Update Error"""
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# UUID
|
# UUID
|
||||||
#
|
#
|
||||||
|
|||||||
+11
-15
@@ -23,22 +23,18 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
import logging
|
import logging
|
||||||
import operator
|
import operator
|
||||||
import platform
|
|
||||||
|
|
||||||
if platform.system() != 'Emscripten':
|
import secrets
|
||||||
import secrets
|
from cryptography.hazmat.primitives.ciphers import Cipher, algorithms, modes
|
||||||
from cryptography.hazmat.primitives.ciphers import Cipher, algorithms, modes
|
from cryptography.hazmat.primitives.asymmetric.ec import (
|
||||||
from cryptography.hazmat.primitives.asymmetric.ec import (
|
generate_private_key,
|
||||||
generate_private_key,
|
ECDH,
|
||||||
ECDH,
|
EllipticCurvePublicNumbers,
|
||||||
EllipticCurvePublicNumbers,
|
EllipticCurvePrivateNumbers,
|
||||||
EllipticCurvePrivateNumbers,
|
SECP256R1,
|
||||||
SECP256R1,
|
)
|
||||||
)
|
from cryptography.hazmat.primitives import cmac
|
||||||
from cryptography.hazmat.primitives import cmac
|
|
||||||
else:
|
|
||||||
# TODO: implement stubs
|
|
||||||
pass
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
|
|||||||
+243
-86
@@ -23,7 +23,20 @@ import asyncio
|
|||||||
import logging
|
import logging
|
||||||
from contextlib import asynccontextmanager, AsyncExitStack
|
from contextlib import asynccontextmanager, AsyncExitStack
|
||||||
from dataclasses import dataclass
|
from dataclasses import dataclass
|
||||||
from typing import Any, Callable, ClassVar, Dict, List, Optional, Tuple, Type, Union
|
from typing import (
|
||||||
|
Any,
|
||||||
|
Callable,
|
||||||
|
ClassVar,
|
||||||
|
Dict,
|
||||||
|
List,
|
||||||
|
Optional,
|
||||||
|
Tuple,
|
||||||
|
Type,
|
||||||
|
Union,
|
||||||
|
cast,
|
||||||
|
overload,
|
||||||
|
TYPE_CHECKING,
|
||||||
|
)
|
||||||
|
|
||||||
from .colors import color
|
from .colors import color
|
||||||
from .att import ATT_CID, ATT_DEFAULT_MTU, ATT_PDU
|
from .att import ATT_CID, ATT_DEFAULT_MTU, ATT_PDU
|
||||||
@@ -86,6 +99,7 @@ from .hci import (
|
|||||||
HCI_LE_Extended_Create_Connection_Command,
|
HCI_LE_Extended_Create_Connection_Command,
|
||||||
HCI_LE_Rand_Command,
|
HCI_LE_Rand_Command,
|
||||||
HCI_LE_Read_PHY_Command,
|
HCI_LE_Read_PHY_Command,
|
||||||
|
HCI_LE_Set_Address_Resolution_Enable_Command,
|
||||||
HCI_LE_Set_Advertising_Data_Command,
|
HCI_LE_Set_Advertising_Data_Command,
|
||||||
HCI_LE_Set_Advertising_Enable_Command,
|
HCI_LE_Set_Advertising_Enable_Command,
|
||||||
HCI_LE_Set_Advertising_Parameters_Command,
|
HCI_LE_Set_Advertising_Parameters_Command,
|
||||||
@@ -129,6 +143,7 @@ from .core import (
|
|||||||
BT_LE_TRANSPORT,
|
BT_LE_TRANSPORT,
|
||||||
BT_PERIPHERAL_ROLE,
|
BT_PERIPHERAL_ROLE,
|
||||||
AdvertisingData,
|
AdvertisingData,
|
||||||
|
ConnectionParameterUpdateError,
|
||||||
CommandTimeoutError,
|
CommandTimeoutError,
|
||||||
ConnectionPHY,
|
ConnectionPHY,
|
||||||
InvalidStateError,
|
InvalidStateError,
|
||||||
@@ -138,6 +153,7 @@ from .utils import (
|
|||||||
CompositeEventEmitter,
|
CompositeEventEmitter,
|
||||||
setup_event_forwarding,
|
setup_event_forwarding,
|
||||||
composite_listener,
|
composite_listener,
|
||||||
|
deprecated,
|
||||||
)
|
)
|
||||||
from .keys import (
|
from .keys import (
|
||||||
KeyStore,
|
KeyStore,
|
||||||
@@ -151,6 +167,9 @@ from . import sdp
|
|||||||
from . import l2cap
|
from . import l2cap
|
||||||
from . import core
|
from . import core
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from .transport.common import TransportSource, TransportSink
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
@@ -651,12 +670,10 @@ class Connection(CompositeEventEmitter):
|
|||||||
def is_incomplete(self) -> bool:
|
def is_incomplete(self) -> bool:
|
||||||
return self.handle is None
|
return self.handle is None
|
||||||
|
|
||||||
def send_l2cap_pdu(self, cid, pdu):
|
def send_l2cap_pdu(self, cid: int, pdu: bytes) -> None:
|
||||||
self.device.send_l2cap_pdu(self.handle, cid, pdu)
|
self.device.send_l2cap_pdu(self.handle, cid, pdu)
|
||||||
|
|
||||||
def create_l2cap_connector(self, psm):
|
@deprecated("Please use create_l2cap_channel()")
|
||||||
return self.device.create_l2cap_connector(self, psm)
|
|
||||||
|
|
||||||
async def open_l2cap_channel(
|
async def open_l2cap_channel(
|
||||||
self,
|
self,
|
||||||
psm,
|
psm,
|
||||||
@@ -666,6 +683,23 @@ class Connection(CompositeEventEmitter):
|
|||||||
):
|
):
|
||||||
return await self.device.open_l2cap_channel(self, psm, max_credits, mtu, mps)
|
return await self.device.open_l2cap_channel(self, psm, max_credits, mtu, mps)
|
||||||
|
|
||||||
|
@overload
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self, spec: l2cap.ClassicChannelSpec
|
||||||
|
) -> l2cap.ClassicChannel:
|
||||||
|
...
|
||||||
|
|
||||||
|
@overload
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self, spec: l2cap.LeCreditBasedChannelSpec
|
||||||
|
) -> l2cap.LeCreditBasedChannel:
|
||||||
|
...
|
||||||
|
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self, spec: Union[l2cap.ClassicChannelSpec, l2cap.LeCreditBasedChannelSpec]
|
||||||
|
) -> Union[l2cap.ClassicChannel, l2cap.LeCreditBasedChannel]:
|
||||||
|
return await self.device.create_l2cap_channel(connection=self, spec=spec)
|
||||||
|
|
||||||
async def disconnect(
|
async def disconnect(
|
||||||
self, reason: int = HCI_REMOTE_USER_TERMINATED_CONNECTION_ERROR
|
self, reason: int = HCI_REMOTE_USER_TERMINATED_CONNECTION_ERROR
|
||||||
) -> None:
|
) -> None:
|
||||||
@@ -708,6 +742,7 @@ class Connection(CompositeEventEmitter):
|
|||||||
connection_interval_max,
|
connection_interval_max,
|
||||||
max_latency,
|
max_latency,
|
||||||
supervision_timeout,
|
supervision_timeout,
|
||||||
|
use_l2cap=False,
|
||||||
):
|
):
|
||||||
return await self.device.update_connection_parameters(
|
return await self.device.update_connection_parameters(
|
||||||
self,
|
self,
|
||||||
@@ -715,6 +750,7 @@ class Connection(CompositeEventEmitter):
|
|||||||
connection_interval_max,
|
connection_interval_max,
|
||||||
max_latency,
|
max_latency,
|
||||||
supervision_timeout,
|
supervision_timeout,
|
||||||
|
use_l2cap=use_l2cap,
|
||||||
)
|
)
|
||||||
|
|
||||||
async def set_phy(self, tx_phys=None, rx_phys=None, phy_options=None):
|
async def set_phy(self, tx_phys=None, rx_phys=None, phy_options=None):
|
||||||
@@ -778,6 +814,7 @@ class DeviceConfiguration:
|
|||||||
self.irk = bytes(16) # This really must be changed for any level of security
|
self.irk = bytes(16) # This really must be changed for any level of security
|
||||||
self.keystore = None
|
self.keystore = None
|
||||||
self.gatt_services: List[Dict[str, Any]] = []
|
self.gatt_services: List[Dict[str, Any]] = []
|
||||||
|
self.address_resolution_offload = False
|
||||||
|
|
||||||
def load_from_dict(self, config: Dict[str, Any]) -> None:
|
def load_from_dict(self, config: Dict[str, Any]) -> None:
|
||||||
# Load simple properties
|
# Load simple properties
|
||||||
@@ -810,6 +847,9 @@ class DeviceConfiguration:
|
|||||||
self.connectable = config.get('connectable', self.connectable)
|
self.connectable = config.get('connectable', self.connectable)
|
||||||
self.discoverable = config.get('discoverable', self.discoverable)
|
self.discoverable = config.get('discoverable', self.discoverable)
|
||||||
self.gatt_services = config.get('gatt_services', self.gatt_services)
|
self.gatt_services = config.get('gatt_services', self.gatt_services)
|
||||||
|
self.address_resolution_offload = config.get(
|
||||||
|
'address_resolution_offload', self.address_resolution_offload
|
||||||
|
)
|
||||||
|
|
||||||
# Load or synthesize an IRK
|
# Load or synthesize an IRK
|
||||||
irk = config.get('irk')
|
irk = config.get('irk')
|
||||||
@@ -940,7 +980,13 @@ class Device(CompositeEventEmitter):
|
|||||||
pass
|
pass
|
||||||
|
|
||||||
@classmethod
|
@classmethod
|
||||||
def with_hci(cls, name, address, hci_source, hci_sink):
|
def with_hci(
|
||||||
|
cls,
|
||||||
|
name: str,
|
||||||
|
address: Address,
|
||||||
|
hci_source: TransportSource,
|
||||||
|
hci_sink: TransportSink,
|
||||||
|
) -> Device:
|
||||||
'''
|
'''
|
||||||
Create a Device instance with a Host configured to communicate with a controller
|
Create a Device instance with a Host configured to communicate with a controller
|
||||||
through an HCI source/sink
|
through an HCI source/sink
|
||||||
@@ -949,18 +995,25 @@ class Device(CompositeEventEmitter):
|
|||||||
return cls(name=name, address=address, host=host)
|
return cls(name=name, address=address, host=host)
|
||||||
|
|
||||||
@classmethod
|
@classmethod
|
||||||
def from_config_file(cls, filename):
|
def from_config_file(cls, filename: str) -> Device:
|
||||||
config = DeviceConfiguration()
|
config = DeviceConfiguration()
|
||||||
config.load_from_file(filename)
|
config.load_from_file(filename)
|
||||||
return cls(config=config)
|
return cls(config=config)
|
||||||
|
|
||||||
@classmethod
|
@classmethod
|
||||||
def from_config_with_hci(cls, config, hci_source, hci_sink):
|
def from_config_with_hci(
|
||||||
|
cls,
|
||||||
|
config: DeviceConfiguration,
|
||||||
|
hci_source: TransportSource,
|
||||||
|
hci_sink: TransportSink,
|
||||||
|
) -> Device:
|
||||||
host = Host(controller_source=hci_source, controller_sink=hci_sink)
|
host = Host(controller_source=hci_source, controller_sink=hci_sink)
|
||||||
return cls(config=config, host=host)
|
return cls(config=config, host=host)
|
||||||
|
|
||||||
@classmethod
|
@classmethod
|
||||||
def from_config_file_with_hci(cls, filename, hci_source, hci_sink):
|
def from_config_file_with_hci(
|
||||||
|
cls, filename: str, hci_source: TransportSource, hci_sink: TransportSink
|
||||||
|
) -> Device:
|
||||||
config = DeviceConfiguration()
|
config = DeviceConfiguration()
|
||||||
config.load_from_file(filename)
|
config.load_from_file(filename)
|
||||||
return cls.from_config_with_hci(config, hci_source, hci_sink)
|
return cls.from_config_with_hci(config, hci_source, hci_sink)
|
||||||
@@ -1029,6 +1082,7 @@ class Device(CompositeEventEmitter):
|
|||||||
self.discoverable = config.discoverable
|
self.discoverable = config.discoverable
|
||||||
self.connectable = config.connectable
|
self.connectable = config.connectable
|
||||||
self.classic_accept_any = config.classic_accept_any
|
self.classic_accept_any = config.classic_accept_any
|
||||||
|
self.address_resolution_offload = config.address_resolution_offload
|
||||||
|
|
||||||
for service in config.gatt_services:
|
for service in config.gatt_services:
|
||||||
characteristics = []
|
characteristics = []
|
||||||
@@ -1093,7 +1147,7 @@ class Device(CompositeEventEmitter):
|
|||||||
return self._host
|
return self._host
|
||||||
|
|
||||||
@host.setter
|
@host.setter
|
||||||
def host(self, host):
|
def host(self, host: Host) -> None:
|
||||||
# Unsubscribe from events from the current host
|
# Unsubscribe from events from the current host
|
||||||
if self._host:
|
if self._host:
|
||||||
for event_name in device_host_event_handlers:
|
for event_name in device_host_event_handlers:
|
||||||
@@ -1147,15 +1201,11 @@ class Device(CompositeEventEmitter):
|
|||||||
|
|
||||||
return None
|
return None
|
||||||
|
|
||||||
def create_l2cap_connector(self, connection, psm):
|
@deprecated("Please use create_l2cap_server()")
|
||||||
return lambda: self.l2cap_channel_manager.connect(connection, psm)
|
def register_l2cap_server(self, psm, server) -> int:
|
||||||
|
return self.l2cap_channel_manager.register_server(psm, server)
|
||||||
def create_l2cap_registrar(self, psm):
|
|
||||||
return lambda handler: self.register_l2cap_server(psm, handler)
|
|
||||||
|
|
||||||
def register_l2cap_server(self, psm, server):
|
|
||||||
self.l2cap_channel_manager.register_server(psm, server)
|
|
||||||
|
|
||||||
|
@deprecated("Please use create_l2cap_server()")
|
||||||
def register_l2cap_channel_server(
|
def register_l2cap_channel_server(
|
||||||
self,
|
self,
|
||||||
psm,
|
psm,
|
||||||
@@ -1168,6 +1218,7 @@ class Device(CompositeEventEmitter):
|
|||||||
psm, server, max_credits, mtu, mps
|
psm, server, max_credits, mtu, mps
|
||||||
)
|
)
|
||||||
|
|
||||||
|
@deprecated("Please use create_l2cap_channel()")
|
||||||
async def open_l2cap_channel(
|
async def open_l2cap_channel(
|
||||||
self,
|
self,
|
||||||
connection,
|
connection,
|
||||||
@@ -1180,7 +1231,75 @@ class Device(CompositeEventEmitter):
|
|||||||
connection, psm, max_credits, mtu, mps
|
connection, psm, max_credits, mtu, mps
|
||||||
)
|
)
|
||||||
|
|
||||||
def send_l2cap_pdu(self, connection_handle, cid, pdu):
|
@overload
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
spec: l2cap.ClassicChannelSpec,
|
||||||
|
) -> l2cap.ClassicChannel:
|
||||||
|
...
|
||||||
|
|
||||||
|
@overload
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
spec: l2cap.LeCreditBasedChannelSpec,
|
||||||
|
) -> l2cap.LeCreditBasedChannel:
|
||||||
|
...
|
||||||
|
|
||||||
|
async def create_l2cap_channel(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
spec: Union[l2cap.ClassicChannelSpec, l2cap.LeCreditBasedChannelSpec],
|
||||||
|
) -> Union[l2cap.ClassicChannel, l2cap.LeCreditBasedChannel]:
|
||||||
|
if isinstance(spec, l2cap.ClassicChannelSpec):
|
||||||
|
return await self.l2cap_channel_manager.create_classic_channel(
|
||||||
|
connection=connection, spec=spec
|
||||||
|
)
|
||||||
|
if isinstance(spec, l2cap.LeCreditBasedChannelSpec):
|
||||||
|
return await self.l2cap_channel_manager.create_le_credit_based_channel(
|
||||||
|
connection=connection, spec=spec
|
||||||
|
)
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def create_l2cap_server(
|
||||||
|
self,
|
||||||
|
spec: l2cap.ClassicChannelSpec,
|
||||||
|
handler: Optional[Callable[[l2cap.ClassicChannel], Any]] = None,
|
||||||
|
) -> l2cap.ClassicChannelServer:
|
||||||
|
...
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def create_l2cap_server(
|
||||||
|
self,
|
||||||
|
spec: l2cap.LeCreditBasedChannelSpec,
|
||||||
|
handler: Optional[Callable[[l2cap.LeCreditBasedChannel], Any]] = None,
|
||||||
|
) -> l2cap.LeCreditBasedChannelServer:
|
||||||
|
...
|
||||||
|
|
||||||
|
def create_l2cap_server(
|
||||||
|
self,
|
||||||
|
spec: Union[l2cap.ClassicChannelSpec, l2cap.LeCreditBasedChannelSpec],
|
||||||
|
handler: Union[
|
||||||
|
Callable[[l2cap.ClassicChannel], Any],
|
||||||
|
Callable[[l2cap.LeCreditBasedChannel], Any],
|
||||||
|
None,
|
||||||
|
] = None,
|
||||||
|
) -> Union[l2cap.ClassicChannelServer, l2cap.LeCreditBasedChannelServer]:
|
||||||
|
if isinstance(spec, l2cap.ClassicChannelSpec):
|
||||||
|
return self.l2cap_channel_manager.create_classic_server(
|
||||||
|
spec=spec,
|
||||||
|
handler=cast(Callable[[l2cap.ClassicChannel], Any], handler),
|
||||||
|
)
|
||||||
|
elif isinstance(spec, l2cap.LeCreditBasedChannelSpec):
|
||||||
|
return self.l2cap_channel_manager.create_le_credit_based_server(
|
||||||
|
handler=cast(Callable[[l2cap.LeCreditBasedChannel], Any], handler),
|
||||||
|
spec=spec,
|
||||||
|
)
|
||||||
|
else:
|
||||||
|
raise ValueError(f'Unexpected mode {spec}')
|
||||||
|
|
||||||
|
def send_l2cap_pdu(self, connection_handle: int, cid: int, pdu: bytes) -> None:
|
||||||
self.host.send_l2cap_pdu(connection_handle, cid, pdu)
|
self.host.send_l2cap_pdu(connection_handle, cid, pdu)
|
||||||
|
|
||||||
async def send_command(self, command, check_result=False):
|
async def send_command(self, command, check_result=False):
|
||||||
@@ -1189,7 +1308,7 @@ class Device(CompositeEventEmitter):
|
|||||||
self.host.send_command(command, check_result), self.command_timeout
|
self.host.send_command(command, check_result), self.command_timeout
|
||||||
)
|
)
|
||||||
except asyncio.TimeoutError as error:
|
except asyncio.TimeoutError as error:
|
||||||
logger.warning('!!! Command timed out')
|
logger.warning(f'!!! Command {command.name} timed out')
|
||||||
raise CommandTimeoutError() from error
|
raise CommandTimeoutError() from error
|
||||||
|
|
||||||
async def power_on(self) -> None:
|
async def power_on(self) -> None:
|
||||||
@@ -1256,31 +1375,16 @@ class Device(CompositeEventEmitter):
|
|||||||
)
|
)
|
||||||
|
|
||||||
# Load the address resolving list
|
# Load the address resolving list
|
||||||
if self.keystore and self.host.supports_command(
|
if self.keystore:
|
||||||
HCI_LE_CLEAR_RESOLVING_LIST_COMMAND
|
await self.refresh_resolving_list()
|
||||||
):
|
|
||||||
await self.send_command(HCI_LE_Clear_Resolving_List_Command()) # type: ignore[call-arg]
|
|
||||||
|
|
||||||
resolving_keys = await self.keystore.get_resolving_keys()
|
# Enable address resolution
|
||||||
for irk, address in resolving_keys:
|
if self.address_resolution_offload:
|
||||||
await self.send_command(
|
await self.send_command(
|
||||||
HCI_LE_Add_Device_To_Resolving_List_Command(
|
HCI_LE_Set_Address_Resolution_Enable_Command(
|
||||||
peer_identity_address_type=address.address_type,
|
address_resolution_enable=1
|
||||||
peer_identity_address=address,
|
) # type: ignore[call-arg]
|
||||||
peer_irk=irk,
|
)
|
||||||
local_irk=self.irk,
|
|
||||||
) # type: ignore[call-arg]
|
|
||||||
)
|
|
||||||
|
|
||||||
# Enable address resolution
|
|
||||||
# await self.send_command(
|
|
||||||
# HCI_LE_Set_Address_Resolution_Enable_Command(
|
|
||||||
# address_resolution_enable=1)
|
|
||||||
# )
|
|
||||||
# )
|
|
||||||
|
|
||||||
# Create a host-side address resolver
|
|
||||||
self.address_resolver = smp.AddressResolver(resolving_keys)
|
|
||||||
|
|
||||||
if self.classic_enabled:
|
if self.classic_enabled:
|
||||||
await self.send_command(
|
await self.send_command(
|
||||||
@@ -1305,11 +1409,34 @@ class Device(CompositeEventEmitter):
|
|||||||
# Done
|
# Done
|
||||||
self.powered_on = True
|
self.powered_on = True
|
||||||
|
|
||||||
|
async def reset(self) -> None:
|
||||||
|
await self.host.reset()
|
||||||
|
|
||||||
async def power_off(self) -> None:
|
async def power_off(self) -> None:
|
||||||
if self.powered_on:
|
if self.powered_on:
|
||||||
await self.host.flush()
|
await self.host.flush()
|
||||||
self.powered_on = False
|
self.powered_on = False
|
||||||
|
|
||||||
|
async def refresh_resolving_list(self) -> None:
|
||||||
|
assert self.keystore is not None
|
||||||
|
|
||||||
|
resolving_keys = await self.keystore.get_resolving_keys()
|
||||||
|
# Create a host-side address resolver
|
||||||
|
self.address_resolver = smp.AddressResolver(resolving_keys)
|
||||||
|
|
||||||
|
if self.address_resolution_offload:
|
||||||
|
await self.send_command(HCI_LE_Clear_Resolving_List_Command()) # type: ignore[call-arg]
|
||||||
|
|
||||||
|
for irk, address in resolving_keys:
|
||||||
|
await self.send_command(
|
||||||
|
HCI_LE_Add_Device_To_Resolving_List_Command(
|
||||||
|
peer_identity_address_type=address.address_type,
|
||||||
|
peer_identity_address=address,
|
||||||
|
peer_irk=irk,
|
||||||
|
local_irk=self.irk,
|
||||||
|
) # type: ignore[call-arg]
|
||||||
|
)
|
||||||
|
|
||||||
def supports_le_feature(self, feature):
|
def supports_le_feature(self, feature):
|
||||||
return self.host.supports_le_feature(feature)
|
return self.host.supports_le_feature(feature)
|
||||||
|
|
||||||
@@ -1387,10 +1514,10 @@ class Device(CompositeEventEmitter):
|
|||||||
check_result=True,
|
check_result=True,
|
||||||
)
|
)
|
||||||
|
|
||||||
self.advertising_own_address_type = own_address_type
|
|
||||||
self.auto_restart_advertising = auto_restart
|
|
||||||
self.advertising_type = advertising_type
|
self.advertising_type = advertising_type
|
||||||
|
self.advertising_own_address_type = own_address_type
|
||||||
self.advertising = True
|
self.advertising = True
|
||||||
|
self.auto_restart_advertising = auto_restart
|
||||||
|
|
||||||
async def stop_advertising(self) -> None:
|
async def stop_advertising(self) -> None:
|
||||||
# Disable advertising
|
# Disable advertising
|
||||||
@@ -1400,9 +1527,9 @@ class Device(CompositeEventEmitter):
|
|||||||
check_result=True,
|
check_result=True,
|
||||||
)
|
)
|
||||||
|
|
||||||
|
self.advertising_type = None
|
||||||
self.advertising_own_address_type = None
|
self.advertising_own_address_type = None
|
||||||
self.advertising = False
|
self.advertising = False
|
||||||
self.advertising_type = None
|
|
||||||
self.auto_restart_advertising = False
|
self.auto_restart_advertising = False
|
||||||
|
|
||||||
@property
|
@property
|
||||||
@@ -2075,11 +2202,30 @@ class Device(CompositeEventEmitter):
|
|||||||
supervision_timeout,
|
supervision_timeout,
|
||||||
min_ce_length=0,
|
min_ce_length=0,
|
||||||
max_ce_length=0,
|
max_ce_length=0,
|
||||||
):
|
use_l2cap=False,
|
||||||
|
) -> None:
|
||||||
'''
|
'''
|
||||||
NOTE: the name of the parameters may look odd, but it just follows the names
|
NOTE: the name of the parameters may look odd, but it just follows the names
|
||||||
used in the Bluetooth spec.
|
used in the Bluetooth spec.
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
if use_l2cap:
|
||||||
|
if connection.role != BT_PERIPHERAL_ROLE:
|
||||||
|
raise InvalidStateError(
|
||||||
|
'only peripheral can update connection parameters with l2cap'
|
||||||
|
)
|
||||||
|
l2cap_result = (
|
||||||
|
await self.l2cap_channel_manager.update_connection_parameters(
|
||||||
|
connection,
|
||||||
|
connection_interval_min,
|
||||||
|
connection_interval_max,
|
||||||
|
max_latency,
|
||||||
|
supervision_timeout,
|
||||||
|
)
|
||||||
|
)
|
||||||
|
if l2cap_result != l2cap.L2CAP_CONNECTION_PARAMETERS_ACCEPTED_RESULT:
|
||||||
|
raise ConnectionParameterUpdateError(l2cap_result)
|
||||||
|
|
||||||
result = await self.send_command(
|
result = await self.send_command(
|
||||||
HCI_LE_Connection_Update_Command(
|
HCI_LE_Connection_Update_Command(
|
||||||
connection_handle=connection.handle,
|
connection_handle=connection.handle,
|
||||||
@@ -2089,7 +2235,7 @@ class Device(CompositeEventEmitter):
|
|||||||
supervision_timeout=supervision_timeout,
|
supervision_timeout=supervision_timeout,
|
||||||
min_ce_length=min_ce_length,
|
min_ce_length=min_ce_length,
|
||||||
max_ce_length=max_ce_length,
|
max_ce_length=max_ce_length,
|
||||||
)
|
) # type: ignore[call-arg]
|
||||||
)
|
)
|
||||||
if result.status != HCI_Command_Status_Event.PENDING:
|
if result.status != HCI_Command_Status_Event.PENDING:
|
||||||
raise HCI_StatusError(result)
|
raise HCI_StatusError(result)
|
||||||
@@ -2230,9 +2376,11 @@ class Device(CompositeEventEmitter):
|
|||||||
def request_pairing(self, connection):
|
def request_pairing(self, connection):
|
||||||
return self.smp_manager.request_pairing(connection)
|
return self.smp_manager.request_pairing(connection)
|
||||||
|
|
||||||
async def get_long_term_key(self, connection_handle, rand, ediv):
|
async def get_long_term_key(
|
||||||
|
self, connection_handle: int, rand: bytes, ediv: int
|
||||||
|
) -> Optional[bytes]:
|
||||||
if (connection := self.lookup_connection(connection_handle)) is None:
|
if (connection := self.lookup_connection(connection_handle)) is None:
|
||||||
return
|
return None
|
||||||
|
|
||||||
# Start by looking for the key in an SMP session
|
# Start by looking for the key in an SMP session
|
||||||
ltk = self.smp_manager.get_long_term_key(connection, rand, ediv)
|
ltk = self.smp_manager.get_long_term_key(connection, rand, ediv)
|
||||||
@@ -2252,19 +2400,24 @@ class Device(CompositeEventEmitter):
|
|||||||
|
|
||||||
if connection.role == BT_PERIPHERAL_ROLE and keys.ltk_peripheral:
|
if connection.role == BT_PERIPHERAL_ROLE and keys.ltk_peripheral:
|
||||||
return keys.ltk_peripheral.value
|
return keys.ltk_peripheral.value
|
||||||
|
return None
|
||||||
|
|
||||||
async def get_link_key(self, address: Address) -> Optional[bytes]:
|
async def get_link_key(self, address: Address) -> Optional[bytes]:
|
||||||
# Look for the key in the keystore
|
if self.keystore is None:
|
||||||
if self.keystore is not None:
|
return None
|
||||||
keys = await self.keystore.get(str(address))
|
|
||||||
if keys is not None:
|
|
||||||
logger.debug('found keys in the key store')
|
|
||||||
if keys.link_key is None:
|
|
||||||
logger.warning('no link key')
|
|
||||||
return None
|
|
||||||
|
|
||||||
return keys.link_key.value
|
# Look for the key in the keystore
|
||||||
return None
|
keys = await self.keystore.get(str(address))
|
||||||
|
if keys is None:
|
||||||
|
logger.debug(f'no keys found for {address}')
|
||||||
|
return None
|
||||||
|
|
||||||
|
logger.debug('found keys in the key store')
|
||||||
|
if keys.link_key is None:
|
||||||
|
logger.warning('no link key')
|
||||||
|
return None
|
||||||
|
|
||||||
|
return keys.link_key.value
|
||||||
|
|
||||||
# [Classic only]
|
# [Classic only]
|
||||||
async def authenticate(self, connection):
|
async def authenticate(self, connection):
|
||||||
@@ -2383,6 +2536,18 @@ class Device(CompositeEventEmitter):
|
|||||||
'connection_encryption_failure', on_encryption_failure
|
'connection_encryption_failure', on_encryption_failure
|
||||||
)
|
)
|
||||||
|
|
||||||
|
async def update_keys(self, address: str, keys: PairingKeys) -> None:
|
||||||
|
if self.keystore is None:
|
||||||
|
return
|
||||||
|
|
||||||
|
try:
|
||||||
|
await self.keystore.update(address, keys)
|
||||||
|
await self.refresh_resolving_list()
|
||||||
|
except Exception as error:
|
||||||
|
logger.warning(f'!!! error while storing keys: {error}')
|
||||||
|
else:
|
||||||
|
self.emit('key_store_update')
|
||||||
|
|
||||||
# [Classic only]
|
# [Classic only]
|
||||||
async def switch_role(self, connection: Connection, role: int):
|
async def switch_role(self, connection: Connection, role: int):
|
||||||
pending_role_change = asyncio.get_running_loop().create_future()
|
pending_role_change = asyncio.get_running_loop().create_future()
|
||||||
@@ -2477,13 +2642,7 @@ class Device(CompositeEventEmitter):
|
|||||||
value=link_key, authenticated=authenticated
|
value=link_key, authenticated=authenticated
|
||||||
)
|
)
|
||||||
|
|
||||||
async def store_keys():
|
self.abort_on('flush', self.update_keys(str(bd_addr), pairing_keys))
|
||||||
try:
|
|
||||||
await self.keystore.update(str(bd_addr), pairing_keys)
|
|
||||||
except Exception as error:
|
|
||||||
logger.warning(f'!!! error while storing keys: {error}')
|
|
||||||
|
|
||||||
self.abort_on('flush', store_keys())
|
|
||||||
|
|
||||||
if connection := self.find_connection_by_bd_addr(
|
if connection := self.find_connection_by_bd_addr(
|
||||||
bd_addr, transport=BT_BR_EDR_TRANSPORT
|
bd_addr, transport=BT_BR_EDR_TRANSPORT
|
||||||
@@ -2560,7 +2719,6 @@ class Device(CompositeEventEmitter):
|
|||||||
own_address_type = self.advertising_own_address_type
|
own_address_type = self.advertising_own_address_type
|
||||||
|
|
||||||
# We are no longer advertising
|
# We are no longer advertising
|
||||||
self.advertising_own_address_type = None
|
|
||||||
self.advertising = False
|
self.advertising = False
|
||||||
|
|
||||||
if own_address_type in (
|
if own_address_type in (
|
||||||
@@ -2617,7 +2775,6 @@ class Device(CompositeEventEmitter):
|
|||||||
and self.advertising
|
and self.advertising
|
||||||
and self.advertising_type.is_directed
|
and self.advertising_type.is_directed
|
||||||
):
|
):
|
||||||
self.advertising_own_address_type = None
|
|
||||||
self.advertising = False
|
self.advertising = False
|
||||||
|
|
||||||
# Notify listeners
|
# Notify listeners
|
||||||
@@ -2688,7 +2845,9 @@ class Device(CompositeEventEmitter):
|
|||||||
self.abort_on(
|
self.abort_on(
|
||||||
'flush',
|
'flush',
|
||||||
self.start_advertising(
|
self.start_advertising(
|
||||||
advertising_type=self.advertising_type, auto_restart=True
|
advertising_type=self.advertising_type,
|
||||||
|
own_address_type=self.advertising_own_address_type,
|
||||||
|
auto_restart=True,
|
||||||
),
|
),
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -2735,20 +2894,6 @@ class Device(CompositeEventEmitter):
|
|||||||
)
|
)
|
||||||
connection.emit('connection_authentication_failure', error)
|
connection.emit('connection_authentication_failure', error)
|
||||||
|
|
||||||
@host_event_handler
|
|
||||||
@with_connection_from_address
|
|
||||||
def on_ssp_complete(self, connection):
|
|
||||||
# On Secure Simple Pairing complete, in case:
|
|
||||||
# - Connection isn't already authenticated
|
|
||||||
# - AND we are not the initiator of the authentication
|
|
||||||
# We must trigger authentication to know if we are truly authenticated
|
|
||||||
if not connection.authenticating and not connection.authenticated:
|
|
||||||
logger.debug(
|
|
||||||
f'*** Trigger Connection Authentication: [0x{connection.handle:04X}] '
|
|
||||||
f'{connection.peer_address}'
|
|
||||||
)
|
|
||||||
asyncio.create_task(connection.authenticate())
|
|
||||||
|
|
||||||
# [Classic only]
|
# [Classic only]
|
||||||
@host_event_handler
|
@host_event_handler
|
||||||
@with_connection_from_address
|
@with_connection_from_address
|
||||||
@@ -3103,6 +3248,18 @@ class Device(CompositeEventEmitter):
|
|||||||
connection.emit('role_change_failure', error)
|
connection.emit('role_change_failure', error)
|
||||||
self.emit('role_change_failure', address, error)
|
self.emit('role_change_failure', address, error)
|
||||||
|
|
||||||
|
# [Classic only]
|
||||||
|
@host_event_handler
|
||||||
|
@with_connection_from_address
|
||||||
|
def on_classic_pairing(self, connection: Connection) -> None:
|
||||||
|
connection.emit('classic_pairing')
|
||||||
|
|
||||||
|
# [Classic only]
|
||||||
|
@host_event_handler
|
||||||
|
@with_connection_from_address
|
||||||
|
def on_classic_pairing_failure(self, connection: Connection, status) -> None:
|
||||||
|
connection.emit('classic_pairing_failure', status)
|
||||||
|
|
||||||
def on_pairing_start(self, connection: Connection) -> None:
|
def on_pairing_start(self, connection: Connection) -> None:
|
||||||
connection.emit('pairing_start')
|
connection.emit('pairing_start')
|
||||||
|
|
||||||
@@ -3151,7 +3308,7 @@ class Device(CompositeEventEmitter):
|
|||||||
|
|
||||||
@host_event_handler
|
@host_event_handler
|
||||||
@with_connection_from_handle
|
@with_connection_from_handle
|
||||||
def on_l2cap_pdu(self, connection, cid, pdu):
|
def on_l2cap_pdu(self, connection: Connection, cid: int, pdu: bytes):
|
||||||
self.l2cap_channel_manager.on_pdu(connection, cid, pdu)
|
self.l2cap_channel_manager.on_pdu(connection, cid, pdu)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self):
|
||||||
|
|||||||
@@ -21,6 +21,8 @@ like loading firmware after a cold start.
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
import abc
|
import abc
|
||||||
import logging
|
import logging
|
||||||
|
import pathlib
|
||||||
|
import platform
|
||||||
from . import rtk
|
from . import rtk
|
||||||
|
|
||||||
|
|
||||||
@@ -66,3 +68,24 @@ async def get_driver_for_host(host):
|
|||||||
return driver
|
return driver
|
||||||
|
|
||||||
return None
|
return None
|
||||||
|
|
||||||
|
|
||||||
|
def project_data_dir() -> pathlib.Path:
|
||||||
|
"""
|
||||||
|
Returns:
|
||||||
|
A path to an OS-specific directory for bumble data. The directory is created if
|
||||||
|
it doesn't exist.
|
||||||
|
"""
|
||||||
|
import platformdirs
|
||||||
|
|
||||||
|
if platform.system() == 'Darwin':
|
||||||
|
# platformdirs doesn't handle macOS right: it doesn't assemble a bundle id
|
||||||
|
# out of author & project
|
||||||
|
return platformdirs.user_data_path(
|
||||||
|
appname='com.google.bumble', ensure_exists=True
|
||||||
|
)
|
||||||
|
else:
|
||||||
|
# windows and linux don't use the com qualifier
|
||||||
|
return platformdirs.user_data_path(
|
||||||
|
appname='bumble', appauthor='google', ensure_exists=True
|
||||||
|
)
|
||||||
|
|||||||
+24
-12
@@ -34,10 +34,9 @@ import weakref
|
|||||||
|
|
||||||
|
|
||||||
from bumble.hci import (
|
from bumble.hci import (
|
||||||
hci_command_op_code,
|
hci_vendor_command_op_code,
|
||||||
STATUS_SPEC,
|
STATUS_SPEC,
|
||||||
HCI_SUCCESS,
|
HCI_SUCCESS,
|
||||||
HCI_COMMAND_NAMES,
|
|
||||||
HCI_Command,
|
HCI_Command,
|
||||||
HCI_Reset_Command,
|
HCI_Reset_Command,
|
||||||
HCI_Read_Local_Version_Information_Command,
|
HCI_Read_Local_Version_Information_Command,
|
||||||
@@ -125,6 +124,7 @@ RTK_USB_PRODUCTS = {
|
|||||||
(0x2550, 0x8761),
|
(0x2550, 0x8761),
|
||||||
(0x2B89, 0x8761),
|
(0x2B89, 0x8761),
|
||||||
(0x7392, 0xC611),
|
(0x7392, 0xC611),
|
||||||
|
(0x0BDA, 0x877B),
|
||||||
# Realtek 8821AE
|
# Realtek 8821AE
|
||||||
(0x0B05, 0x17DC),
|
(0x0B05, 0x17DC),
|
||||||
(0x13D3, 0x3414),
|
(0x13D3, 0x3414),
|
||||||
@@ -178,8 +178,10 @@ RTK_USB_PRODUCTS = {
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# HCI Commands
|
# HCI Commands
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
HCI_RTK_READ_ROM_VERSION_COMMAND = hci_command_op_code(0x3F, 0x6D)
|
HCI_RTK_READ_ROM_VERSION_COMMAND = hci_vendor_command_op_code(0x6D)
|
||||||
HCI_COMMAND_NAMES[HCI_RTK_READ_ROM_VERSION_COMMAND] = "HCI_RTK_READ_ROM_VERSION_COMMAND"
|
HCI_RTK_DOWNLOAD_COMMAND = hci_vendor_command_op_code(0x20)
|
||||||
|
HCI_RTK_DROP_FIRMWARE_COMMAND = hci_vendor_command_op_code(0x66)
|
||||||
|
HCI_Command.register_commands(globals())
|
||||||
|
|
||||||
|
|
||||||
@HCI_Command.command(return_parameters_fields=[("status", STATUS_SPEC), ("version", 1)])
|
@HCI_Command.command(return_parameters_fields=[("status", STATUS_SPEC), ("version", 1)])
|
||||||
@@ -187,10 +189,6 @@ class HCI_RTK_Read_ROM_Version_Command(HCI_Command):
|
|||||||
pass
|
pass
|
||||||
|
|
||||||
|
|
||||||
HCI_RTK_DOWNLOAD_COMMAND = hci_command_op_code(0x3F, 0x20)
|
|
||||||
HCI_COMMAND_NAMES[HCI_RTK_DOWNLOAD_COMMAND] = "HCI_RTK_DOWNLOAD_COMMAND"
|
|
||||||
|
|
||||||
|
|
||||||
@HCI_Command.command(
|
@HCI_Command.command(
|
||||||
fields=[("index", 1), ("payload", RTK_FRAGMENT_LENGTH)],
|
fields=[("index", 1), ("payload", RTK_FRAGMENT_LENGTH)],
|
||||||
return_parameters_fields=[("status", STATUS_SPEC), ("index", 1)],
|
return_parameters_fields=[("status", STATUS_SPEC), ("index", 1)],
|
||||||
@@ -199,10 +197,6 @@ class HCI_RTK_Download_Command(HCI_Command):
|
|||||||
pass
|
pass
|
||||||
|
|
||||||
|
|
||||||
HCI_RTK_DROP_FIRMWARE_COMMAND = hci_command_op_code(0x3F, 0x66)
|
|
||||||
HCI_COMMAND_NAMES[HCI_RTK_DROP_FIRMWARE_COMMAND] = "HCI_RTK_DROP_FIRMWARE_COMMAND"
|
|
||||||
|
|
||||||
|
|
||||||
@HCI_Command.command()
|
@HCI_Command.command()
|
||||||
class HCI_RTK_Drop_Firmware_Command(HCI_Command):
|
class HCI_RTK_Drop_Firmware_Command(HCI_Command):
|
||||||
pass
|
pass
|
||||||
@@ -445,6 +439,11 @@ class Driver:
|
|||||||
# When the environment variable is set, don't look elsewhere
|
# When the environment variable is set, don't look elsewhere
|
||||||
return None
|
return None
|
||||||
|
|
||||||
|
# Then, look where the firmware download tool writes by default
|
||||||
|
if (path := rtk_firmware_dir() / file_name).is_file():
|
||||||
|
logger.debug(f"{file_name} found in project data dir")
|
||||||
|
return path
|
||||||
|
|
||||||
# Then, look in the package's driver directory
|
# Then, look in the package's driver directory
|
||||||
if (path := pathlib.Path(__file__).parent / "rtk_fw" / file_name).is_file():
|
if (path := pathlib.Path(__file__).parent / "rtk_fw" / file_name).is_file():
|
||||||
logger.debug(f"{file_name} found in package dir")
|
logger.debug(f"{file_name} found in package dir")
|
||||||
@@ -645,3 +644,16 @@ class Driver:
|
|||||||
await self.download_firmware()
|
await self.download_firmware()
|
||||||
await self.host.send_command(HCI_Reset_Command(), check_result=True)
|
await self.host.send_command(HCI_Reset_Command(), check_result=True)
|
||||||
logger.info(f"loaded FW image {self.driver_info.fw_name}")
|
logger.info(f"loaded FW image {self.driver_info.fw_name}")
|
||||||
|
|
||||||
|
|
||||||
|
def rtk_firmware_dir() -> pathlib.Path:
|
||||||
|
"""
|
||||||
|
Returns:
|
||||||
|
A path to a subdir of the project data dir for Realtek firmware.
|
||||||
|
The directory is created if it doesn't exist.
|
||||||
|
"""
|
||||||
|
from bumble.drivers import project_data_dir
|
||||||
|
|
||||||
|
p = project_data_dir() / "firmware" / "realtek"
|
||||||
|
p.mkdir(parents=True, exist_ok=True)
|
||||||
|
return p
|
||||||
|
|||||||
+22
-20
@@ -28,7 +28,7 @@ import enum
|
|||||||
import functools
|
import functools
|
||||||
import logging
|
import logging
|
||||||
import struct
|
import struct
|
||||||
from typing import Optional, Sequence, List
|
from typing import Optional, Sequence, Iterable, List, Union
|
||||||
|
|
||||||
from .colors import color
|
from .colors import color
|
||||||
from .core import UUID, get_dict_key_by_value
|
from .core import UUID, get_dict_key_by_value
|
||||||
@@ -187,7 +187,7 @@ GATT_CENTRAL_ADDRESS_RESOLUTION__CHARACTERISTIC = UUID.from_16_bi
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def show_services(services):
|
def show_services(services: Iterable[Service]) -> None:
|
||||||
for service in services:
|
for service in services:
|
||||||
print(color(str(service), 'cyan'))
|
print(color(str(service), 'cyan'))
|
||||||
|
|
||||||
@@ -210,11 +210,11 @@ class Service(Attribute):
|
|||||||
|
|
||||||
def __init__(
|
def __init__(
|
||||||
self,
|
self,
|
||||||
uuid,
|
uuid: Union[str, UUID],
|
||||||
characteristics: List[Characteristic],
|
characteristics: List[Characteristic],
|
||||||
primary=True,
|
primary=True,
|
||||||
included_services: List[Service] = [],
|
included_services: List[Service] = [],
|
||||||
):
|
) -> None:
|
||||||
# Convert the uuid to a UUID object if it isn't already
|
# Convert the uuid to a UUID object if it isn't already
|
||||||
if isinstance(uuid, str):
|
if isinstance(uuid, str):
|
||||||
uuid = UUID(uuid)
|
uuid = UUID(uuid)
|
||||||
@@ -239,7 +239,7 @@ class Service(Attribute):
|
|||||||
"""
|
"""
|
||||||
return None
|
return None
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'Service(handle=0x{self.handle:04X}, '
|
f'Service(handle=0x{self.handle:04X}, '
|
||||||
f'end=0x{self.end_group_handle:04X}, '
|
f'end=0x{self.end_group_handle:04X}, '
|
||||||
@@ -255,9 +255,11 @@ class TemplateService(Service):
|
|||||||
to expose their UUID as a class property
|
to expose their UUID as a class property
|
||||||
'''
|
'''
|
||||||
|
|
||||||
UUID: Optional[UUID] = None
|
UUID: UUID
|
||||||
|
|
||||||
def __init__(self, characteristics, primary=True):
|
def __init__(
|
||||||
|
self, characteristics: List[Characteristic], primary: bool = True
|
||||||
|
) -> None:
|
||||||
super().__init__(self.UUID, characteristics, primary)
|
super().__init__(self.UUID, characteristics, primary)
|
||||||
|
|
||||||
|
|
||||||
@@ -269,7 +271,7 @@ class IncludedServiceDeclaration(Attribute):
|
|||||||
|
|
||||||
service: Service
|
service: Service
|
||||||
|
|
||||||
def __init__(self, service):
|
def __init__(self, service: Service) -> None:
|
||||||
declaration_bytes = struct.pack(
|
declaration_bytes = struct.pack(
|
||||||
'<HH2s', service.handle, service.end_group_handle, service.uuid.to_bytes()
|
'<HH2s', service.handle, service.end_group_handle, service.uuid.to_bytes()
|
||||||
)
|
)
|
||||||
@@ -278,7 +280,7 @@ class IncludedServiceDeclaration(Attribute):
|
|||||||
)
|
)
|
||||||
self.service = service
|
self.service = service
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'IncludedServiceDefinition(handle=0x{self.handle:04X}, '
|
f'IncludedServiceDefinition(handle=0x{self.handle:04X}, '
|
||||||
f'group_starting_handle=0x{self.service.handle:04X}, '
|
f'group_starting_handle=0x{self.service.handle:04X}, '
|
||||||
@@ -326,7 +328,7 @@ class Characteristic(Attribute):
|
|||||||
f"Characteristic.Properties::from_string() error:\nExpected a string containing any of the keys, separated by , or |: {enum_list_str}\nGot: {properties_str}"
|
f"Characteristic.Properties::from_string() error:\nExpected a string containing any of the keys, separated by , or |: {enum_list_str}\nGot: {properties_str}"
|
||||||
)
|
)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
# NOTE: we override this method to offer a consistent result between python
|
# NOTE: we override this method to offer a consistent result between python
|
||||||
# versions: the value returned by IntFlag.__str__() changed in version 11.
|
# versions: the value returned by IntFlag.__str__() changed in version 11.
|
||||||
return '|'.join(
|
return '|'.join(
|
||||||
@@ -348,10 +350,10 @@ class Characteristic(Attribute):
|
|||||||
|
|
||||||
def __init__(
|
def __init__(
|
||||||
self,
|
self,
|
||||||
uuid,
|
uuid: Union[str, bytes, UUID],
|
||||||
properties: Characteristic.Properties,
|
properties: Characteristic.Properties,
|
||||||
permissions,
|
permissions: Union[str, Attribute.Permissions],
|
||||||
value=b'',
|
value: Union[str, bytes, CharacteristicValue] = b'',
|
||||||
descriptors: Sequence[Descriptor] = (),
|
descriptors: Sequence[Descriptor] = (),
|
||||||
):
|
):
|
||||||
super().__init__(uuid, permissions, value)
|
super().__init__(uuid, permissions, value)
|
||||||
@@ -369,7 +371,7 @@ class Characteristic(Attribute):
|
|||||||
def has_properties(self, properties: Characteristic.Properties) -> bool:
|
def has_properties(self, properties: Characteristic.Properties) -> bool:
|
||||||
return self.properties & properties == properties
|
return self.properties & properties == properties
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'Characteristic(handle=0x{self.handle:04X}, '
|
f'Characteristic(handle=0x{self.handle:04X}, '
|
||||||
f'end=0x{self.end_group_handle:04X}, '
|
f'end=0x{self.end_group_handle:04X}, '
|
||||||
@@ -386,7 +388,7 @@ class CharacteristicDeclaration(Attribute):
|
|||||||
|
|
||||||
characteristic: Characteristic
|
characteristic: Characteristic
|
||||||
|
|
||||||
def __init__(self, characteristic, value_handle):
|
def __init__(self, characteristic: Characteristic, value_handle: int) -> None:
|
||||||
declaration_bytes = (
|
declaration_bytes = (
|
||||||
struct.pack('<BH', characteristic.properties, value_handle)
|
struct.pack('<BH', characteristic.properties, value_handle)
|
||||||
+ characteristic.uuid.to_pdu_bytes()
|
+ characteristic.uuid.to_pdu_bytes()
|
||||||
@@ -397,7 +399,7 @@ class CharacteristicDeclaration(Attribute):
|
|||||||
self.value_handle = value_handle
|
self.value_handle = value_handle
|
||||||
self.characteristic = characteristic
|
self.characteristic = characteristic
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'CharacteristicDeclaration(handle=0x{self.handle:04X}, '
|
f'CharacteristicDeclaration(handle=0x{self.handle:04X}, '
|
||||||
f'value_handle=0x{self.value_handle:04X}, '
|
f'value_handle=0x{self.value_handle:04X}, '
|
||||||
@@ -520,7 +522,7 @@ class CharacteristicAdapter:
|
|||||||
|
|
||||||
return self.wrapped_characteristic.unsubscribe(subscriber)
|
return self.wrapped_characteristic.unsubscribe(subscriber)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
wrapped = str(self.wrapped_characteristic)
|
wrapped = str(self.wrapped_characteristic)
|
||||||
return f'{self.__class__.__name__}({wrapped})'
|
return f'{self.__class__.__name__}({wrapped})'
|
||||||
|
|
||||||
@@ -600,10 +602,10 @@ class UTF8CharacteristicAdapter(CharacteristicAdapter):
|
|||||||
Adapter that converts strings to/from bytes using UTF-8 encoding
|
Adapter that converts strings to/from bytes using UTF-8 encoding
|
||||||
'''
|
'''
|
||||||
|
|
||||||
def encode_value(self, value):
|
def encode_value(self, value: str) -> bytes:
|
||||||
return value.encode('utf-8')
|
return value.encode('utf-8')
|
||||||
|
|
||||||
def decode_value(self, value):
|
def decode_value(self, value: bytes) -> str:
|
||||||
return value.decode('utf-8')
|
return value.decode('utf-8')
|
||||||
|
|
||||||
|
|
||||||
@@ -613,7 +615,7 @@ class Descriptor(Attribute):
|
|||||||
See Vol 3, Part G - 3.3.3 Characteristic Descriptor Declarations
|
See Vol 3, Part G - 3.3.3 Characteristic Descriptor Declarations
|
||||||
'''
|
'''
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'Descriptor(handle=0x{self.handle:04X}, '
|
f'Descriptor(handle=0x{self.handle:04X}, '
|
||||||
f'type={self.type}, '
|
f'type={self.type}, '
|
||||||
|
|||||||
+67
-32
@@ -28,7 +28,18 @@ import asyncio
|
|||||||
import logging
|
import logging
|
||||||
import struct
|
import struct
|
||||||
from datetime import datetime
|
from datetime import datetime
|
||||||
from typing import List, Optional, Dict, Tuple, Callable, Union, Any
|
from typing import (
|
||||||
|
List,
|
||||||
|
Optional,
|
||||||
|
Dict,
|
||||||
|
Tuple,
|
||||||
|
Callable,
|
||||||
|
Union,
|
||||||
|
Any,
|
||||||
|
Iterable,
|
||||||
|
Type,
|
||||||
|
TYPE_CHECKING,
|
||||||
|
)
|
||||||
|
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
|
|
||||||
@@ -66,8 +77,12 @@ from .gatt import (
|
|||||||
GATT_INCLUDE_ATTRIBUTE_TYPE,
|
GATT_INCLUDE_ATTRIBUTE_TYPE,
|
||||||
Characteristic,
|
Characteristic,
|
||||||
ClientCharacteristicConfigurationBits,
|
ClientCharacteristicConfigurationBits,
|
||||||
|
TemplateService,
|
||||||
)
|
)
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from bumble.device import Connection
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -78,16 +93,16 @@ logger = logging.getLogger(__name__)
|
|||||||
# Proxies
|
# Proxies
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class AttributeProxy(EventEmitter):
|
class AttributeProxy(EventEmitter):
|
||||||
client: Client
|
def __init__(
|
||||||
|
self, client: Client, handle: int, end_group_handle: int, attribute_type: UUID
|
||||||
def __init__(self, client, handle, end_group_handle, attribute_type):
|
) -> None:
|
||||||
EventEmitter.__init__(self)
|
EventEmitter.__init__(self)
|
||||||
self.client = client
|
self.client = client
|
||||||
self.handle = handle
|
self.handle = handle
|
||||||
self.end_group_handle = end_group_handle
|
self.end_group_handle = end_group_handle
|
||||||
self.type = attribute_type
|
self.type = attribute_type
|
||||||
|
|
||||||
async def read_value(self, no_long_read=False):
|
async def read_value(self, no_long_read: bool = False) -> bytes:
|
||||||
return self.decode_value(
|
return self.decode_value(
|
||||||
await self.client.read_value(self.handle, no_long_read)
|
await self.client.read_value(self.handle, no_long_read)
|
||||||
)
|
)
|
||||||
@@ -97,13 +112,13 @@ class AttributeProxy(EventEmitter):
|
|||||||
self.handle, self.encode_value(value), with_response
|
self.handle, self.encode_value(value), with_response
|
||||||
)
|
)
|
||||||
|
|
||||||
def encode_value(self, value):
|
def encode_value(self, value: Any) -> bytes:
|
||||||
return value
|
return value
|
||||||
|
|
||||||
def decode_value(self, value_bytes):
|
def decode_value(self, value_bytes: bytes) -> Any:
|
||||||
return value_bytes
|
return value_bytes
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return f'Attribute(handle=0x{self.handle:04X}, type={self.type})'
|
return f'Attribute(handle=0x{self.handle:04X}, type={self.type})'
|
||||||
|
|
||||||
|
|
||||||
@@ -136,14 +151,14 @@ class ServiceProxy(AttributeProxy):
|
|||||||
def get_characteristics_by_uuid(self, uuid):
|
def get_characteristics_by_uuid(self, uuid):
|
||||||
return self.client.get_characteristics_by_uuid(uuid, self)
|
return self.client.get_characteristics_by_uuid(uuid, self)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return f'Service(handle=0x{self.handle:04X}, uuid={self.uuid})'
|
return f'Service(handle=0x{self.handle:04X}, uuid={self.uuid})'
|
||||||
|
|
||||||
|
|
||||||
class CharacteristicProxy(AttributeProxy):
|
class CharacteristicProxy(AttributeProxy):
|
||||||
properties: Characteristic.Properties
|
properties: Characteristic.Properties
|
||||||
descriptors: List[DescriptorProxy]
|
descriptors: List[DescriptorProxy]
|
||||||
subscribers: Dict[Any, Callable]
|
subscribers: Dict[Any, Callable[[bytes], Any]]
|
||||||
|
|
||||||
def __init__(
|
def __init__(
|
||||||
self,
|
self,
|
||||||
@@ -171,7 +186,9 @@ class CharacteristicProxy(AttributeProxy):
|
|||||||
return await self.client.discover_descriptors(self)
|
return await self.client.discover_descriptors(self)
|
||||||
|
|
||||||
async def subscribe(
|
async def subscribe(
|
||||||
self, subscriber: Optional[Callable] = None, prefer_notify=True
|
self,
|
||||||
|
subscriber: Optional[Callable[[bytes], Any]] = None,
|
||||||
|
prefer_notify: bool = True,
|
||||||
):
|
):
|
||||||
if subscriber is not None:
|
if subscriber is not None:
|
||||||
if subscriber in self.subscribers:
|
if subscriber in self.subscribers:
|
||||||
@@ -195,7 +212,7 @@ class CharacteristicProxy(AttributeProxy):
|
|||||||
|
|
||||||
return await self.client.unsubscribe(self, subscriber)
|
return await self.client.unsubscribe(self, subscriber)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'Characteristic(handle=0x{self.handle:04X}, '
|
f'Characteristic(handle=0x{self.handle:04X}, '
|
||||||
f'uuid={self.uuid}, '
|
f'uuid={self.uuid}, '
|
||||||
@@ -207,7 +224,7 @@ class DescriptorProxy(AttributeProxy):
|
|||||||
def __init__(self, client, handle, descriptor_type):
|
def __init__(self, client, handle, descriptor_type):
|
||||||
super().__init__(client, handle, 0, descriptor_type)
|
super().__init__(client, handle, 0, descriptor_type)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return f'Descriptor(handle=0x{self.handle:04X}, type={self.type})'
|
return f'Descriptor(handle=0x{self.handle:04X}, type={self.type})'
|
||||||
|
|
||||||
|
|
||||||
@@ -216,8 +233,10 @@ class ProfileServiceProxy:
|
|||||||
Base class for profile-specific service proxies
|
Base class for profile-specific service proxies
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
SERVICE_CLASS: Type[TemplateService]
|
||||||
|
|
||||||
@classmethod
|
@classmethod
|
||||||
def from_client(cls, client):
|
def from_client(cls, client: Client) -> ProfileServiceProxy:
|
||||||
return ServiceProxy.from_client(cls, client, cls.SERVICE_CLASS.UUID)
|
return ServiceProxy.from_client(cls, client, cls.SERVICE_CLASS.UUID)
|
||||||
|
|
||||||
|
|
||||||
@@ -227,8 +246,12 @@ class ProfileServiceProxy:
|
|||||||
class Client:
|
class Client:
|
||||||
services: List[ServiceProxy]
|
services: List[ServiceProxy]
|
||||||
cached_values: Dict[int, Tuple[datetime, bytes]]
|
cached_values: Dict[int, Tuple[datetime, bytes]]
|
||||||
|
notification_subscribers: Dict[int, Callable[[bytes], Any]]
|
||||||
|
indication_subscribers: Dict[int, Callable[[bytes], Any]]
|
||||||
|
pending_response: Optional[asyncio.futures.Future[ATT_PDU]]
|
||||||
|
pending_request: Optional[ATT_PDU]
|
||||||
|
|
||||||
def __init__(self, connection):
|
def __init__(self, connection: Connection) -> None:
|
||||||
self.connection = connection
|
self.connection = connection
|
||||||
self.mtu_exchange_done = False
|
self.mtu_exchange_done = False
|
||||||
self.request_semaphore = asyncio.Semaphore(1)
|
self.request_semaphore = asyncio.Semaphore(1)
|
||||||
@@ -241,16 +264,16 @@ class Client:
|
|||||||
self.services = []
|
self.services = []
|
||||||
self.cached_values = {}
|
self.cached_values = {}
|
||||||
|
|
||||||
def send_gatt_pdu(self, pdu):
|
def send_gatt_pdu(self, pdu: bytes) -> None:
|
||||||
self.connection.send_l2cap_pdu(ATT_CID, pdu)
|
self.connection.send_l2cap_pdu(ATT_CID, pdu)
|
||||||
|
|
||||||
async def send_command(self, command):
|
async def send_command(self, command: ATT_PDU) -> None:
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'GATT Command from client: [0x{self.connection.handle:04X}] {command}'
|
f'GATT Command from client: [0x{self.connection.handle:04X}] {command}'
|
||||||
)
|
)
|
||||||
self.send_gatt_pdu(command.to_bytes())
|
self.send_gatt_pdu(command.to_bytes())
|
||||||
|
|
||||||
async def send_request(self, request):
|
async def send_request(self, request: ATT_PDU):
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'GATT Request from client: [0x{self.connection.handle:04X}] {request}'
|
f'GATT Request from client: [0x{self.connection.handle:04X}] {request}'
|
||||||
)
|
)
|
||||||
@@ -279,14 +302,14 @@ class Client:
|
|||||||
|
|
||||||
return response
|
return response
|
||||||
|
|
||||||
def send_confirmation(self, confirmation):
|
def send_confirmation(self, confirmation: ATT_Handle_Value_Confirmation) -> None:
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'GATT Confirmation from client: [0x{self.connection.handle:04X}] '
|
f'GATT Confirmation from client: [0x{self.connection.handle:04X}] '
|
||||||
f'{confirmation}'
|
f'{confirmation}'
|
||||||
)
|
)
|
||||||
self.send_gatt_pdu(confirmation.to_bytes())
|
self.send_gatt_pdu(confirmation.to_bytes())
|
||||||
|
|
||||||
async def request_mtu(self, mtu):
|
async def request_mtu(self, mtu: int) -> int:
|
||||||
# Check the range
|
# Check the range
|
||||||
if mtu < ATT_DEFAULT_MTU:
|
if mtu < ATT_DEFAULT_MTU:
|
||||||
raise ValueError(f'MTU must be >= {ATT_DEFAULT_MTU}')
|
raise ValueError(f'MTU must be >= {ATT_DEFAULT_MTU}')
|
||||||
@@ -313,10 +336,12 @@ class Client:
|
|||||||
|
|
||||||
return self.connection.att_mtu
|
return self.connection.att_mtu
|
||||||
|
|
||||||
def get_services_by_uuid(self, uuid):
|
def get_services_by_uuid(self, uuid: UUID) -> List[ServiceProxy]:
|
||||||
return [service for service in self.services if service.uuid == uuid]
|
return [service for service in self.services if service.uuid == uuid]
|
||||||
|
|
||||||
def get_characteristics_by_uuid(self, uuid, service=None):
|
def get_characteristics_by_uuid(
|
||||||
|
self, uuid: UUID, service: Optional[ServiceProxy] = None
|
||||||
|
) -> List[CharacteristicProxy]:
|
||||||
services = [service] if service else self.services
|
services = [service] if service else self.services
|
||||||
return [
|
return [
|
||||||
c
|
c
|
||||||
@@ -363,7 +388,7 @@ class Client:
|
|||||||
if not already_known:
|
if not already_known:
|
||||||
self.services.append(service)
|
self.services.append(service)
|
||||||
|
|
||||||
async def discover_services(self, uuids=None) -> List[ServiceProxy]:
|
async def discover_services(self, uuids: Iterable[UUID] = []) -> List[ServiceProxy]:
|
||||||
'''
|
'''
|
||||||
See Vol 3, Part G - 4.4.1 Discover All Primary Services
|
See Vol 3, Part G - 4.4.1 Discover All Primary Services
|
||||||
'''
|
'''
|
||||||
@@ -435,7 +460,7 @@ class Client:
|
|||||||
|
|
||||||
return services
|
return services
|
||||||
|
|
||||||
async def discover_service(self, uuid):
|
async def discover_service(self, uuid: Union[str, UUID]) -> List[ServiceProxy]:
|
||||||
'''
|
'''
|
||||||
See Vol 3, Part G - 4.4.2 Discover Primary Service by Service UUID
|
See Vol 3, Part G - 4.4.2 Discover Primary Service by Service UUID
|
||||||
'''
|
'''
|
||||||
@@ -468,7 +493,7 @@ class Client:
|
|||||||
f'{HCI_Constant.error_name(response.error_code)}'
|
f'{HCI_Constant.error_name(response.error_code)}'
|
||||||
)
|
)
|
||||||
# TODO raise appropriate exception
|
# TODO raise appropriate exception
|
||||||
return
|
return []
|
||||||
break
|
break
|
||||||
|
|
||||||
for attribute_handle, end_group_handle in response.handles_information:
|
for attribute_handle, end_group_handle in response.handles_information:
|
||||||
@@ -480,7 +505,7 @@ class Client:
|
|||||||
logger.warning(
|
logger.warning(
|
||||||
f'bogus handle values: {attribute_handle} {end_group_handle}'
|
f'bogus handle values: {attribute_handle} {end_group_handle}'
|
||||||
)
|
)
|
||||||
return
|
return []
|
||||||
|
|
||||||
# Create a service proxy for this service
|
# Create a service proxy for this service
|
||||||
service = ServiceProxy(
|
service = ServiceProxy(
|
||||||
@@ -721,7 +746,7 @@ class Client:
|
|||||||
|
|
||||||
return descriptors
|
return descriptors
|
||||||
|
|
||||||
async def discover_attributes(self):
|
async def discover_attributes(self) -> List[AttributeProxy]:
|
||||||
'''
|
'''
|
||||||
Discover all attributes, regardless of type
|
Discover all attributes, regardless of type
|
||||||
'''
|
'''
|
||||||
@@ -844,7 +869,9 @@ class Client:
|
|||||||
# No more subscribers left
|
# No more subscribers left
|
||||||
await self.write_value(cccd, b'\x00\x00', with_response=True)
|
await self.write_value(cccd, b'\x00\x00', with_response=True)
|
||||||
|
|
||||||
async def read_value(self, attribute, no_long_read=False):
|
async def read_value(
|
||||||
|
self, attribute: Union[int, AttributeProxy], no_long_read: bool = False
|
||||||
|
) -> Any:
|
||||||
'''
|
'''
|
||||||
See Vol 3, Part G - 4.8.1 Read Characteristic Value
|
See Vol 3, Part G - 4.8.1 Read Characteristic Value
|
||||||
|
|
||||||
@@ -905,7 +932,9 @@ class Client:
|
|||||||
# Return the value as bytes
|
# Return the value as bytes
|
||||||
return attribute_value
|
return attribute_value
|
||||||
|
|
||||||
async def read_characteristics_by_uuid(self, uuid, service):
|
async def read_characteristics_by_uuid(
|
||||||
|
self, uuid: UUID, service: Optional[ServiceProxy]
|
||||||
|
) -> List[bytes]:
|
||||||
'''
|
'''
|
||||||
See Vol 3, Part G - 4.8.2 Read Using Characteristic UUID
|
See Vol 3, Part G - 4.8.2 Read Using Characteristic UUID
|
||||||
'''
|
'''
|
||||||
@@ -960,7 +989,12 @@ class Client:
|
|||||||
|
|
||||||
return characteristics_values
|
return characteristics_values
|
||||||
|
|
||||||
async def write_value(self, attribute, value, with_response=False):
|
async def write_value(
|
||||||
|
self,
|
||||||
|
attribute: Union[int, AttributeProxy],
|
||||||
|
value: bytes,
|
||||||
|
with_response: bool = False,
|
||||||
|
) -> None:
|
||||||
'''
|
'''
|
||||||
See Vol 3, Part G - 4.9.1 Write Without Response & 4.9.3 Write Characteristic
|
See Vol 3, Part G - 4.9.1 Write Without Response & 4.9.3 Write Characteristic
|
||||||
Value
|
Value
|
||||||
@@ -990,7 +1024,7 @@ class Client:
|
|||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
def on_gatt_pdu(self, att_pdu):
|
def on_gatt_pdu(self, att_pdu: ATT_PDU) -> None:
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'GATT Response to client: [0x{self.connection.handle:04X}] {att_pdu}'
|
f'GATT Response to client: [0x{self.connection.handle:04X}] {att_pdu}'
|
||||||
)
|
)
|
||||||
@@ -1013,6 +1047,7 @@ class Client:
|
|||||||
return
|
return
|
||||||
|
|
||||||
# Return the response to the coroutine that is waiting for it
|
# Return the response to the coroutine that is waiting for it
|
||||||
|
assert self.pending_response is not None
|
||||||
self.pending_response.set_result(att_pdu)
|
self.pending_response.set_result(att_pdu)
|
||||||
else:
|
else:
|
||||||
handler_name = f'on_{att_pdu.name.lower()}'
|
handler_name = f'on_{att_pdu.name.lower()}'
|
||||||
@@ -1060,7 +1095,7 @@ class Client:
|
|||||||
# Confirm that we received the indication
|
# Confirm that we received the indication
|
||||||
self.send_confirmation(ATT_Handle_Value_Confirmation())
|
self.send_confirmation(ATT_Handle_Value_Confirmation())
|
||||||
|
|
||||||
def cache_value(self, attribute_handle: int, value: bytes):
|
def cache_value(self, attribute_handle: int, value: bytes) -> None:
|
||||||
self.cached_values[attribute_handle] = (
|
self.cached_values[attribute_handle] = (
|
||||||
datetime.now(),
|
datetime.now(),
|
||||||
value,
|
value,
|
||||||
|
|||||||
+75
-31
@@ -23,11 +23,12 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
import logging
|
import logging
|
||||||
from collections import defaultdict
|
from collections import defaultdict
|
||||||
import struct
|
import struct
|
||||||
from typing import List, Tuple, Optional, TypeVar, Type
|
from typing import List, Tuple, Optional, TypeVar, Type, Dict, Iterable, TYPE_CHECKING
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
|
|
||||||
from .colors import color
|
from .colors import color
|
||||||
@@ -42,6 +43,7 @@ from .att import (
|
|||||||
ATT_INVALID_OFFSET_ERROR,
|
ATT_INVALID_OFFSET_ERROR,
|
||||||
ATT_REQUEST_NOT_SUPPORTED_ERROR,
|
ATT_REQUEST_NOT_SUPPORTED_ERROR,
|
||||||
ATT_REQUESTS,
|
ATT_REQUESTS,
|
||||||
|
ATT_PDU,
|
||||||
ATT_UNLIKELY_ERROR_ERROR,
|
ATT_UNLIKELY_ERROR_ERROR,
|
||||||
ATT_UNSUPPORTED_GROUP_TYPE_ERROR,
|
ATT_UNSUPPORTED_GROUP_TYPE_ERROR,
|
||||||
ATT_Error,
|
ATT_Error,
|
||||||
@@ -73,6 +75,8 @@ from .gatt import (
|
|||||||
Service,
|
Service,
|
||||||
)
|
)
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from bumble.device import Device, Connection
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
@@ -91,8 +95,13 @@ GATT_SERVER_DEFAULT_MAX_MTU = 517
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Server(EventEmitter):
|
class Server(EventEmitter):
|
||||||
attributes: List[Attribute]
|
attributes: List[Attribute]
|
||||||
|
services: List[Service]
|
||||||
|
attributes_by_handle: Dict[int, Attribute]
|
||||||
|
subscribers: Dict[int, Dict[int, bytes]]
|
||||||
|
indication_semaphores: defaultdict[int, asyncio.Semaphore]
|
||||||
|
pending_confirmations: defaultdict[int, Optional[asyncio.futures.Future]]
|
||||||
|
|
||||||
def __init__(self, device):
|
def __init__(self, device: Device) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.device = device
|
self.device = device
|
||||||
self.services = []
|
self.services = []
|
||||||
@@ -107,16 +116,16 @@ class Server(EventEmitter):
|
|||||||
self.indication_semaphores = defaultdict(lambda: asyncio.Semaphore(1))
|
self.indication_semaphores = defaultdict(lambda: asyncio.Semaphore(1))
|
||||||
self.pending_confirmations = defaultdict(lambda: None)
|
self.pending_confirmations = defaultdict(lambda: None)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return "\n".join(map(str, self.attributes))
|
return "\n".join(map(str, self.attributes))
|
||||||
|
|
||||||
def send_gatt_pdu(self, connection_handle, pdu):
|
def send_gatt_pdu(self, connection_handle: int, pdu: bytes) -> None:
|
||||||
self.device.send_l2cap_pdu(connection_handle, ATT_CID, pdu)
|
self.device.send_l2cap_pdu(connection_handle, ATT_CID, pdu)
|
||||||
|
|
||||||
def next_handle(self):
|
def next_handle(self) -> int:
|
||||||
return 1 + len(self.attributes)
|
return 1 + len(self.attributes)
|
||||||
|
|
||||||
def get_advertising_service_data(self):
|
def get_advertising_service_data(self) -> Dict[Attribute, bytes]:
|
||||||
return {
|
return {
|
||||||
attribute: data
|
attribute: data
|
||||||
for attribute in self.attributes
|
for attribute in self.attributes
|
||||||
@@ -124,7 +133,7 @@ class Server(EventEmitter):
|
|||||||
and (data := attribute.get_advertising_data())
|
and (data := attribute.get_advertising_data())
|
||||||
}
|
}
|
||||||
|
|
||||||
def get_attribute(self, handle):
|
def get_attribute(self, handle: int) -> Optional[Attribute]:
|
||||||
attribute = self.attributes_by_handle.get(handle)
|
attribute = self.attributes_by_handle.get(handle)
|
||||||
if attribute:
|
if attribute:
|
||||||
return attribute
|
return attribute
|
||||||
@@ -173,12 +182,17 @@ class Server(EventEmitter):
|
|||||||
|
|
||||||
return next(
|
return next(
|
||||||
(
|
(
|
||||||
(attribute, self.get_attribute(attribute.characteristic.handle))
|
(
|
||||||
|
attribute,
|
||||||
|
self.get_attribute(attribute.characteristic.handle),
|
||||||
|
) # type: ignore
|
||||||
for attribute in map(
|
for attribute in map(
|
||||||
self.get_attribute,
|
self.get_attribute,
|
||||||
range(service_handle.handle, service_handle.end_group_handle + 1),
|
range(service_handle.handle, service_handle.end_group_handle + 1),
|
||||||
)
|
)
|
||||||
if attribute.type == GATT_CHARACTERISTIC_ATTRIBUTE_TYPE
|
if attribute is not None
|
||||||
|
and attribute.type == GATT_CHARACTERISTIC_ATTRIBUTE_TYPE
|
||||||
|
and isinstance(attribute, CharacteristicDeclaration)
|
||||||
and attribute.characteristic.uuid == characteristic_uuid
|
and attribute.characteristic.uuid == characteristic_uuid
|
||||||
),
|
),
|
||||||
None,
|
None,
|
||||||
@@ -197,7 +211,7 @@ class Server(EventEmitter):
|
|||||||
|
|
||||||
return next(
|
return next(
|
||||||
(
|
(
|
||||||
attribute
|
attribute # type: ignore
|
||||||
for attribute in map(
|
for attribute in map(
|
||||||
self.get_attribute,
|
self.get_attribute,
|
||||||
range(
|
range(
|
||||||
@@ -205,12 +219,12 @@ class Server(EventEmitter):
|
|||||||
characteristic_value.end_group_handle + 1,
|
characteristic_value.end_group_handle + 1,
|
||||||
),
|
),
|
||||||
)
|
)
|
||||||
if attribute.type == descriptor_uuid
|
if attribute is not None and attribute.type == descriptor_uuid
|
||||||
),
|
),
|
||||||
None,
|
None,
|
||||||
)
|
)
|
||||||
|
|
||||||
def add_attribute(self, attribute):
|
def add_attribute(self, attribute: Attribute) -> None:
|
||||||
# Assign a handle to this attribute
|
# Assign a handle to this attribute
|
||||||
attribute.handle = self.next_handle()
|
attribute.handle = self.next_handle()
|
||||||
attribute.end_group_handle = (
|
attribute.end_group_handle = (
|
||||||
@@ -220,7 +234,7 @@ class Server(EventEmitter):
|
|||||||
# Add this attribute to the list
|
# Add this attribute to the list
|
||||||
self.attributes.append(attribute)
|
self.attributes.append(attribute)
|
||||||
|
|
||||||
def add_service(self, service: Service):
|
def add_service(self, service: Service) -> None:
|
||||||
# Add the service attribute to the DB
|
# Add the service attribute to the DB
|
||||||
self.add_attribute(service)
|
self.add_attribute(service)
|
||||||
|
|
||||||
@@ -285,11 +299,13 @@ class Server(EventEmitter):
|
|||||||
service.end_group_handle = self.attributes[-1].handle
|
service.end_group_handle = self.attributes[-1].handle
|
||||||
self.services.append(service)
|
self.services.append(service)
|
||||||
|
|
||||||
def add_services(self, services):
|
def add_services(self, services: Iterable[Service]) -> None:
|
||||||
for service in services:
|
for service in services:
|
||||||
self.add_service(service)
|
self.add_service(service)
|
||||||
|
|
||||||
def read_cccd(self, connection, characteristic):
|
def read_cccd(
|
||||||
|
self, connection: Optional[Connection], characteristic: Characteristic
|
||||||
|
) -> bytes:
|
||||||
if connection is None:
|
if connection is None:
|
||||||
return bytes([0, 0])
|
return bytes([0, 0])
|
||||||
|
|
||||||
@@ -300,7 +316,12 @@ class Server(EventEmitter):
|
|||||||
|
|
||||||
return cccd or bytes([0, 0])
|
return cccd or bytes([0, 0])
|
||||||
|
|
||||||
def write_cccd(self, connection, characteristic, value):
|
def write_cccd(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
characteristic: Characteristic,
|
||||||
|
value: bytes,
|
||||||
|
) -> None:
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'Subscription update for connection=0x{connection.handle:04X}, '
|
f'Subscription update for connection=0x{connection.handle:04X}, '
|
||||||
f'handle=0x{characteristic.handle:04X}: {value.hex()}'
|
f'handle=0x{characteristic.handle:04X}: {value.hex()}'
|
||||||
@@ -327,13 +348,19 @@ class Server(EventEmitter):
|
|||||||
indicate_enabled,
|
indicate_enabled,
|
||||||
)
|
)
|
||||||
|
|
||||||
def send_response(self, connection, response):
|
def send_response(self, connection: Connection, response: ATT_PDU) -> None:
|
||||||
logger.debug(
|
logger.debug(
|
||||||
f'GATT Response from server: [0x{connection.handle:04X}] {response}'
|
f'GATT Response from server: [0x{connection.handle:04X}] {response}'
|
||||||
)
|
)
|
||||||
self.send_gatt_pdu(connection.handle, response.to_bytes())
|
self.send_gatt_pdu(connection.handle, response.to_bytes())
|
||||||
|
|
||||||
async def notify_subscriber(self, connection, attribute, value=None, force=False):
|
async def notify_subscriber(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
attribute: Attribute,
|
||||||
|
value: Optional[bytes] = None,
|
||||||
|
force: bool = False,
|
||||||
|
) -> None:
|
||||||
# Check if there's a subscriber
|
# Check if there's a subscriber
|
||||||
if not force:
|
if not force:
|
||||||
subscribers = self.subscribers.get(connection.handle)
|
subscribers = self.subscribers.get(connection.handle)
|
||||||
@@ -370,7 +397,13 @@ class Server(EventEmitter):
|
|||||||
)
|
)
|
||||||
self.send_gatt_pdu(connection.handle, bytes(notification))
|
self.send_gatt_pdu(connection.handle, bytes(notification))
|
||||||
|
|
||||||
async def indicate_subscriber(self, connection, attribute, value=None, force=False):
|
async def indicate_subscriber(
|
||||||
|
self,
|
||||||
|
connection: Connection,
|
||||||
|
attribute: Attribute,
|
||||||
|
value: Optional[bytes] = None,
|
||||||
|
force: bool = False,
|
||||||
|
) -> None:
|
||||||
# Check if there's a subscriber
|
# Check if there's a subscriber
|
||||||
if not force:
|
if not force:
|
||||||
subscribers = self.subscribers.get(connection.handle)
|
subscribers = self.subscribers.get(connection.handle)
|
||||||
@@ -411,15 +444,13 @@ class Server(EventEmitter):
|
|||||||
assert self.pending_confirmations[connection.handle] is None
|
assert self.pending_confirmations[connection.handle] is None
|
||||||
|
|
||||||
# Create a future value to hold the eventual response
|
# Create a future value to hold the eventual response
|
||||||
self.pending_confirmations[
|
pending_confirmation = self.pending_confirmations[
|
||||||
connection.handle
|
connection.handle
|
||||||
] = asyncio.get_running_loop().create_future()
|
] = asyncio.get_running_loop().create_future()
|
||||||
|
|
||||||
try:
|
try:
|
||||||
self.send_gatt_pdu(connection.handle, indication.to_bytes())
|
self.send_gatt_pdu(connection.handle, indication.to_bytes())
|
||||||
await asyncio.wait_for(
|
await asyncio.wait_for(pending_confirmation, GATT_REQUEST_TIMEOUT)
|
||||||
self.pending_confirmations[connection.handle], GATT_REQUEST_TIMEOUT
|
|
||||||
)
|
|
||||||
except asyncio.TimeoutError as error:
|
except asyncio.TimeoutError as error:
|
||||||
logger.warning(color('!!! GATT Indicate timeout', 'red'))
|
logger.warning(color('!!! GATT Indicate timeout', 'red'))
|
||||||
raise TimeoutError(f'GATT timeout for {indication.name}') from error
|
raise TimeoutError(f'GATT timeout for {indication.name}') from error
|
||||||
@@ -427,8 +458,12 @@ class Server(EventEmitter):
|
|||||||
self.pending_confirmations[connection.handle] = None
|
self.pending_confirmations[connection.handle] = None
|
||||||
|
|
||||||
async def notify_or_indicate_subscribers(
|
async def notify_or_indicate_subscribers(
|
||||||
self, indicate, attribute, value=None, force=False
|
self,
|
||||||
):
|
indicate: bool,
|
||||||
|
attribute: Attribute,
|
||||||
|
value: Optional[bytes] = None,
|
||||||
|
force: bool = False,
|
||||||
|
) -> None:
|
||||||
# Get all the connections for which there's at least one subscription
|
# Get all the connections for which there's at least one subscription
|
||||||
connections = [
|
connections = [
|
||||||
connection
|
connection
|
||||||
@@ -450,13 +485,23 @@ class Server(EventEmitter):
|
|||||||
]
|
]
|
||||||
)
|
)
|
||||||
|
|
||||||
async def notify_subscribers(self, attribute, value=None, force=False):
|
async def notify_subscribers(
|
||||||
|
self,
|
||||||
|
attribute: Attribute,
|
||||||
|
value: Optional[bytes] = None,
|
||||||
|
force: bool = False,
|
||||||
|
):
|
||||||
return await self.notify_or_indicate_subscribers(False, attribute, value, force)
|
return await self.notify_or_indicate_subscribers(False, attribute, value, force)
|
||||||
|
|
||||||
async def indicate_subscribers(self, attribute, value=None, force=False):
|
async def indicate_subscribers(
|
||||||
|
self,
|
||||||
|
attribute: Attribute,
|
||||||
|
value: Optional[bytes] = None,
|
||||||
|
force: bool = False,
|
||||||
|
):
|
||||||
return await self.notify_or_indicate_subscribers(True, attribute, value, force)
|
return await self.notify_or_indicate_subscribers(True, attribute, value, force)
|
||||||
|
|
||||||
def on_disconnection(self, connection):
|
def on_disconnection(self, connection: Connection) -> None:
|
||||||
if connection.handle in self.subscribers:
|
if connection.handle in self.subscribers:
|
||||||
del self.subscribers[connection.handle]
|
del self.subscribers[connection.handle]
|
||||||
if connection.handle in self.indication_semaphores:
|
if connection.handle in self.indication_semaphores:
|
||||||
@@ -464,7 +509,7 @@ class Server(EventEmitter):
|
|||||||
if connection.handle in self.pending_confirmations:
|
if connection.handle in self.pending_confirmations:
|
||||||
del self.pending_confirmations[connection.handle]
|
del self.pending_confirmations[connection.handle]
|
||||||
|
|
||||||
def on_gatt_pdu(self, connection, att_pdu):
|
def on_gatt_pdu(self, connection: Connection, att_pdu: ATT_PDU) -> None:
|
||||||
logger.debug(f'GATT Request to server: [0x{connection.handle:04X}] {att_pdu}')
|
logger.debug(f'GATT Request to server: [0x{connection.handle:04X}] {att_pdu}')
|
||||||
handler_name = f'on_{att_pdu.name.lower()}'
|
handler_name = f'on_{att_pdu.name.lower()}'
|
||||||
handler = getattr(self, handler_name, None)
|
handler = getattr(self, handler_name, None)
|
||||||
@@ -506,7 +551,7 @@ class Server(EventEmitter):
|
|||||||
#######################################################
|
#######################################################
|
||||||
# ATT handlers
|
# ATT handlers
|
||||||
#######################################################
|
#######################################################
|
||||||
def on_att_request(self, connection, pdu):
|
def on_att_request(self, connection: Connection, pdu: ATT_PDU) -> None:
|
||||||
'''
|
'''
|
||||||
Handler for requests without a more specific handler
|
Handler for requests without a more specific handler
|
||||||
'''
|
'''
|
||||||
@@ -679,7 +724,6 @@ class Server(EventEmitter):
|
|||||||
and attribute.handle <= request.ending_handle
|
and attribute.handle <= request.ending_handle
|
||||||
and pdu_space_available
|
and pdu_space_available
|
||||||
):
|
):
|
||||||
|
|
||||||
try:
|
try:
|
||||||
attribute_value = attribute.read_value(connection)
|
attribute_value = attribute.read_value(connection)
|
||||||
except ATT_Error as error:
|
except ATT_Error as error:
|
||||||
|
|||||||
+388
-291
File diff suppressed because it is too large
Load Diff
+737
-17
@@ -1,4 +1,4 @@
|
|||||||
# Copyright 2021-2022 Google LLC
|
# Copyright 2023 Google LLC
|
||||||
#
|
#
|
||||||
# Licensed under the Apache License, Version 2.0 (the "License");
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
# you may not use this file except in compliance with the License.
|
# you may not use this file except in compliance with the License.
|
||||||
@@ -15,19 +15,51 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
import collections.abc
|
||||||
import logging
|
import logging
|
||||||
import asyncio
|
import asyncio
|
||||||
import collections
|
import dataclasses
|
||||||
from typing import Union
|
import enum
|
||||||
|
import traceback
|
||||||
|
import warnings
|
||||||
|
from typing import Dict, List, Union, Set, TYPE_CHECKING
|
||||||
|
|
||||||
|
from . import at
|
||||||
from . import rfcomm
|
from . import rfcomm
|
||||||
from .colors import color
|
|
||||||
|
from bumble.colors import color
|
||||||
|
from bumble.core import (
|
||||||
|
ProtocolError,
|
||||||
|
BT_GENERIC_AUDIO_SERVICE,
|
||||||
|
BT_HANDSFREE_SERVICE,
|
||||||
|
BT_L2CAP_PROTOCOL_ID,
|
||||||
|
BT_RFCOMM_PROTOCOL_ID,
|
||||||
|
)
|
||||||
|
from bumble.sdp import (
|
||||||
|
DataElement,
|
||||||
|
ServiceAttribute,
|
||||||
|
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID,
|
||||||
|
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_BLUETOOTH_PROFILE_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_SUPPORTED_FEATURES_ATTRIBUTE_ID,
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
logger = logging.getLogger(__name__)
|
logger = logging.getLogger(__name__)
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Error
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
|
class HfpProtocolError(ProtocolError):
|
||||||
|
def __init__(self, error_name: str = '', details: str = ''):
|
||||||
|
super().__init__(None, 'hfp', error_name, details)
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Protocol Support
|
# Protocol Support
|
||||||
@@ -41,6 +73,7 @@ class HfpProtocol:
|
|||||||
lines_available: asyncio.Event
|
lines_available: asyncio.Event
|
||||||
|
|
||||||
def __init__(self, dlc: rfcomm.DLC) -> None:
|
def __init__(self, dlc: rfcomm.DLC) -> None:
|
||||||
|
warnings.warn("See HfProtocol", DeprecationWarning)
|
||||||
self.dlc = dlc
|
self.dlc = dlc
|
||||||
self.buffer = ''
|
self.buffer = ''
|
||||||
self.lines = collections.deque()
|
self.lines = collections.deque()
|
||||||
@@ -83,19 +116,706 @@ class HfpProtocol:
|
|||||||
logger.debug(color(f'<<< {line}', 'green'))
|
logger.debug(color(f'<<< {line}', 'green'))
|
||||||
return line
|
return line
|
||||||
|
|
||||||
async def initialize_service(self) -> None:
|
|
||||||
# Perform Service Level Connection Initialization
|
|
||||||
self.send_command_line('AT+BRSF=2072') # Retrieve Supported Features
|
|
||||||
await (self.next_line())
|
|
||||||
await (self.next_line())
|
|
||||||
|
|
||||||
self.send_command_line('AT+CIND=?')
|
# -----------------------------------------------------------------------------
|
||||||
await (self.next_line())
|
# Normative protocol definitions
|
||||||
await (self.next_line())
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
self.send_command_line('AT+CIND?')
|
|
||||||
await (self.next_line())
|
|
||||||
await (self.next_line())
|
|
||||||
|
|
||||||
self.send_command_line('AT+CMER=3,0,0,1')
|
# HF supported features (AT+BRSF=) (normative).
|
||||||
await (self.next_line())
|
# Hands-Free Profile v1.8, 4.34.2, AT Capabilities Re-Used from GSM 07.07
|
||||||
|
# and 3GPP 27.007
|
||||||
|
class HfFeature(enum.IntFlag):
|
||||||
|
EC_NR = 0x001 # Echo Cancel & Noise reduction
|
||||||
|
THREE_WAY_CALLING = 0x002
|
||||||
|
CLI_PRESENTATION_CAPABILITY = 0x004
|
||||||
|
VOICE_RECOGNITION_ACTIVATION = 0x008
|
||||||
|
REMOTE_VOLUME_CONTROL = 0x010
|
||||||
|
ENHANCED_CALL_STATUS = 0x020
|
||||||
|
ENHANCED_CALL_CONTROL = 0x040
|
||||||
|
CODEC_NEGOTIATION = 0x080
|
||||||
|
HF_INDICATORS = 0x100
|
||||||
|
ESCO_S4_SETTINGS_SUPPORTED = 0x200
|
||||||
|
ENHANCED_VOICE_RECOGNITION_STATUS = 0x400
|
||||||
|
VOICE_RECOGNITION_TEST = 0x800
|
||||||
|
|
||||||
|
|
||||||
|
# AG supported features (+BRSF:) (normative).
|
||||||
|
# Hands-Free Profile v1.8, 4.34.2, AT Capabilities Re-Used from GSM 07.07
|
||||||
|
# and 3GPP 27.007
|
||||||
|
class AgFeature(enum.IntFlag):
|
||||||
|
THREE_WAY_CALLING = 0x001
|
||||||
|
EC_NR = 0x002 # Echo Cancel & Noise reduction
|
||||||
|
VOICE_RECOGNITION_FUNCTION = 0x004
|
||||||
|
IN_BAND_RING_TONE_CAPABILITY = 0x008
|
||||||
|
VOICE_TAG = 0x010 # Attach a number to voice tag
|
||||||
|
REJECT_CALL = 0x020 # Ability to reject a call
|
||||||
|
ENHANCED_CALL_STATUS = 0x040
|
||||||
|
ENHANCED_CALL_CONTROL = 0x080
|
||||||
|
EXTENDED_ERROR_RESULT_CODES = 0x100
|
||||||
|
CODEC_NEGOTIATION = 0x200
|
||||||
|
HF_INDICATORS = 0x400
|
||||||
|
ESCO_S4_SETTINGS_SUPPORTED = 0x800
|
||||||
|
ENHANCED_VOICE_RECOGNITION_STATUS = 0x1000
|
||||||
|
VOICE_RECOGNITION_TEST = 0x2000
|
||||||
|
|
||||||
|
|
||||||
|
# Audio Codec IDs (normative).
|
||||||
|
# Hands-Free Profile v1.8, 10 Appendix B
|
||||||
|
class AudioCodec(enum.IntEnum):
|
||||||
|
CVSD = 0x01 # Support for CVSD audio codec
|
||||||
|
MSBC = 0x02 # Support for mSBC audio codec
|
||||||
|
|
||||||
|
|
||||||
|
# HF Indicators (normative).
|
||||||
|
# Bluetooth Assigned Numbers, 6.10.1 HF Indicators
|
||||||
|
class HfIndicator(enum.IntEnum):
|
||||||
|
ENHANCED_SAFETY = 0x01 # Enhanced safety feature
|
||||||
|
BATTERY_LEVEL = 0x02 # Battery level feature
|
||||||
|
|
||||||
|
|
||||||
|
# Call Hold supported operations (normative).
|
||||||
|
# AT Commands Reference Guide, 3.5.2.3.12 +CHLD - Call Holding Services
|
||||||
|
class CallHoldOperation(enum.IntEnum):
|
||||||
|
RELEASE_ALL_HELD_CALLS = 0 # Release all held calls
|
||||||
|
RELEASE_ALL_ACTIVE_CALLS = 1 # Release all active calls, accept other
|
||||||
|
HOLD_ALL_ACTIVE_CALLS = 2 # Place all active calls on hold, accept other
|
||||||
|
ADD_HELD_CALL = 3 # Adds a held call to conversation
|
||||||
|
|
||||||
|
|
||||||
|
# Response Hold status (normative).
|
||||||
|
# Hands-Free Profile v1.8, 4.34.2, AT Capabilities Re-Used from GSM 07.07
|
||||||
|
# and 3GPP 27.007
|
||||||
|
class ResponseHoldStatus(enum.IntEnum):
|
||||||
|
INC_CALL_HELD = 0 # Put incoming call on hold
|
||||||
|
HELD_CALL_ACC = 1 # Accept a held incoming call
|
||||||
|
HELD_CALL_REJ = 2 # Reject a held incoming call
|
||||||
|
|
||||||
|
|
||||||
|
# Values for the Call Setup AG indicator (normative).
|
||||||
|
# Hands-Free Profile v1.8, 4.34.2, AT Capabilities Re-Used from GSM 07.07
|
||||||
|
# and 3GPP 27.007
|
||||||
|
class CallSetupAgIndicator(enum.IntEnum):
|
||||||
|
NOT_IN_CALL_SETUP = 0
|
||||||
|
INCOMING_CALL_PROCESS = 1
|
||||||
|
OUTGOING_CALL_SETUP = 2
|
||||||
|
REMOTE_ALERTED = 3 # Remote party alerted in an outgoing call
|
||||||
|
|
||||||
|
|
||||||
|
# Values for the Call Held AG indicator (normative).
|
||||||
|
# Hands-Free Profile v1.8, 4.34.2, AT Capabilities Re-Used from GSM 07.07
|
||||||
|
# and 3GPP 27.007
|
||||||
|
class CallHeldAgIndicator(enum.IntEnum):
|
||||||
|
NO_CALLS_HELD = 0
|
||||||
|
# Call is placed on hold or active/held calls swapped
|
||||||
|
# (The AG has both an active AND a held call)
|
||||||
|
CALL_ON_HOLD_AND_ACTIVE_CALL = 1
|
||||||
|
CALL_ON_HOLD_NO_ACTIVE_CALL = 2 # Call on hold, no active call
|
||||||
|
|
||||||
|
|
||||||
|
# Call Info direction (normative).
|
||||||
|
# AT Commands Reference Guide, 3.5.2.3.15 +CLCC - List Current Calls
|
||||||
|
class CallInfoDirection(enum.IntEnum):
|
||||||
|
MOBILE_ORIGINATED_CALL = 0
|
||||||
|
MOBILE_TERMINATED_CALL = 1
|
||||||
|
|
||||||
|
|
||||||
|
# Call Info status (normative).
|
||||||
|
# AT Commands Reference Guide, 3.5.2.3.15 +CLCC - List Current Calls
|
||||||
|
class CallInfoStatus(enum.IntEnum):
|
||||||
|
ACTIVE = 0
|
||||||
|
HELD = 1
|
||||||
|
DIALING = 2
|
||||||
|
ALERTING = 3
|
||||||
|
INCOMING = 4
|
||||||
|
WAITING = 5
|
||||||
|
|
||||||
|
|
||||||
|
# Call Info mode (normative).
|
||||||
|
# AT Commands Reference Guide, 3.5.2.3.15 +CLCC - List Current Calls
|
||||||
|
class CallInfoMode(enum.IntEnum):
|
||||||
|
VOICE = 0
|
||||||
|
DATA = 1
|
||||||
|
FAX = 2
|
||||||
|
UNKNOWN = 9
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Hands-Free Control Interoperability Requirements
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
# Response codes.
|
||||||
|
RESPONSE_CODES = [
|
||||||
|
"+APLSIRI",
|
||||||
|
"+BAC",
|
||||||
|
"+BCC",
|
||||||
|
"+BCS",
|
||||||
|
"+BIA",
|
||||||
|
"+BIEV",
|
||||||
|
"+BIND",
|
||||||
|
"+BINP",
|
||||||
|
"+BLDN",
|
||||||
|
"+BRSF",
|
||||||
|
"+BTRH",
|
||||||
|
"+BVRA",
|
||||||
|
"+CCWA",
|
||||||
|
"+CHLD",
|
||||||
|
"+CHUP",
|
||||||
|
"+CIND",
|
||||||
|
"+CLCC",
|
||||||
|
"+CLIP",
|
||||||
|
"+CMEE",
|
||||||
|
"+CMER",
|
||||||
|
"+CNUM",
|
||||||
|
"+COPS",
|
||||||
|
"+IPHONEACCEV",
|
||||||
|
"+NREC",
|
||||||
|
"+VGM",
|
||||||
|
"+VGS",
|
||||||
|
"+VTS",
|
||||||
|
"+XAPL",
|
||||||
|
"A",
|
||||||
|
"D",
|
||||||
|
]
|
||||||
|
|
||||||
|
# Unsolicited responses and statuses.
|
||||||
|
UNSOLICITED_CODES = [
|
||||||
|
"+APLSIRI",
|
||||||
|
"+BCS",
|
||||||
|
"+BIND",
|
||||||
|
"+BSIR",
|
||||||
|
"+BTRH",
|
||||||
|
"+BVRA",
|
||||||
|
"+CCWA",
|
||||||
|
"+CIEV",
|
||||||
|
"+CLIP",
|
||||||
|
"+VGM",
|
||||||
|
"+VGS",
|
||||||
|
"BLACKLISTED",
|
||||||
|
"BUSY",
|
||||||
|
"DELAYED",
|
||||||
|
"NO ANSWER",
|
||||||
|
"NO CARRIER",
|
||||||
|
"RING",
|
||||||
|
]
|
||||||
|
|
||||||
|
# Status codes
|
||||||
|
STATUS_CODES = [
|
||||||
|
"+CME ERROR",
|
||||||
|
"BLACKLISTED",
|
||||||
|
"BUSY",
|
||||||
|
"DELAYED",
|
||||||
|
"ERROR",
|
||||||
|
"NO ANSWER",
|
||||||
|
"NO CARRIER",
|
||||||
|
"OK",
|
||||||
|
]
|
||||||
|
|
||||||
|
|
||||||
|
@dataclasses.dataclass
|
||||||
|
class Configuration:
|
||||||
|
supported_hf_features: List[HfFeature]
|
||||||
|
supported_hf_indicators: List[HfIndicator]
|
||||||
|
supported_audio_codecs: List[AudioCodec]
|
||||||
|
|
||||||
|
|
||||||
|
class AtResponseType(enum.Enum):
|
||||||
|
"""Indicate if a response is expected from an AT command, and if multiple
|
||||||
|
responses are accepted."""
|
||||||
|
|
||||||
|
NONE = 0
|
||||||
|
SINGLE = 1
|
||||||
|
MULTIPLE = 2
|
||||||
|
|
||||||
|
|
||||||
|
class AtResponse:
|
||||||
|
code: str
|
||||||
|
parameters: list
|
||||||
|
|
||||||
|
def __init__(self, response: bytearray):
|
||||||
|
code_and_parameters = response.split(b':')
|
||||||
|
parameters = (
|
||||||
|
code_and_parameters[1] if len(code_and_parameters) > 1 else bytearray()
|
||||||
|
)
|
||||||
|
self.code = code_and_parameters[0].decode()
|
||||||
|
self.parameters = at.parse_parameters(parameters)
|
||||||
|
|
||||||
|
|
||||||
|
@dataclasses.dataclass
|
||||||
|
class AgIndicatorState:
|
||||||
|
description: str
|
||||||
|
index: int
|
||||||
|
supported_values: Set[int]
|
||||||
|
current_status: int
|
||||||
|
|
||||||
|
|
||||||
|
@dataclasses.dataclass
|
||||||
|
class HfIndicatorState:
|
||||||
|
supported: bool = False
|
||||||
|
enabled: bool = False
|
||||||
|
|
||||||
|
|
||||||
|
class HfProtocol:
|
||||||
|
"""Implementation for the Hands-Free side of the Hands-Free profile.
|
||||||
|
Reference specification Hands-Free Profile v1.8"""
|
||||||
|
|
||||||
|
supported_hf_features: int
|
||||||
|
supported_audio_codecs: List[AudioCodec]
|
||||||
|
|
||||||
|
supported_ag_features: int
|
||||||
|
supported_ag_call_hold_operations: List[CallHoldOperation]
|
||||||
|
|
||||||
|
ag_indicators: List[AgIndicatorState]
|
||||||
|
hf_indicators: Dict[HfIndicator, HfIndicatorState]
|
||||||
|
|
||||||
|
dlc: rfcomm.DLC
|
||||||
|
command_lock: asyncio.Lock
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
response_queue: asyncio.Queue[AtResponse]
|
||||||
|
unsolicited_queue: asyncio.Queue[AtResponse]
|
||||||
|
else:
|
||||||
|
response_queue: asyncio.Queue
|
||||||
|
unsolicited_queue: asyncio.Queue
|
||||||
|
read_buffer: bytearray
|
||||||
|
|
||||||
|
def __init__(self, dlc: rfcomm.DLC, configuration: Configuration):
|
||||||
|
# Configure internal state.
|
||||||
|
self.dlc = dlc
|
||||||
|
self.command_lock = asyncio.Lock()
|
||||||
|
self.response_queue = asyncio.Queue()
|
||||||
|
self.unsolicited_queue = asyncio.Queue()
|
||||||
|
self.read_buffer = bytearray()
|
||||||
|
|
||||||
|
# Build local features.
|
||||||
|
self.supported_hf_features = sum(configuration.supported_hf_features)
|
||||||
|
self.supported_audio_codecs = configuration.supported_audio_codecs
|
||||||
|
|
||||||
|
self.hf_indicators = {
|
||||||
|
indicator: HfIndicatorState()
|
||||||
|
for indicator in configuration.supported_hf_indicators
|
||||||
|
}
|
||||||
|
|
||||||
|
# Clear remote features.
|
||||||
|
self.supported_ag_features = 0
|
||||||
|
self.supported_ag_call_hold_operations = []
|
||||||
|
self.ag_indicators = []
|
||||||
|
|
||||||
|
# Bind the AT reader to the RFCOMM channel.
|
||||||
|
self.dlc.sink = self._read_at
|
||||||
|
|
||||||
|
def supports_hf_feature(self, feature: HfFeature) -> bool:
|
||||||
|
return (self.supported_hf_features & feature) != 0
|
||||||
|
|
||||||
|
def supports_ag_feature(self, feature: AgFeature) -> bool:
|
||||||
|
return (self.supported_ag_features & feature) != 0
|
||||||
|
|
||||||
|
# Read AT messages from the RFCOMM channel.
|
||||||
|
# Enqueue AT commands, responses, unsolicited responses to their
|
||||||
|
# respective queues, and set the corresponding event.
|
||||||
|
def _read_at(self, data: bytes):
|
||||||
|
# Append to the read buffer.
|
||||||
|
self.read_buffer.extend(data)
|
||||||
|
|
||||||
|
# Locate header and trailer.
|
||||||
|
header = self.read_buffer.find(b'\r\n')
|
||||||
|
trailer = self.read_buffer.find(b'\r\n', header + 2)
|
||||||
|
if header == -1 or trailer == -1:
|
||||||
|
return
|
||||||
|
|
||||||
|
# Isolate the AT response code and parameters.
|
||||||
|
raw_response = self.read_buffer[header + 2 : trailer]
|
||||||
|
response = AtResponse(raw_response)
|
||||||
|
logger.debug(f"<<< {raw_response.decode()}")
|
||||||
|
|
||||||
|
# Consume the response bytes.
|
||||||
|
self.read_buffer = self.read_buffer[trailer + 2 :]
|
||||||
|
|
||||||
|
# Forward the received code to the correct queue.
|
||||||
|
if self.command_lock.locked() and (
|
||||||
|
response.code in STATUS_CODES or response.code in RESPONSE_CODES
|
||||||
|
):
|
||||||
|
self.response_queue.put_nowait(response)
|
||||||
|
elif response.code in UNSOLICITED_CODES:
|
||||||
|
self.unsolicited_queue.put_nowait(response)
|
||||||
|
else:
|
||||||
|
logger.warning(f"dropping unexpected response with code '{response.code}'")
|
||||||
|
|
||||||
|
# Send an AT command and wait for the peer response.
|
||||||
|
# Wait for the AT responses sent by the peer, to the status code.
|
||||||
|
# Raises asyncio.TimeoutError if the status is not received
|
||||||
|
# after a timeout (default 1 second).
|
||||||
|
# Raises ProtocolError if the status is not OK.
|
||||||
|
async def execute_command(
|
||||||
|
self,
|
||||||
|
cmd: str,
|
||||||
|
timeout: float = 1.0,
|
||||||
|
response_type: AtResponseType = AtResponseType.NONE,
|
||||||
|
) -> Union[None, AtResponse, List[AtResponse]]:
|
||||||
|
async with self.command_lock:
|
||||||
|
logger.debug(f">>> {cmd}")
|
||||||
|
self.dlc.write(cmd + '\r')
|
||||||
|
responses: List[AtResponse] = []
|
||||||
|
|
||||||
|
while True:
|
||||||
|
result = await asyncio.wait_for(
|
||||||
|
self.response_queue.get(), timeout=timeout
|
||||||
|
)
|
||||||
|
if result.code == 'OK':
|
||||||
|
if response_type == AtResponseType.SINGLE and len(responses) != 1:
|
||||||
|
raise HfpProtocolError("NO ANSWER")
|
||||||
|
|
||||||
|
if response_type == AtResponseType.MULTIPLE:
|
||||||
|
return responses
|
||||||
|
if response_type == AtResponseType.SINGLE:
|
||||||
|
return responses[0]
|
||||||
|
return None
|
||||||
|
if result.code in STATUS_CODES:
|
||||||
|
raise HfpProtocolError(result.code)
|
||||||
|
responses.append(result)
|
||||||
|
|
||||||
|
# 4.2.1 Service Level Connection Initialization.
|
||||||
|
async def initiate_slc(self):
|
||||||
|
# 4.2.1.1 Supported features exchange
|
||||||
|
# First, in the initialization procedure, the HF shall send the
|
||||||
|
# AT+BRSF=<HF supported features> command to the AG to both notify
|
||||||
|
# the AG of the supported features in the HF, as well as to retrieve the
|
||||||
|
# supported features in the AG using the +BRSF result code.
|
||||||
|
response = await self.execute_command(
|
||||||
|
f"AT+BRSF={self.supported_hf_features}", response_type=AtResponseType.SINGLE
|
||||||
|
)
|
||||||
|
|
||||||
|
self.supported_ag_features = int(response.parameters[0])
|
||||||
|
logger.info(f"supported AG features: {self.supported_ag_features}")
|
||||||
|
for feature in AgFeature:
|
||||||
|
if self.supports_ag_feature(feature):
|
||||||
|
logger.info(f" - {feature.name}")
|
||||||
|
|
||||||
|
# 4.2.1.2 Codec Negotiation
|
||||||
|
# Secondly, in the initialization procedure, if the HF supports the
|
||||||
|
# Codec Negotiation feature, it shall check if the AT+BRSF command
|
||||||
|
# response from the AG has indicated that it supports the Codec
|
||||||
|
# Negotiation feature.
|
||||||
|
if self.supports_hf_feature(
|
||||||
|
HfFeature.CODEC_NEGOTIATION
|
||||||
|
) and self.supports_ag_feature(AgFeature.CODEC_NEGOTIATION):
|
||||||
|
# If both the HF and AG do support the Codec Negotiation feature
|
||||||
|
# then the HF shall send the AT+BAC=<HF available codecs> command to
|
||||||
|
# the AG to notify the AG of the available codecs in the HF.
|
||||||
|
codecs = [str(c) for c in self.supported_audio_codecs]
|
||||||
|
await self.execute_command(f"AT+BAC={','.join(codecs)}")
|
||||||
|
|
||||||
|
# 4.2.1.3 AG Indicators
|
||||||
|
# After having retrieved the supported features in the AG, the HF shall
|
||||||
|
# determine which indicators are supported by the AG, as well as the
|
||||||
|
# ordering of the supported indicators. This is because, according to
|
||||||
|
# the 3GPP 27.007 specification [2], the AG may support additional
|
||||||
|
# indicators not provided for by the Hands-Free Profile, and because the
|
||||||
|
# ordering of the indicators is implementation specific. The HF uses
|
||||||
|
# the AT+CIND=? Test command to retrieve information about the supported
|
||||||
|
# indicators and their ordering.
|
||||||
|
response = await self.execute_command(
|
||||||
|
"AT+CIND=?", response_type=AtResponseType.SINGLE
|
||||||
|
)
|
||||||
|
|
||||||
|
self.ag_indicators = []
|
||||||
|
for index, indicator in enumerate(response.parameters):
|
||||||
|
description = indicator[0].decode()
|
||||||
|
supported_values = []
|
||||||
|
for value in indicator[1]:
|
||||||
|
value = value.split(b'-')
|
||||||
|
value = [int(v) for v in value]
|
||||||
|
value_min = value[0]
|
||||||
|
value_max = value[1] if len(value) > 1 else value[0]
|
||||||
|
supported_values.extend([v for v in range(value_min, value_max + 1)])
|
||||||
|
|
||||||
|
self.ag_indicators.append(
|
||||||
|
AgIndicatorState(description, index, set(supported_values), 0)
|
||||||
|
)
|
||||||
|
|
||||||
|
# Once the HF has the necessary supported indicator and ordering
|
||||||
|
# information, it shall retrieve the current status of the indicators
|
||||||
|
# in the AG using the AT+CIND? Read command.
|
||||||
|
response = await self.execute_command(
|
||||||
|
"AT+CIND?", response_type=AtResponseType.SINGLE
|
||||||
|
)
|
||||||
|
|
||||||
|
for index, indicator in enumerate(response.parameters):
|
||||||
|
self.ag_indicators[index].current_status = int(indicator)
|
||||||
|
|
||||||
|
# After having retrieved the status of the indicators in the AG, the HF
|
||||||
|
# shall then enable the "Indicators status update" function in the AG by
|
||||||
|
# issuing the AT+CMER command, to which the AG shall respond with OK.
|
||||||
|
await self.execute_command("AT+CMER=3,,,1")
|
||||||
|
|
||||||
|
if self.supports_hf_feature(
|
||||||
|
HfFeature.THREE_WAY_CALLING
|
||||||
|
) and self.supports_ag_feature(HfFeature.THREE_WAY_CALLING):
|
||||||
|
# After the HF has enabled the “Indicators status update” function in
|
||||||
|
# the AG, and if the “Call waiting and 3-way calling” bit was set in the
|
||||||
|
# supported features bitmap by both the HF and the AG, the HF shall
|
||||||
|
# issue the AT+CHLD=? test command to retrieve the information about how
|
||||||
|
# the call hold and multiparty services are supported in the AG. The HF
|
||||||
|
# shall not issue the AT+CHLD=? test command in case either the HF or
|
||||||
|
# the AG does not support the "Three-way calling" feature.
|
||||||
|
response = await self.execute_command(
|
||||||
|
"AT+CHLD=?", response_type=AtResponseType.SINGLE
|
||||||
|
)
|
||||||
|
|
||||||
|
self.supported_ag_call_hold_operations = [
|
||||||
|
CallHoldOperation(int(operation))
|
||||||
|
for operation in response.parameters[0]
|
||||||
|
if not b'x' in operation
|
||||||
|
]
|
||||||
|
|
||||||
|
# 4.2.1.4 HF Indicators
|
||||||
|
# If the HF supports the HF indicator feature, it shall check the +BRSF
|
||||||
|
# response to see if the AG also supports the HF Indicator feature.
|
||||||
|
if self.supports_hf_feature(
|
||||||
|
HfFeature.HF_INDICATORS
|
||||||
|
) and self.supports_ag_feature(AgFeature.HF_INDICATORS):
|
||||||
|
# If both the HF and AG support the HF Indicator feature, then the HF
|
||||||
|
# shall send the AT+BIND=<HF supported HF indicators> command to the AG
|
||||||
|
# to notify the AG of the supported indicators’ assigned numbers in the
|
||||||
|
# HF. The AG shall respond with OK
|
||||||
|
indicators = [str(i) for i in self.hf_indicators.keys()]
|
||||||
|
await self.execute_command(f"AT+BIND={','.join(indicators)}")
|
||||||
|
|
||||||
|
# After having provided the AG with the HF indicators it supports,
|
||||||
|
# the HF shall send the AT+BIND=? to request HF indicators supported
|
||||||
|
# by the AG. The AG shall reply with the +BIND response listing all
|
||||||
|
# HF indicators that it supports followed by an OK.
|
||||||
|
response = await self.execute_command(
|
||||||
|
"AT+BIND=?", response_type=AtResponseType.SINGLE
|
||||||
|
)
|
||||||
|
|
||||||
|
logger.info("supported HF indicators:")
|
||||||
|
for indicator in response.parameters[0]:
|
||||||
|
indicator = HfIndicator(int(indicator))
|
||||||
|
logger.info(f" - {indicator.name}")
|
||||||
|
if indicator in self.hf_indicators:
|
||||||
|
self.hf_indicators[indicator].supported = True
|
||||||
|
|
||||||
|
# Once the HF receives the supported HF indicators list from the AG,
|
||||||
|
# the HF shall send the AT+BIND? command to determine which HF
|
||||||
|
# indicators are enabled. The AG shall respond with one or more
|
||||||
|
# +BIND responses. The AG shall terminate the list with OK.
|
||||||
|
# (See Section 4.36.1.3).
|
||||||
|
responses = await self.execute_command(
|
||||||
|
"AT+BIND?", response_type=AtResponseType.MULTIPLE
|
||||||
|
)
|
||||||
|
|
||||||
|
logger.info("enabled HF indicators:")
|
||||||
|
for response in responses:
|
||||||
|
indicator = HfIndicator(int(response.parameters[0]))
|
||||||
|
enabled = int(response.parameters[1]) != 0
|
||||||
|
logger.info(f" - {indicator.name}: {enabled}")
|
||||||
|
if indicator in self.hf_indicators:
|
||||||
|
self.hf_indicators[indicator].enabled = True
|
||||||
|
|
||||||
|
logger.info("SLC setup completed")
|
||||||
|
|
||||||
|
# 4.11.2 Audio Connection Setup by HF
|
||||||
|
async def setup_audio_connection(self):
|
||||||
|
# When the HF triggers the establishment of the Codec Connection it
|
||||||
|
# shall send the AT command AT+BCC to the AG. The AG shall respond with
|
||||||
|
# OK if it will start the Codec Connection procedure, and with ERROR
|
||||||
|
# if it cannot start the Codec Connection procedure.
|
||||||
|
await self.execute_command("AT+BCC")
|
||||||
|
|
||||||
|
# 4.11.3 Codec Connection Setup
|
||||||
|
async def setup_codec_connection(self, codec_id: int):
|
||||||
|
# The AG shall send a +BCS=<Codec ID> unsolicited response to the HF.
|
||||||
|
# The HF shall then respond to the incoming unsolicited response with
|
||||||
|
# the AT command AT+BCS=<Codec ID>. The ID shall be the same as in the
|
||||||
|
# unsolicited response code as long as the ID is supported.
|
||||||
|
# If the received ID is not available, the HF shall respond with
|
||||||
|
# AT+BAC with its available codecs.
|
||||||
|
if codec_id not in self.supported_audio_codecs:
|
||||||
|
codecs = [str(c) for c in self.supported_audio_codecs]
|
||||||
|
await self.execute_command(f"AT+BAC={','.join(codecs)}")
|
||||||
|
return
|
||||||
|
|
||||||
|
await self.execute_command(f"AT+BCS={codec_id}")
|
||||||
|
|
||||||
|
# After sending the OK response, the AG shall open the
|
||||||
|
# Synchronous Connection with the settings that are determined by the
|
||||||
|
# ID. The HF shall be ready to accept the synchronous connection
|
||||||
|
# establishment as soon as it has sent the AT commands AT+BCS=<Codec ID>.
|
||||||
|
|
||||||
|
logger.info("codec connection setup completed")
|
||||||
|
|
||||||
|
# 4.13.1 Answer Incoming Call from the HF – In-Band Ringing
|
||||||
|
async def answer_incoming_call(self):
|
||||||
|
# The user accepts the incoming voice call by using the proper means
|
||||||
|
# provided by the HF. The HF shall then send the ATA command
|
||||||
|
# (see Section 4.34) to the AG. The AG shall then begin the procedure for
|
||||||
|
# accepting the incoming call.
|
||||||
|
await self.execute_command("ATA")
|
||||||
|
|
||||||
|
# 4.14.1 Reject an Incoming Call from the HF
|
||||||
|
async def reject_incoming_call(self):
|
||||||
|
# The user rejects the incoming call by using the User Interface on the
|
||||||
|
# Hands-Free unit. The HF shall then send the AT+CHUP command
|
||||||
|
# (see Section 4.34) to the AG. This may happen at any time during the
|
||||||
|
# procedures described in Sections 4.13.1 and 4.13.2.
|
||||||
|
await self.execute_command("AT+CHUP")
|
||||||
|
|
||||||
|
# 4.15.1 Terminate a Call Process from the HF
|
||||||
|
async def terminate_call(self):
|
||||||
|
# The user may abort the ongoing call process using whatever means
|
||||||
|
# provided by the Hands-Free unit. The HF shall send AT+CHUP command
|
||||||
|
# (see Section 4.34) to the AG, and the AG shall then start the
|
||||||
|
# procedure to terminate or interrupt the current call procedure.
|
||||||
|
# The AG shall then send the OK indication followed by the +CIEV result
|
||||||
|
# code, with the value indicating (call=0).
|
||||||
|
await self.execute_command("AT+CHUP")
|
||||||
|
|
||||||
|
async def update_ag_indicator(self, index: int, value: int):
|
||||||
|
self.ag_indicators[index].current_status = value
|
||||||
|
logger.info(
|
||||||
|
f"AG indicator updated: {self.ag_indicators[index].description}, {value}"
|
||||||
|
)
|
||||||
|
|
||||||
|
async def handle_unsolicited(self):
|
||||||
|
"""Handle unsolicited result codes sent by the audio gateway."""
|
||||||
|
result = await self.unsolicited_queue.get()
|
||||||
|
if result.code == "+BCS":
|
||||||
|
await self.setup_codec_connection(int(result.parameters[0]))
|
||||||
|
elif result.code == "+CIEV":
|
||||||
|
await self.update_ag_indicator(
|
||||||
|
int(result.parameters[0]), int(result.parameters[1])
|
||||||
|
)
|
||||||
|
else:
|
||||||
|
logging.info(f"unhandled unsolicited response {result.code}")
|
||||||
|
|
||||||
|
async def run(self):
|
||||||
|
"""Main rountine for the Hands-Free side of the HFP protocol.
|
||||||
|
Initiates the service level connection then loops handling
|
||||||
|
unsolicited AG responses."""
|
||||||
|
|
||||||
|
try:
|
||||||
|
await self.initiate_slc()
|
||||||
|
while True:
|
||||||
|
await self.handle_unsolicited()
|
||||||
|
except Exception:
|
||||||
|
logger.error("HFP-HF protocol failed with the following error:")
|
||||||
|
logger.error(traceback.format_exc())
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Normative SDP definitions
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
|
# Profile version (normative).
|
||||||
|
# Hands-Free Profile v1.8, 5.3 SDP Interoperability Requirements
|
||||||
|
class ProfileVersion(enum.IntEnum):
|
||||||
|
V1_5 = 0x0105
|
||||||
|
V1_6 = 0x0106
|
||||||
|
V1_7 = 0x0107
|
||||||
|
V1_8 = 0x0108
|
||||||
|
V1_9 = 0x0109
|
||||||
|
|
||||||
|
|
||||||
|
# HF supported features (normative).
|
||||||
|
# Hands-Free Profile v1.8, 5.3 SDP Interoperability Requirements
|
||||||
|
class HfSdpFeature(enum.IntFlag):
|
||||||
|
EC_NR = 0x01 # Echo Cancel & Noise reduction
|
||||||
|
THREE_WAY_CALLING = 0x02
|
||||||
|
CLI_PRESENTATION_CAPABILITY = 0x04
|
||||||
|
VOICE_RECOGNITION_ACTIVATION = 0x08
|
||||||
|
REMOTE_VOLUME_CONTROL = 0x10
|
||||||
|
WIDE_BAND = 0x20 # Wide band speech
|
||||||
|
ENHANCED_VOICE_RECOGNITION_STATUS = 0x40
|
||||||
|
VOICE_RECOGNITION_TEST = 0x80
|
||||||
|
|
||||||
|
|
||||||
|
# AG supported features (normative).
|
||||||
|
# Hands-Free Profile v1.8, 5.3 SDP Interoperability Requirements
|
||||||
|
class AgSdpFeature(enum.IntFlag):
|
||||||
|
THREE_WAY_CALLING = 0x01
|
||||||
|
EC_NR = 0x02 # Echo Cancel & Noise reduction
|
||||||
|
VOICE_RECOGNITION_FUNCTION = 0x04
|
||||||
|
IN_BAND_RING_TONE_CAPABILITY = 0x08
|
||||||
|
VOICE_TAG = 0x10 # Attach a number to voice tag
|
||||||
|
WIDE_BAND = 0x20 # Wide band speech
|
||||||
|
ENHANCED_VOICE_RECOGNITION_STATUS = 0x40
|
||||||
|
VOICE_RECOGNITION_TEST = 0x80
|
||||||
|
|
||||||
|
|
||||||
|
def sdp_records(
|
||||||
|
service_record_handle: int, rfcomm_channel: int, configuration: Configuration
|
||||||
|
) -> List[ServiceAttribute]:
|
||||||
|
"""Generate the SDP record for HFP Hands-Free support.
|
||||||
|
The record exposes the features supported in the input configuration,
|
||||||
|
and the allocated RFCOMM channel."""
|
||||||
|
|
||||||
|
hf_supported_features = 0
|
||||||
|
|
||||||
|
if HfFeature.EC_NR in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.EC_NR
|
||||||
|
if HfFeature.THREE_WAY_CALLING in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.THREE_WAY_CALLING
|
||||||
|
if HfFeature.CLI_PRESENTATION_CAPABILITY in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.CLI_PRESENTATION_CAPABILITY
|
||||||
|
if HfFeature.VOICE_RECOGNITION_ACTIVATION in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.VOICE_RECOGNITION_ACTIVATION
|
||||||
|
if HfFeature.REMOTE_VOLUME_CONTROL in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.REMOTE_VOLUME_CONTROL
|
||||||
|
if (
|
||||||
|
HfFeature.ENHANCED_VOICE_RECOGNITION_STATUS
|
||||||
|
in configuration.supported_hf_features
|
||||||
|
):
|
||||||
|
hf_supported_features |= HfSdpFeature.ENHANCED_VOICE_RECOGNITION_STATUS
|
||||||
|
if HfFeature.VOICE_RECOGNITION_TEST in configuration.supported_hf_features:
|
||||||
|
hf_supported_features |= HfSdpFeature.VOICE_RECOGNITION_TEST
|
||||||
|
|
||||||
|
if AudioCodec.MSBC in configuration.supported_audio_codecs:
|
||||||
|
hf_supported_features |= HfSdpFeature.WIDE_BAND
|
||||||
|
|
||||||
|
return [
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID,
|
||||||
|
DataElement.unsigned_integer_32(service_record_handle),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.uuid(BT_HANDSFREE_SERVICE),
|
||||||
|
DataElement.uuid(BT_GENERIC_AUDIO_SERVICE),
|
||||||
|
]
|
||||||
|
),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.sequence([DataElement.uuid(BT_L2CAP_PROTOCOL_ID)]),
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.uuid(BT_RFCOMM_PROTOCOL_ID),
|
||||||
|
DataElement.unsigned_integer_8(rfcomm_channel),
|
||||||
|
]
|
||||||
|
),
|
||||||
|
]
|
||||||
|
),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_BLUETOOTH_PROFILE_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.uuid(BT_HANDSFREE_SERVICE),
|
||||||
|
DataElement.unsigned_integer_16(ProfileVersion.V1_8),
|
||||||
|
]
|
||||||
|
)
|
||||||
|
]
|
||||||
|
),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_SUPPORTED_FEATURES_ATTRIBUTE_ID,
|
||||||
|
DataElement.unsigned_integer_16(hf_supported_features),
|
||||||
|
),
|
||||||
|
]
|
||||||
|
|||||||
+332
@@ -0,0 +1,332 @@
|
|||||||
|
# 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
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
|
from dataclasses import dataclass
|
||||||
|
import logging
|
||||||
|
import asyncio
|
||||||
|
import enum
|
||||||
|
|
||||||
|
from pyee import EventEmitter
|
||||||
|
from typing import Optional, Tuple, Callable, Dict, Union, TYPE_CHECKING
|
||||||
|
|
||||||
|
from . import core, l2cap # type: ignore
|
||||||
|
from .colors import color # type: ignore
|
||||||
|
from .core import BT_BR_EDR_TRANSPORT, InvalidStateError, ProtocolError # type: ignore
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from bumble.device import Device, Connection
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Logging
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
logger = logging.getLogger(__name__)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Constants
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# fmt: on
|
||||||
|
HID_CONTROL_PSM = 0x0011
|
||||||
|
HID_INTERRUPT_PSM = 0x0013
|
||||||
|
|
||||||
|
|
||||||
|
class Message:
|
||||||
|
message_type: MessageType
|
||||||
|
# Report types
|
||||||
|
class ReportType(enum.IntEnum):
|
||||||
|
OTHER_REPORT = 0x00
|
||||||
|
INPUT_REPORT = 0x01
|
||||||
|
OUTPUT_REPORT = 0x02
|
||||||
|
FEATURE_REPORT = 0x03
|
||||||
|
|
||||||
|
# Handshake parameters
|
||||||
|
class Handshake(enum.IntEnum):
|
||||||
|
SUCCESSFUL = 0x00
|
||||||
|
NOT_READY = 0x01
|
||||||
|
ERR_INVALID_REPORT_ID = 0x02
|
||||||
|
ERR_UNSUPPORTED_REQUEST = 0x03
|
||||||
|
ERR_UNKNOWN = 0x0E
|
||||||
|
ERR_FATAL = 0x0F
|
||||||
|
|
||||||
|
# Message Type
|
||||||
|
class MessageType(enum.IntEnum):
|
||||||
|
HANDSHAKE = 0x00
|
||||||
|
CONTROL = 0x01
|
||||||
|
GET_REPORT = 0x04
|
||||||
|
SET_REPORT = 0x05
|
||||||
|
GET_PROTOCOL = 0x06
|
||||||
|
SET_PROTOCOL = 0x07
|
||||||
|
DATA = 0x0A
|
||||||
|
|
||||||
|
# Protocol modes
|
||||||
|
class ProtocolMode(enum.IntEnum):
|
||||||
|
BOOT_PROTOCOL = 0x00
|
||||||
|
REPORT_PROTOCOL = 0x01
|
||||||
|
|
||||||
|
# Control Operations
|
||||||
|
class ControlCommand(enum.IntEnum):
|
||||||
|
SUSPEND = 0x03
|
||||||
|
EXIT_SUSPEND = 0x04
|
||||||
|
VIRTUAL_CABLE_UNPLUG = 0x05
|
||||||
|
|
||||||
|
# Class Method to derive header
|
||||||
|
@classmethod
|
||||||
|
def header(cls, lower_bits: int = 0x00) -> bytes:
|
||||||
|
return bytes([(cls.message_type << 4) | lower_bits])
|
||||||
|
|
||||||
|
|
||||||
|
# HIDP messages
|
||||||
|
@dataclass
|
||||||
|
class GetReportMessage(Message):
|
||||||
|
report_type: int
|
||||||
|
report_id: int
|
||||||
|
buffer_size: int
|
||||||
|
message_type = Message.MessageType.GET_REPORT
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
packet_bytes = bytearray()
|
||||||
|
packet_bytes.append(self.report_id)
|
||||||
|
packet_bytes.extend(
|
||||||
|
[(self.buffer_size & 0xFF), ((self.buffer_size >> 8) & 0xFF)]
|
||||||
|
)
|
||||||
|
if self.report_type == Message.ReportType.OTHER_REPORT:
|
||||||
|
return self.header(self.report_type) + packet_bytes
|
||||||
|
else:
|
||||||
|
return self.header(0x08 | self.report_type) + packet_bytes
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class SetReportMessage(Message):
|
||||||
|
report_type: int
|
||||||
|
data: bytes
|
||||||
|
message_type = Message.MessageType.SET_REPORT
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(self.report_type) + self.data
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class GetProtocolMessage(Message):
|
||||||
|
message_type = Message.MessageType.GET_PROTOCOL
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header()
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class SetProtocolMessage(Message):
|
||||||
|
protocol_mode: int
|
||||||
|
message_type = Message.MessageType.SET_PROTOCOL
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(self.protocol_mode)
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class Suspend(Message):
|
||||||
|
message_type = Message.MessageType.CONTROL
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(Message.ControlCommand.SUSPEND)
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class ExitSuspend(Message):
|
||||||
|
message_type = Message.MessageType.CONTROL
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(Message.ControlCommand.EXIT_SUSPEND)
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class VirtualCableUnplug(Message):
|
||||||
|
message_type = Message.MessageType.CONTROL
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(Message.ControlCommand.VIRTUAL_CABLE_UNPLUG)
|
||||||
|
|
||||||
|
|
||||||
|
@dataclass
|
||||||
|
class SendData(Message):
|
||||||
|
data: bytes
|
||||||
|
message_type = Message.MessageType.DATA
|
||||||
|
|
||||||
|
def __bytes__(self) -> bytes:
|
||||||
|
return self.header(Message.ReportType.OUTPUT_REPORT) + self.data
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
class Host(EventEmitter):
|
||||||
|
l2cap_ctrl_channel: Optional[l2cap.ClassicChannel]
|
||||||
|
l2cap_intr_channel: Optional[l2cap.ClassicChannel]
|
||||||
|
|
||||||
|
def __init__(self, device: Device, connection: Connection) -> None:
|
||||||
|
super().__init__()
|
||||||
|
self.device = device
|
||||||
|
self.connection = connection
|
||||||
|
|
||||||
|
self.l2cap_ctrl_channel = None
|
||||||
|
self.l2cap_intr_channel = None
|
||||||
|
|
||||||
|
# Register ourselves with the L2CAP channel manager
|
||||||
|
device.register_l2cap_server(HID_CONTROL_PSM, self.on_connection)
|
||||||
|
device.register_l2cap_server(HID_INTERRUPT_PSM, self.on_connection)
|
||||||
|
|
||||||
|
async def connect_control_channel(self) -> None:
|
||||||
|
# Create a new L2CAP connection - control channel
|
||||||
|
try:
|
||||||
|
self.l2cap_ctrl_channel = await self.device.l2cap_channel_manager.connect(
|
||||||
|
self.connection, HID_CONTROL_PSM
|
||||||
|
)
|
||||||
|
except ProtocolError:
|
||||||
|
logging.exception(f'L2CAP connection failed.')
|
||||||
|
raise
|
||||||
|
|
||||||
|
assert self.l2cap_ctrl_channel is not None
|
||||||
|
# Become a sink for the L2CAP channel
|
||||||
|
self.l2cap_ctrl_channel.sink = self.on_ctrl_pdu
|
||||||
|
|
||||||
|
async def connect_interrupt_channel(self) -> None:
|
||||||
|
# Create a new L2CAP connection - interrupt channel
|
||||||
|
try:
|
||||||
|
self.l2cap_intr_channel = await self.device.l2cap_channel_manager.connect(
|
||||||
|
self.connection, HID_INTERRUPT_PSM
|
||||||
|
)
|
||||||
|
except ProtocolError:
|
||||||
|
logging.exception(f'L2CAP connection failed.')
|
||||||
|
raise
|
||||||
|
|
||||||
|
assert self.l2cap_intr_channel is not None
|
||||||
|
# Become a sink for the L2CAP channel
|
||||||
|
self.l2cap_intr_channel.sink = self.on_intr_pdu
|
||||||
|
|
||||||
|
async def disconnect_interrupt_channel(self) -> None:
|
||||||
|
if self.l2cap_intr_channel is None:
|
||||||
|
raise InvalidStateError('invalid state')
|
||||||
|
channel = self.l2cap_intr_channel
|
||||||
|
self.l2cap_intr_channel = None
|
||||||
|
await channel.disconnect()
|
||||||
|
|
||||||
|
async def disconnect_control_channel(self) -> None:
|
||||||
|
if self.l2cap_ctrl_channel is None:
|
||||||
|
raise InvalidStateError('invalid state')
|
||||||
|
channel = self.l2cap_ctrl_channel
|
||||||
|
self.l2cap_ctrl_channel = None
|
||||||
|
await channel.disconnect()
|
||||||
|
|
||||||
|
def on_connection(self, l2cap_channel: l2cap.ClassicChannel) -> None:
|
||||||
|
logger.debug(f'+++ New L2CAP connection: {l2cap_channel}')
|
||||||
|
l2cap_channel.on('open', lambda: self.on_l2cap_channel_open(l2cap_channel))
|
||||||
|
|
||||||
|
def on_l2cap_channel_open(self, l2cap_channel: l2cap.ClassicChannel) -> None:
|
||||||
|
if l2cap_channel.psm == HID_CONTROL_PSM:
|
||||||
|
self.l2cap_ctrl_channel = l2cap_channel
|
||||||
|
self.l2cap_ctrl_channel.sink = self.on_ctrl_pdu
|
||||||
|
else:
|
||||||
|
self.l2cap_intr_channel = l2cap_channel
|
||||||
|
self.l2cap_intr_channel.sink = self.on_intr_pdu
|
||||||
|
logger.debug(f'$$$ L2CAP channel open: {l2cap_channel}')
|
||||||
|
|
||||||
|
def on_ctrl_pdu(self, pdu: bytes) -> None:
|
||||||
|
logger.debug(f'<<< HID CONTROL PDU: {pdu.hex()}')
|
||||||
|
# Here we will receive all kinds of packets, parse and then call respective callbacks
|
||||||
|
message_type = pdu[0] >> 4
|
||||||
|
param = pdu[0] & 0x0F
|
||||||
|
|
||||||
|
if message_type == Message.MessageType.HANDSHAKE:
|
||||||
|
logger.debug(f'<<< HID HANDSHAKE: {Message.Handshake(param).name}')
|
||||||
|
self.emit('handshake', Message.Handshake(param))
|
||||||
|
elif message_type == Message.MessageType.DATA:
|
||||||
|
logger.debug('<<< HID CONTROL DATA')
|
||||||
|
self.emit('data', pdu)
|
||||||
|
elif message_type == Message.MessageType.CONTROL:
|
||||||
|
if param == Message.ControlCommand.SUSPEND:
|
||||||
|
logger.debug('<<< HID SUSPEND')
|
||||||
|
self.emit('suspend', pdu)
|
||||||
|
elif param == Message.ControlCommand.EXIT_SUSPEND:
|
||||||
|
logger.debug('<<< HID EXIT SUSPEND')
|
||||||
|
self.emit('exit_suspend', pdu)
|
||||||
|
elif param == Message.ControlCommand.VIRTUAL_CABLE_UNPLUG:
|
||||||
|
logger.debug('<<< HID VIRTUAL CABLE UNPLUG')
|
||||||
|
self.emit('virtual_cable_unplug')
|
||||||
|
else:
|
||||||
|
logger.debug('<<< HID CONTROL OPERATION UNSUPPORTED')
|
||||||
|
else:
|
||||||
|
logger.debug('<<< HID CONTROL DATA')
|
||||||
|
self.emit('data', pdu)
|
||||||
|
|
||||||
|
def on_intr_pdu(self, pdu: bytes) -> None:
|
||||||
|
logger.debug(f'<<< HID INTERRUPT PDU: {pdu.hex()}')
|
||||||
|
self.emit("data", pdu)
|
||||||
|
|
||||||
|
def get_report(self, report_type: int, report_id: int, buffer_size: int) -> None:
|
||||||
|
msg = GetReportMessage(
|
||||||
|
report_type=report_type, report_id=report_id, buffer_size=buffer_size
|
||||||
|
)
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL GET REPORT, PDU: {hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(hid_message)
|
||||||
|
|
||||||
|
def set_report(self, report_type: int, data: bytes):
|
||||||
|
msg = SetReportMessage(report_type=report_type, data=data)
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL SET REPORT, PDU:{hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(hid_message)
|
||||||
|
|
||||||
|
def get_protocol(self):
|
||||||
|
msg = GetProtocolMessage()
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL GET PROTOCOL, PDU: {hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(hid_message)
|
||||||
|
|
||||||
|
def set_protocol(self, protocol_mode: int):
|
||||||
|
msg = SetProtocolMessage(protocol_mode=protocol_mode)
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL SET PROTOCOL, PDU: {hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(hid_message)
|
||||||
|
|
||||||
|
def send_pdu_on_ctrl(self, msg: bytes) -> None:
|
||||||
|
self.l2cap_ctrl_channel.send_pdu(msg) # type: ignore
|
||||||
|
|
||||||
|
def send_pdu_on_intr(self, msg: bytes) -> None:
|
||||||
|
self.l2cap_intr_channel.send_pdu(msg) # type: ignore
|
||||||
|
|
||||||
|
def send_data(self, data):
|
||||||
|
msg = SendData(data)
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID INTERRUPT SEND DATA, PDU: {hid_message.hex()}')
|
||||||
|
self.send_pdu_on_intr(hid_message)
|
||||||
|
|
||||||
|
def suspend(self):
|
||||||
|
msg = Suspend()
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL SUSPEND, PDU:{hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(msg)
|
||||||
|
|
||||||
|
def exit_suspend(self):
|
||||||
|
msg = ExitSuspend()
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL EXIT SUSPEND, PDU:{hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(msg)
|
||||||
|
|
||||||
|
def virtual_cable_unplug(self):
|
||||||
|
msg = VirtualCableUnplug()
|
||||||
|
hid_message = bytes(msg)
|
||||||
|
logger.debug(f'>>> HID CONTROL VIRTUAL CABLE UNPLUG, PDU: {hid_message.hex()}')
|
||||||
|
self.send_pdu_on_ctrl(msg)
|
||||||
+58
-31
@@ -15,23 +15,24 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
import collections
|
import collections
|
||||||
import logging
|
import logging
|
||||||
import struct
|
import struct
|
||||||
|
|
||||||
|
from typing import Optional, TYPE_CHECKING, Dict, Callable, Awaitable
|
||||||
|
|
||||||
from bumble.colors import color
|
from bumble.colors import color
|
||||||
from bumble.l2cap import L2CAP_PDU
|
from bumble.l2cap import L2CAP_PDU
|
||||||
from bumble.snoop import Snooper
|
from bumble.snoop import Snooper
|
||||||
from bumble import drivers
|
from bumble import drivers
|
||||||
|
|
||||||
from typing import Optional
|
|
||||||
|
|
||||||
from .hci import (
|
from .hci import (
|
||||||
Address,
|
Address,
|
||||||
HCI_ACL_DATA_PACKET,
|
HCI_ACL_DATA_PACKET,
|
||||||
HCI_COMMAND_COMPLETE_EVENT,
|
|
||||||
HCI_COMMAND_PACKET,
|
HCI_COMMAND_PACKET,
|
||||||
|
HCI_COMMAND_COMPLETE_EVENT,
|
||||||
HCI_EVENT_PACKET,
|
HCI_EVENT_PACKET,
|
||||||
HCI_LE_READ_BUFFER_SIZE_COMMAND,
|
HCI_LE_READ_BUFFER_SIZE_COMMAND,
|
||||||
HCI_LE_READ_LOCAL_SUPPORTED_FEATURES_COMMAND,
|
HCI_LE_READ_LOCAL_SUPPORTED_FEATURES_COMMAND,
|
||||||
@@ -45,8 +46,11 @@ from .hci import (
|
|||||||
HCI_VERSION_BLUETOOTH_CORE_4_0,
|
HCI_VERSION_BLUETOOTH_CORE_4_0,
|
||||||
HCI_AclDataPacket,
|
HCI_AclDataPacket,
|
||||||
HCI_AclDataPacketAssembler,
|
HCI_AclDataPacketAssembler,
|
||||||
|
HCI_Command,
|
||||||
|
HCI_Command_Complete_Event,
|
||||||
HCI_Constant,
|
HCI_Constant,
|
||||||
HCI_Error,
|
HCI_Error,
|
||||||
|
HCI_Event,
|
||||||
HCI_LE_Long_Term_Key_Request_Negative_Reply_Command,
|
HCI_LE_Long_Term_Key_Request_Negative_Reply_Command,
|
||||||
HCI_LE_Long_Term_Key_Request_Reply_Command,
|
HCI_LE_Long_Term_Key_Request_Reply_Command,
|
||||||
HCI_LE_Read_Buffer_Size_Command,
|
HCI_LE_Read_Buffer_Size_Command,
|
||||||
@@ -63,16 +67,19 @@ from .hci import (
|
|||||||
HCI_Read_Local_Version_Information_Command,
|
HCI_Read_Local_Version_Information_Command,
|
||||||
HCI_Reset_Command,
|
HCI_Reset_Command,
|
||||||
HCI_Set_Event_Mask_Command,
|
HCI_Set_Event_Mask_Command,
|
||||||
map_null_terminated_utf8_string,
|
|
||||||
)
|
)
|
||||||
from .core import (
|
from .core import (
|
||||||
BT_BR_EDR_TRANSPORT,
|
BT_BR_EDR_TRANSPORT,
|
||||||
BT_CENTRAL_ROLE,
|
|
||||||
BT_LE_TRANSPORT,
|
BT_LE_TRANSPORT,
|
||||||
ConnectionPHY,
|
ConnectionPHY,
|
||||||
ConnectionParameters,
|
ConnectionParameters,
|
||||||
|
InvalidStateError,
|
||||||
)
|
)
|
||||||
from .utils import AbortableEventEmitter
|
from .utils import AbortableEventEmitter
|
||||||
|
from .transport.common import TransportLostError
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from .transport.common import TransportSink, TransportSource
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -96,27 +103,38 @@ HOST_HC_TOTAL_NUM_ACL_DATA_PACKETS = 1
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Connection:
|
class Connection:
|
||||||
def __init__(self, host, handle, peer_address, transport):
|
def __init__(self, host: Host, handle: int, peer_address: Address, transport: int):
|
||||||
self.host = host
|
self.host = host
|
||||||
self.handle = handle
|
self.handle = handle
|
||||||
self.peer_address = peer_address
|
self.peer_address = peer_address
|
||||||
self.assembler = HCI_AclDataPacketAssembler(self.on_acl_pdu)
|
self.assembler = HCI_AclDataPacketAssembler(self.on_acl_pdu)
|
||||||
self.transport = transport
|
self.transport = transport
|
||||||
|
|
||||||
def on_hci_acl_data_packet(self, packet):
|
def on_hci_acl_data_packet(self, packet: HCI_AclDataPacket) -> None:
|
||||||
self.assembler.feed_packet(packet)
|
self.assembler.feed_packet(packet)
|
||||||
|
|
||||||
def on_acl_pdu(self, pdu):
|
def on_acl_pdu(self, pdu: bytes) -> None:
|
||||||
l2cap_pdu = L2CAP_PDU.from_bytes(pdu)
|
l2cap_pdu = L2CAP_PDU.from_bytes(pdu)
|
||||||
self.host.on_l2cap_pdu(self, l2cap_pdu.cid, l2cap_pdu.payload)
|
self.host.on_l2cap_pdu(self, l2cap_pdu.cid, l2cap_pdu.payload)
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Host(AbortableEventEmitter):
|
class Host(AbortableEventEmitter):
|
||||||
def __init__(self, controller_source=None, controller_sink=None):
|
connections: Dict[int, Connection]
|
||||||
|
acl_packet_queue: collections.deque[HCI_AclDataPacket]
|
||||||
|
hci_sink: TransportSink
|
||||||
|
long_term_key_provider: Optional[
|
||||||
|
Callable[[int, bytes, int], Awaitable[Optional[bytes]]]
|
||||||
|
]
|
||||||
|
link_key_provider: Optional[Callable[[Address], Awaitable[Optional[bytes]]]]
|
||||||
|
|
||||||
|
def __init__(
|
||||||
|
self,
|
||||||
|
controller_source: Optional[TransportSource] = None,
|
||||||
|
controller_sink: Optional[TransportSink] = None,
|
||||||
|
) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
|
|
||||||
self.hci_sink = None
|
|
||||||
self.hci_metadata = None
|
self.hci_metadata = None
|
||||||
self.ready = False # True when we can accept incoming packets
|
self.ready = False # True when we can accept incoming packets
|
||||||
self.reset_done = False
|
self.reset_done = False
|
||||||
@@ -296,7 +314,7 @@ class Host(AbortableEventEmitter):
|
|||||||
self.reset_done = True
|
self.reset_done = True
|
||||||
|
|
||||||
@property
|
@property
|
||||||
def controller(self):
|
def controller(self) -> TransportSink:
|
||||||
return self.hci_sink
|
return self.hci_sink
|
||||||
|
|
||||||
@controller.setter
|
@controller.setter
|
||||||
@@ -305,13 +323,12 @@ class Host(AbortableEventEmitter):
|
|||||||
if controller:
|
if controller:
|
||||||
controller.set_packet_sink(self)
|
controller.set_packet_sink(self)
|
||||||
|
|
||||||
def set_packet_sink(self, sink):
|
def set_packet_sink(self, sink: TransportSink) -> None:
|
||||||
self.hci_sink = sink
|
self.hci_sink = sink
|
||||||
|
|
||||||
def send_hci_packet(self, packet):
|
def send_hci_packet(self, packet: HCI_Packet) -> None:
|
||||||
if self.snooper:
|
if self.snooper:
|
||||||
self.snooper.snoop(bytes(packet), Snooper.Direction.HOST_TO_CONTROLLER)
|
self.snooper.snoop(bytes(packet), Snooper.Direction.HOST_TO_CONTROLLER)
|
||||||
|
|
||||||
self.hci_sink.on_packet(bytes(packet))
|
self.hci_sink.on_packet(bytes(packet))
|
||||||
|
|
||||||
async def send_command(self, command, check_result=False):
|
async def send_command(self, command, check_result=False):
|
||||||
@@ -349,7 +366,7 @@ class Host(AbortableEventEmitter):
|
|||||||
return response
|
return response
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
logger.warning(
|
logger.warning(
|
||||||
f'{color("!!! Exception while sending HCI packet:", "red")} {error}'
|
f'{color("!!! Exception while sending command:", "red")} {error}'
|
||||||
)
|
)
|
||||||
raise error
|
raise error
|
||||||
finally:
|
finally:
|
||||||
@@ -357,13 +374,13 @@ class Host(AbortableEventEmitter):
|
|||||||
self.pending_response = None
|
self.pending_response = None
|
||||||
|
|
||||||
# Use this method to send a command from a task
|
# Use this method to send a command from a task
|
||||||
def send_command_sync(self, command):
|
def send_command_sync(self, command: HCI_Command) -> None:
|
||||||
async def send_command(command):
|
async def send_command(command: HCI_Command) -> None:
|
||||||
await self.send_command(command)
|
await self.send_command(command)
|
||||||
|
|
||||||
asyncio.create_task(send_command(command))
|
asyncio.create_task(send_command(command))
|
||||||
|
|
||||||
def send_l2cap_pdu(self, connection_handle, cid, pdu):
|
def send_l2cap_pdu(self, connection_handle: int, cid: int, pdu: bytes) -> None:
|
||||||
l2cap_pdu = bytes(L2CAP_PDU(cid, pdu))
|
l2cap_pdu = bytes(L2CAP_PDU(cid, pdu))
|
||||||
|
|
||||||
# Send the data to the controller via ACL packets
|
# Send the data to the controller via ACL packets
|
||||||
@@ -388,7 +405,7 @@ class Host(AbortableEventEmitter):
|
|||||||
offset += data_total_length
|
offset += data_total_length
|
||||||
bytes_remaining -= data_total_length
|
bytes_remaining -= data_total_length
|
||||||
|
|
||||||
def queue_acl_packet(self, acl_packet):
|
def queue_acl_packet(self, acl_packet: HCI_AclDataPacket) -> None:
|
||||||
self.acl_packet_queue.appendleft(acl_packet)
|
self.acl_packet_queue.appendleft(acl_packet)
|
||||||
self.check_acl_packet_queue()
|
self.check_acl_packet_queue()
|
||||||
|
|
||||||
@@ -398,7 +415,7 @@ class Host(AbortableEventEmitter):
|
|||||||
f'{len(self.acl_packet_queue)} in queue'
|
f'{len(self.acl_packet_queue)} in queue'
|
||||||
)
|
)
|
||||||
|
|
||||||
def check_acl_packet_queue(self):
|
def check_acl_packet_queue(self) -> None:
|
||||||
# Send all we can (TODO: support different LE/Classic limits)
|
# Send all we can (TODO: support different LE/Classic limits)
|
||||||
while (
|
while (
|
||||||
len(self.acl_packet_queue) > 0
|
len(self.acl_packet_queue) > 0
|
||||||
@@ -444,47 +461,53 @@ class Host(AbortableEventEmitter):
|
|||||||
]
|
]
|
||||||
|
|
||||||
# Packet Sink protocol (packets coming from the controller via HCI)
|
# Packet Sink protocol (packets coming from the controller via HCI)
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
hci_packet = HCI_Packet.from_bytes(packet)
|
hci_packet = HCI_Packet.from_bytes(packet)
|
||||||
if self.ready or (
|
if self.ready or (
|
||||||
hci_packet.hci_packet_type == HCI_EVENT_PACKET
|
isinstance(hci_packet, HCI_Command_Complete_Event)
|
||||||
and hci_packet.event_code == HCI_COMMAND_COMPLETE_EVENT
|
|
||||||
and hci_packet.command_opcode == HCI_RESET_COMMAND
|
and hci_packet.command_opcode == HCI_RESET_COMMAND
|
||||||
):
|
):
|
||||||
self.on_hci_packet(hci_packet)
|
self.on_hci_packet(hci_packet)
|
||||||
else:
|
else:
|
||||||
logger.debug('reset not done, ignoring packet from controller')
|
logger.debug('reset not done, ignoring packet from controller')
|
||||||
|
|
||||||
def on_hci_packet(self, packet):
|
def on_transport_lost(self):
|
||||||
|
# Called by the source when the transport has been lost.
|
||||||
|
if self.pending_response:
|
||||||
|
self.pending_response.set_exception(TransportLostError('transport lost'))
|
||||||
|
|
||||||
|
self.emit('flush')
|
||||||
|
|
||||||
|
def on_hci_packet(self, packet: HCI_Packet) -> None:
|
||||||
logger.debug(f'{color("### CONTROLLER -> HOST", "green")}: {packet}')
|
logger.debug(f'{color("### CONTROLLER -> HOST", "green")}: {packet}')
|
||||||
|
|
||||||
if self.snooper:
|
if self.snooper:
|
||||||
self.snooper.snoop(bytes(packet), Snooper.Direction.CONTROLLER_TO_HOST)
|
self.snooper.snoop(bytes(packet), Snooper.Direction.CONTROLLER_TO_HOST)
|
||||||
|
|
||||||
# If the packet is a command, invoke the handler for this packet
|
# If the packet is a command, invoke the handler for this packet
|
||||||
if packet.hci_packet_type == HCI_COMMAND_PACKET:
|
if isinstance(packet, HCI_Command):
|
||||||
self.on_hci_command_packet(packet)
|
self.on_hci_command_packet(packet)
|
||||||
elif packet.hci_packet_type == HCI_EVENT_PACKET:
|
elif isinstance(packet, HCI_Event):
|
||||||
self.on_hci_event_packet(packet)
|
self.on_hci_event_packet(packet)
|
||||||
elif packet.hci_packet_type == HCI_ACL_DATA_PACKET:
|
elif isinstance(packet, HCI_AclDataPacket):
|
||||||
self.on_hci_acl_data_packet(packet)
|
self.on_hci_acl_data_packet(packet)
|
||||||
else:
|
else:
|
||||||
logger.warning(f'!!! unknown packet type {packet.hci_packet_type}')
|
logger.warning(f'!!! unknown packet type {packet.hci_packet_type}')
|
||||||
|
|
||||||
def on_hci_command_packet(self, command):
|
def on_hci_command_packet(self, command: HCI_Command) -> None:
|
||||||
logger.warning(f'!!! unexpected command packet: {command}')
|
logger.warning(f'!!! unexpected command packet: {command}')
|
||||||
|
|
||||||
def on_hci_event_packet(self, event):
|
def on_hci_event_packet(self, event: HCI_Event) -> None:
|
||||||
handler_name = f'on_{event.name.lower()}'
|
handler_name = f'on_{event.name.lower()}'
|
||||||
handler = getattr(self, handler_name, self.on_hci_event)
|
handler = getattr(self, handler_name, self.on_hci_event)
|
||||||
handler(event)
|
handler(event)
|
||||||
|
|
||||||
def on_hci_acl_data_packet(self, packet):
|
def on_hci_acl_data_packet(self, packet: HCI_AclDataPacket) -> None:
|
||||||
# Look for the connection to which this data belongs
|
# Look for the connection to which this data belongs
|
||||||
if connection := self.connections.get(packet.connection_handle):
|
if connection := self.connections.get(packet.connection_handle):
|
||||||
connection.on_hci_acl_data_packet(packet)
|
connection.on_hci_acl_data_packet(packet)
|
||||||
|
|
||||||
def on_l2cap_pdu(self, connection, cid, pdu):
|
def on_l2cap_pdu(self, connection: Connection, cid: int, pdu: bytes) -> None:
|
||||||
self.emit('l2cap_pdu', connection.handle, cid, pdu)
|
self.emit('l2cap_pdu', connection.handle, cid, pdu)
|
||||||
|
|
||||||
def on_command_processed(self, event):
|
def on_command_processed(self, event):
|
||||||
@@ -822,6 +845,10 @@ class Host(AbortableEventEmitter):
|
|||||||
f'simple pairing complete for {event.bd_addr}: '
|
f'simple pairing complete for {event.bd_addr}: '
|
||||||
f'status={HCI_Constant.status_name(event.status)}'
|
f'status={HCI_Constant.status_name(event.status)}'
|
||||||
)
|
)
|
||||||
|
if event.status == HCI_SUCCESS:
|
||||||
|
self.emit('classic_pairing', event.bd_addr)
|
||||||
|
else:
|
||||||
|
self.emit('classic_pairing_failure', event.bd_addr, event.status)
|
||||||
|
|
||||||
def on_hci_pin_code_request_event(self, event):
|
def on_hci_pin_code_request_event(self, event):
|
||||||
self.emit('pin_code_request', event.bd_addr)
|
self.emit('pin_code_request', event.bd_addr)
|
||||||
|
|||||||
+694
-359
File diff suppressed because it is too large
Load Diff
@@ -19,6 +19,7 @@ import enum
|
|||||||
from typing import Optional, Tuple
|
from typing import Optional, Tuple
|
||||||
|
|
||||||
from .hci import (
|
from .hci import (
|
||||||
|
Address,
|
||||||
HCI_NO_INPUT_NO_OUTPUT_IO_CAPABILITY,
|
HCI_NO_INPUT_NO_OUTPUT_IO_CAPABILITY,
|
||||||
HCI_DISPLAY_ONLY_IO_CAPABILITY,
|
HCI_DISPLAY_ONLY_IO_CAPABILITY,
|
||||||
HCI_DISPLAY_YES_NO_IO_CAPABILITY,
|
HCI_DISPLAY_YES_NO_IO_CAPABILITY,
|
||||||
@@ -168,21 +169,28 @@ class PairingDelegate:
|
|||||||
class PairingConfig:
|
class PairingConfig:
|
||||||
"""Configuration for the Pairing protocol."""
|
"""Configuration for the Pairing protocol."""
|
||||||
|
|
||||||
|
class AddressType(enum.IntEnum):
|
||||||
|
PUBLIC = Address.PUBLIC_DEVICE_ADDRESS
|
||||||
|
RANDOM = Address.RANDOM_DEVICE_ADDRESS
|
||||||
|
|
||||||
def __init__(
|
def __init__(
|
||||||
self,
|
self,
|
||||||
sc: bool = True,
|
sc: bool = True,
|
||||||
mitm: bool = True,
|
mitm: bool = True,
|
||||||
bonding: bool = True,
|
bonding: bool = True,
|
||||||
delegate: Optional[PairingDelegate] = None,
|
delegate: Optional[PairingDelegate] = None,
|
||||||
|
identity_address_type: Optional[AddressType] = None,
|
||||||
) -> None:
|
) -> None:
|
||||||
self.sc = sc
|
self.sc = sc
|
||||||
self.mitm = mitm
|
self.mitm = mitm
|
||||||
self.bonding = bonding
|
self.bonding = bonding
|
||||||
self.delegate = delegate or PairingDelegate()
|
self.delegate = delegate or PairingDelegate()
|
||||||
|
self.identity_address_type = identity_address_type
|
||||||
|
|
||||||
def __str__(self) -> str:
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'PairingConfig(sc={self.sc}, '
|
f'PairingConfig(sc={self.sc}, '
|
||||||
f'mitm={self.mitm}, bonding={self.bonding}, '
|
f'mitm={self.mitm}, bonding={self.bonding}, '
|
||||||
|
f'identity_address_type={self.identity_address_type}, '
|
||||||
f'delegate[{self.delegate.io_capability}])'
|
f'delegate[{self.delegate.io_capability}])'
|
||||||
)
|
)
|
||||||
|
|||||||
@@ -26,11 +26,13 @@ from .config import Config
|
|||||||
from .device import PandoraDevice
|
from .device import PandoraDevice
|
||||||
from .host import HostService
|
from .host import HostService
|
||||||
from .security import SecurityService, SecurityStorageService
|
from .security import SecurityService, SecurityStorageService
|
||||||
|
from .l2cap import L2CAPService
|
||||||
from pandora.host_grpc_aio import add_HostServicer_to_server
|
from pandora.host_grpc_aio import add_HostServicer_to_server
|
||||||
from pandora.security_grpc_aio import (
|
from pandora.security_grpc_aio import (
|
||||||
add_SecurityServicer_to_server,
|
add_SecurityServicer_to_server,
|
||||||
add_SecurityStorageServicer_to_server,
|
add_SecurityStorageServicer_to_server,
|
||||||
)
|
)
|
||||||
|
from pandora.l2cap_grpc_aio import add_L2CAPServicer_to_server
|
||||||
from typing import Callable, List, Optional
|
from typing import Callable, List, Optional
|
||||||
|
|
||||||
# public symbols
|
# public symbols
|
||||||
@@ -77,6 +79,7 @@ async def serve(
|
|||||||
add_SecurityStorageServicer_to_server(
|
add_SecurityStorageServicer_to_server(
|
||||||
SecurityStorageService(bumble.device, config), server
|
SecurityStorageService(bumble.device, config), server
|
||||||
)
|
)
|
||||||
|
add_L2CAPServicer_to_server(L2CAPService(bumble.device, config), server)
|
||||||
|
|
||||||
# call hooks if any.
|
# call hooks if any.
|
||||||
for hook in _SERVICERS_HOOKS:
|
for hook in _SERVICERS_HOOKS:
|
||||||
|
|||||||
@@ -12,7 +12,8 @@
|
|||||||
# See the License for the specific language governing permissions and
|
# See the License for the specific language governing permissions and
|
||||||
# limitations under the License.
|
# limitations under the License.
|
||||||
|
|
||||||
from bumble.pairing import PairingDelegate
|
from __future__ import annotations
|
||||||
|
from bumble.pairing import PairingConfig, PairingDelegate
|
||||||
from dataclasses import dataclass
|
from dataclasses import dataclass
|
||||||
from typing import Any, Dict
|
from typing import Any, Dict
|
||||||
|
|
||||||
@@ -20,6 +21,7 @@ from typing import Any, Dict
|
|||||||
@dataclass
|
@dataclass
|
||||||
class Config:
|
class Config:
|
||||||
io_capability: PairingDelegate.IoCapability = PairingDelegate.NO_OUTPUT_NO_INPUT
|
io_capability: PairingDelegate.IoCapability = PairingDelegate.NO_OUTPUT_NO_INPUT
|
||||||
|
identity_address_type: PairingConfig.AddressType = PairingConfig.AddressType.RANDOM
|
||||||
pairing_sc_enable: bool = True
|
pairing_sc_enable: bool = True
|
||||||
pairing_mitm_enable: bool = True
|
pairing_mitm_enable: bool = True
|
||||||
pairing_bonding_enable: bool = True
|
pairing_bonding_enable: bool = True
|
||||||
@@ -35,6 +37,12 @@ class Config:
|
|||||||
'io_capability', 'no_output_no_input'
|
'io_capability', 'no_output_no_input'
|
||||||
).upper()
|
).upper()
|
||||||
self.io_capability = getattr(PairingDelegate, io_capability_name)
|
self.io_capability = getattr(PairingDelegate, io_capability_name)
|
||||||
|
identity_address_type_name: str = config.get(
|
||||||
|
'identity_address_type', 'random'
|
||||||
|
).upper()
|
||||||
|
self.identity_address_type = getattr(
|
||||||
|
PairingConfig.AddressType, identity_address_type_name
|
||||||
|
)
|
||||||
self.pairing_sc_enable = config.get('pairing_sc_enable', True)
|
self.pairing_sc_enable = config.get('pairing_sc_enable', True)
|
||||||
self.pairing_mitm_enable = config.get('pairing_mitm_enable', True)
|
self.pairing_mitm_enable = config.get('pairing_mitm_enable', True)
|
||||||
self.pairing_bonding_enable = config.get('pairing_bonding_enable', True)
|
self.pairing_bonding_enable = config.get('pairing_bonding_enable', True)
|
||||||
|
|||||||
@@ -14,6 +14,7 @@
|
|||||||
|
|
||||||
"""Generic & dependency free Bumble (reference) device."""
|
"""Generic & dependency free Bumble (reference) device."""
|
||||||
|
|
||||||
|
from __future__ import annotations
|
||||||
from bumble import transport
|
from bumble import transport
|
||||||
from bumble.core import (
|
from bumble.core import (
|
||||||
BT_GENERIC_AUDIO_SERVICE,
|
BT_GENERIC_AUDIO_SERVICE,
|
||||||
@@ -34,6 +35,10 @@ from bumble.sdp import (
|
|||||||
from typing import Any, Dict, List, Optional
|
from typing import Any, Dict, List, Optional
|
||||||
|
|
||||||
|
|
||||||
|
# Default rootcanal HCI TCP address
|
||||||
|
ROOTCANAL_HCI_ADDRESS = "localhost:6402"
|
||||||
|
|
||||||
|
|
||||||
class PandoraDevice:
|
class PandoraDevice:
|
||||||
"""
|
"""
|
||||||
Small wrapper around a Bumble device and it's HCI transport.
|
Small wrapper around a Bumble device and it's HCI transport.
|
||||||
@@ -53,7 +58,9 @@ class PandoraDevice:
|
|||||||
def __init__(self, config: Dict[str, Any]) -> None:
|
def __init__(self, config: Dict[str, Any]) -> None:
|
||||||
self.config = config
|
self.config = config
|
||||||
self.device = _make_device(config)
|
self.device = _make_device(config)
|
||||||
self._hci_name = config.get('transport', '')
|
self._hci_name = config.get(
|
||||||
|
'transport', f"tcp-client:{config.get('tcp', ROOTCANAL_HCI_ADDRESS)}"
|
||||||
|
)
|
||||||
self._hci = None
|
self._hci = None
|
||||||
|
|
||||||
@property
|
@property
|
||||||
|
|||||||
+25
-24
@@ -12,6 +12,7 @@
|
|||||||
# See the License for the specific language governing permissions and
|
# See the License for the specific language governing permissions and
|
||||||
# limitations under the License.
|
# limitations under the License.
|
||||||
|
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
import bumble.device
|
import bumble.device
|
||||||
import grpc
|
import grpc
|
||||||
@@ -112,7 +113,7 @@ class HostService(HostServicer):
|
|||||||
async def FactoryReset(
|
async def FactoryReset(
|
||||||
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
self.log.info('FactoryReset')
|
self.log.debug('FactoryReset')
|
||||||
|
|
||||||
# delete all bonds
|
# delete all bonds
|
||||||
if self.device.keystore is not None:
|
if self.device.keystore is not None:
|
||||||
@@ -126,7 +127,7 @@ class HostService(HostServicer):
|
|||||||
async def Reset(
|
async def Reset(
|
||||||
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
self.log.info('Reset')
|
self.log.debug('Reset')
|
||||||
|
|
||||||
# clear service.
|
# clear service.
|
||||||
self.waited_connections.clear()
|
self.waited_connections.clear()
|
||||||
@@ -139,7 +140,7 @@ class HostService(HostServicer):
|
|||||||
async def ReadLocalAddress(
|
async def ReadLocalAddress(
|
||||||
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
||||||
) -> ReadLocalAddressResponse:
|
) -> ReadLocalAddressResponse:
|
||||||
self.log.info('ReadLocalAddress')
|
self.log.debug('ReadLocalAddress')
|
||||||
return ReadLocalAddressResponse(
|
return ReadLocalAddressResponse(
|
||||||
address=bytes(reversed(bytes(self.device.public_address)))
|
address=bytes(reversed(bytes(self.device.public_address)))
|
||||||
)
|
)
|
||||||
@@ -152,7 +153,7 @@ class HostService(HostServicer):
|
|||||||
address = Address(
|
address = Address(
|
||||||
bytes(reversed(request.address)), address_type=Address.PUBLIC_DEVICE_ADDRESS
|
bytes(reversed(request.address)), address_type=Address.PUBLIC_DEVICE_ADDRESS
|
||||||
)
|
)
|
||||||
self.log.info(f"Connect to {address}")
|
self.log.debug(f"Connect to {address}")
|
||||||
|
|
||||||
try:
|
try:
|
||||||
connection = await self.device.connect(
|
connection = await self.device.connect(
|
||||||
@@ -167,7 +168,7 @@ class HostService(HostServicer):
|
|||||||
return ConnectResponse(connection_already_exists=empty_pb2.Empty())
|
return ConnectResponse(connection_already_exists=empty_pb2.Empty())
|
||||||
raise e
|
raise e
|
||||||
|
|
||||||
self.log.info(f"Connect to {address} done (handle={connection.handle})")
|
self.log.debug(f"Connect to {address} done (handle={connection.handle})")
|
||||||
|
|
||||||
cookie = any_pb2.Any(value=connection.handle.to_bytes(4, 'big'))
|
cookie = any_pb2.Any(value=connection.handle.to_bytes(4, 'big'))
|
||||||
return ConnectResponse(connection=Connection(cookie=cookie))
|
return ConnectResponse(connection=Connection(cookie=cookie))
|
||||||
@@ -186,7 +187,7 @@ class HostService(HostServicer):
|
|||||||
if address in (Address.NIL, Address.ANY):
|
if address in (Address.NIL, Address.ANY):
|
||||||
raise ValueError('Invalid address')
|
raise ValueError('Invalid address')
|
||||||
|
|
||||||
self.log.info(f"WaitConnection from {address}...")
|
self.log.debug(f"WaitConnection from {address}...")
|
||||||
|
|
||||||
connection = self.device.find_connection_by_bd_addr(
|
connection = self.device.find_connection_by_bd_addr(
|
||||||
address, transport=BT_BR_EDR_TRANSPORT
|
address, transport=BT_BR_EDR_TRANSPORT
|
||||||
@@ -201,7 +202,7 @@ class HostService(HostServicer):
|
|||||||
# save connection has waited and respond.
|
# save connection has waited and respond.
|
||||||
self.waited_connections.add(id(connection))
|
self.waited_connections.add(id(connection))
|
||||||
|
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"WaitConnection from {address} done (handle={connection.handle})"
|
f"WaitConnection from {address} done (handle={connection.handle})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -216,7 +217,7 @@ class HostService(HostServicer):
|
|||||||
if address in (Address.NIL, Address.ANY):
|
if address in (Address.NIL, Address.ANY):
|
||||||
raise ValueError('Invalid address')
|
raise ValueError('Invalid address')
|
||||||
|
|
||||||
self.log.info(f"ConnectLE to {address}...")
|
self.log.debug(f"ConnectLE to {address}...")
|
||||||
|
|
||||||
try:
|
try:
|
||||||
connection = await self.device.connect(
|
connection = await self.device.connect(
|
||||||
@@ -233,7 +234,7 @@ class HostService(HostServicer):
|
|||||||
return ConnectLEResponse(connection_already_exists=empty_pb2.Empty())
|
return ConnectLEResponse(connection_already_exists=empty_pb2.Empty())
|
||||||
raise e
|
raise e
|
||||||
|
|
||||||
self.log.info(f"ConnectLE to {address} done (handle={connection.handle})")
|
self.log.debug(f"ConnectLE to {address} done (handle={connection.handle})")
|
||||||
|
|
||||||
cookie = any_pb2.Any(value=connection.handle.to_bytes(4, 'big'))
|
cookie = any_pb2.Any(value=connection.handle.to_bytes(4, 'big'))
|
||||||
return ConnectLEResponse(connection=Connection(cookie=cookie))
|
return ConnectLEResponse(connection=Connection(cookie=cookie))
|
||||||
@@ -243,12 +244,12 @@ class HostService(HostServicer):
|
|||||||
self, request: DisconnectRequest, context: grpc.ServicerContext
|
self, request: DisconnectRequest, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
self.log.info(f"Disconnect: {connection_handle}")
|
self.log.debug(f"Disconnect: {connection_handle}")
|
||||||
|
|
||||||
self.log.info("Disconnecting...")
|
self.log.debug("Disconnecting...")
|
||||||
if connection := self.device.lookup_connection(connection_handle):
|
if connection := self.device.lookup_connection(connection_handle):
|
||||||
await connection.disconnect(HCI_REMOTE_USER_TERMINATED_CONNECTION_ERROR)
|
await connection.disconnect(HCI_REMOTE_USER_TERMINATED_CONNECTION_ERROR)
|
||||||
self.log.info("Disconnected")
|
self.log.debug("Disconnected")
|
||||||
|
|
||||||
return empty_pb2.Empty()
|
return empty_pb2.Empty()
|
||||||
|
|
||||||
@@ -257,7 +258,7 @@ class HostService(HostServicer):
|
|||||||
self, request: WaitDisconnectionRequest, context: grpc.ServicerContext
|
self, request: WaitDisconnectionRequest, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
self.log.info(f"WaitDisconnection: {connection_handle}")
|
self.log.debug(f"WaitDisconnection: {connection_handle}")
|
||||||
|
|
||||||
if connection := self.device.lookup_connection(connection_handle):
|
if connection := self.device.lookup_connection(connection_handle):
|
||||||
disconnection_future: asyncio.Future[
|
disconnection_future: asyncio.Future[
|
||||||
@@ -270,7 +271,7 @@ class HostService(HostServicer):
|
|||||||
connection.on('disconnection', on_disconnection)
|
connection.on('disconnection', on_disconnection)
|
||||||
try:
|
try:
|
||||||
await disconnection_future
|
await disconnection_future
|
||||||
self.log.info("Disconnected")
|
self.log.debug("Disconnected")
|
||||||
finally:
|
finally:
|
||||||
connection.remove_listener('disconnection', on_disconnection) # type: ignore
|
connection.remove_listener('disconnection', on_disconnection) # type: ignore
|
||||||
|
|
||||||
@@ -378,7 +379,7 @@ class HostService(HostServicer):
|
|||||||
try:
|
try:
|
||||||
while True:
|
while True:
|
||||||
if not self.device.is_advertising:
|
if not self.device.is_advertising:
|
||||||
self.log.info('Advertise')
|
self.log.debug('Advertise')
|
||||||
await self.device.start_advertising(
|
await self.device.start_advertising(
|
||||||
target=target,
|
target=target,
|
||||||
advertising_type=advertising_type,
|
advertising_type=advertising_type,
|
||||||
@@ -393,10 +394,10 @@ class HostService(HostServicer):
|
|||||||
bumble.device.Connection
|
bumble.device.Connection
|
||||||
] = asyncio.get_running_loop().create_future()
|
] = asyncio.get_running_loop().create_future()
|
||||||
|
|
||||||
self.log.info('Wait for LE connection...')
|
self.log.debug('Wait for LE connection...')
|
||||||
connection = await pending_connection
|
connection = await pending_connection
|
||||||
|
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Advertise: Connected to {connection.peer_address} (handle={connection.handle})"
|
f"Advertise: Connected to {connection.peer_address} (handle={connection.handle})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -410,7 +411,7 @@ class HostService(HostServicer):
|
|||||||
self.device.remove_listener('connection', on_connection) # type: ignore
|
self.device.remove_listener('connection', on_connection) # type: ignore
|
||||||
|
|
||||||
try:
|
try:
|
||||||
self.log.info('Stop advertising')
|
self.log.debug('Stop advertising')
|
||||||
await self.device.abort_on('flush', self.device.stop_advertising())
|
await self.device.abort_on('flush', self.device.stop_advertising())
|
||||||
except:
|
except:
|
||||||
pass
|
pass
|
||||||
@@ -423,7 +424,7 @@ class HostService(HostServicer):
|
|||||||
if request.phys:
|
if request.phys:
|
||||||
raise NotImplementedError("TODO: add support for `request.phys`")
|
raise NotImplementedError("TODO: add support for `request.phys`")
|
||||||
|
|
||||||
self.log.info('Scan')
|
self.log.debug('Scan')
|
||||||
|
|
||||||
scan_queue: asyncio.Queue[Advertisement] = asyncio.Queue()
|
scan_queue: asyncio.Queue[Advertisement] = asyncio.Queue()
|
||||||
handler = self.device.on('advertisement', scan_queue.put_nowait)
|
handler = self.device.on('advertisement', scan_queue.put_nowait)
|
||||||
@@ -470,7 +471,7 @@ class HostService(HostServicer):
|
|||||||
finally:
|
finally:
|
||||||
self.device.remove_listener('advertisement', handler) # type: ignore
|
self.device.remove_listener('advertisement', handler) # type: ignore
|
||||||
try:
|
try:
|
||||||
self.log.info('Stop scanning')
|
self.log.debug('Stop scanning')
|
||||||
await self.device.abort_on('flush', self.device.stop_scanning())
|
await self.device.abort_on('flush', self.device.stop_scanning())
|
||||||
except:
|
except:
|
||||||
pass
|
pass
|
||||||
@@ -479,7 +480,7 @@ class HostService(HostServicer):
|
|||||||
async def Inquiry(
|
async def Inquiry(
|
||||||
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
self, request: empty_pb2.Empty, context: grpc.ServicerContext
|
||||||
) -> AsyncGenerator[InquiryResponse, None]:
|
) -> AsyncGenerator[InquiryResponse, None]:
|
||||||
self.log.info('Inquiry')
|
self.log.debug('Inquiry')
|
||||||
|
|
||||||
inquiry_queue: asyncio.Queue[
|
inquiry_queue: asyncio.Queue[
|
||||||
Optional[Tuple[Address, int, AdvertisingData, int]]
|
Optional[Tuple[Address, int, AdvertisingData, int]]
|
||||||
@@ -510,7 +511,7 @@ class HostService(HostServicer):
|
|||||||
self.device.remove_listener('inquiry_complete', complete_handler) # type: ignore
|
self.device.remove_listener('inquiry_complete', complete_handler) # type: ignore
|
||||||
self.device.remove_listener('inquiry_result', result_handler) # type: ignore
|
self.device.remove_listener('inquiry_result', result_handler) # type: ignore
|
||||||
try:
|
try:
|
||||||
self.log.info('Stop inquiry')
|
self.log.debug('Stop inquiry')
|
||||||
await self.device.abort_on('flush', self.device.stop_discovery())
|
await self.device.abort_on('flush', self.device.stop_discovery())
|
||||||
except:
|
except:
|
||||||
pass
|
pass
|
||||||
@@ -519,7 +520,7 @@ class HostService(HostServicer):
|
|||||||
async def SetDiscoverabilityMode(
|
async def SetDiscoverabilityMode(
|
||||||
self, request: SetDiscoverabilityModeRequest, context: grpc.ServicerContext
|
self, request: SetDiscoverabilityModeRequest, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
self.log.info("SetDiscoverabilityMode")
|
self.log.debug("SetDiscoverabilityMode")
|
||||||
await self.device.set_discoverable(request.mode != NOT_DISCOVERABLE)
|
await self.device.set_discoverable(request.mode != NOT_DISCOVERABLE)
|
||||||
return empty_pb2.Empty()
|
return empty_pb2.Empty()
|
||||||
|
|
||||||
@@ -527,7 +528,7 @@ class HostService(HostServicer):
|
|||||||
async def SetConnectabilityMode(
|
async def SetConnectabilityMode(
|
||||||
self, request: SetConnectabilityModeRequest, context: grpc.ServicerContext
|
self, request: SetConnectabilityModeRequest, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
self.log.info("SetConnectabilityMode")
|
self.log.debug("SetConnectabilityMode")
|
||||||
await self.device.set_connectable(request.mode != NOT_CONNECTABLE)
|
await self.device.set_connectable(request.mode != NOT_CONNECTABLE)
|
||||||
return empty_pb2.Empty()
|
return empty_pb2.Empty()
|
||||||
|
|
||||||
|
|||||||
@@ -0,0 +1,289 @@
|
|||||||
|
# Copyright 2023 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.
|
||||||
|
|
||||||
|
import asyncio
|
||||||
|
import dataclasses
|
||||||
|
import grpc
|
||||||
|
import struct
|
||||||
|
|
||||||
|
from bumble import device
|
||||||
|
from bumble import l2cap
|
||||||
|
from bumble.pandora import config
|
||||||
|
from bumble.pandora import utils
|
||||||
|
from bumble.utils import EventWatcher
|
||||||
|
from google.protobuf import any_pb2 # pytype: disable=pyi-error
|
||||||
|
from google.protobuf import empty_pb2 # pytype: disable=pyi-error
|
||||||
|
from pandora import l2cap_pb2
|
||||||
|
from pandora import l2cap_grpc_aio
|
||||||
|
from typing import Any, AsyncGenerator, AsyncIterator, Dict, List, Union
|
||||||
|
|
||||||
|
|
||||||
|
@dataclasses.dataclass
|
||||||
|
class ChannelProxy:
|
||||||
|
channel: Union[l2cap.ClassicChannel, l2cap.LeCreditBasedChannel, None]
|
||||||
|
|
||||||
|
def __post_init__(self) -> None:
|
||||||
|
assert self.channel
|
||||||
|
self.rx: asyncio.Queue[bytes] = asyncio.Queue()
|
||||||
|
self._disconnection_result: asyncio.Future[None] = asyncio.Future()
|
||||||
|
self.channel.sink = self.rx.put_nowait
|
||||||
|
|
||||||
|
def on_close() -> None:
|
||||||
|
assert not self._disconnection_result.done()
|
||||||
|
self.channel = None
|
||||||
|
self._disconnection_result.set_result(None)
|
||||||
|
|
||||||
|
self.channel.on('close', on_close)
|
||||||
|
|
||||||
|
def send(self, data: bytes) -> None:
|
||||||
|
assert self.channel
|
||||||
|
if isinstance(self.channel, l2cap.ClassicChannel):
|
||||||
|
self.channel.send_pdu(data)
|
||||||
|
else:
|
||||||
|
self.channel.write(data)
|
||||||
|
|
||||||
|
async def disconnect(self) -> None:
|
||||||
|
assert self.channel
|
||||||
|
await self.channel.disconnect()
|
||||||
|
|
||||||
|
async def wait_disconnect(self) -> None:
|
||||||
|
await self._disconnection_result
|
||||||
|
assert not self.channel
|
||||||
|
|
||||||
|
|
||||||
|
@dataclasses.dataclass
|
||||||
|
class ChannelIndex:
|
||||||
|
connection_handle: int
|
||||||
|
cid: int
|
||||||
|
|
||||||
|
@classmethod
|
||||||
|
def from_token(cls, token: l2cap_pb2.Channel) -> 'ChannelIndex':
|
||||||
|
connection_handle, cid = struct.unpack('>HH', token.cookie.value)
|
||||||
|
return cls(connection_handle, cid)
|
||||||
|
|
||||||
|
def into_token(self) -> l2cap_pb2.Channel:
|
||||||
|
return l2cap_pb2.Channel(
|
||||||
|
cookie=any_pb2.Any(
|
||||||
|
value=struct.pack('>HH', self.connection_handle, self.cid)
|
||||||
|
)
|
||||||
|
)
|
||||||
|
|
||||||
|
def __hash__(self):
|
||||||
|
return hash(self.connection_handle | (self.cid << 12))
|
||||||
|
|
||||||
|
|
||||||
|
class L2CAPService(l2cap_grpc_aio.L2CAPServicer):
|
||||||
|
channels: Dict[ChannelIndex, ChannelProxy] = {}
|
||||||
|
pending: List[l2cap.IncomingConnection.Any] = []
|
||||||
|
accepts: List[asyncio.Queue[l2cap.IncomingConnection.Any]] = []
|
||||||
|
|
||||||
|
def __init__(self, dev: device.Device, config: config.Config) -> None:
|
||||||
|
self.device = dev
|
||||||
|
self.config = config
|
||||||
|
|
||||||
|
def on_connection(incoming: l2cap.IncomingConnection.Any) -> None:
|
||||||
|
self.pending.append(incoming)
|
||||||
|
for acceptor in self.accepts:
|
||||||
|
acceptor.put_nowait(incoming)
|
||||||
|
|
||||||
|
# Make sure our listener is called before the builtins ones.
|
||||||
|
self.device.l2cap_channel_manager.listeners.insert(0, on_connection)
|
||||||
|
|
||||||
|
def register(self, index: ChannelIndex, proxy: ChannelProxy) -> None:
|
||||||
|
self.channels[index] = proxy
|
||||||
|
|
||||||
|
def on_close(*_: Any) -> None:
|
||||||
|
# TODO: Fix Bumble L2CAP which emit `close` event twice.
|
||||||
|
if index in self.channels:
|
||||||
|
del self.channels[index]
|
||||||
|
|
||||||
|
# Listen for disconnection.
|
||||||
|
assert proxy.channel
|
||||||
|
proxy.channel.on('close', on_close)
|
||||||
|
|
||||||
|
async def listen(self) -> AsyncIterator[l2cap.IncomingConnection.Any]:
|
||||||
|
for incoming in self.pending:
|
||||||
|
if incoming.future.done():
|
||||||
|
self.pending.remove(incoming)
|
||||||
|
continue
|
||||||
|
yield incoming
|
||||||
|
queue: asyncio.Queue[l2cap.IncomingConnection.Any] = asyncio.Queue()
|
||||||
|
self.accepts.append(queue)
|
||||||
|
try:
|
||||||
|
while incoming := await queue.get():
|
||||||
|
yield incoming
|
||||||
|
finally:
|
||||||
|
self.accepts.remove(queue)
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def Connect(
|
||||||
|
self, request: l2cap_pb2.ConnectRequest, context: grpc.ServicerContext
|
||||||
|
) -> l2cap_pb2.ConnectResponse:
|
||||||
|
# Retrieve Bumble `Connection` from request.
|
||||||
|
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
|
connection = self.device.lookup_connection(connection_handle)
|
||||||
|
if connection is None:
|
||||||
|
raise RuntimeError(f'{connection_handle}: not connection for handle')
|
||||||
|
|
||||||
|
channel: Union[l2cap.ClassicChannel, l2cap.LeCreditBasedChannel]
|
||||||
|
if request.type_variant() == 'basic':
|
||||||
|
assert request.basic
|
||||||
|
channel = await connection.create_l2cap_channel(
|
||||||
|
spec=l2cap.ClassicChannelSpec(
|
||||||
|
psm=request.basic.psm, mtu=request.basic.mtu
|
||||||
|
)
|
||||||
|
)
|
||||||
|
elif request.type_variant() == 'le_credit_based':
|
||||||
|
assert request.le_credit_based
|
||||||
|
channel = await connection.create_l2cap_channel(
|
||||||
|
spec=l2cap.LeCreditBasedChannelSpec(
|
||||||
|
psm=request.le_credit_based.spsm,
|
||||||
|
max_credits=request.le_credit_based.initial_credit,
|
||||||
|
mtu=request.le_credit_based.mtu,
|
||||||
|
mps=request.le_credit_based.mps,
|
||||||
|
)
|
||||||
|
)
|
||||||
|
else:
|
||||||
|
raise NotImplementedError(f"{request.type_variant()}: unsupported type")
|
||||||
|
|
||||||
|
index = ChannelIndex(channel.connection.handle, channel.source_cid)
|
||||||
|
self.register(index, ChannelProxy(channel))
|
||||||
|
return l2cap_pb2.ConnectResponse(channel=index.into_token())
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def WaitConnection(
|
||||||
|
self, request: l2cap_pb2.WaitConnectionRequest, context: grpc.ServicerContext
|
||||||
|
) -> l2cap_pb2.WaitConnectionResponse:
|
||||||
|
iter = self.listen()
|
||||||
|
fut: asyncio.Future[
|
||||||
|
Union[l2cap.ClassicChannel, l2cap.LeCreditBasedChannel]
|
||||||
|
] = asyncio.Future()
|
||||||
|
|
||||||
|
# Filter by connection.
|
||||||
|
if request.connection:
|
||||||
|
handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
|
iter = (it async for it in iter if it.connection.handle == handle)
|
||||||
|
|
||||||
|
if request.type_variant() == 'basic':
|
||||||
|
assert request.basic
|
||||||
|
basic = l2cap.PendingConnection.Basic(
|
||||||
|
fut.set_result,
|
||||||
|
request.basic.mtu or l2cap.L2CAP_MIN_BR_EDR_MTU,
|
||||||
|
)
|
||||||
|
async for i in (
|
||||||
|
it
|
||||||
|
async for it in iter
|
||||||
|
if isinstance(it, l2cap.IncomingConnection.Basic)
|
||||||
|
):
|
||||||
|
if not i.future.done() and i.psm == request.basic.psm:
|
||||||
|
i.future.set_result(basic)
|
||||||
|
break
|
||||||
|
elif request.type_variant() == 'le_credit_based':
|
||||||
|
assert request.le_credit_based
|
||||||
|
le_credit_based = l2cap.PendingConnection.LeCreditBased(
|
||||||
|
fut.set_result,
|
||||||
|
request.le_credit_based.mtu
|
||||||
|
or l2cap.L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MTU,
|
||||||
|
request.le_credit_based.mps
|
||||||
|
or l2cap.L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_MPS,
|
||||||
|
request.le_credit_based.initial_credit
|
||||||
|
or l2cap.L2CAP_LE_CREDIT_BASED_CONNECTION_DEFAULT_INITIAL_CREDITS,
|
||||||
|
)
|
||||||
|
async for j in (
|
||||||
|
it
|
||||||
|
async for it in iter
|
||||||
|
if isinstance(it, l2cap.IncomingConnection.LeCreditBased)
|
||||||
|
):
|
||||||
|
if not j.future.done() and j.psm == request.le_credit_based.spsm:
|
||||||
|
j.future.set_result(le_credit_based)
|
||||||
|
break
|
||||||
|
else:
|
||||||
|
raise NotImplementedError(f"{request.type_variant()}: unsupported type")
|
||||||
|
|
||||||
|
channel = await fut
|
||||||
|
index = ChannelIndex(channel.connection.handle, channel.source_cid)
|
||||||
|
self.register(index, ChannelProxy(channel))
|
||||||
|
return l2cap_pb2.WaitConnectionResponse(channel=index.into_token())
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def Disconnect(
|
||||||
|
self, request: l2cap_pb2.DisconnectRequest, context: grpc.ServicerContext
|
||||||
|
) -> l2cap_pb2.DisconnectResponse:
|
||||||
|
channel = self.channels[ChannelIndex.from_token(request.channel)]
|
||||||
|
await channel.disconnect()
|
||||||
|
return l2cap_pb2.DisconnectResponse(success=empty_pb2.Empty())
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def WaitDisconnection(
|
||||||
|
self, request: l2cap_pb2.WaitDisconnectionRequest, context: grpc.ServicerContext
|
||||||
|
) -> l2cap_pb2.WaitDisconnectionResponse:
|
||||||
|
channel = self.channels[ChannelIndex.from_token(request.channel)]
|
||||||
|
await channel.wait_disconnect()
|
||||||
|
return l2cap_pb2.WaitDisconnectionResponse(success=empty_pb2.Empty())
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def Receive(
|
||||||
|
self, request: l2cap_pb2.ReceiveRequest, context: grpc.ServicerContext
|
||||||
|
) -> AsyncGenerator[l2cap_pb2.ReceiveResponse, None]:
|
||||||
|
watcher = EventWatcher()
|
||||||
|
if request.source_variant() == 'channel':
|
||||||
|
assert request.channel
|
||||||
|
channel = self.channels[ChannelIndex.from_token(request.channel)]
|
||||||
|
rx = channel.rx
|
||||||
|
elif request.source_variant() == 'fixed_channel':
|
||||||
|
assert request.fixed_channel
|
||||||
|
rx = asyncio.Queue()
|
||||||
|
handle = request.fixed_channel.connection is not None and int.from_bytes(
|
||||||
|
request.fixed_channel.connection.cookie.value, 'big'
|
||||||
|
)
|
||||||
|
|
||||||
|
@watcher.on(self.device.host, 'l2cap_pdu')
|
||||||
|
def _(connection: device.Connection, cid: int, pdu: bytes) -> None:
|
||||||
|
assert request.fixed_channel
|
||||||
|
if cid == request.fixed_channel.cid and (
|
||||||
|
handle is None or handle == connection.handle
|
||||||
|
):
|
||||||
|
rx.put_nowait(pdu)
|
||||||
|
|
||||||
|
else:
|
||||||
|
raise NotImplementedError(f"{request.source_variant()}: unsupported type")
|
||||||
|
try:
|
||||||
|
while data := await rx.get():
|
||||||
|
yield l2cap_pb2.ReceiveResponse(data=data)
|
||||||
|
finally:
|
||||||
|
watcher.close()
|
||||||
|
|
||||||
|
@utils.rpc
|
||||||
|
async def Send(
|
||||||
|
self, request: l2cap_pb2.SendRequest, context: grpc.ServicerContext
|
||||||
|
) -> l2cap_pb2.SendResponse:
|
||||||
|
if request.sink_variant() == 'channel':
|
||||||
|
assert request.channel
|
||||||
|
channel = self.channels[ChannelIndex.from_token(request.channel)]
|
||||||
|
channel.send(request.data)
|
||||||
|
elif request.sink_variant() == 'fixed_channel':
|
||||||
|
assert request.fixed_channel
|
||||||
|
# Retrieve Bumble `Connection` from request.
|
||||||
|
connection_handle = int.from_bytes(
|
||||||
|
request.fixed_channel.connection.cookie.value, 'big'
|
||||||
|
)
|
||||||
|
connection = self.device.lookup_connection(connection_handle)
|
||||||
|
if connection is None:
|
||||||
|
raise RuntimeError(f'{connection_handle}: not connection for handle')
|
||||||
|
self.device.l2cap_channel_manager.send_pdu(
|
||||||
|
connection, request.fixed_channel.cid, request.data
|
||||||
|
)
|
||||||
|
else:
|
||||||
|
raise NotImplementedError(f"{request.sink_variant()}: unsupported type")
|
||||||
|
return l2cap_pb2.SendResponse(success=empty_pb2.Empty())
|
||||||
+82
-49
@@ -12,7 +12,9 @@
|
|||||||
# See the License for the specific language governing permissions and
|
# See the License for the specific language governing permissions and
|
||||||
# limitations under the License.
|
# limitations under the License.
|
||||||
|
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
|
import contextlib
|
||||||
import grpc
|
import grpc
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
@@ -27,8 +29,8 @@ from bumble.core import (
|
|||||||
)
|
)
|
||||||
from bumble.device import Connection as BumbleConnection, Device
|
from bumble.device import Connection as BumbleConnection, Device
|
||||||
from bumble.hci import HCI_Error
|
from bumble.hci import HCI_Error
|
||||||
|
from bumble.utils import EventWatcher
|
||||||
from bumble.pairing import PairingConfig, PairingDelegate as BasePairingDelegate
|
from bumble.pairing import PairingConfig, PairingDelegate as BasePairingDelegate
|
||||||
from contextlib import suppress
|
|
||||||
from google.protobuf import any_pb2 # pytype: disable=pyi-error
|
from google.protobuf import any_pb2 # pytype: disable=pyi-error
|
||||||
from google.protobuf import empty_pb2 # pytype: disable=pyi-error
|
from google.protobuf import empty_pb2 # pytype: disable=pyi-error
|
||||||
from google.protobuf import wrappers_pb2 # pytype: disable=pyi-error
|
from google.protobuf import wrappers_pb2 # pytype: disable=pyi-error
|
||||||
@@ -99,7 +101,7 @@ class PairingDelegate(BasePairingDelegate):
|
|||||||
return ev
|
return ev
|
||||||
|
|
||||||
async def confirm(self, auto: bool = False) -> bool:
|
async def confirm(self, auto: bool = False) -> bool:
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Pairing event: `just_works` (io_capability: {self.io_capability})"
|
f"Pairing event: `just_works` (io_capability: {self.io_capability})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -114,7 +116,7 @@ class PairingDelegate(BasePairingDelegate):
|
|||||||
return answer.confirm
|
return answer.confirm
|
||||||
|
|
||||||
async def compare_numbers(self, number: int, digits: int = 6) -> bool:
|
async def compare_numbers(self, number: int, digits: int = 6) -> bool:
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Pairing event: `numeric_comparison` (io_capability: {self.io_capability})"
|
f"Pairing event: `numeric_comparison` (io_capability: {self.io_capability})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -129,7 +131,7 @@ class PairingDelegate(BasePairingDelegate):
|
|||||||
return answer.confirm
|
return answer.confirm
|
||||||
|
|
||||||
async def get_number(self) -> Optional[int]:
|
async def get_number(self) -> Optional[int]:
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Pairing event: `passkey_entry_request` (io_capability: {self.io_capability})"
|
f"Pairing event: `passkey_entry_request` (io_capability: {self.io_capability})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -146,7 +148,7 @@ class PairingDelegate(BasePairingDelegate):
|
|||||||
return answer.passkey
|
return answer.passkey
|
||||||
|
|
||||||
async def get_string(self, max_length: int) -> Optional[str]:
|
async def get_string(self, max_length: int) -> Optional[str]:
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Pairing event: `pin_code_request` (io_capability: {self.io_capability})"
|
f"Pairing event: `pin_code_request` (io_capability: {self.io_capability})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -177,7 +179,7 @@ class PairingDelegate(BasePairingDelegate):
|
|||||||
):
|
):
|
||||||
return
|
return
|
||||||
|
|
||||||
self.log.info(
|
self.log.debug(
|
||||||
f"Pairing event: `passkey_entry_notification` (io_capability: {self.io_capability})"
|
f"Pairing event: `passkey_entry_notification` (io_capability: {self.io_capability})"
|
||||||
)
|
)
|
||||||
|
|
||||||
@@ -232,6 +234,11 @@ class SecurityService(SecurityServicer):
|
|||||||
sc=config.pairing_sc_enable,
|
sc=config.pairing_sc_enable,
|
||||||
mitm=config.pairing_mitm_enable,
|
mitm=config.pairing_mitm_enable,
|
||||||
bonding=config.pairing_bonding_enable,
|
bonding=config.pairing_bonding_enable,
|
||||||
|
identity_address_type=(
|
||||||
|
PairingConfig.AddressType.PUBLIC
|
||||||
|
if connection.self_address.is_public
|
||||||
|
else config.identity_address_type
|
||||||
|
),
|
||||||
delegate=PairingDelegate(
|
delegate=PairingDelegate(
|
||||||
connection,
|
connection,
|
||||||
self,
|
self,
|
||||||
@@ -247,7 +254,7 @@ class SecurityService(SecurityServicer):
|
|||||||
async def OnPairing(
|
async def OnPairing(
|
||||||
self, request: AsyncIterator[PairingEventAnswer], context: grpc.ServicerContext
|
self, request: AsyncIterator[PairingEventAnswer], context: grpc.ServicerContext
|
||||||
) -> AsyncGenerator[PairingEvent, None]:
|
) -> AsyncGenerator[PairingEvent, None]:
|
||||||
self.log.info('OnPairing')
|
self.log.debug('OnPairing')
|
||||||
|
|
||||||
if self.event_queue is not None:
|
if self.event_queue is not None:
|
||||||
raise RuntimeError('already streaming pairing events')
|
raise RuntimeError('already streaming pairing events')
|
||||||
@@ -273,7 +280,7 @@ class SecurityService(SecurityServicer):
|
|||||||
self, request: SecureRequest, context: grpc.ServicerContext
|
self, request: SecureRequest, context: grpc.ServicerContext
|
||||||
) -> SecureResponse:
|
) -> SecureResponse:
|
||||||
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
self.log.info(f"Secure: {connection_handle}")
|
self.log.debug(f"Secure: {connection_handle}")
|
||||||
|
|
||||||
connection = self.device.lookup_connection(connection_handle)
|
connection = self.device.lookup_connection(connection_handle)
|
||||||
assert connection
|
assert connection
|
||||||
@@ -291,25 +298,37 @@ class SecurityService(SecurityServicer):
|
|||||||
# trigger pairing if needed
|
# trigger pairing if needed
|
||||||
if self.need_pairing(connection, level):
|
if self.need_pairing(connection, level):
|
||||||
try:
|
try:
|
||||||
self.log.info('Pair...')
|
self.log.debug('Pair...')
|
||||||
|
|
||||||
if (
|
security_result = asyncio.get_running_loop().create_future()
|
||||||
connection.transport == BT_LE_TRANSPORT
|
|
||||||
and connection.role == BT_PERIPHERAL_ROLE
|
|
||||||
):
|
|
||||||
wait_for_security: asyncio.Future[
|
|
||||||
bool
|
|
||||||
] = asyncio.get_running_loop().create_future()
|
|
||||||
connection.on("pairing", lambda *_: wait_for_security.set_result(True)) # type: ignore
|
|
||||||
connection.on("pairing_failure", wait_for_security.set_exception)
|
|
||||||
|
|
||||||
connection.request_pairing()
|
with contextlib.closing(EventWatcher()) as watcher:
|
||||||
|
|
||||||
await wait_for_security
|
@watcher.on(connection, 'pairing')
|
||||||
else:
|
def on_pairing(*_: Any) -> None:
|
||||||
await connection.pair()
|
security_result.set_result('success')
|
||||||
|
|
||||||
self.log.info('Paired')
|
@watcher.on(connection, 'pairing_failure')
|
||||||
|
def on_pairing_failure(*_: Any) -> None:
|
||||||
|
security_result.set_result('pairing_failure')
|
||||||
|
|
||||||
|
@watcher.on(connection, 'disconnection')
|
||||||
|
def on_disconnection(*_: Any) -> None:
|
||||||
|
security_result.set_result('connection_died')
|
||||||
|
|
||||||
|
if (
|
||||||
|
connection.transport == BT_LE_TRANSPORT
|
||||||
|
and connection.role == BT_PERIPHERAL_ROLE
|
||||||
|
):
|
||||||
|
connection.request_pairing()
|
||||||
|
else:
|
||||||
|
await connection.pair()
|
||||||
|
|
||||||
|
result = await security_result
|
||||||
|
|
||||||
|
self.log.debug(f'Pairing session complete, status={result}')
|
||||||
|
if result != 'success':
|
||||||
|
return SecureResponse(**{result: empty_pb2.Empty()})
|
||||||
except asyncio.CancelledError:
|
except asyncio.CancelledError:
|
||||||
self.log.warning("Connection died during encryption")
|
self.log.warning("Connection died during encryption")
|
||||||
return SecureResponse(connection_died=empty_pb2.Empty())
|
return SecureResponse(connection_died=empty_pb2.Empty())
|
||||||
@@ -320,9 +339,9 @@ class SecurityService(SecurityServicer):
|
|||||||
# trigger authentication if needed
|
# trigger authentication if needed
|
||||||
if self.need_authentication(connection, level):
|
if self.need_authentication(connection, level):
|
||||||
try:
|
try:
|
||||||
self.log.info('Authenticate...')
|
self.log.debug('Authenticate...')
|
||||||
await connection.authenticate()
|
await connection.authenticate()
|
||||||
self.log.info('Authenticated')
|
self.log.debug('Authenticated')
|
||||||
except asyncio.CancelledError:
|
except asyncio.CancelledError:
|
||||||
self.log.warning("Connection died during authentication")
|
self.log.warning("Connection died during authentication")
|
||||||
return SecureResponse(connection_died=empty_pb2.Empty())
|
return SecureResponse(connection_died=empty_pb2.Empty())
|
||||||
@@ -333,9 +352,9 @@ class SecurityService(SecurityServicer):
|
|||||||
# trigger encryption if needed
|
# trigger encryption if needed
|
||||||
if self.need_encryption(connection, level):
|
if self.need_encryption(connection, level):
|
||||||
try:
|
try:
|
||||||
self.log.info('Encrypt...')
|
self.log.debug('Encrypt...')
|
||||||
await connection.encrypt()
|
await connection.encrypt()
|
||||||
self.log.info('Encrypted')
|
self.log.debug('Encrypted')
|
||||||
except asyncio.CancelledError:
|
except asyncio.CancelledError:
|
||||||
self.log.warning("Connection died during encryption")
|
self.log.warning("Connection died during encryption")
|
||||||
return SecureResponse(connection_died=empty_pb2.Empty())
|
return SecureResponse(connection_died=empty_pb2.Empty())
|
||||||
@@ -353,7 +372,7 @@ class SecurityService(SecurityServicer):
|
|||||||
self, request: WaitSecurityRequest, context: grpc.ServicerContext
|
self, request: WaitSecurityRequest, context: grpc.ServicerContext
|
||||||
) -> WaitSecurityResponse:
|
) -> WaitSecurityResponse:
|
||||||
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
connection_handle = int.from_bytes(request.connection.cookie.value, 'big')
|
||||||
self.log.info(f"WaitSecurity: {connection_handle}")
|
self.log.debug(f"WaitSecurity: {connection_handle}")
|
||||||
|
|
||||||
connection = self.device.lookup_connection(connection_handle)
|
connection = self.device.lookup_connection(connection_handle)
|
||||||
assert connection
|
assert connection
|
||||||
@@ -368,6 +387,7 @@ class SecurityService(SecurityServicer):
|
|||||||
str
|
str
|
||||||
] = asyncio.get_running_loop().create_future()
|
] = asyncio.get_running_loop().create_future()
|
||||||
authenticate_task: Optional[asyncio.Future[None]] = None
|
authenticate_task: Optional[asyncio.Future[None]] = None
|
||||||
|
pair_task: Optional[asyncio.Future[None]] = None
|
||||||
|
|
||||||
async def authenticate() -> None:
|
async def authenticate() -> None:
|
||||||
assert connection
|
assert connection
|
||||||
@@ -390,7 +410,7 @@ class SecurityService(SecurityServicer):
|
|||||||
|
|
||||||
def set_failure(name: str) -> Callable[..., None]:
|
def set_failure(name: str) -> Callable[..., None]:
|
||||||
def wrapper(*args: Any) -> None:
|
def wrapper(*args: Any) -> None:
|
||||||
self.log.info(f'Wait for security: error `{name}`: {args}')
|
self.log.debug(f'Wait for security: error `{name}`: {args}')
|
||||||
wait_for_security.set_result(name)
|
wait_for_security.set_result(name)
|
||||||
|
|
||||||
return wrapper
|
return wrapper
|
||||||
@@ -398,13 +418,13 @@ class SecurityService(SecurityServicer):
|
|||||||
def try_set_success(*_: Any) -> None:
|
def try_set_success(*_: Any) -> None:
|
||||||
assert connection
|
assert connection
|
||||||
if self.reached_security_level(connection, level):
|
if self.reached_security_level(connection, level):
|
||||||
self.log.info('Wait for security: done')
|
self.log.debug('Wait for security: done')
|
||||||
wait_for_security.set_result('success')
|
wait_for_security.set_result('success')
|
||||||
|
|
||||||
def on_encryption_change(*_: Any) -> None:
|
def on_encryption_change(*_: Any) -> None:
|
||||||
assert connection
|
assert connection
|
||||||
if self.reached_security_level(connection, level):
|
if self.reached_security_level(connection, level):
|
||||||
self.log.info('Wait for security: done')
|
self.log.debug('Wait for security: done')
|
||||||
wait_for_security.set_result('success')
|
wait_for_security.set_result('success')
|
||||||
elif (
|
elif (
|
||||||
connection.transport == BT_BR_EDR_TRANSPORT
|
connection.transport == BT_BR_EDR_TRANSPORT
|
||||||
@@ -414,6 +434,10 @@ class SecurityService(SecurityServicer):
|
|||||||
if authenticate_task is None:
|
if authenticate_task is None:
|
||||||
authenticate_task = asyncio.create_task(authenticate())
|
authenticate_task = asyncio.create_task(authenticate())
|
||||||
|
|
||||||
|
def pair(*_: Any) -> None:
|
||||||
|
if self.need_pairing(connection, level):
|
||||||
|
pair_task = asyncio.create_task(connection.pair())
|
||||||
|
|
||||||
listeners: Dict[str, Callable[..., None]] = {
|
listeners: Dict[str, Callable[..., None]] = {
|
||||||
'disconnection': set_failure('connection_died'),
|
'disconnection': set_failure('connection_died'),
|
||||||
'pairing_failure': set_failure('pairing_failure'),
|
'pairing_failure': set_failure('pairing_failure'),
|
||||||
@@ -422,32 +446,41 @@ class SecurityService(SecurityServicer):
|
|||||||
'pairing': try_set_success,
|
'pairing': try_set_success,
|
||||||
'connection_authentication': try_set_success,
|
'connection_authentication': try_set_success,
|
||||||
'connection_encryption_change': on_encryption_change,
|
'connection_encryption_change': on_encryption_change,
|
||||||
|
'classic_pairing': try_set_success,
|
||||||
|
'classic_pairing_failure': set_failure('pairing_failure'),
|
||||||
|
'security_request': pair,
|
||||||
}
|
}
|
||||||
|
|
||||||
# register event handlers
|
with contextlib.closing(EventWatcher()) as watcher:
|
||||||
for event, listener in listeners.items():
|
# register event handlers
|
||||||
connection.on(event, listener)
|
for event, listener in listeners.items():
|
||||||
|
watcher.on(connection, event, listener)
|
||||||
|
|
||||||
# security level already reached
|
# security level already reached
|
||||||
if self.reached_security_level(connection, level):
|
if self.reached_security_level(connection, level):
|
||||||
return WaitSecurityResponse(success=empty_pb2.Empty())
|
return WaitSecurityResponse(success=empty_pb2.Empty())
|
||||||
|
|
||||||
self.log.info('Wait for security...')
|
self.log.debug('Wait for security...')
|
||||||
kwargs = {}
|
kwargs = {}
|
||||||
kwargs[await wait_for_security] = empty_pb2.Empty()
|
kwargs[await wait_for_security] = empty_pb2.Empty()
|
||||||
|
|
||||||
# remove event handlers
|
|
||||||
for event, listener in listeners.items():
|
|
||||||
connection.remove_listener(event, listener) # type: ignore
|
|
||||||
|
|
||||||
# wait for `authenticate` to finish if any
|
# wait for `authenticate` to finish if any
|
||||||
if authenticate_task is not None:
|
if authenticate_task is not None:
|
||||||
self.log.info('Wait for authentication...')
|
self.log.debug('Wait for authentication...')
|
||||||
try:
|
try:
|
||||||
await authenticate_task # type: ignore
|
await authenticate_task # type: ignore
|
||||||
except:
|
except:
|
||||||
pass
|
pass
|
||||||
self.log.info('Authenticated')
|
self.log.debug('Authenticated')
|
||||||
|
|
||||||
|
# wait for `pair` to finish if any
|
||||||
|
if pair_task is not None:
|
||||||
|
self.log.debug('Wait for authentication...')
|
||||||
|
try:
|
||||||
|
await pair_task # type: ignore
|
||||||
|
except:
|
||||||
|
pass
|
||||||
|
self.log.debug('paired')
|
||||||
|
|
||||||
return WaitSecurityResponse(**kwargs)
|
return WaitSecurityResponse(**kwargs)
|
||||||
|
|
||||||
@@ -503,7 +536,7 @@ class SecurityStorageService(SecurityStorageServicer):
|
|||||||
self, request: IsBondedRequest, context: grpc.ServicerContext
|
self, request: IsBondedRequest, context: grpc.ServicerContext
|
||||||
) -> wrappers_pb2.BoolValue:
|
) -> wrappers_pb2.BoolValue:
|
||||||
address = utils.address_from_request(request, request.WhichOneof("address"))
|
address = utils.address_from_request(request, request.WhichOneof("address"))
|
||||||
self.log.info(f"IsBonded: {address}")
|
self.log.debug(f"IsBonded: {address}")
|
||||||
|
|
||||||
if self.device.keystore is not None:
|
if self.device.keystore is not None:
|
||||||
is_bonded = await self.device.keystore.get(str(address)) is not None
|
is_bonded = await self.device.keystore.get(str(address)) is not None
|
||||||
@@ -517,10 +550,10 @@ class SecurityStorageService(SecurityStorageServicer):
|
|||||||
self, request: DeleteBondRequest, context: grpc.ServicerContext
|
self, request: DeleteBondRequest, context: grpc.ServicerContext
|
||||||
) -> empty_pb2.Empty:
|
) -> empty_pb2.Empty:
|
||||||
address = utils.address_from_request(request, request.WhichOneof("address"))
|
address = utils.address_from_request(request, request.WhichOneof("address"))
|
||||||
self.log.info(f"DeleteBond: {address}")
|
self.log.debug(f"DeleteBond: {address}")
|
||||||
|
|
||||||
if self.device.keystore is not None:
|
if self.device.keystore is not None:
|
||||||
with suppress(KeyError):
|
with contextlib.suppress(KeyError):
|
||||||
await self.device.keystore.delete(str(address))
|
await self.device.keystore.delete(str(address))
|
||||||
|
|
||||||
return empty_pb2.Empty()
|
return empty_pb2.Empty()
|
||||||
|
|||||||
@@ -12,6 +12,7 @@
|
|||||||
# See the License for the specific language governing permissions and
|
# See the License for the specific language governing permissions and
|
||||||
# limitations under the License.
|
# limitations under the License.
|
||||||
|
|
||||||
|
from __future__ import annotations
|
||||||
import contextlib
|
import contextlib
|
||||||
import functools
|
import functools
|
||||||
import grpc
|
import grpc
|
||||||
|
|||||||
@@ -19,6 +19,8 @@
|
|||||||
import struct
|
import struct
|
||||||
import logging
|
import logging
|
||||||
from typing import List
|
from typing import List
|
||||||
|
|
||||||
|
from bumble import l2cap
|
||||||
from ..core import AdvertisingData
|
from ..core import AdvertisingData
|
||||||
from ..device import Device, Connection
|
from ..device import Device, Connection
|
||||||
from ..gatt import (
|
from ..gatt import (
|
||||||
@@ -149,7 +151,10 @@ class AshaService(TemplateService):
|
|||||||
channel.sink = on_data
|
channel.sink = on_data
|
||||||
|
|
||||||
# let the server find a free PSM
|
# let the server find a free PSM
|
||||||
self.psm = self.device.register_l2cap_channel_server(self.psm, on_coc, 8)
|
self.psm = device.create_l2cap_server(
|
||||||
|
spec=l2cap.LeCreditBasedChannelSpec(psm=self.psm, max_credits=8),
|
||||||
|
handler=on_coc,
|
||||||
|
).psm
|
||||||
self.le_psm_out_characteristic = Characteristic(
|
self.le_psm_out_characteristic = Characteristic(
|
||||||
GATT_ASHA_LE_PSM_OUT_CHARACTERISTIC,
|
GATT_ASHA_LE_PSM_OUT_CHARACTERISTIC,
|
||||||
Characteristic.Properties.READ,
|
Characteristic.Properties.READ,
|
||||||
|
|||||||
@@ -42,12 +42,12 @@ class HeartRateService(TemplateService):
|
|||||||
RESET_ENERGY_EXPENDED = 0x01
|
RESET_ENERGY_EXPENDED = 0x01
|
||||||
|
|
||||||
class BodySensorLocation(IntEnum):
|
class BodySensorLocation(IntEnum):
|
||||||
OTHER = (0,)
|
OTHER = 0
|
||||||
CHEST = (1,)
|
CHEST = 1
|
||||||
WRIST = (2,)
|
WRIST = 2
|
||||||
FINGER = (3,)
|
FINGER = 3
|
||||||
HAND = (4,)
|
HAND = 4
|
||||||
EAR_LOBE = (5,)
|
EAR_LOBE = 5
|
||||||
FOOT = 6
|
FOOT = 6
|
||||||
|
|
||||||
class HeartRateMeasurement:
|
class HeartRateMeasurement:
|
||||||
|
|||||||
+177
-132
@@ -15,15 +15,37 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
|
|
||||||
import logging
|
import logging
|
||||||
import asyncio
|
import asyncio
|
||||||
|
import enum
|
||||||
|
from typing import Callable, Dict, List, Optional, Tuple, Union, TYPE_CHECKING
|
||||||
|
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
from typing import Optional, Tuple, Callable, Dict, Union
|
|
||||||
|
|
||||||
from . import core, l2cap
|
from . import core, l2cap
|
||||||
from .colors import color
|
from .colors import color
|
||||||
from .core import BT_BR_EDR_TRANSPORT, InvalidStateError, ProtocolError
|
from .core import (
|
||||||
|
UUID,
|
||||||
|
BT_RFCOMM_PROTOCOL_ID,
|
||||||
|
BT_BR_EDR_TRANSPORT,
|
||||||
|
BT_L2CAP_PROTOCOL_ID,
|
||||||
|
InvalidStateError,
|
||||||
|
ProtocolError,
|
||||||
|
)
|
||||||
|
from .sdp import (
|
||||||
|
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID,
|
||||||
|
SDP_BROWSE_GROUP_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
SDP_PUBLIC_BROWSE_ROOT,
|
||||||
|
DataElement,
|
||||||
|
ServiceAttribute,
|
||||||
|
)
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from bumble.device import Device, Connection
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
@@ -105,6 +127,50 @@ RFCOMM_DYNAMIC_CHANNEL_NUMBER_END = 30
|
|||||||
# fmt: on
|
# fmt: on
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
def make_service_sdp_records(
|
||||||
|
service_record_handle: int, channel: int, uuid: Optional[UUID] = None
|
||||||
|
) -> List[ServiceAttribute]:
|
||||||
|
"""
|
||||||
|
Create SDP records for an RFComm service given a channel number and an
|
||||||
|
optional UUID. A Service Class Attribute is included only if the UUID is not None.
|
||||||
|
"""
|
||||||
|
records = [
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID,
|
||||||
|
DataElement.unsigned_integer_32(service_record_handle),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_BROWSE_GROUP_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence([DataElement.uuid(SDP_PUBLIC_BROWSE_ROOT)]),
|
||||||
|
),
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.sequence([DataElement.uuid(BT_L2CAP_PROTOCOL_ID)]),
|
||||||
|
DataElement.sequence(
|
||||||
|
[
|
||||||
|
DataElement.uuid(BT_RFCOMM_PROTOCOL_ID),
|
||||||
|
DataElement.unsigned_integer_8(channel),
|
||||||
|
]
|
||||||
|
),
|
||||||
|
]
|
||||||
|
),
|
||||||
|
),
|
||||||
|
]
|
||||||
|
|
||||||
|
if uuid:
|
||||||
|
records.append(
|
||||||
|
ServiceAttribute(
|
||||||
|
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID,
|
||||||
|
DataElement.sequence([DataElement.uuid(uuid)]),
|
||||||
|
)
|
||||||
|
)
|
||||||
|
|
||||||
|
return records
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
def compute_fcs(buffer: bytes) -> int:
|
def compute_fcs(buffer: bytes) -> int:
|
||||||
result = 0xFF
|
result = 0xFF
|
||||||
@@ -149,9 +215,9 @@ class RFCOMM_Frame:
|
|||||||
return RFCOMM_FRAME_TYPE_NAMES[self.type]
|
return RFCOMM_FRAME_TYPE_NAMES[self.type]
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def parse_mcc(data) -> Tuple[int, int, bytes]:
|
def parse_mcc(data) -> Tuple[int, bool, bytes]:
|
||||||
mcc_type = data[0] >> 2
|
mcc_type = data[0] >> 2
|
||||||
c_r = (data[0] >> 1) & 1
|
c_r = bool((data[0] >> 1) & 1)
|
||||||
length = data[1]
|
length = data[1]
|
||||||
if data[1] & 1:
|
if data[1] & 1:
|
||||||
length >>= 1
|
length >>= 1
|
||||||
@@ -192,7 +258,7 @@ class RFCOMM_Frame:
|
|||||||
)
|
)
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def from_bytes(data: bytes):
|
def from_bytes(data: bytes) -> RFCOMM_Frame:
|
||||||
# Extract fields
|
# Extract fields
|
||||||
dlci = (data[0] >> 2) & 0x3F
|
dlci = (data[0] >> 2) & 0x3F
|
||||||
c_r = (data[0] >> 1) & 0x01
|
c_r = (data[0] >> 1) & 0x01
|
||||||
@@ -215,7 +281,7 @@ class RFCOMM_Frame:
|
|||||||
|
|
||||||
return frame
|
return frame
|
||||||
|
|
||||||
def __bytes__(self):
|
def __bytes__(self) -> bytes:
|
||||||
return (
|
return (
|
||||||
bytes([self.address, self.control])
|
bytes([self.address, self.control])
|
||||||
+ self.length
|
+ self.length
|
||||||
@@ -223,7 +289,7 @@ class RFCOMM_Frame:
|
|||||||
+ bytes([self.fcs])
|
+ bytes([self.fcs])
|
||||||
)
|
)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'{color(self.type_name(), "yellow")}'
|
f'{color(self.type_name(), "yellow")}'
|
||||||
f'(c/r={self.c_r},'
|
f'(c/r={self.c_r},'
|
||||||
@@ -253,7 +319,7 @@ class RFCOMM_MCC_PN:
|
|||||||
max_frame_size: int,
|
max_frame_size: int,
|
||||||
max_retransmissions: int,
|
max_retransmissions: int,
|
||||||
window_size: int,
|
window_size: int,
|
||||||
):
|
) -> None:
|
||||||
self.dlci = dlci
|
self.dlci = dlci
|
||||||
self.cl = cl
|
self.cl = cl
|
||||||
self.priority = priority
|
self.priority = priority
|
||||||
@@ -263,7 +329,7 @@ class RFCOMM_MCC_PN:
|
|||||||
self.window_size = window_size
|
self.window_size = window_size
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def from_bytes(data: bytes):
|
def from_bytes(data: bytes) -> RFCOMM_MCC_PN:
|
||||||
return RFCOMM_MCC_PN(
|
return RFCOMM_MCC_PN(
|
||||||
dlci=data[0],
|
dlci=data[0],
|
||||||
cl=data[1],
|
cl=data[1],
|
||||||
@@ -274,7 +340,7 @@ class RFCOMM_MCC_PN:
|
|||||||
window_size=data[7],
|
window_size=data[7],
|
||||||
)
|
)
|
||||||
|
|
||||||
def __bytes__(self):
|
def __bytes__(self) -> bytes:
|
||||||
return bytes(
|
return bytes(
|
||||||
[
|
[
|
||||||
self.dlci & 0xFF,
|
self.dlci & 0xFF,
|
||||||
@@ -288,7 +354,7 @@ class RFCOMM_MCC_PN:
|
|||||||
]
|
]
|
||||||
)
|
)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'PN(dlci={self.dlci},'
|
f'PN(dlci={self.dlci},'
|
||||||
f'cl={self.cl},'
|
f'cl={self.cl},'
|
||||||
@@ -309,7 +375,9 @@ class RFCOMM_MCC_MSC:
|
|||||||
ic: int
|
ic: int
|
||||||
dv: int
|
dv: int
|
||||||
|
|
||||||
def __init__(self, dlci: int, fc: int, rtc: int, rtr: int, ic: int, dv: int):
|
def __init__(
|
||||||
|
self, dlci: int, fc: int, rtc: int, rtr: int, ic: int, dv: int
|
||||||
|
) -> None:
|
||||||
self.dlci = dlci
|
self.dlci = dlci
|
||||||
self.fc = fc
|
self.fc = fc
|
||||||
self.rtc = rtc
|
self.rtc = rtc
|
||||||
@@ -318,7 +386,7 @@ class RFCOMM_MCC_MSC:
|
|||||||
self.dv = dv
|
self.dv = dv
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def from_bytes(data: bytes):
|
def from_bytes(data: bytes) -> RFCOMM_MCC_MSC:
|
||||||
return RFCOMM_MCC_MSC(
|
return RFCOMM_MCC_MSC(
|
||||||
dlci=data[0] >> 2,
|
dlci=data[0] >> 2,
|
||||||
fc=data[1] >> 1 & 1,
|
fc=data[1] >> 1 & 1,
|
||||||
@@ -328,7 +396,7 @@ class RFCOMM_MCC_MSC:
|
|||||||
dv=data[1] >> 7 & 1,
|
dv=data[1] >> 7 & 1,
|
||||||
)
|
)
|
||||||
|
|
||||||
def __bytes__(self):
|
def __bytes__(self) -> bytes:
|
||||||
return bytes(
|
return bytes(
|
||||||
[
|
[
|
||||||
(self.dlci << 2) | 3,
|
(self.dlci << 2) | 3,
|
||||||
@@ -341,7 +409,7 @@ class RFCOMM_MCC_MSC:
|
|||||||
]
|
]
|
||||||
)
|
)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return (
|
return (
|
||||||
f'MSC(dlci={self.dlci},'
|
f'MSC(dlci={self.dlci},'
|
||||||
f'fc={self.fc},'
|
f'fc={self.fc},'
|
||||||
@@ -354,29 +422,24 @@ class RFCOMM_MCC_MSC:
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class DLC(EventEmitter):
|
class DLC(EventEmitter):
|
||||||
# States
|
class State(enum.IntEnum):
|
||||||
INIT = 0x00
|
INIT = 0x00
|
||||||
CONNECTING = 0x01
|
CONNECTING = 0x01
|
||||||
CONNECTED = 0x02
|
CONNECTED = 0x02
|
||||||
DISCONNECTING = 0x03
|
DISCONNECTING = 0x03
|
||||||
DISCONNECTED = 0x04
|
DISCONNECTED = 0x04
|
||||||
RESET = 0x05
|
RESET = 0x05
|
||||||
|
|
||||||
STATE_NAMES = {
|
|
||||||
INIT: 'INIT',
|
|
||||||
CONNECTING: 'CONNECTING',
|
|
||||||
CONNECTED: 'CONNECTED',
|
|
||||||
DISCONNECTING: 'DISCONNECTING',
|
|
||||||
DISCONNECTED: 'DISCONNECTED',
|
|
||||||
RESET: 'RESET',
|
|
||||||
}
|
|
||||||
|
|
||||||
connection_result: Optional[asyncio.Future]
|
connection_result: Optional[asyncio.Future]
|
||||||
sink: Optional[Callable[[bytes], None]]
|
sink: Optional[Callable[[bytes], None]]
|
||||||
|
|
||||||
def __init__(
|
def __init__(
|
||||||
self, multiplexer, dlci: int, max_frame_size: int, initial_tx_credits: int
|
self,
|
||||||
):
|
multiplexer: Multiplexer,
|
||||||
|
dlci: int,
|
||||||
|
max_frame_size: int,
|
||||||
|
initial_tx_credits: int,
|
||||||
|
) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.multiplexer = multiplexer
|
self.multiplexer = multiplexer
|
||||||
self.dlci = dlci
|
self.dlci = dlci
|
||||||
@@ -384,9 +447,9 @@ class DLC(EventEmitter):
|
|||||||
self.rx_threshold = self.rx_credits // 2
|
self.rx_threshold = self.rx_credits // 2
|
||||||
self.tx_credits = initial_tx_credits
|
self.tx_credits = initial_tx_credits
|
||||||
self.tx_buffer = b''
|
self.tx_buffer = b''
|
||||||
self.state = DLC.INIT
|
self.state = DLC.State.INIT
|
||||||
self.role = multiplexer.role
|
self.role = multiplexer.role
|
||||||
self.c_r = 1 if self.role == Multiplexer.INITIATOR else 0
|
self.c_r = 1 if self.role == Multiplexer.Role.INITIATOR else 0
|
||||||
self.sink = None
|
self.sink = None
|
||||||
self.connection_result = None
|
self.connection_result = None
|
||||||
|
|
||||||
@@ -396,14 +459,8 @@ class DLC(EventEmitter):
|
|||||||
max_frame_size, self.multiplexer.l2cap_channel.mtu - max_overhead
|
max_frame_size, self.multiplexer.l2cap_channel.mtu - max_overhead
|
||||||
)
|
)
|
||||||
|
|
||||||
@staticmethod
|
def change_state(self, new_state: State) -> None:
|
||||||
def state_name(state: int) -> str:
|
logger.debug(f'{self} state change -> {color(new_state.name, "magenta")}')
|
||||||
return DLC.STATE_NAMES[state]
|
|
||||||
|
|
||||||
def change_state(self, new_state: int) -> None:
|
|
||||||
logger.debug(
|
|
||||||
f'{self} state change -> {color(self.state_name(new_state), "magenta")}'
|
|
||||||
)
|
|
||||||
self.state = new_state
|
self.state = new_state
|
||||||
|
|
||||||
def send_frame(self, frame: RFCOMM_Frame) -> None:
|
def send_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
@@ -413,8 +470,8 @@ class DLC(EventEmitter):
|
|||||||
handler = getattr(self, f'on_{frame.type_name()}_frame'.lower())
|
handler = getattr(self, f'on_{frame.type_name()}_frame'.lower())
|
||||||
handler(frame)
|
handler(frame)
|
||||||
|
|
||||||
def on_sabm_frame(self, _frame) -> None:
|
def on_sabm_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
if self.state != DLC.CONNECTING:
|
if self.state != DLC.State.CONNECTING:
|
||||||
logger.warning(
|
logger.warning(
|
||||||
color('!!! received SABM when not in CONNECTING state', 'red')
|
color('!!! received SABM when not in CONNECTING state', 'red')
|
||||||
)
|
)
|
||||||
@@ -430,11 +487,11 @@ class DLC(EventEmitter):
|
|||||||
logger.debug(f'>>> MCC MSC Command: {msc}')
|
logger.debug(f'>>> MCC MSC Command: {msc}')
|
||||||
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
||||||
|
|
||||||
self.change_state(DLC.CONNECTED)
|
self.change_state(DLC.State.CONNECTED)
|
||||||
self.emit('open')
|
self.emit('open')
|
||||||
|
|
||||||
def on_ua_frame(self, _frame) -> None:
|
def on_ua_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
if self.state != DLC.CONNECTING:
|
if self.state != DLC.State.CONNECTING:
|
||||||
logger.warning(
|
logger.warning(
|
||||||
color('!!! received SABM when not in CONNECTING state', 'red')
|
color('!!! received SABM when not in CONNECTING state', 'red')
|
||||||
)
|
)
|
||||||
@@ -448,14 +505,14 @@ class DLC(EventEmitter):
|
|||||||
logger.debug(f'>>> MCC MSC Command: {msc}')
|
logger.debug(f'>>> MCC MSC Command: {msc}')
|
||||||
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
||||||
|
|
||||||
self.change_state(DLC.CONNECTED)
|
self.change_state(DLC.State.CONNECTED)
|
||||||
self.multiplexer.on_dlc_open_complete(self)
|
self.multiplexer.on_dlc_open_complete(self)
|
||||||
|
|
||||||
def on_dm_frame(self, frame) -> None:
|
def on_dm_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
# TODO: handle all states
|
# TODO: handle all states
|
||||||
pass
|
pass
|
||||||
|
|
||||||
def on_disc_frame(self, _frame) -> None:
|
def on_disc_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
# TODO: handle all states
|
# TODO: handle all states
|
||||||
self.send_frame(RFCOMM_Frame.ua(c_r=1 - self.c_r, dlci=self.dlci))
|
self.send_frame(RFCOMM_Frame.ua(c_r=1 - self.c_r, dlci=self.dlci))
|
||||||
|
|
||||||
@@ -489,10 +546,10 @@ class DLC(EventEmitter):
|
|||||||
# Check if there's anything to send (including credits)
|
# Check if there's anything to send (including credits)
|
||||||
self.process_tx()
|
self.process_tx()
|
||||||
|
|
||||||
def on_ui_frame(self, frame) -> None:
|
def on_ui_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
pass
|
pass
|
||||||
|
|
||||||
def on_mcc_msc(self, c_r, msc) -> None:
|
def on_mcc_msc(self, c_r: bool, msc: RFCOMM_MCC_MSC) -> None:
|
||||||
if c_r:
|
if c_r:
|
||||||
# Command
|
# Command
|
||||||
logger.debug(f'<<< MCC MSC Command: {msc}')
|
logger.debug(f'<<< MCC MSC Command: {msc}')
|
||||||
@@ -507,15 +564,15 @@ class DLC(EventEmitter):
|
|||||||
logger.debug(f'<<< MCC MSC Response: {msc}')
|
logger.debug(f'<<< MCC MSC Response: {msc}')
|
||||||
|
|
||||||
def connect(self) -> None:
|
def connect(self) -> None:
|
||||||
if self.state != DLC.INIT:
|
if self.state != DLC.State.INIT:
|
||||||
raise InvalidStateError('invalid state')
|
raise InvalidStateError('invalid state')
|
||||||
|
|
||||||
self.change_state(DLC.CONNECTING)
|
self.change_state(DLC.State.CONNECTING)
|
||||||
self.connection_result = asyncio.get_running_loop().create_future()
|
self.connection_result = asyncio.get_running_loop().create_future()
|
||||||
self.send_frame(RFCOMM_Frame.sabm(c_r=self.c_r, dlci=self.dlci))
|
self.send_frame(RFCOMM_Frame.sabm(c_r=self.c_r, dlci=self.dlci))
|
||||||
|
|
||||||
def accept(self) -> None:
|
def accept(self) -> None:
|
||||||
if self.state != DLC.INIT:
|
if self.state != DLC.State.INIT:
|
||||||
raise InvalidStateError('invalid state')
|
raise InvalidStateError('invalid state')
|
||||||
|
|
||||||
pn = RFCOMM_MCC_PN(
|
pn = RFCOMM_MCC_PN(
|
||||||
@@ -530,7 +587,7 @@ class DLC(EventEmitter):
|
|||||||
mcc = RFCOMM_Frame.make_mcc(mcc_type=RFCOMM_MCC_PN_TYPE, c_r=0, data=bytes(pn))
|
mcc = RFCOMM_Frame.make_mcc(mcc_type=RFCOMM_MCC_PN_TYPE, c_r=0, data=bytes(pn))
|
||||||
logger.debug(f'>>> PN Response: {pn}')
|
logger.debug(f'>>> PN Response: {pn}')
|
||||||
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
self.send_frame(RFCOMM_Frame.uih(c_r=self.c_r, dlci=0, information=mcc))
|
||||||
self.change_state(DLC.CONNECTING)
|
self.change_state(DLC.State.CONNECTING)
|
||||||
|
|
||||||
def rx_credits_needed(self) -> int:
|
def rx_credits_needed(self) -> int:
|
||||||
if self.rx_credits <= self.rx_threshold:
|
if self.rx_credits <= self.rx_threshold:
|
||||||
@@ -592,34 +649,24 @@ class DLC(EventEmitter):
|
|||||||
# TODO
|
# TODO
|
||||||
pass
|
pass
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return f'DLC(dlci={self.dlci},state={self.state_name(self.state)})'
|
return f'DLC(dlci={self.dlci},state={self.state.name})'
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Multiplexer(EventEmitter):
|
class Multiplexer(EventEmitter):
|
||||||
# Roles
|
class Role(enum.IntEnum):
|
||||||
INITIATOR = 0x00
|
INITIATOR = 0x00
|
||||||
RESPONDER = 0x01
|
RESPONDER = 0x01
|
||||||
|
|
||||||
# States
|
class State(enum.IntEnum):
|
||||||
INIT = 0x00
|
INIT = 0x00
|
||||||
CONNECTING = 0x01
|
CONNECTING = 0x01
|
||||||
CONNECTED = 0x02
|
CONNECTED = 0x02
|
||||||
OPENING = 0x03
|
OPENING = 0x03
|
||||||
DISCONNECTING = 0x04
|
DISCONNECTING = 0x04
|
||||||
DISCONNECTED = 0x05
|
DISCONNECTED = 0x05
|
||||||
RESET = 0x06
|
RESET = 0x06
|
||||||
|
|
||||||
STATE_NAMES = {
|
|
||||||
INIT: 'INIT',
|
|
||||||
CONNECTING: 'CONNECTING',
|
|
||||||
CONNECTED: 'CONNECTED',
|
|
||||||
OPENING: 'OPENING',
|
|
||||||
DISCONNECTING: 'DISCONNECTING',
|
|
||||||
DISCONNECTED: 'DISCONNECTED',
|
|
||||||
RESET: 'RESET',
|
|
||||||
}
|
|
||||||
|
|
||||||
connection_result: Optional[asyncio.Future]
|
connection_result: Optional[asyncio.Future]
|
||||||
disconnection_result: Optional[asyncio.Future]
|
disconnection_result: Optional[asyncio.Future]
|
||||||
@@ -627,11 +674,11 @@ class Multiplexer(EventEmitter):
|
|||||||
acceptor: Optional[Callable[[int], bool]]
|
acceptor: Optional[Callable[[int], bool]]
|
||||||
dlcs: Dict[int, DLC]
|
dlcs: Dict[int, DLC]
|
||||||
|
|
||||||
def __init__(self, l2cap_channel: l2cap.Channel, role: int) -> None:
|
def __init__(self, l2cap_channel: l2cap.ClassicChannel, role: Role) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.role = role
|
self.role = role
|
||||||
self.l2cap_channel = l2cap_channel
|
self.l2cap_channel = l2cap_channel
|
||||||
self.state = Multiplexer.INIT
|
self.state = Multiplexer.State.INIT
|
||||||
self.dlcs = {} # DLCs, by DLCI
|
self.dlcs = {} # DLCs, by DLCI
|
||||||
self.connection_result = None
|
self.connection_result = None
|
||||||
self.disconnection_result = None
|
self.disconnection_result = None
|
||||||
@@ -641,14 +688,8 @@ class Multiplexer(EventEmitter):
|
|||||||
# Become a sink for the L2CAP channel
|
# Become a sink for the L2CAP channel
|
||||||
l2cap_channel.sink = self.on_pdu
|
l2cap_channel.sink = self.on_pdu
|
||||||
|
|
||||||
@staticmethod
|
def change_state(self, new_state: State) -> None:
|
||||||
def state_name(state: int):
|
logger.debug(f'{self} state change -> {color(new_state.name, "cyan")}')
|
||||||
return Multiplexer.STATE_NAMES[state]
|
|
||||||
|
|
||||||
def change_state(self, new_state: int) -> None:
|
|
||||||
logger.debug(
|
|
||||||
f'{self} state change -> {color(self.state_name(new_state), "cyan")}'
|
|
||||||
)
|
|
||||||
self.state = new_state
|
self.state = new_state
|
||||||
|
|
||||||
def send_frame(self, frame: RFCOMM_Frame) -> None:
|
def send_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
@@ -679,28 +720,28 @@ class Multiplexer(EventEmitter):
|
|||||||
handler = getattr(self, f'on_{frame.type_name()}_frame'.lower())
|
handler = getattr(self, f'on_{frame.type_name()}_frame'.lower())
|
||||||
handler(frame)
|
handler(frame)
|
||||||
|
|
||||||
def on_sabm_frame(self, _frame) -> None:
|
def on_sabm_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
if self.state != Multiplexer.INIT:
|
if self.state != Multiplexer.State.INIT:
|
||||||
logger.debug('not in INIT state, ignoring SABM')
|
logger.debug('not in INIT state, ignoring SABM')
|
||||||
return
|
return
|
||||||
self.change_state(Multiplexer.CONNECTED)
|
self.change_state(Multiplexer.State.CONNECTED)
|
||||||
self.send_frame(RFCOMM_Frame.ua(c_r=1, dlci=0))
|
self.send_frame(RFCOMM_Frame.ua(c_r=1, dlci=0))
|
||||||
|
|
||||||
def on_ua_frame(self, _frame) -> None:
|
def on_ua_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
if self.state == Multiplexer.CONNECTING:
|
if self.state == Multiplexer.State.CONNECTING:
|
||||||
self.change_state(Multiplexer.CONNECTED)
|
self.change_state(Multiplexer.State.CONNECTED)
|
||||||
if self.connection_result:
|
if self.connection_result:
|
||||||
self.connection_result.set_result(0)
|
self.connection_result.set_result(0)
|
||||||
self.connection_result = None
|
self.connection_result = None
|
||||||
elif self.state == Multiplexer.DISCONNECTING:
|
elif self.state == Multiplexer.State.DISCONNECTING:
|
||||||
self.change_state(Multiplexer.DISCONNECTED)
|
self.change_state(Multiplexer.State.DISCONNECTED)
|
||||||
if self.disconnection_result:
|
if self.disconnection_result:
|
||||||
self.disconnection_result.set_result(None)
|
self.disconnection_result.set_result(None)
|
||||||
self.disconnection_result = None
|
self.disconnection_result = None
|
||||||
|
|
||||||
def on_dm_frame(self, _frame) -> None:
|
def on_dm_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
if self.state == Multiplexer.OPENING:
|
if self.state == Multiplexer.State.OPENING:
|
||||||
self.change_state(Multiplexer.CONNECTED)
|
self.change_state(Multiplexer.State.CONNECTED)
|
||||||
if self.open_result:
|
if self.open_result:
|
||||||
self.open_result.set_exception(
|
self.open_result.set_exception(
|
||||||
core.ConnectionError(
|
core.ConnectionError(
|
||||||
@@ -713,10 +754,12 @@ class Multiplexer(EventEmitter):
|
|||||||
else:
|
else:
|
||||||
logger.warning(f'unexpected state for DM: {self}')
|
logger.warning(f'unexpected state for DM: {self}')
|
||||||
|
|
||||||
def on_disc_frame(self, _frame) -> None:
|
def on_disc_frame(self, _frame: RFCOMM_Frame) -> None:
|
||||||
self.change_state(Multiplexer.DISCONNECTED)
|
self.change_state(Multiplexer.State.DISCONNECTED)
|
||||||
self.send_frame(
|
self.send_frame(
|
||||||
RFCOMM_Frame.ua(c_r=0 if self.role == Multiplexer.INITIATOR else 1, dlci=0)
|
RFCOMM_Frame.ua(
|
||||||
|
c_r=0 if self.role == Multiplexer.Role.INITIATOR else 1, dlci=0
|
||||||
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
def on_uih_frame(self, frame: RFCOMM_Frame) -> None:
|
def on_uih_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
@@ -729,11 +772,11 @@ class Multiplexer(EventEmitter):
|
|||||||
mcs = RFCOMM_MCC_MSC.from_bytes(value)
|
mcs = RFCOMM_MCC_MSC.from_bytes(value)
|
||||||
self.on_mcc_msc(c_r, mcs)
|
self.on_mcc_msc(c_r, mcs)
|
||||||
|
|
||||||
def on_ui_frame(self, frame) -> None:
|
def on_ui_frame(self, frame: RFCOMM_Frame) -> None:
|
||||||
pass
|
pass
|
||||||
|
|
||||||
def on_mcc_pn(self, c_r, pn) -> None:
|
def on_mcc_pn(self, c_r: bool, pn: RFCOMM_MCC_PN) -> None:
|
||||||
if c_r == 1:
|
if c_r:
|
||||||
# Command
|
# Command
|
||||||
logger.debug(f'<<< PN Command: {pn}')
|
logger.debug(f'<<< PN Command: {pn}')
|
||||||
|
|
||||||
@@ -764,14 +807,14 @@ class Multiplexer(EventEmitter):
|
|||||||
else:
|
else:
|
||||||
# Response
|
# Response
|
||||||
logger.debug(f'>>> PN Response: {pn}')
|
logger.debug(f'>>> PN Response: {pn}')
|
||||||
if self.state == Multiplexer.OPENING:
|
if self.state == Multiplexer.State.OPENING:
|
||||||
dlc = DLC(self, pn.dlci, pn.max_frame_size, pn.window_size)
|
dlc = DLC(self, pn.dlci, pn.max_frame_size, pn.window_size)
|
||||||
self.dlcs[pn.dlci] = dlc
|
self.dlcs[pn.dlci] = dlc
|
||||||
dlc.connect()
|
dlc.connect()
|
||||||
else:
|
else:
|
||||||
logger.warning('ignoring PN response')
|
logger.warning('ignoring PN response')
|
||||||
|
|
||||||
def on_mcc_msc(self, c_r, msc) -> None:
|
def on_mcc_msc(self, c_r: bool, msc: RFCOMM_MCC_MSC) -> None:
|
||||||
dlc = self.dlcs.get(msc.dlci)
|
dlc = self.dlcs.get(msc.dlci)
|
||||||
if dlc is None:
|
if dlc is None:
|
||||||
logger.warning(f'no dlc for DLCI {msc.dlci}')
|
logger.warning(f'no dlc for DLCI {msc.dlci}')
|
||||||
@@ -779,30 +822,30 @@ class Multiplexer(EventEmitter):
|
|||||||
dlc.on_mcc_msc(c_r, msc)
|
dlc.on_mcc_msc(c_r, msc)
|
||||||
|
|
||||||
async def connect(self) -> None:
|
async def connect(self) -> None:
|
||||||
if self.state != Multiplexer.INIT:
|
if self.state != Multiplexer.State.INIT:
|
||||||
raise InvalidStateError('invalid state')
|
raise InvalidStateError('invalid state')
|
||||||
|
|
||||||
self.change_state(Multiplexer.CONNECTING)
|
self.change_state(Multiplexer.State.CONNECTING)
|
||||||
self.connection_result = asyncio.get_running_loop().create_future()
|
self.connection_result = asyncio.get_running_loop().create_future()
|
||||||
self.send_frame(RFCOMM_Frame.sabm(c_r=1, dlci=0))
|
self.send_frame(RFCOMM_Frame.sabm(c_r=1, dlci=0))
|
||||||
return await self.connection_result
|
return await self.connection_result
|
||||||
|
|
||||||
async def disconnect(self) -> None:
|
async def disconnect(self) -> None:
|
||||||
if self.state != Multiplexer.CONNECTED:
|
if self.state != Multiplexer.State.CONNECTED:
|
||||||
return
|
return
|
||||||
|
|
||||||
self.disconnection_result = asyncio.get_running_loop().create_future()
|
self.disconnection_result = asyncio.get_running_loop().create_future()
|
||||||
self.change_state(Multiplexer.DISCONNECTING)
|
self.change_state(Multiplexer.State.DISCONNECTING)
|
||||||
self.send_frame(
|
self.send_frame(
|
||||||
RFCOMM_Frame.disc(
|
RFCOMM_Frame.disc(
|
||||||
c_r=1 if self.role == Multiplexer.INITIATOR else 0, dlci=0
|
c_r=1 if self.role == Multiplexer.Role.INITIATOR else 0, dlci=0
|
||||||
)
|
)
|
||||||
)
|
)
|
||||||
await self.disconnection_result
|
await self.disconnection_result
|
||||||
|
|
||||||
async def open_dlc(self, channel: int) -> DLC:
|
async def open_dlc(self, channel: int) -> DLC:
|
||||||
if self.state != Multiplexer.CONNECTED:
|
if self.state != Multiplexer.State.CONNECTED:
|
||||||
if self.state == Multiplexer.OPENING:
|
if self.state == Multiplexer.State.OPENING:
|
||||||
raise InvalidStateError('open already in progress')
|
raise InvalidStateError('open already in progress')
|
||||||
|
|
||||||
raise InvalidStateError('not connected')
|
raise InvalidStateError('not connected')
|
||||||
@@ -819,10 +862,10 @@ class Multiplexer(EventEmitter):
|
|||||||
mcc = RFCOMM_Frame.make_mcc(mcc_type=RFCOMM_MCC_PN_TYPE, c_r=1, data=bytes(pn))
|
mcc = RFCOMM_Frame.make_mcc(mcc_type=RFCOMM_MCC_PN_TYPE, c_r=1, data=bytes(pn))
|
||||||
logger.debug(f'>>> Sending MCC: {pn}')
|
logger.debug(f'>>> Sending MCC: {pn}')
|
||||||
self.open_result = asyncio.get_running_loop().create_future()
|
self.open_result = asyncio.get_running_loop().create_future()
|
||||||
self.change_state(Multiplexer.OPENING)
|
self.change_state(Multiplexer.State.OPENING)
|
||||||
self.send_frame(
|
self.send_frame(
|
||||||
RFCOMM_Frame.uih(
|
RFCOMM_Frame.uih(
|
||||||
c_r=1 if self.role == Multiplexer.INITIATOR else 0,
|
c_r=1 if self.role == Multiplexer.Role.INITIATOR else 0,
|
||||||
dlci=0,
|
dlci=0,
|
||||||
information=mcc,
|
information=mcc,
|
||||||
)
|
)
|
||||||
@@ -831,22 +874,22 @@ class Multiplexer(EventEmitter):
|
|||||||
self.open_result = None
|
self.open_result = None
|
||||||
return result
|
return result
|
||||||
|
|
||||||
def on_dlc_open_complete(self, dlc: DLC):
|
def on_dlc_open_complete(self, dlc: DLC) -> None:
|
||||||
logger.debug(f'DLC [{dlc.dlci}] open complete')
|
logger.debug(f'DLC [{dlc.dlci}] open complete')
|
||||||
self.change_state(Multiplexer.CONNECTED)
|
self.change_state(Multiplexer.State.CONNECTED)
|
||||||
if self.open_result:
|
if self.open_result:
|
||||||
self.open_result.set_result(dlc)
|
self.open_result.set_result(dlc)
|
||||||
|
|
||||||
def __str__(self):
|
def __str__(self) -> str:
|
||||||
return f'Multiplexer(state={self.state_name(self.state)})'
|
return f'Multiplexer(state={self.state.name})'
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Client:
|
class Client:
|
||||||
multiplexer: Optional[Multiplexer]
|
multiplexer: Optional[Multiplexer]
|
||||||
l2cap_channel: Optional[l2cap.Channel]
|
l2cap_channel: Optional[l2cap.ClassicChannel]
|
||||||
|
|
||||||
def __init__(self, device, connection) -> None:
|
def __init__(self, device: Device, connection: Connection) -> None:
|
||||||
self.device = device
|
self.device = device
|
||||||
self.connection = connection
|
self.connection = connection
|
||||||
self.l2cap_channel = None
|
self.l2cap_channel = None
|
||||||
@@ -855,8 +898,8 @@ class Client:
|
|||||||
async def start(self) -> Multiplexer:
|
async def start(self) -> Multiplexer:
|
||||||
# Create a new L2CAP connection
|
# Create a new L2CAP connection
|
||||||
try:
|
try:
|
||||||
self.l2cap_channel = await self.device.l2cap_channel_manager.connect(
|
self.l2cap_channel = await self.connection.create_l2cap_channel(
|
||||||
self.connection, RFCOMM_PSM
|
spec=l2cap.ClassicChannelSpec(RFCOMM_PSM)
|
||||||
)
|
)
|
||||||
except ProtocolError as error:
|
except ProtocolError as error:
|
||||||
logger.warning(f'L2CAP connection failed: {error}')
|
logger.warning(f'L2CAP connection failed: {error}')
|
||||||
@@ -864,7 +907,7 @@ class Client:
|
|||||||
|
|
||||||
assert self.l2cap_channel is not None
|
assert self.l2cap_channel is not None
|
||||||
# Create a mutliplexer to manage DLCs with the server
|
# Create a mutliplexer to manage DLCs with the server
|
||||||
self.multiplexer = Multiplexer(self.l2cap_channel, Multiplexer.INITIATOR)
|
self.multiplexer = Multiplexer(self.l2cap_channel, Multiplexer.Role.INITIATOR)
|
||||||
|
|
||||||
# Connect the multiplexer
|
# Connect the multiplexer
|
||||||
await self.multiplexer.connect()
|
await self.multiplexer.connect()
|
||||||
@@ -886,14 +929,16 @@ class Client:
|
|||||||
class Server(EventEmitter):
|
class Server(EventEmitter):
|
||||||
acceptors: Dict[int, Callable[[DLC], None]]
|
acceptors: Dict[int, Callable[[DLC], None]]
|
||||||
|
|
||||||
def __init__(self, device) -> None:
|
def __init__(self, device: Device) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.device = device
|
self.device = device
|
||||||
self.multiplexer = None
|
self.multiplexer = None
|
||||||
self.acceptors = {}
|
self.acceptors = {}
|
||||||
|
|
||||||
# Register ourselves with the L2CAP channel manager
|
# Register ourselves with the L2CAP channel manager
|
||||||
device.register_l2cap_server(RFCOMM_PSM, self.on_connection)
|
device.create_l2cap_server(
|
||||||
|
spec=l2cap.ClassicChannelSpec(psm=RFCOMM_PSM), handler=self.on_connection
|
||||||
|
)
|
||||||
|
|
||||||
def listen(self, acceptor: Callable[[DLC], None], channel: int = 0) -> int:
|
def listen(self, acceptor: Callable[[DLC], None], channel: int = 0) -> int:
|
||||||
if channel:
|
if channel:
|
||||||
@@ -917,15 +962,15 @@ class Server(EventEmitter):
|
|||||||
self.acceptors[channel] = acceptor
|
self.acceptors[channel] = acceptor
|
||||||
return channel
|
return channel
|
||||||
|
|
||||||
def on_connection(self, l2cap_channel: l2cap.Channel) -> None:
|
def on_connection(self, l2cap_channel: l2cap.ClassicChannel) -> None:
|
||||||
logger.debug(f'+++ new L2CAP connection: {l2cap_channel}')
|
logger.debug(f'+++ new L2CAP connection: {l2cap_channel}')
|
||||||
l2cap_channel.on('open', lambda: self.on_l2cap_channel_open(l2cap_channel))
|
l2cap_channel.on('open', lambda: self.on_l2cap_channel_open(l2cap_channel))
|
||||||
|
|
||||||
def on_l2cap_channel_open(self, l2cap_channel: l2cap.Channel) -> None:
|
def on_l2cap_channel_open(self, l2cap_channel: l2cap.ClassicChannel) -> None:
|
||||||
logger.debug(f'$$$ L2CAP channel open: {l2cap_channel}')
|
logger.debug(f'$$$ L2CAP channel open: {l2cap_channel}')
|
||||||
|
|
||||||
# Create a new multiplexer for the channel
|
# Create a new multiplexer for the channel
|
||||||
multiplexer = Multiplexer(l2cap_channel, Multiplexer.RESPONDER)
|
multiplexer = Multiplexer(l2cap_channel, Multiplexer.Role.RESPONDER)
|
||||||
multiplexer.acceptor = self.accept_dlc
|
multiplexer.acceptor = self.accept_dlc
|
||||||
multiplexer.on('dlc', self.on_dlc)
|
multiplexer.on('dlc', self.on_dlc)
|
||||||
|
|
||||||
|
|||||||
+98
-32
@@ -18,13 +18,16 @@
|
|||||||
from __future__ import annotations
|
from __future__ import annotations
|
||||||
import logging
|
import logging
|
||||||
import struct
|
import struct
|
||||||
from typing import Dict, List, Type
|
from typing import Dict, List, Type, Optional, Tuple, Union, NewType, TYPE_CHECKING
|
||||||
|
|
||||||
from . import core
|
from . import core, l2cap
|
||||||
from .colors import color
|
from .colors import color
|
||||||
from .core import InvalidStateError
|
from .core import InvalidStateError
|
||||||
from .hci import HCI_Object, name_or_number, key_with_value
|
from .hci import HCI_Object, name_or_number, key_with_value
|
||||||
|
|
||||||
|
if TYPE_CHECKING:
|
||||||
|
from .device import Device, Connection
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -94,6 +97,10 @@ SDP_CLIENT_EXECUTABLE_URL_ATTRIBUTE_ID = 0X000B
|
|||||||
SDP_ICON_URL_ATTRIBUTE_ID = 0X000C
|
SDP_ICON_URL_ATTRIBUTE_ID = 0X000C
|
||||||
SDP_ADDITIONAL_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID = 0X000D
|
SDP_ADDITIONAL_PROTOCOL_DESCRIPTOR_LIST_ATTRIBUTE_ID = 0X000D
|
||||||
|
|
||||||
|
# Attribute Identifier (cf. Assigned Numbers for Service Discovery)
|
||||||
|
# used by AVRCP, HFP and A2DP
|
||||||
|
SDP_SUPPORTED_FEATURES_ATTRIBUTE_ID = 0x0311
|
||||||
|
|
||||||
SDP_ATTRIBUTE_ID_NAMES = {
|
SDP_ATTRIBUTE_ID_NAMES = {
|
||||||
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID: 'SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID',
|
SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID: 'SDP_SERVICE_RECORD_HANDLE_ATTRIBUTE_ID',
|
||||||
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID: 'SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID',
|
SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID: 'SDP_SERVICE_CLASS_ID_LIST_ATTRIBUTE_ID',
|
||||||
@@ -160,7 +167,7 @@ class DataElement:
|
|||||||
UUID: lambda x: DataElement(
|
UUID: lambda x: DataElement(
|
||||||
DataElement.UUID, core.UUID.from_bytes(bytes(reversed(x)))
|
DataElement.UUID, core.UUID.from_bytes(bytes(reversed(x)))
|
||||||
),
|
),
|
||||||
TEXT_STRING: lambda x: DataElement(DataElement.TEXT_STRING, x.decode('utf8')),
|
TEXT_STRING: lambda x: DataElement(DataElement.TEXT_STRING, x),
|
||||||
BOOLEAN: lambda x: DataElement(DataElement.BOOLEAN, x[0] == 1),
|
BOOLEAN: lambda x: DataElement(DataElement.BOOLEAN, x[0] == 1),
|
||||||
SEQUENCE: lambda x: DataElement(
|
SEQUENCE: lambda x: DataElement(
|
||||||
DataElement.SEQUENCE, DataElement.list_from_bytes(x)
|
DataElement.SEQUENCE, DataElement.list_from_bytes(x)
|
||||||
@@ -222,7 +229,7 @@ class DataElement:
|
|||||||
return DataElement(DataElement.UUID, value)
|
return DataElement(DataElement.UUID, value)
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def text_string(value: str) -> DataElement:
|
def text_string(value: bytes) -> DataElement:
|
||||||
return DataElement(DataElement.TEXT_STRING, value)
|
return DataElement(DataElement.TEXT_STRING, value)
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
@@ -369,7 +376,7 @@ class DataElement:
|
|||||||
raise ValueError('invalid value_size')
|
raise ValueError('invalid value_size')
|
||||||
elif self.type == DataElement.UUID:
|
elif self.type == DataElement.UUID:
|
||||||
data = bytes(reversed(bytes(self.value)))
|
data = bytes(reversed(bytes(self.value)))
|
||||||
elif self.type in (DataElement.TEXT_STRING, DataElement.URL):
|
elif self.type == DataElement.URL:
|
||||||
data = self.value.encode('utf8')
|
data = self.value.encode('utf8')
|
||||||
elif self.type == DataElement.BOOLEAN:
|
elif self.type == DataElement.BOOLEAN:
|
||||||
data = bytes([1 if self.value else 0])
|
data = bytes([1 if self.value else 0])
|
||||||
@@ -462,7 +469,7 @@ class ServiceAttribute:
|
|||||||
self.value = value
|
self.value = value
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def list_from_data_elements(elements):
|
def list_from_data_elements(elements: List[DataElement]) -> List[ServiceAttribute]:
|
||||||
attribute_list = []
|
attribute_list = []
|
||||||
for i in range(0, len(elements) // 2):
|
for i in range(0, len(elements) // 2):
|
||||||
attribute_id, attribute_value = elements[2 * i : 2 * (i + 1)]
|
attribute_id, attribute_value = elements[2 * i : 2 * (i + 1)]
|
||||||
@@ -474,7 +481,9 @@ class ServiceAttribute:
|
|||||||
return attribute_list
|
return attribute_list
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def find_attribute_in_list(attribute_list, attribute_id):
|
def find_attribute_in_list(
|
||||||
|
attribute_list: List[ServiceAttribute], attribute_id: int
|
||||||
|
) -> Optional[DataElement]:
|
||||||
return next(
|
return next(
|
||||||
(
|
(
|
||||||
attribute.value
|
attribute.value
|
||||||
@@ -489,7 +498,7 @@ class ServiceAttribute:
|
|||||||
return name_or_number(SDP_ATTRIBUTE_ID_NAMES, id_code)
|
return name_or_number(SDP_ATTRIBUTE_ID_NAMES, id_code)
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def is_uuid_in_value(uuid, value):
|
def is_uuid_in_value(uuid: core.UUID, value: DataElement) -> bool:
|
||||||
# Find if a uuid matches a value, either directly or recursing into sequences
|
# Find if a uuid matches a value, either directly or recursing into sequences
|
||||||
if value.type == DataElement.UUID:
|
if value.type == DataElement.UUID:
|
||||||
return value.value == uuid
|
return value.value == uuid
|
||||||
@@ -543,7 +552,9 @@ class SDP_PDU:
|
|||||||
return self
|
return self
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def parse_service_record_handle_list_preceded_by_count(data, offset):
|
def parse_service_record_handle_list_preceded_by_count(
|
||||||
|
data: bytes, offset: int
|
||||||
|
) -> Tuple[int, List[int]]:
|
||||||
count = struct.unpack_from('>H', data, offset - 2)[0]
|
count = struct.unpack_from('>H', data, offset - 2)[0]
|
||||||
handle_list = [
|
handle_list = [
|
||||||
struct.unpack_from('>I', data, offset + x * 4)[0] for x in range(count)
|
struct.unpack_from('>I', data, offset + x * 4)[0] for x in range(count)
|
||||||
@@ -641,6 +652,10 @@ class SDP_ServiceSearchRequest(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.5.1 SDP_ServiceSearchRequest PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.5.1 SDP_ServiceSearchRequest PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
service_search_pattern: DataElement
|
||||||
|
maximum_service_record_count: int
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@SDP_PDU.subclass(
|
@SDP_PDU.subclass(
|
||||||
@@ -659,6 +674,11 @@ class SDP_ServiceSearchResponse(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.5.2 SDP_ServiceSearchResponse PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.5.2 SDP_ServiceSearchResponse PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
service_record_handle_list: List[int]
|
||||||
|
total_service_record_count: int
|
||||||
|
current_service_record_count: int
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@SDP_PDU.subclass(
|
@SDP_PDU.subclass(
|
||||||
@@ -674,6 +694,11 @@ class SDP_ServiceAttributeRequest(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.6.1 SDP_ServiceAttributeRequest PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.6.1 SDP_ServiceAttributeRequest PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
service_record_handle: int
|
||||||
|
maximum_attribute_byte_count: int
|
||||||
|
attribute_id_list: DataElement
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@SDP_PDU.subclass(
|
@SDP_PDU.subclass(
|
||||||
@@ -688,6 +713,10 @@ class SDP_ServiceAttributeResponse(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.6.2 SDP_ServiceAttributeResponse PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.6.2 SDP_ServiceAttributeResponse PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
attribute_list_byte_count: int
|
||||||
|
attribute_list: bytes
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@SDP_PDU.subclass(
|
@SDP_PDU.subclass(
|
||||||
@@ -703,6 +732,11 @@ class SDP_ServiceSearchAttributeRequest(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.7.1 SDP_ServiceSearchAttributeRequest PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.7.1 SDP_ServiceSearchAttributeRequest PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
service_search_pattern: DataElement
|
||||||
|
maximum_attribute_byte_count: int
|
||||||
|
attribute_id_list: DataElement
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@SDP_PDU.subclass(
|
@SDP_PDU.subclass(
|
||||||
@@ -717,26 +751,35 @@ class SDP_ServiceSearchAttributeResponse(SDP_PDU):
|
|||||||
See Bluetooth spec @ Vol 3, Part B - 4.7.2 SDP_ServiceSearchAttributeResponse PDU
|
See Bluetooth spec @ Vol 3, Part B - 4.7.2 SDP_ServiceSearchAttributeResponse PDU
|
||||||
'''
|
'''
|
||||||
|
|
||||||
|
attribute_list_byte_count: int
|
||||||
|
attribute_list: bytes
|
||||||
|
continuation_state: bytes
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Client:
|
class Client:
|
||||||
def __init__(self, device):
|
channel: Optional[l2cap.ClassicChannel]
|
||||||
|
|
||||||
|
def __init__(self, device: Device) -> None:
|
||||||
self.device = device
|
self.device = device
|
||||||
self.pending_request = None
|
self.pending_request = None
|
||||||
self.channel = None
|
self.channel = None
|
||||||
|
|
||||||
async def connect(self, connection):
|
async def connect(self, connection: Connection) -> None:
|
||||||
result = await self.device.l2cap_channel_manager.connect(connection, SDP_PSM)
|
self.channel = await connection.create_l2cap_channel(
|
||||||
self.channel = result
|
spec=l2cap.ClassicChannelSpec(SDP_PSM)
|
||||||
|
)
|
||||||
|
|
||||||
async def disconnect(self):
|
async def disconnect(self) -> None:
|
||||||
if self.channel:
|
if self.channel:
|
||||||
await self.channel.disconnect()
|
await self.channel.disconnect()
|
||||||
self.channel = None
|
self.channel = None
|
||||||
|
|
||||||
async def search_services(self, uuids):
|
async def search_services(self, uuids: List[core.UUID]) -> List[int]:
|
||||||
if self.pending_request is not None:
|
if self.pending_request is not None:
|
||||||
raise InvalidStateError('request already pending')
|
raise InvalidStateError('request already pending')
|
||||||
|
if self.channel is None:
|
||||||
|
raise InvalidStateError('L2CAP not connected')
|
||||||
|
|
||||||
service_search_pattern = DataElement.sequence(
|
service_search_pattern = DataElement.sequence(
|
||||||
[DataElement.uuid(uuid) for uuid in uuids]
|
[DataElement.uuid(uuid) for uuid in uuids]
|
||||||
@@ -766,9 +809,13 @@ class Client:
|
|||||||
|
|
||||||
return service_record_handle_list
|
return service_record_handle_list
|
||||||
|
|
||||||
async def search_attributes(self, uuids, attribute_ids):
|
async def search_attributes(
|
||||||
|
self, uuids: List[core.UUID], attribute_ids: List[Union[int, Tuple[int, int]]]
|
||||||
|
) -> List[List[ServiceAttribute]]:
|
||||||
if self.pending_request is not None:
|
if self.pending_request is not None:
|
||||||
raise InvalidStateError('request already pending')
|
raise InvalidStateError('request already pending')
|
||||||
|
if self.channel is None:
|
||||||
|
raise InvalidStateError('L2CAP not connected')
|
||||||
|
|
||||||
service_search_pattern = DataElement.sequence(
|
service_search_pattern = DataElement.sequence(
|
||||||
[DataElement.uuid(uuid) for uuid in uuids]
|
[DataElement.uuid(uuid) for uuid in uuids]
|
||||||
@@ -819,9 +866,15 @@ class Client:
|
|||||||
if sequence.type == DataElement.SEQUENCE
|
if sequence.type == DataElement.SEQUENCE
|
||||||
]
|
]
|
||||||
|
|
||||||
async def get_attributes(self, service_record_handle, attribute_ids):
|
async def get_attributes(
|
||||||
|
self,
|
||||||
|
service_record_handle: int,
|
||||||
|
attribute_ids: List[Union[int, Tuple[int, int]]],
|
||||||
|
) -> List[ServiceAttribute]:
|
||||||
if self.pending_request is not None:
|
if self.pending_request is not None:
|
||||||
raise InvalidStateError('request already pending')
|
raise InvalidStateError('request already pending')
|
||||||
|
if self.channel is None:
|
||||||
|
raise InvalidStateError('L2CAP not connected')
|
||||||
|
|
||||||
attribute_id_list = DataElement.sequence(
|
attribute_id_list = DataElement.sequence(
|
||||||
[
|
[
|
||||||
@@ -869,21 +922,27 @@ class Client:
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class Server:
|
class Server:
|
||||||
CONTINUATION_STATE = bytes([0x01, 0x43])
|
CONTINUATION_STATE = bytes([0x01, 0x43])
|
||||||
|
channel: Optional[l2cap.ClassicChannel]
|
||||||
|
Service = NewType('Service', List[ServiceAttribute])
|
||||||
|
service_records: Dict[int, Service]
|
||||||
|
current_response: Union[None, bytes, Tuple[int, List[int]]]
|
||||||
|
|
||||||
def __init__(self, device):
|
def __init__(self, device: Device) -> None:
|
||||||
self.device = device
|
self.device = device
|
||||||
self.service_records = {} # Service records maps, by record handle
|
self.service_records = {} # Service records maps, by record handle
|
||||||
self.channel = None
|
self.channel = None
|
||||||
self.current_response = None
|
self.current_response = None
|
||||||
|
|
||||||
def register(self, l2cap_channel_manager):
|
def register(self, l2cap_channel_manager: l2cap.ChannelManager) -> None:
|
||||||
l2cap_channel_manager.register_server(SDP_PSM, self.on_connection)
|
l2cap_channel_manager.create_classic_server(
|
||||||
|
spec=l2cap.ClassicChannelSpec(psm=SDP_PSM), handler=self.on_connection
|
||||||
|
)
|
||||||
|
|
||||||
def send_response(self, response):
|
def send_response(self, response):
|
||||||
logger.debug(f'{color(">>> Sending SDP Response", "blue")}: {response}')
|
logger.debug(f'{color(">>> Sending SDP Response", "blue")}: {response}')
|
||||||
self.channel.send_pdu(response)
|
self.channel.send_pdu(response)
|
||||||
|
|
||||||
def match_services(self, search_pattern):
|
def match_services(self, search_pattern: DataElement) -> Dict[int, Service]:
|
||||||
# Find the services for which the attributes in the pattern is a subset of the
|
# Find the services for which the attributes in the pattern is a subset of the
|
||||||
# service's attribute values (NOTE: the value search recurses into sequences)
|
# service's attribute values (NOTE: the value search recurses into sequences)
|
||||||
matching_services = {}
|
matching_services = {}
|
||||||
@@ -953,7 +1012,9 @@ class Server:
|
|||||||
return (payload, continuation_state)
|
return (payload, continuation_state)
|
||||||
|
|
||||||
@staticmethod
|
@staticmethod
|
||||||
def get_service_attributes(service, attribute_ids):
|
def get_service_attributes(
|
||||||
|
service: Service, attribute_ids: List[DataElement]
|
||||||
|
) -> DataElement:
|
||||||
attributes = []
|
attributes = []
|
||||||
for attribute_id in attribute_ids:
|
for attribute_id in attribute_ids:
|
||||||
if attribute_id.value_size == 4:
|
if attribute_id.value_size == 4:
|
||||||
@@ -978,10 +1039,10 @@ class Server:
|
|||||||
|
|
||||||
return attribute_list
|
return attribute_list
|
||||||
|
|
||||||
def on_sdp_service_search_request(self, request):
|
def on_sdp_service_search_request(self, request: SDP_ServiceSearchRequest) -> None:
|
||||||
# Check if this is a continuation
|
# Check if this is a continuation
|
||||||
if len(request.continuation_state) > 1:
|
if len(request.continuation_state) > 1:
|
||||||
if not self.current_response:
|
if self.current_response is None:
|
||||||
self.send_response(
|
self.send_response(
|
||||||
SDP_ErrorResponse(
|
SDP_ErrorResponse(
|
||||||
transaction_id=request.transaction_id,
|
transaction_id=request.transaction_id,
|
||||||
@@ -1010,6 +1071,7 @@ class Server:
|
|||||||
)
|
)
|
||||||
|
|
||||||
# Respond, keeping any unsent handles for later
|
# Respond, keeping any unsent handles for later
|
||||||
|
assert isinstance(self.current_response, tuple)
|
||||||
service_record_handles = self.current_response[1][
|
service_record_handles = self.current_response[1][
|
||||||
: request.maximum_service_record_count
|
: request.maximum_service_record_count
|
||||||
]
|
]
|
||||||
@@ -1033,10 +1095,12 @@ class Server:
|
|||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
def on_sdp_service_attribute_request(self, request):
|
def on_sdp_service_attribute_request(
|
||||||
|
self, request: SDP_ServiceAttributeRequest
|
||||||
|
) -> None:
|
||||||
# Check if this is a continuation
|
# Check if this is a continuation
|
||||||
if len(request.continuation_state) > 1:
|
if len(request.continuation_state) > 1:
|
||||||
if not self.current_response:
|
if self.current_response is None:
|
||||||
self.send_response(
|
self.send_response(
|
||||||
SDP_ErrorResponse(
|
SDP_ErrorResponse(
|
||||||
transaction_id=request.transaction_id,
|
transaction_id=request.transaction_id,
|
||||||
@@ -1069,22 +1133,24 @@ class Server:
|
|||||||
self.current_response = bytes(attribute_list)
|
self.current_response = bytes(attribute_list)
|
||||||
|
|
||||||
# Respond, keeping any pending chunks for later
|
# Respond, keeping any pending chunks for later
|
||||||
attribute_list, continuation_state = self.get_next_response_payload(
|
attribute_list_response, continuation_state = self.get_next_response_payload(
|
||||||
request.maximum_attribute_byte_count
|
request.maximum_attribute_byte_count
|
||||||
)
|
)
|
||||||
self.send_response(
|
self.send_response(
|
||||||
SDP_ServiceAttributeResponse(
|
SDP_ServiceAttributeResponse(
|
||||||
transaction_id=request.transaction_id,
|
transaction_id=request.transaction_id,
|
||||||
attribute_list_byte_count=len(attribute_list),
|
attribute_list_byte_count=len(attribute_list_response),
|
||||||
attribute_list=attribute_list,
|
attribute_list=attribute_list,
|
||||||
continuation_state=continuation_state,
|
continuation_state=continuation_state,
|
||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
def on_sdp_service_search_attribute_request(self, request):
|
def on_sdp_service_search_attribute_request(
|
||||||
|
self, request: SDP_ServiceSearchAttributeRequest
|
||||||
|
) -> None:
|
||||||
# Check if this is a continuation
|
# Check if this is a continuation
|
||||||
if len(request.continuation_state) > 1:
|
if len(request.continuation_state) > 1:
|
||||||
if not self.current_response:
|
if self.current_response is None:
|
||||||
self.send_response(
|
self.send_response(
|
||||||
SDP_ErrorResponse(
|
SDP_ErrorResponse(
|
||||||
transaction_id=request.transaction_id,
|
transaction_id=request.transaction_id,
|
||||||
@@ -1114,13 +1180,13 @@ class Server:
|
|||||||
self.current_response = bytes(attribute_lists)
|
self.current_response = bytes(attribute_lists)
|
||||||
|
|
||||||
# Respond, keeping any pending chunks for later
|
# Respond, keeping any pending chunks for later
|
||||||
attribute_lists, continuation_state = self.get_next_response_payload(
|
attribute_lists_response, continuation_state = self.get_next_response_payload(
|
||||||
request.maximum_attribute_byte_count
|
request.maximum_attribute_byte_count
|
||||||
)
|
)
|
||||||
self.send_response(
|
self.send_response(
|
||||||
SDP_ServiceSearchAttributeResponse(
|
SDP_ServiceSearchAttributeResponse(
|
||||||
transaction_id=request.transaction_id,
|
transaction_id=request.transaction_id,
|
||||||
attribute_lists_byte_count=len(attribute_lists),
|
attribute_lists_byte_count=len(attribute_lists_response),
|
||||||
attribute_lists=attribute_lists,
|
attribute_lists=attribute_lists,
|
||||||
continuation_state=continuation_state,
|
continuation_state=continuation_state,
|
||||||
)
|
)
|
||||||
|
|||||||
+41
-30
@@ -37,6 +37,7 @@ from typing import (
|
|||||||
Optional,
|
Optional,
|
||||||
Tuple,
|
Tuple,
|
||||||
Type,
|
Type,
|
||||||
|
cast,
|
||||||
)
|
)
|
||||||
|
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
@@ -993,6 +994,19 @@ class Session:
|
|||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
|
def send_identity_address_command(self) -> None:
|
||||||
|
identity_address = {
|
||||||
|
None: self.connection.self_address,
|
||||||
|
Address.PUBLIC_DEVICE_ADDRESS: self.manager.device.public_address,
|
||||||
|
Address.RANDOM_DEVICE_ADDRESS: self.manager.device.random_address,
|
||||||
|
}[self.pairing_config.identity_address_type]
|
||||||
|
self.send_command(
|
||||||
|
SMP_Identity_Address_Information_Command(
|
||||||
|
addr_type=identity_address.address_type,
|
||||||
|
bd_addr=identity_address,
|
||||||
|
)
|
||||||
|
)
|
||||||
|
|
||||||
def start_encryption(self, key: bytes) -> None:
|
def start_encryption(self, key: bytes) -> None:
|
||||||
# We can now encrypt the connection with the short term key, so that we can
|
# We can now encrypt the connection with the short term key, so that we can
|
||||||
# distribute the long term and/or other keys over an encrypted connection
|
# distribute the long term and/or other keys over an encrypted connection
|
||||||
@@ -1016,6 +1030,7 @@ class Session:
|
|||||||
self.ltk = crypto.h6(ilk, b'brle')
|
self.ltk = crypto.h6(ilk, b'brle')
|
||||||
|
|
||||||
def distribute_keys(self) -> None:
|
def distribute_keys(self) -> None:
|
||||||
|
|
||||||
# Distribute the keys as required
|
# Distribute the keys as required
|
||||||
if self.is_initiator:
|
if self.is_initiator:
|
||||||
# CTKD: Derive LTK from LinkKey
|
# CTKD: Derive LTK from LinkKey
|
||||||
@@ -1045,12 +1060,7 @@ class Session:
|
|||||||
identity_resolving_key=self.manager.device.irk
|
identity_resolving_key=self.manager.device.irk
|
||||||
)
|
)
|
||||||
)
|
)
|
||||||
self.send_command(
|
self.send_identity_address_command()
|
||||||
SMP_Identity_Address_Information_Command(
|
|
||||||
addr_type=self.connection.self_address.address_type,
|
|
||||||
bd_addr=self.connection.self_address,
|
|
||||||
)
|
|
||||||
)
|
|
||||||
|
|
||||||
# Distribute CSRK
|
# Distribute CSRK
|
||||||
csrk = bytes(16) # FIXME: testing
|
csrk = bytes(16) # FIXME: testing
|
||||||
@@ -1094,12 +1104,7 @@ class Session:
|
|||||||
identity_resolving_key=self.manager.device.irk
|
identity_resolving_key=self.manager.device.irk
|
||||||
)
|
)
|
||||||
)
|
)
|
||||||
self.send_command(
|
self.send_identity_address_command()
|
||||||
SMP_Identity_Address_Information_Command(
|
|
||||||
addr_type=self.connection.self_address.address_type,
|
|
||||||
bd_addr=self.connection.self_address,
|
|
||||||
)
|
|
||||||
)
|
|
||||||
|
|
||||||
# Distribute CSRK
|
# Distribute CSRK
|
||||||
csrk = bytes(16) # FIXME: testing
|
csrk = bytes(16) # FIXME: testing
|
||||||
@@ -1268,7 +1273,7 @@ class Session:
|
|||||||
keys.link_key = PairingKeys.Key(
|
keys.link_key = PairingKeys.Key(
|
||||||
value=self.link_key, authenticated=authenticated
|
value=self.link_key, authenticated=authenticated
|
||||||
)
|
)
|
||||||
self.manager.on_pairing(self, peer_address, keys)
|
await self.manager.on_pairing(self, peer_address, keys)
|
||||||
|
|
||||||
def on_pairing_failure(self, reason: int) -> None:
|
def on_pairing_failure(self, reason: int) -> None:
|
||||||
logger.warning(f'pairing failure ({error_name(reason)})')
|
logger.warning(f'pairing failure ({error_name(reason)})')
|
||||||
@@ -1767,7 +1772,26 @@ class Manager(EventEmitter):
|
|||||||
cid = SMP_BR_CID if connection.transport == BT_BR_EDR_TRANSPORT else SMP_CID
|
cid = SMP_BR_CID if connection.transport == BT_BR_EDR_TRANSPORT else SMP_CID
|
||||||
connection.send_l2cap_pdu(cid, command.to_bytes())
|
connection.send_l2cap_pdu(cid, command.to_bytes())
|
||||||
|
|
||||||
|
def on_smp_security_request_command(
|
||||||
|
self, connection: Connection, request: SMP_Security_Request_Command
|
||||||
|
) -> None:
|
||||||
|
connection.emit('security_request', request.auth_req)
|
||||||
|
|
||||||
def on_smp_pdu(self, connection: Connection, pdu: bytes) -> None:
|
def on_smp_pdu(self, connection: Connection, pdu: bytes) -> None:
|
||||||
|
# Parse the L2CAP payload into an SMP Command object
|
||||||
|
command = SMP_Command.from_bytes(pdu)
|
||||||
|
logger.debug(
|
||||||
|
f'<<< Received SMP Command on connection [0x{connection.handle:04X}] '
|
||||||
|
f'{connection.peer_address}: {command}'
|
||||||
|
)
|
||||||
|
|
||||||
|
# Security request is more than just pairing, so let applications handle them
|
||||||
|
if command.code == SMP_SECURITY_REQUEST_COMMAND:
|
||||||
|
self.on_smp_security_request_command(
|
||||||
|
connection, cast(SMP_Security_Request_Command, command)
|
||||||
|
)
|
||||||
|
return
|
||||||
|
|
||||||
# Look for a session with this connection, and create one if none exists
|
# Look for a session with this connection, and create one if none exists
|
||||||
if not (session := self.sessions.get(connection.handle)):
|
if not (session := self.sessions.get(connection.handle)):
|
||||||
if connection.role == BT_CENTRAL_ROLE:
|
if connection.role == BT_CENTRAL_ROLE:
|
||||||
@@ -1778,13 +1802,6 @@ class Manager(EventEmitter):
|
|||||||
)
|
)
|
||||||
self.sessions[connection.handle] = session
|
self.sessions[connection.handle] = session
|
||||||
|
|
||||||
# Parse the L2CAP payload into an SMP Command object
|
|
||||||
command = SMP_Command.from_bytes(pdu)
|
|
||||||
logger.debug(
|
|
||||||
f'<<< Received SMP Command on connection [0x{connection.handle:04X}] '
|
|
||||||
f'{connection.peer_address}: {command}'
|
|
||||||
)
|
|
||||||
|
|
||||||
# Delegate the handling of the command to the session
|
# Delegate the handling of the command to the session
|
||||||
session.on_smp_command(command)
|
session.on_smp_command(command)
|
||||||
|
|
||||||
@@ -1823,20 +1840,14 @@ class Manager(EventEmitter):
|
|||||||
def on_session_start(self, session: Session) -> None:
|
def on_session_start(self, session: Session) -> None:
|
||||||
self.device.on_pairing_start(session.connection)
|
self.device.on_pairing_start(session.connection)
|
||||||
|
|
||||||
def on_pairing(
|
async def on_pairing(
|
||||||
self, session: Session, identity_address: Optional[Address], keys: PairingKeys
|
self, session: Session, identity_address: Optional[Address], keys: PairingKeys
|
||||||
) -> None:
|
) -> None:
|
||||||
# Store the keys in the key store
|
# Store the keys in the key store
|
||||||
if self.device.keystore and identity_address is not None:
|
if self.device.keystore and identity_address is not None:
|
||||||
|
self.device.abort_on(
|
||||||
async def store_keys():
|
'flush', self.device.update_keys(str(identity_address), keys)
|
||||||
try:
|
)
|
||||||
assert self.device.keystore
|
|
||||||
await self.device.keystore.update(str(identity_address), keys)
|
|
||||||
except Exception as error:
|
|
||||||
logger.warning(f'!!! error while storing keys: {error}')
|
|
||||||
|
|
||||||
self.device.abort_on('flush', store_keys())
|
|
||||||
|
|
||||||
# Notify the device
|
# Notify the device
|
||||||
self.device.on_pairing(session.connection, identity_address, keys, session.sc)
|
self.device.on_pairing(session.connection, identity_address, keys, session.sc)
|
||||||
|
|||||||
@@ -20,7 +20,6 @@ import logging
|
|||||||
import os
|
import os
|
||||||
|
|
||||||
from .common import Transport, AsyncPipeSink, SnoopingTransport
|
from .common import Transport, AsyncPipeSink, SnoopingTransport
|
||||||
from ..controller import Controller
|
|
||||||
from ..snoop import create_snooper
|
from ..snoop import create_snooper
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -69,6 +68,7 @@ async def open_transport(name: str) -> Transport:
|
|||||||
* usb
|
* usb
|
||||||
* pyusb
|
* pyusb
|
||||||
* android-emulator
|
* android-emulator
|
||||||
|
* android-netsim
|
||||||
"""
|
"""
|
||||||
|
|
||||||
return _wrap_transport(await _open_transport(name))
|
return _wrap_transport(await _open_transport(name))
|
||||||
@@ -118,7 +118,8 @@ async def _open_transport(name: str) -> Transport:
|
|||||||
if scheme == 'file':
|
if scheme == 'file':
|
||||||
from .file import open_file_transport
|
from .file import open_file_transport
|
||||||
|
|
||||||
return await open_file_transport(spec[0] if spec else None)
|
assert spec is not None
|
||||||
|
return await open_file_transport(spec[0])
|
||||||
|
|
||||||
if scheme == 'vhci':
|
if scheme == 'vhci':
|
||||||
from .vhci import open_vhci_transport
|
from .vhci import open_vhci_transport
|
||||||
@@ -133,12 +134,14 @@ async def _open_transport(name: str) -> Transport:
|
|||||||
if scheme == 'usb':
|
if scheme == 'usb':
|
||||||
from .usb import open_usb_transport
|
from .usb import open_usb_transport
|
||||||
|
|
||||||
return await open_usb_transport(spec[0] if spec else None)
|
assert spec is not None
|
||||||
|
return await open_usb_transport(spec[0])
|
||||||
|
|
||||||
if scheme == 'pyusb':
|
if scheme == 'pyusb':
|
||||||
from .pyusb import open_pyusb_transport
|
from .pyusb import open_pyusb_transport
|
||||||
|
|
||||||
return await open_pyusb_transport(spec[0] if spec else None)
|
assert spec is not None
|
||||||
|
return await open_pyusb_transport(spec[0])
|
||||||
|
|
||||||
if scheme == 'android-emulator':
|
if scheme == 'android-emulator':
|
||||||
from .android_emulator import open_android_emulator_transport
|
from .android_emulator import open_android_emulator_transport
|
||||||
@@ -167,6 +170,7 @@ async def open_transport_or_link(name: str) -> Transport:
|
|||||||
|
|
||||||
"""
|
"""
|
||||||
if name.startswith('link-relay:'):
|
if name.startswith('link-relay:'):
|
||||||
|
from ..controller import Controller
|
||||||
from ..link import RemoteLink # lazy import
|
from ..link import RemoteLink # lazy import
|
||||||
|
|
||||||
link = RemoteLink(name[11:])
|
link = RemoteLink(name[11:])
|
||||||
|
|||||||
@@ -18,7 +18,9 @@
|
|||||||
import logging
|
import logging
|
||||||
import grpc.aio
|
import grpc.aio
|
||||||
|
|
||||||
from .common import PumpedTransport, PumpedPacketSource, PumpedPacketSink
|
from typing import Optional, Union
|
||||||
|
|
||||||
|
from .common import PumpedTransport, PumpedPacketSource, PumpedPacketSink, Transport
|
||||||
|
|
||||||
# pylint: disable=no-name-in-module
|
# pylint: disable=no-name-in-module
|
||||||
from .grpc_protobuf.emulated_bluetooth_pb2_grpc import EmulatedBluetoothServiceStub
|
from .grpc_protobuf.emulated_bluetooth_pb2_grpc import EmulatedBluetoothServiceStub
|
||||||
@@ -33,7 +35,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_android_emulator_transport(spec):
|
async def open_android_emulator_transport(spec: Optional[str]) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a transport connection to an Android emulator via its gRPC interface.
|
Open a transport connection to an Android emulator via its gRPC interface.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
@@ -66,7 +68,7 @@ async def open_android_emulator_transport(spec):
|
|||||||
# Parse the parameters
|
# Parse the parameters
|
||||||
mode = 'host'
|
mode = 'host'
|
||||||
server_host = 'localhost'
|
server_host = 'localhost'
|
||||||
server_port = 8554
|
server_port = '8554'
|
||||||
if spec is not None:
|
if spec is not None:
|
||||||
params = spec.split(',')
|
params = spec.split(',')
|
||||||
for param in params:
|
for param in params:
|
||||||
@@ -82,6 +84,7 @@ async def open_android_emulator_transport(spec):
|
|||||||
logger.debug(f'connecting to gRPC server at {server_address}')
|
logger.debug(f'connecting to gRPC server at {server_address}')
|
||||||
channel = grpc.aio.insecure_channel(server_address)
|
channel = grpc.aio.insecure_channel(server_address)
|
||||||
|
|
||||||
|
service: Union[EmulatedBluetoothServiceStub, VhciForwardingServiceStub]
|
||||||
if mode == 'host':
|
if mode == 'host':
|
||||||
# Connect as a host
|
# Connect as a host
|
||||||
service = EmulatedBluetoothServiceStub(channel)
|
service = EmulatedBluetoothServiceStub(channel)
|
||||||
@@ -94,10 +97,13 @@ async def open_android_emulator_transport(spec):
|
|||||||
raise ValueError('invalid mode')
|
raise ValueError('invalid mode')
|
||||||
|
|
||||||
# Create the transport object
|
# Create the transport object
|
||||||
transport = PumpedTransport(
|
class EmulatorTransport(PumpedTransport):
|
||||||
PumpedPacketSource(hci_device.read),
|
async def close(self):
|
||||||
PumpedPacketSink(hci_device.write),
|
await super().close()
|
||||||
channel.close,
|
await channel.close()
|
||||||
|
|
||||||
|
transport = EmulatorTransport(
|
||||||
|
PumpedPacketSource(hci_device.read), PumpedPacketSink(hci_device.write)
|
||||||
)
|
)
|
||||||
transport.start()
|
transport.start()
|
||||||
|
|
||||||
|
|||||||
@@ -18,11 +18,12 @@
|
|||||||
import asyncio
|
import asyncio
|
||||||
import atexit
|
import atexit
|
||||||
import logging
|
import logging
|
||||||
import grpc.aio
|
|
||||||
import os
|
import os
|
||||||
import pathlib
|
import pathlib
|
||||||
import sys
|
import sys
|
||||||
from typing import Optional
|
from typing import Dict, Optional
|
||||||
|
|
||||||
|
import grpc.aio
|
||||||
|
|
||||||
from .common import (
|
from .common import (
|
||||||
ParserSource,
|
ParserSource,
|
||||||
@@ -33,8 +34,8 @@ from .common import (
|
|||||||
)
|
)
|
||||||
|
|
||||||
# pylint: disable=no-name-in-module
|
# pylint: disable=no-name-in-module
|
||||||
from .grpc_protobuf.packet_streamer_pb2_grpc import PacketStreamerStub
|
|
||||||
from .grpc_protobuf.packet_streamer_pb2_grpc import (
|
from .grpc_protobuf.packet_streamer_pb2_grpc import (
|
||||||
|
PacketStreamerStub,
|
||||||
PacketStreamerServicer,
|
PacketStreamerServicer,
|
||||||
add_PacketStreamerServicer_to_server,
|
add_PacketStreamerServicer_to_server,
|
||||||
)
|
)
|
||||||
@@ -43,6 +44,7 @@ from .grpc_protobuf.hci_packet_pb2 import HCIPacket
|
|||||||
from .grpc_protobuf.startup_pb2 import Chip, ChipInfo
|
from .grpc_protobuf.startup_pb2 import Chip, ChipInfo
|
||||||
from .grpc_protobuf.common_pb2 import ChipKind
|
from .grpc_protobuf.common_pb2 import ChipKind
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -74,14 +76,20 @@ def get_ini_dir() -> Optional[pathlib.Path]:
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
def find_grpc_port() -> int:
|
def ini_file_name(instance_number: int) -> str:
|
||||||
|
suffix = f'_{instance_number}' if instance_number > 0 else ''
|
||||||
|
return f'netsim{suffix}.ini'
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
def find_grpc_port(instance_number: int) -> int:
|
||||||
if not (ini_dir := get_ini_dir()):
|
if not (ini_dir := get_ini_dir()):
|
||||||
logger.debug('no known directory for .ini file')
|
logger.debug('no known directory for .ini file')
|
||||||
return 0
|
return 0
|
||||||
|
|
||||||
ini_file = ini_dir / 'netsim.ini'
|
ini_file = ini_dir / ini_file_name(instance_number)
|
||||||
|
logger.debug(f'Looking for .ini file at {ini_file}')
|
||||||
if ini_file.is_file():
|
if ini_file.is_file():
|
||||||
logger.debug(f'Found .ini file at {ini_file}')
|
|
||||||
with open(ini_file, 'r') as ini_file_data:
|
with open(ini_file, 'r') as ini_file_data:
|
||||||
for line in ini_file_data.readlines():
|
for line in ini_file_data.readlines():
|
||||||
if '=' in line:
|
if '=' in line:
|
||||||
@@ -90,12 +98,14 @@ def find_grpc_port() -> int:
|
|||||||
logger.debug(f'gRPC port = {value}')
|
logger.debug(f'gRPC port = {value}')
|
||||||
return int(value)
|
return int(value)
|
||||||
|
|
||||||
|
logger.debug('no grpc.port property found in .ini file')
|
||||||
|
|
||||||
# Not found
|
# Not found
|
||||||
return 0
|
return 0
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
def publish_grpc_port(grpc_port) -> bool:
|
def publish_grpc_port(grpc_port: int, instance_number: int) -> bool:
|
||||||
if not (ini_dir := get_ini_dir()):
|
if not (ini_dir := get_ini_dir()):
|
||||||
logger.debug('no known directory for .ini file')
|
logger.debug('no known directory for .ini file')
|
||||||
return False
|
return False
|
||||||
@@ -104,7 +114,7 @@ def publish_grpc_port(grpc_port) -> bool:
|
|||||||
logger.debug('ini directory does not exist')
|
logger.debug('ini directory does not exist')
|
||||||
return False
|
return False
|
||||||
|
|
||||||
ini_file = ini_dir / 'netsim.ini'
|
ini_file = ini_dir / ini_file_name(instance_number)
|
||||||
try:
|
try:
|
||||||
ini_file.write_text(f'grpc.port={grpc_port}\n')
|
ini_file.write_text(f'grpc.port={grpc_port}\n')
|
||||||
logger.debug(f"published gRPC port at {ini_file}")
|
logger.debug(f"published gRPC port at {ini_file}")
|
||||||
@@ -121,13 +131,16 @@ def publish_grpc_port(grpc_port) -> bool:
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_android_netsim_controller_transport(server_host, server_port):
|
async def open_android_netsim_controller_transport(
|
||||||
|
server_host: Optional[str], server_port: int, options: Dict[str, str]
|
||||||
|
) -> Transport:
|
||||||
if not server_port:
|
if not server_port:
|
||||||
raise ValueError('invalid port')
|
raise ValueError('invalid port')
|
||||||
if server_host == '_' or not server_host:
|
if server_host == '_' or not server_host:
|
||||||
server_host = 'localhost'
|
server_host = 'localhost'
|
||||||
|
|
||||||
if not publish_grpc_port(server_port):
|
instance_number = int(options.get('instance', "0"))
|
||||||
|
if not publish_grpc_port(server_port, instance_number):
|
||||||
logger.warning("unable to publish gRPC port")
|
logger.warning("unable to publish gRPC port")
|
||||||
|
|
||||||
class HciDevice:
|
class HciDevice:
|
||||||
@@ -184,15 +197,12 @@ async def open_android_netsim_controller_transport(server_host, server_port):
|
|||||||
logger.debug(f'<<< PACKET: {data.hex()}')
|
logger.debug(f'<<< PACKET: {data.hex()}')
|
||||||
self.on_data_received(data)
|
self.on_data_received(data)
|
||||||
|
|
||||||
def send_packet(self, data):
|
async def send_packet(self, data):
|
||||||
async def send():
|
return await self.context.write(
|
||||||
await self.context.write(
|
PacketResponse(
|
||||||
PacketResponse(
|
hci_packet=HCIPacket(packet_type=data[0], packet=data[1:])
|
||||||
hci_packet=HCIPacket(packet_type=data[0], packet=data[1:])
|
|
||||||
)
|
|
||||||
)
|
)
|
||||||
|
)
|
||||||
self.loop.create_task(send())
|
|
||||||
|
|
||||||
def terminate(self):
|
def terminate(self):
|
||||||
self.task.cancel()
|
self.task.cancel()
|
||||||
@@ -226,17 +236,17 @@ async def open_android_netsim_controller_transport(server_host, server_port):
|
|||||||
logger.debug('gRPC server cancelled')
|
logger.debug('gRPC server cancelled')
|
||||||
await self.grpc_server.stop(None)
|
await self.grpc_server.stop(None)
|
||||||
|
|
||||||
def on_packet(self, packet):
|
async def send_packet(self, packet):
|
||||||
if not self.device:
|
if not self.device:
|
||||||
logger.debug('no device, dropping packet')
|
logger.debug('no device, dropping packet')
|
||||||
return
|
return
|
||||||
|
|
||||||
self.device.send_packet(packet)
|
return await self.device.send_packet(packet)
|
||||||
|
|
||||||
async def StreamPackets(self, _request_iterator, context):
|
async def StreamPackets(self, _request_iterator, context):
|
||||||
logger.debug('StreamPackets request')
|
logger.debug('StreamPackets request')
|
||||||
|
|
||||||
# Check that we won't already have a device
|
# Check that we don't already have a device
|
||||||
if self.device:
|
if self.device:
|
||||||
logger.debug('busy, already serving a device')
|
logger.debug('busy, already serving a device')
|
||||||
return PacketResponse(error='Busy')
|
return PacketResponse(error='Busy')
|
||||||
@@ -259,15 +269,42 @@ async def open_android_netsim_controller_transport(server_host, server_port):
|
|||||||
await server.start()
|
await server.start()
|
||||||
asyncio.get_running_loop().create_task(server.serve())
|
asyncio.get_running_loop().create_task(server.serve())
|
||||||
|
|
||||||
class GrpcServerTransport(Transport):
|
sink = PumpedPacketSink(server.send_packet)
|
||||||
async def close(self):
|
sink.start()
|
||||||
await super().close()
|
return Transport(server, sink)
|
||||||
|
|
||||||
return GrpcServerTransport(server, server)
|
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_android_netsim_host_transport(server_host, server_port, options):
|
async def open_android_netsim_host_transport_with_address(
|
||||||
|
server_host: Optional[str],
|
||||||
|
server_port: int,
|
||||||
|
options: Optional[Dict[str, str]] = None,
|
||||||
|
):
|
||||||
|
if server_host == '_' or not server_host:
|
||||||
|
server_host = 'localhost'
|
||||||
|
|
||||||
|
if not server_port:
|
||||||
|
# Look for the gRPC config in a .ini file
|
||||||
|
instance_number = 0 if options is None else int(options.get('instance', '0'))
|
||||||
|
server_port = find_grpc_port(instance_number)
|
||||||
|
if not server_port:
|
||||||
|
raise RuntimeError('gRPC server port not found')
|
||||||
|
|
||||||
|
# Connect to the gRPC server
|
||||||
|
server_address = f'{server_host}:{server_port}'
|
||||||
|
logger.debug(f'Connecting to gRPC server at {server_address}')
|
||||||
|
channel = grpc.aio.insecure_channel(server_address)
|
||||||
|
|
||||||
|
return await open_android_netsim_host_transport_with_channel(
|
||||||
|
channel,
|
||||||
|
options,
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
async def open_android_netsim_host_transport_with_channel(
|
||||||
|
channel, options: Optional[Dict[str, str]] = None
|
||||||
|
):
|
||||||
# Wrapper for I/O operations
|
# Wrapper for I/O operations
|
||||||
class HciDevice:
|
class HciDevice:
|
||||||
def __init__(self, name, manufacturer, hci_device):
|
def __init__(self, name, manufacturer, hci_device):
|
||||||
@@ -286,10 +323,12 @@ async def open_android_netsim_host_transport(server_host, server_port, options):
|
|||||||
async def read(self):
|
async def read(self):
|
||||||
response = await self.hci_device.read()
|
response = await self.hci_device.read()
|
||||||
response_type = response.WhichOneof('response_type')
|
response_type = response.WhichOneof('response_type')
|
||||||
|
|
||||||
if response_type == 'error':
|
if response_type == 'error':
|
||||||
logger.warning(f'received error: {response.error}')
|
logger.warning(f'received error: {response.error}')
|
||||||
raise RuntimeError(response.error)
|
raise RuntimeError(response.error)
|
||||||
elif response_type == 'hci_packet':
|
|
||||||
|
if response_type == 'hci_packet':
|
||||||
return (
|
return (
|
||||||
bytes([response.hci_packet.packet_type])
|
bytes([response.hci_packet.packet_type])
|
||||||
+ response.hci_packet.packet
|
+ response.hci_packet.packet
|
||||||
@@ -304,24 +343,9 @@ async def open_android_netsim_host_transport(server_host, server_port, options):
|
|||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
name = options.get('name', DEFAULT_NAME)
|
name = DEFAULT_NAME if options is None else options.get('name', DEFAULT_NAME)
|
||||||
manufacturer = DEFAULT_MANUFACTURER
|
manufacturer = DEFAULT_MANUFACTURER
|
||||||
|
|
||||||
if server_host == '_' or not server_host:
|
|
||||||
server_host = 'localhost'
|
|
||||||
|
|
||||||
if not server_port:
|
|
||||||
# Look for the gRPC config in a .ini file
|
|
||||||
server_host = 'localhost'
|
|
||||||
server_port = find_grpc_port()
|
|
||||||
if not server_port:
|
|
||||||
raise RuntimeError('gRPC server port not found')
|
|
||||||
|
|
||||||
# Connect to the gRPC server
|
|
||||||
server_address = f'{server_host}:{server_port}'
|
|
||||||
logger.debug(f'Connecting to gRPC server at {server_address}')
|
|
||||||
channel = grpc.aio.insecure_channel(server_address)
|
|
||||||
|
|
||||||
# Connect as a host
|
# Connect as a host
|
||||||
service = PacketStreamerStub(channel)
|
service = PacketStreamerStub(channel)
|
||||||
hci_device = HciDevice(
|
hci_device = HciDevice(
|
||||||
@@ -332,10 +356,14 @@ async def open_android_netsim_host_transport(server_host, server_port, options):
|
|||||||
await hci_device.start()
|
await hci_device.start()
|
||||||
|
|
||||||
# Create the transport object
|
# Create the transport object
|
||||||
transport = PumpedTransport(
|
class GrpcTransport(PumpedTransport):
|
||||||
|
async def close(self):
|
||||||
|
await super().close()
|
||||||
|
await channel.close()
|
||||||
|
|
||||||
|
transport = GrpcTransport(
|
||||||
PumpedPacketSource(hci_device.read),
|
PumpedPacketSource(hci_device.read),
|
||||||
PumpedPacketSink(hci_device.write),
|
PumpedPacketSink(hci_device.write),
|
||||||
channel.close,
|
|
||||||
)
|
)
|
||||||
transport.start()
|
transport.start()
|
||||||
|
|
||||||
@@ -343,7 +371,7 @@ async def open_android_netsim_host_transport(server_host, server_port, options):
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_android_netsim_transport(spec):
|
async def open_android_netsim_transport(spec: Optional[str]) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a transport connection as a client or server, implementing Android's `netsim`
|
Open a transport connection as a client or server, implementing Android's `netsim`
|
||||||
simulator protocol over gRPC.
|
simulator protocol over gRPC.
|
||||||
@@ -357,6 +385,11 @@ async def open_android_netsim_transport(spec):
|
|||||||
to connect *to* a netsim server (netsim is the controller), or accept
|
to connect *to* a netsim server (netsim is the controller), or accept
|
||||||
connections *as* a netsim-compatible server.
|
connections *as* a netsim-compatible server.
|
||||||
|
|
||||||
|
instance=<n>
|
||||||
|
Specifies an instance number, with <n> > 0. This is used to determine which
|
||||||
|
.init file to use. In `host` mode, it is ignored when the <host>:<port>
|
||||||
|
specifier is present, since in that case no .ini file is used.
|
||||||
|
|
||||||
In `host` mode:
|
In `host` mode:
|
||||||
The <host>:<port> part is optional. When not specified, the transport
|
The <host>:<port> part is optional. When not specified, the transport
|
||||||
looks for a netsim .ini file, from which it will read the `grpc.backend.port`
|
looks for a netsim .ini file, from which it will read the `grpc.backend.port`
|
||||||
@@ -385,14 +418,15 @@ async def open_android_netsim_transport(spec):
|
|||||||
params = spec.split(',') if spec else []
|
params = spec.split(',') if spec else []
|
||||||
if params and ':' in params[0]:
|
if params and ':' in params[0]:
|
||||||
# Explicit <host>:<port>
|
# Explicit <host>:<port>
|
||||||
host, port = params[0].split(':')
|
host, port_str = params[0].split(':')
|
||||||
|
port = int(port_str)
|
||||||
params_offset = 1
|
params_offset = 1
|
||||||
else:
|
else:
|
||||||
host = None
|
host = None
|
||||||
port = 0
|
port = 0
|
||||||
params_offset = 0
|
params_offset = 0
|
||||||
|
|
||||||
options = {}
|
options: Dict[str, str] = {}
|
||||||
for param in params[params_offset:]:
|
for param in params[params_offset:]:
|
||||||
if '=' not in param:
|
if '=' not in param:
|
||||||
raise ValueError('invalid parameter, expected <name>=<value>')
|
raise ValueError('invalid parameter, expected <name>=<value>')
|
||||||
@@ -401,10 +435,12 @@ async def open_android_netsim_transport(spec):
|
|||||||
|
|
||||||
mode = options.get('mode', 'host')
|
mode = options.get('mode', 'host')
|
||||||
if mode == 'host':
|
if mode == 'host':
|
||||||
return await open_android_netsim_host_transport(host, port, options)
|
return await open_android_netsim_host_transport_with_address(
|
||||||
|
host, port, options
|
||||||
|
)
|
||||||
if mode == 'controller':
|
if mode == 'controller':
|
||||||
if host is None:
|
if host is None:
|
||||||
raise ValueError('<host>:<port> missing')
|
raise ValueError('<host>:<port> missing')
|
||||||
return await open_android_netsim_controller_transport(host, port)
|
return await open_android_netsim_controller_transport(host, port, options)
|
||||||
|
|
||||||
raise ValueError('invalid mode option')
|
raise ValueError('invalid mode option')
|
||||||
|
|||||||
+127
-73
@@ -20,11 +20,12 @@ import contextlib
|
|||||||
import struct
|
import struct
|
||||||
import asyncio
|
import asyncio
|
||||||
import logging
|
import logging
|
||||||
from typing import ContextManager
|
import io
|
||||||
|
from typing import ContextManager, Tuple, Optional, Protocol, Dict
|
||||||
|
|
||||||
from .. import hci
|
from bumble import hci
|
||||||
from ..colors import color
|
from bumble.colors import color
|
||||||
from ..snoop import Snooper
|
from bumble.snoop import Snooper
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -36,7 +37,7 @@ logger = logging.getLogger(__name__)
|
|||||||
# Information needed to parse HCI packets with a generic parser:
|
# Information needed to parse HCI packets with a generic parser:
|
||||||
# For each packet type, the info represents:
|
# For each packet type, the info represents:
|
||||||
# (length-size, length-offset, unpack-type)
|
# (length-size, length-offset, unpack-type)
|
||||||
HCI_PACKET_INFO = {
|
HCI_PACKET_INFO: Dict[int, Tuple[int, int, str]] = {
|
||||||
hci.HCI_COMMAND_PACKET: (1, 2, 'B'),
|
hci.HCI_COMMAND_PACKET: (1, 2, 'B'),
|
||||||
hci.HCI_ACL_DATA_PACKET: (2, 2, 'H'),
|
hci.HCI_ACL_DATA_PACKET: (2, 2, 'H'),
|
||||||
hci.HCI_SYNCHRONOUS_DATA_PACKET: (1, 2, 'B'),
|
hci.HCI_SYNCHRONOUS_DATA_PACKET: (1, 2, 'B'),
|
||||||
@@ -45,33 +46,54 @@ HCI_PACKET_INFO = {
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class PacketPump:
|
# Errors
|
||||||
'''
|
# -----------------------------------------------------------------------------
|
||||||
Pump HCI packets from a reader to a sink
|
class TransportLostError(Exception):
|
||||||
'''
|
"""
|
||||||
|
The Transport has been lost/disconnected.
|
||||||
|
"""
|
||||||
|
|
||||||
def __init__(self, reader, sink):
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Typing Protocols
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
class TransportSink(Protocol):
|
||||||
|
def on_packet(self, packet: bytes) -> None:
|
||||||
|
...
|
||||||
|
|
||||||
|
|
||||||
|
class TransportSource(Protocol):
|
||||||
|
terminated: asyncio.Future[None]
|
||||||
|
|
||||||
|
def set_packet_sink(self, sink: TransportSink) -> None:
|
||||||
|
...
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
class PacketPump:
|
||||||
|
"""
|
||||||
|
Pump HCI packets from a reader to a sink.
|
||||||
|
"""
|
||||||
|
|
||||||
|
def __init__(self, reader: AsyncPacketReader, sink: TransportSink) -> None:
|
||||||
self.reader = reader
|
self.reader = reader
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
|
|
||||||
async def run(self):
|
async def run(self) -> None:
|
||||||
while True:
|
while True:
|
||||||
try:
|
try:
|
||||||
# Get a packet from the source
|
|
||||||
packet = hci.HCI_Packet.from_bytes(await self.reader.next_packet())
|
|
||||||
|
|
||||||
# Deliver the packet to the sink
|
# Deliver the packet to the sink
|
||||||
self.sink.on_packet(packet)
|
self.sink.on_packet(await self.reader.next_packet())
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
logger.warning(f'!!! {error}')
|
logger.warning(f'!!! {error}')
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class PacketParser:
|
class PacketParser:
|
||||||
'''
|
"""
|
||||||
In-line parser that accepts data and emits 'on_packet' when a full packet has been
|
In-line parser that accepts data and emits 'on_packet' when a full packet has been
|
||||||
parsed
|
parsed.
|
||||||
'''
|
"""
|
||||||
|
|
||||||
# pylint: disable=attribute-defined-outside-init
|
# pylint: disable=attribute-defined-outside-init
|
||||||
|
|
||||||
@@ -79,18 +101,22 @@ class PacketParser:
|
|||||||
NEED_LENGTH = 1
|
NEED_LENGTH = 1
|
||||||
NEED_BODY = 2
|
NEED_BODY = 2
|
||||||
|
|
||||||
def __init__(self, sink=None):
|
sink: Optional[TransportSink]
|
||||||
|
extended_packet_info: Dict[int, Tuple[int, int, str]]
|
||||||
|
packet_info: Optional[Tuple[int, int, str]] = None
|
||||||
|
|
||||||
|
def __init__(self, sink: Optional[TransportSink] = None) -> None:
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
self.extended_packet_info = {}
|
self.extended_packet_info = {}
|
||||||
self.reset()
|
self.reset()
|
||||||
|
|
||||||
def reset(self):
|
def reset(self) -> None:
|
||||||
self.state = PacketParser.NEED_TYPE
|
self.state = PacketParser.NEED_TYPE
|
||||||
self.bytes_needed = 1
|
self.bytes_needed = 1
|
||||||
self.packet = bytearray()
|
self.packet = bytearray()
|
||||||
self.packet_info = None
|
self.packet_info = None
|
||||||
|
|
||||||
def feed_data(self, data):
|
def feed_data(self, data: bytes) -> None:
|
||||||
data_offset = 0
|
data_offset = 0
|
||||||
data_left = len(data)
|
data_left = len(data)
|
||||||
while data_left and self.bytes_needed:
|
while data_left and self.bytes_needed:
|
||||||
@@ -111,6 +137,7 @@ class PacketParser:
|
|||||||
self.state = PacketParser.NEED_LENGTH
|
self.state = PacketParser.NEED_LENGTH
|
||||||
self.bytes_needed = self.packet_info[0] + self.packet_info[1]
|
self.bytes_needed = self.packet_info[0] + self.packet_info[1]
|
||||||
elif self.state == PacketParser.NEED_LENGTH:
|
elif self.state == PacketParser.NEED_LENGTH:
|
||||||
|
assert self.packet_info is not None
|
||||||
body_length = struct.unpack_from(
|
body_length = struct.unpack_from(
|
||||||
self.packet_info[2], self.packet, 1 + self.packet_info[1]
|
self.packet_info[2], self.packet, 1 + self.packet_info[1]
|
||||||
)[0]
|
)[0]
|
||||||
@@ -128,20 +155,20 @@ class PacketParser:
|
|||||||
)
|
)
|
||||||
self.reset()
|
self.reset()
|
||||||
|
|
||||||
def set_packet_sink(self, sink):
|
def set_packet_sink(self, sink: TransportSink) -> None:
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class PacketReader:
|
class PacketReader:
|
||||||
'''
|
"""
|
||||||
Reader that reads HCI packets from a sync source
|
Reader that reads HCI packets from a sync source.
|
||||||
'''
|
"""
|
||||||
|
|
||||||
def __init__(self, source):
|
def __init__(self, source: io.BufferedReader) -> None:
|
||||||
self.source = source
|
self.source = source
|
||||||
|
|
||||||
def next_packet(self):
|
def next_packet(self) -> Optional[bytes]:
|
||||||
# Get the packet type
|
# Get the packet type
|
||||||
packet_type = self.source.read(1)
|
packet_type = self.source.read(1)
|
||||||
if len(packet_type) != 1:
|
if len(packet_type) != 1:
|
||||||
@@ -150,7 +177,7 @@ class PacketReader:
|
|||||||
# Get the packet info based on its type
|
# Get the packet info based on its type
|
||||||
packet_info = HCI_PACKET_INFO.get(packet_type[0])
|
packet_info = HCI_PACKET_INFO.get(packet_type[0])
|
||||||
if packet_info is None:
|
if packet_info is None:
|
||||||
raise ValueError(f'invalid packet type {packet_type} found')
|
raise ValueError(f'invalid packet type {packet_type[0]} found')
|
||||||
|
|
||||||
# Read the header (that includes the length)
|
# Read the header (that includes the length)
|
||||||
header_size = packet_info[0] + packet_info[1]
|
header_size = packet_info[0] + packet_info[1]
|
||||||
@@ -169,21 +196,21 @@ class PacketReader:
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class AsyncPacketReader:
|
class AsyncPacketReader:
|
||||||
'''
|
"""
|
||||||
Reader that reads HCI packets from an async source
|
Reader that reads HCI packets from an async source.
|
||||||
'''
|
"""
|
||||||
|
|
||||||
def __init__(self, source):
|
def __init__(self, source: asyncio.StreamReader) -> None:
|
||||||
self.source = source
|
self.source = source
|
||||||
|
|
||||||
async def next_packet(self):
|
async def next_packet(self) -> bytes:
|
||||||
# Get the packet type
|
# Get the packet type
|
||||||
packet_type = await self.source.readexactly(1)
|
packet_type = await self.source.readexactly(1)
|
||||||
|
|
||||||
# Get the packet info based on its type
|
# Get the packet info based on its type
|
||||||
packet_info = HCI_PACKET_INFO.get(packet_type[0])
|
packet_info = HCI_PACKET_INFO.get(packet_type[0])
|
||||||
if packet_info is None:
|
if packet_info is None:
|
||||||
raise ValueError(f'invalid packet type {packet_type} found')
|
raise ValueError(f'invalid packet type {packet_type[0]} found')
|
||||||
|
|
||||||
# Read the header (that includes the length)
|
# Read the header (that includes the length)
|
||||||
header_size = packet_info[0] + packet_info[1]
|
header_size = packet_info[0] + packet_info[1]
|
||||||
@@ -198,15 +225,15 @@ class AsyncPacketReader:
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class AsyncPipeSink:
|
class AsyncPipeSink:
|
||||||
'''
|
"""
|
||||||
Sink that forwards packets asynchronously to another sink
|
Sink that forwards packets asynchronously to another sink.
|
||||||
'''
|
"""
|
||||||
|
|
||||||
def __init__(self, sink):
|
def __init__(self, sink: TransportSink) -> None:
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
self.loop = asyncio.get_running_loop()
|
self.loop = asyncio.get_running_loop()
|
||||||
|
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
self.loop.call_soon(self.sink.on_packet, packet)
|
self.loop.call_soon(self.sink.on_packet, packet)
|
||||||
|
|
||||||
|
|
||||||
@@ -216,35 +243,48 @@ class ParserSource:
|
|||||||
Base class designed to be subclassed by transport-specific source classes
|
Base class designed to be subclassed by transport-specific source classes
|
||||||
"""
|
"""
|
||||||
|
|
||||||
def __init__(self):
|
terminated: asyncio.Future[None]
|
||||||
|
parser: PacketParser
|
||||||
|
|
||||||
|
def __init__(self) -> None:
|
||||||
self.parser = PacketParser()
|
self.parser = PacketParser()
|
||||||
self.terminated = asyncio.get_running_loop().create_future()
|
self.terminated = asyncio.get_running_loop().create_future()
|
||||||
|
|
||||||
def set_packet_sink(self, sink):
|
def set_packet_sink(self, sink: TransportSink) -> None:
|
||||||
self.parser.set_packet_sink(sink)
|
self.parser.set_packet_sink(sink)
|
||||||
|
|
||||||
async def wait_for_termination(self):
|
def on_transport_lost(self) -> None:
|
||||||
|
self.terminated.set_result(None)
|
||||||
|
if self.parser.sink:
|
||||||
|
if hasattr(self.parser.sink, 'on_transport_lost'):
|
||||||
|
self.parser.sink.on_transport_lost()
|
||||||
|
|
||||||
|
async def wait_for_termination(self) -> None:
|
||||||
|
"""
|
||||||
|
Convenience method for backward compatibility. Prefer using the `terminated`
|
||||||
|
attribute instead.
|
||||||
|
"""
|
||||||
return await self.terminated
|
return await self.terminated
|
||||||
|
|
||||||
def close(self):
|
def close(self) -> None:
|
||||||
pass
|
pass
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class StreamPacketSource(asyncio.Protocol, ParserSource):
|
class StreamPacketSource(asyncio.Protocol, ParserSource):
|
||||||
def data_received(self, data):
|
def data_received(self, data: bytes) -> None:
|
||||||
self.parser.feed_data(data)
|
self.parser.feed_data(data)
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class StreamPacketSink:
|
class StreamPacketSink:
|
||||||
def __init__(self, transport):
|
def __init__(self, transport: asyncio.WriteTransport) -> None:
|
||||||
self.transport = transport
|
self.transport = transport
|
||||||
|
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
self.transport.write(packet)
|
self.transport.write(packet)
|
||||||
|
|
||||||
def close(self):
|
def close(self) -> None:
|
||||||
self.transport.close()
|
self.transport.close()
|
||||||
|
|
||||||
|
|
||||||
@@ -264,7 +304,7 @@ class Transport:
|
|||||||
...
|
...
|
||||||
"""
|
"""
|
||||||
|
|
||||||
def __init__(self, source, sink):
|
def __init__(self, source: TransportSource, sink: TransportSink) -> None:
|
||||||
self.source = source
|
self.source = source
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
|
|
||||||
@@ -278,34 +318,39 @@ class Transport:
|
|||||||
return iter((self.source, self.sink))
|
return iter((self.source, self.sink))
|
||||||
|
|
||||||
async def close(self) -> None:
|
async def close(self) -> None:
|
||||||
self.source.close()
|
if hasattr(self.source, 'close'):
|
||||||
self.sink.close()
|
self.source.close()
|
||||||
|
if hasattr(self.sink, 'close'):
|
||||||
|
self.sink.close()
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class PumpedPacketSource(ParserSource):
|
class PumpedPacketSource(ParserSource):
|
||||||
def __init__(self, receive):
|
pump_task: Optional[asyncio.Task[None]]
|
||||||
|
|
||||||
|
def __init__(self, receive) -> None:
|
||||||
super().__init__()
|
super().__init__()
|
||||||
self.receive_function = receive
|
self.receive_function = receive
|
||||||
self.pump_task = None
|
self.pump_task = None
|
||||||
|
|
||||||
def start(self):
|
def start(self) -> None:
|
||||||
async def pump_packets():
|
async def pump_packets() -> None:
|
||||||
while True:
|
while True:
|
||||||
try:
|
try:
|
||||||
packet = await self.receive_function()
|
packet = await self.receive_function()
|
||||||
self.parser.feed_data(packet)
|
self.parser.feed_data(packet)
|
||||||
except asyncio.exceptions.CancelledError:
|
except asyncio.CancelledError:
|
||||||
logger.debug('source pump task done')
|
logger.debug('source pump task done')
|
||||||
|
self.terminated.set_result(None)
|
||||||
break
|
break
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
logger.warning(f'exception while waiting for packet: {error}')
|
logger.warning(f'exception while waiting for packet: {error}')
|
||||||
self.terminated.set_result(error)
|
self.terminated.set_exception(error)
|
||||||
break
|
break
|
||||||
|
|
||||||
self.pump_task = asyncio.create_task(pump_packets())
|
self.pump_task = asyncio.create_task(pump_packets())
|
||||||
|
|
||||||
def close(self):
|
def close(self) -> None:
|
||||||
if self.pump_task:
|
if self.pump_task:
|
||||||
self.pump_task.cancel()
|
self.pump_task.cancel()
|
||||||
|
|
||||||
@@ -317,7 +362,7 @@ class PumpedPacketSink:
|
|||||||
self.packet_queue = asyncio.Queue()
|
self.packet_queue = asyncio.Queue()
|
||||||
self.pump_task = None
|
self.pump_task = None
|
||||||
|
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
self.packet_queue.put_nowait(packet)
|
self.packet_queue.put_nowait(packet)
|
||||||
|
|
||||||
def start(self):
|
def start(self):
|
||||||
@@ -326,7 +371,7 @@ class PumpedPacketSink:
|
|||||||
try:
|
try:
|
||||||
packet = await self.packet_queue.get()
|
packet = await self.packet_queue.get()
|
||||||
await self.send_function(packet)
|
await self.send_function(packet)
|
||||||
except asyncio.exceptions.CancelledError:
|
except asyncio.CancelledError:
|
||||||
logger.debug('sink pump task done')
|
logger.debug('sink pump task done')
|
||||||
break
|
break
|
||||||
except Exception as error:
|
except Exception as error:
|
||||||
@@ -342,18 +387,20 @@ class PumpedPacketSink:
|
|||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class PumpedTransport(Transport):
|
class PumpedTransport(Transport):
|
||||||
def __init__(self, source, sink, close_function):
|
source: PumpedPacketSource
|
||||||
super().__init__(source, sink)
|
sink: PumpedPacketSink
|
||||||
self.close_function = close_function
|
|
||||||
|
|
||||||
def start(self):
|
def __init__(
|
||||||
|
self,
|
||||||
|
source: PumpedPacketSource,
|
||||||
|
sink: PumpedPacketSink,
|
||||||
|
) -> None:
|
||||||
|
super().__init__(source, sink)
|
||||||
|
|
||||||
|
def start(self) -> None:
|
||||||
self.source.start()
|
self.source.start()
|
||||||
self.sink.start()
|
self.sink.start()
|
||||||
|
|
||||||
async def close(self):
|
|
||||||
await super().close()
|
|
||||||
await self.close_function()
|
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
class SnoopingTransport(Transport):
|
class SnoopingTransport(Transport):
|
||||||
@@ -375,31 +422,38 @@ class SnoopingTransport(Transport):
|
|||||||
raise RuntimeError('unexpected code path') # Satisfy the type checker
|
raise RuntimeError('unexpected code path') # Satisfy the type checker
|
||||||
|
|
||||||
class Source:
|
class Source:
|
||||||
def __init__(self, source, snooper):
|
sink: TransportSink
|
||||||
|
|
||||||
|
def __init__(self, source: TransportSource, snooper: Snooper):
|
||||||
self.source = source
|
self.source = source
|
||||||
self.snooper = snooper
|
self.snooper = snooper
|
||||||
self.sink = None
|
self.terminated = source.terminated
|
||||||
|
|
||||||
def set_packet_sink(self, sink):
|
def set_packet_sink(self, sink: TransportSink) -> None:
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
self.source.set_packet_sink(self)
|
self.source.set_packet_sink(self)
|
||||||
|
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
self.snooper.snoop(packet, Snooper.Direction.CONTROLLER_TO_HOST)
|
self.snooper.snoop(packet, Snooper.Direction.CONTROLLER_TO_HOST)
|
||||||
if self.sink:
|
if self.sink:
|
||||||
self.sink.on_packet(packet)
|
self.sink.on_packet(packet)
|
||||||
|
|
||||||
class Sink:
|
class Sink:
|
||||||
def __init__(self, sink, snooper):
|
def __init__(self, sink: TransportSink, snooper: Snooper) -> None:
|
||||||
self.sink = sink
|
self.sink = sink
|
||||||
self.snooper = snooper
|
self.snooper = snooper
|
||||||
|
|
||||||
def on_packet(self, packet):
|
def on_packet(self, packet: bytes) -> None:
|
||||||
self.snooper.snoop(packet, Snooper.Direction.HOST_TO_CONTROLLER)
|
self.snooper.snoop(packet, Snooper.Direction.HOST_TO_CONTROLLER)
|
||||||
if self.sink:
|
if self.sink:
|
||||||
self.sink.on_packet(packet)
|
self.sink.on_packet(packet)
|
||||||
|
|
||||||
def __init__(self, transport, snooper, close_snooper=None):
|
def __init__(
|
||||||
|
self,
|
||||||
|
transport: Transport,
|
||||||
|
snooper: Snooper,
|
||||||
|
close_snooper=None,
|
||||||
|
) -> None:
|
||||||
super().__init__(
|
super().__init__(
|
||||||
self.Source(transport.source, snooper), self.Sink(transport.sink, snooper)
|
self.Source(transport.source, snooper), self.Sink(transport.sink, snooper)
|
||||||
)
|
)
|
||||||
|
|||||||
@@ -28,7 +28,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_file_transport(spec):
|
async def open_file_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a File transport (typically not for a real file, but for a PTY or other unix
|
Open a File transport (typically not for a real file, but for a PTY or other unix
|
||||||
virtual files).
|
virtual files).
|
||||||
|
|||||||
@@ -23,6 +23,8 @@ import socket
|
|||||||
import ctypes
|
import ctypes
|
||||||
import collections
|
import collections
|
||||||
|
|
||||||
|
from typing import Optional
|
||||||
|
|
||||||
from .common import Transport, ParserSource
|
from .common import Transport, ParserSource
|
||||||
|
|
||||||
|
|
||||||
@@ -33,7 +35,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_hci_socket_transport(spec):
|
async def open_hci_socket_transport(spec: Optional[str]) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open an HCI Socket (only available on some platforms).
|
Open an HCI Socket (only available on some platforms).
|
||||||
The parameter string is either empty (to use the first/default Bluetooth adapter)
|
The parameter string is either empty (to use the first/default Bluetooth adapter)
|
||||||
@@ -45,9 +47,9 @@ async def open_hci_socket_transport(spec):
|
|||||||
# Create a raw HCI socket
|
# Create a raw HCI socket
|
||||||
try:
|
try:
|
||||||
hci_socket = socket.socket(
|
hci_socket = socket.socket(
|
||||||
socket.AF_BLUETOOTH,
|
socket.AF_BLUETOOTH, # type: ignore[attr-defined]
|
||||||
socket.SOCK_RAW | socket.SOCK_NONBLOCK,
|
socket.SOCK_RAW | socket.SOCK_NONBLOCK, # type: ignore[attr-defined]
|
||||||
socket.BTPROTO_HCI,
|
socket.BTPROTO_HCI, # type: ignore[attr-defined]
|
||||||
)
|
)
|
||||||
except AttributeError as error:
|
except AttributeError as error:
|
||||||
# Not supported on this platform
|
# Not supported on this platform
|
||||||
@@ -78,7 +80,7 @@ async def open_hci_socket_transport(spec):
|
|||||||
bind_address = struct.pack(
|
bind_address = struct.pack(
|
||||||
# pylint: disable=no-member
|
# pylint: disable=no-member
|
||||||
'<HHH',
|
'<HHH',
|
||||||
socket.AF_BLUETOOTH,
|
socket.AF_BLUETOOTH, # type: ignore[attr-defined]
|
||||||
adapter_index,
|
adapter_index,
|
||||||
HCI_CHANNEL_USER,
|
HCI_CHANNEL_USER,
|
||||||
)
|
)
|
||||||
|
|||||||
@@ -23,6 +23,8 @@ import atexit
|
|||||||
import os
|
import os
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
|
from typing import Optional
|
||||||
|
|
||||||
from .common import Transport, StreamPacketSource, StreamPacketSink
|
from .common import Transport, StreamPacketSource, StreamPacketSink
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -32,7 +34,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_pty_transport(spec):
|
async def open_pty_transport(spec: Optional[str]) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a PTY transport.
|
Open a PTY transport.
|
||||||
The parameter string may be empty, or a path name where a symbolic link
|
The parameter string may be empty, or a path name where a symbolic link
|
||||||
|
|||||||
@@ -35,7 +35,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_pyusb_transport(spec):
|
async def open_pyusb_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a USB transport. [Implementation based on PyUSB]
|
Open a USB transport. [Implementation based on PyUSB]
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
|
|||||||
@@ -28,7 +28,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_serial_transport(spec):
|
async def open_serial_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a serial port transport.
|
Open a serial port transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
|
|||||||
@@ -27,7 +27,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_tcp_client_transport(spec):
|
async def open_tcp_client_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a TCP client transport.
|
Open a TCP client transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
@@ -39,7 +39,7 @@ async def open_tcp_client_transport(spec):
|
|||||||
class TcpPacketSource(StreamPacketSource):
|
class TcpPacketSource(StreamPacketSource):
|
||||||
def connection_lost(self, exc):
|
def connection_lost(self, exc):
|
||||||
logger.debug(f'connection lost: {exc}')
|
logger.debug(f'connection lost: {exc}')
|
||||||
self.terminated.set_result(exc)
|
self.on_transport_lost()
|
||||||
|
|
||||||
remote_host, remote_port = spec.split(':')
|
remote_host, remote_port = spec.split(':')
|
||||||
tcp_transport, packet_source = await asyncio.get_running_loop().create_connection(
|
tcp_transport, packet_source = await asyncio.get_running_loop().create_connection(
|
||||||
|
|||||||
@@ -15,6 +15,7 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
@@ -27,7 +28,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_tcp_server_transport(spec):
|
async def open_tcp_server_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a TCP server transport.
|
Open a TCP server transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
@@ -42,7 +43,7 @@ async def open_tcp_server_transport(spec):
|
|||||||
async def close(self):
|
async def close(self):
|
||||||
await super().close()
|
await super().close()
|
||||||
|
|
||||||
class TcpServerProtocol:
|
class TcpServerProtocol(asyncio.BaseProtocol):
|
||||||
def __init__(self, packet_source, packet_sink):
|
def __init__(self, packet_source, packet_sink):
|
||||||
self.packet_source = packet_source
|
self.packet_source = packet_source
|
||||||
self.packet_sink = packet_sink
|
self.packet_sink = packet_sink
|
||||||
|
|||||||
@@ -27,7 +27,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_udp_transport(spec):
|
async def open_udp_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a UDP transport.
|
Open a UDP transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
|
|||||||
@@ -60,7 +60,7 @@ def load_libusb():
|
|||||||
usb1.loadLibrary(libusb_dll)
|
usb1.loadLibrary(libusb_dll)
|
||||||
|
|
||||||
|
|
||||||
async def open_usb_transport(spec):
|
async def open_usb_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a USB transport.
|
Open a USB transport.
|
||||||
The moniker string has this syntax:
|
The moniker string has this syntax:
|
||||||
|
|||||||
@@ -17,6 +17,9 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
|
from typing import Optional
|
||||||
|
|
||||||
|
from .common import Transport
|
||||||
from .file import open_file_transport
|
from .file import open_file_transport
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -26,7 +29,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_vhci_transport(spec):
|
async def open_vhci_transport(spec: Optional[str]) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a VHCI transport (only available on some platforms).
|
Open a VHCI transport (only available on some platforms).
|
||||||
The parameter string is either empty (to use the default VHCI device
|
The parameter string is either empty (to use the default VHCI device
|
||||||
@@ -42,15 +45,15 @@ async def open_vhci_transport(spec):
|
|||||||
# Override the source's `data_received` method so that we can
|
# Override the source's `data_received` method so that we can
|
||||||
# filter out the vendor packet that is received just after the
|
# filter out the vendor packet that is received just after the
|
||||||
# initial open
|
# initial open
|
||||||
def vhci_data_received(data):
|
def vhci_data_received(data: bytes) -> None:
|
||||||
if len(data) > 0 and data[0] == HCI_VENDOR_PKT:
|
if len(data) > 0 and data[0] == HCI_VENDOR_PKT:
|
||||||
if len(data) == 4:
|
if len(data) == 4:
|
||||||
hci_index = data[2] << 8 | data[3]
|
hci_index = data[2] << 8 | data[3]
|
||||||
logger.info(f'HCI index {hci_index}')
|
logger.info(f'HCI index {hci_index}')
|
||||||
else:
|
else:
|
||||||
transport.source.parser.feed_data(data)
|
transport.source.parser.feed_data(data) # type: ignore
|
||||||
|
|
||||||
transport.source.data_received = vhci_data_received
|
transport.source.data_received = vhci_data_received # type: ignore
|
||||||
|
|
||||||
# Write the initial config
|
# Write the initial config
|
||||||
transport.sink.on_packet(bytes([HCI_VENDOR_PKT, HCI_BREDR]))
|
transport.sink.on_packet(bytes([HCI_VENDOR_PKT, HCI_BREDR]))
|
||||||
|
|||||||
@@ -16,9 +16,9 @@
|
|||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
import logging
|
import logging
|
||||||
import websockets
|
import websockets.client
|
||||||
|
|
||||||
from .common import PumpedPacketSource, PumpedPacketSink, PumpedTransport
|
from .common import PumpedPacketSource, PumpedPacketSink, PumpedTransport, Transport
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Logging
|
# Logging
|
||||||
@@ -27,23 +27,25 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_ws_client_transport(spec):
|
async def open_ws_client_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a WebSocket client transport.
|
Open a WebSocket client transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
<remote-host>:<remote-port>
|
<websocket-url>
|
||||||
|
|
||||||
Example: 127.0.0.1:9001
|
Example: ws://localhost:7681/v1/websocket/bt
|
||||||
'''
|
'''
|
||||||
|
|
||||||
remote_host, remote_port = spec.split(':')
|
websocket = await websockets.client.connect(spec)
|
||||||
uri = f'ws://{remote_host}:{remote_port}'
|
|
||||||
websocket = await websockets.connect(uri)
|
|
||||||
|
|
||||||
transport = PumpedTransport(
|
class WsTransport(PumpedTransport):
|
||||||
|
async def close(self):
|
||||||
|
await super().close()
|
||||||
|
await websocket.close()
|
||||||
|
|
||||||
|
transport = WsTransport(
|
||||||
PumpedPacketSource(websocket.recv),
|
PumpedPacketSource(websocket.recv),
|
||||||
PumpedPacketSink(websocket.send),
|
PumpedPacketSink(websocket.send),
|
||||||
websocket.close,
|
|
||||||
)
|
)
|
||||||
transport.start()
|
transport.start()
|
||||||
return transport
|
return transport
|
||||||
|
|||||||
@@ -15,7 +15,6 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
import asyncio
|
|
||||||
import logging
|
import logging
|
||||||
import websockets
|
import websockets
|
||||||
|
|
||||||
@@ -28,7 +27,7 @@ logger = logging.getLogger(__name__)
|
|||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
async def open_ws_server_transport(spec):
|
async def open_ws_server_transport(spec: str) -> Transport:
|
||||||
'''
|
'''
|
||||||
Open a WebSocket server transport.
|
Open a WebSocket server transport.
|
||||||
The parameter string has this syntax:
|
The parameter string has this syntax:
|
||||||
@@ -43,7 +42,7 @@ async def open_ws_server_transport(spec):
|
|||||||
def __init__(self):
|
def __init__(self):
|
||||||
source = ParserSource()
|
source = ParserSource()
|
||||||
sink = PumpedPacketSink(self.send_packet)
|
sink = PumpedPacketSink(self.send_packet)
|
||||||
self.connection = asyncio.get_running_loop().create_future()
|
self.connection = None
|
||||||
self.server = None
|
self.server = None
|
||||||
|
|
||||||
super().__init__(source, sink)
|
super().__init__(source, sink)
|
||||||
@@ -63,7 +62,7 @@ async def open_ws_server_transport(spec):
|
|||||||
f'new connection on {connection.local_address} '
|
f'new connection on {connection.local_address} '
|
||||||
f'from {connection.remote_address}'
|
f'from {connection.remote_address}'
|
||||||
)
|
)
|
||||||
self.connection.set_result(connection)
|
self.connection = connection
|
||||||
# pylint: disable=no-member
|
# pylint: disable=no-member
|
||||||
try:
|
try:
|
||||||
async for packet in connection:
|
async for packet in connection:
|
||||||
@@ -74,12 +73,14 @@ async def open_ws_server_transport(spec):
|
|||||||
except websockets.WebSocketException as error:
|
except websockets.WebSocketException as error:
|
||||||
logger.debug(f'exception while receiving packet: {error}')
|
logger.debug(f'exception while receiving packet: {error}')
|
||||||
|
|
||||||
# Wait for a new connection
|
# We're now disconnected
|
||||||
self.connection = asyncio.get_running_loop().create_future()
|
self.connection = None
|
||||||
|
|
||||||
async def send_packet(self, packet):
|
async def send_packet(self, packet):
|
||||||
connection = await self.connection
|
if self.connection is None:
|
||||||
return await connection.send(packet)
|
logger.debug('no connection, dropping packet')
|
||||||
|
return
|
||||||
|
return await self.connection.send(packet)
|
||||||
|
|
||||||
local_host, local_port = spec.split(':')
|
local_host, local_port = spec.split(':')
|
||||||
transport = WsServerTransport()
|
transport = WsServerTransport()
|
||||||
|
|||||||
+144
-2
@@ -15,13 +15,26 @@
|
|||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
# Imports
|
# Imports
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
|
from __future__ import annotations
|
||||||
import asyncio
|
import asyncio
|
||||||
import logging
|
import logging
|
||||||
import traceback
|
import traceback
|
||||||
import collections
|
import collections
|
||||||
import sys
|
import sys
|
||||||
from typing import Awaitable, Set, TypeVar
|
import warnings
|
||||||
from functools import wraps
|
from typing import (
|
||||||
|
Awaitable,
|
||||||
|
Set,
|
||||||
|
TypeVar,
|
||||||
|
List,
|
||||||
|
Tuple,
|
||||||
|
Callable,
|
||||||
|
Any,
|
||||||
|
Optional,
|
||||||
|
Union,
|
||||||
|
overload,
|
||||||
|
)
|
||||||
|
from functools import wraps, partial
|
||||||
from pyee import EventEmitter
|
from pyee import EventEmitter
|
||||||
|
|
||||||
from .colors import color
|
from .colors import color
|
||||||
@@ -64,6 +77,102 @@ def composite_listener(cls):
|
|||||||
return cls
|
return cls
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
_Handler = TypeVar('_Handler', bound=Callable)
|
||||||
|
|
||||||
|
|
||||||
|
class EventWatcher:
|
||||||
|
'''A wrapper class to control the lifecycle of event handlers better.
|
||||||
|
|
||||||
|
Usage:
|
||||||
|
```
|
||||||
|
watcher = EventWatcher()
|
||||||
|
|
||||||
|
def on_foo():
|
||||||
|
...
|
||||||
|
watcher.on(emitter, 'foo', on_foo)
|
||||||
|
|
||||||
|
@watcher.on(emitter, 'bar')
|
||||||
|
def on_bar():
|
||||||
|
...
|
||||||
|
|
||||||
|
# Close all event handlers watching through this watcher
|
||||||
|
watcher.close()
|
||||||
|
```
|
||||||
|
|
||||||
|
As context:
|
||||||
|
```
|
||||||
|
with contextlib.closing(EventWatcher()) as context:
|
||||||
|
@context.on(emitter, 'foo')
|
||||||
|
def on_foo():
|
||||||
|
...
|
||||||
|
# on_foo() has been removed here!
|
||||||
|
```
|
||||||
|
'''
|
||||||
|
|
||||||
|
handlers: List[Tuple[EventEmitter, str, Callable[..., Any]]]
|
||||||
|
|
||||||
|
def __init__(self) -> None:
|
||||||
|
self.handlers = []
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def on(self, emitter: EventEmitter, event: str) -> Callable[[_Handler], _Handler]:
|
||||||
|
...
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def on(self, emitter: EventEmitter, event: str, handler: _Handler) -> _Handler:
|
||||||
|
...
|
||||||
|
|
||||||
|
def on(
|
||||||
|
self, emitter: EventEmitter, event: str, handler: Optional[_Handler] = None
|
||||||
|
) -> Union[_Handler, Callable[[_Handler], _Handler]]:
|
||||||
|
'''Watch an event until the context is closed.
|
||||||
|
|
||||||
|
Args:
|
||||||
|
emitter: EventEmitter to watch
|
||||||
|
event: Event name
|
||||||
|
handler: (Optional) Event handler. When nothing is passed, this method works as a decorator.
|
||||||
|
'''
|
||||||
|
|
||||||
|
def wrapper(f: _Handler) -> _Handler:
|
||||||
|
self.handlers.append((emitter, event, f))
|
||||||
|
emitter.on(event, f)
|
||||||
|
return f
|
||||||
|
|
||||||
|
return wrapper if handler is None else wrapper(handler)
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def once(self, emitter: EventEmitter, event: str) -> Callable[[_Handler], _Handler]:
|
||||||
|
...
|
||||||
|
|
||||||
|
@overload
|
||||||
|
def once(self, emitter: EventEmitter, event: str, handler: _Handler) -> _Handler:
|
||||||
|
...
|
||||||
|
|
||||||
|
def once(
|
||||||
|
self, emitter: EventEmitter, event: str, handler: Optional[_Handler] = None
|
||||||
|
) -> Union[_Handler, Callable[[_Handler], _Handler]]:
|
||||||
|
'''Watch an event for once.
|
||||||
|
|
||||||
|
Args:
|
||||||
|
emitter: EventEmitter to watch
|
||||||
|
event: Event name
|
||||||
|
handler: (Optional) Event handler. When nothing passed, this method works as a decorator.
|
||||||
|
'''
|
||||||
|
|
||||||
|
def wrapper(f: _Handler) -> _Handler:
|
||||||
|
self.handlers.append((emitter, event, f))
|
||||||
|
emitter.once(event, f)
|
||||||
|
return f
|
||||||
|
|
||||||
|
return wrapper if handler is None else wrapper(handler)
|
||||||
|
|
||||||
|
def close(self) -> None:
|
||||||
|
for emitter, event, handler in self.handlers:
|
||||||
|
if handler in emitter.listeners(event):
|
||||||
|
emitter.remove_listener(event, handler)
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
_T = TypeVar('_T')
|
_T = TypeVar('_T')
|
||||||
|
|
||||||
@@ -302,3 +411,36 @@ class FlowControlAsyncPipe:
|
|||||||
self.resume_source()
|
self.resume_source()
|
||||||
|
|
||||||
self.check_pump()
|
self.check_pump()
|
||||||
|
|
||||||
|
|
||||||
|
async def async_call(function, *args, **kwargs):
|
||||||
|
"""
|
||||||
|
Immediately calls the function with provided args and kwargs, wrapping it in an async function.
|
||||||
|
Rust's `pyo3_asyncio` library needs functions to be marked async to properly inject a running loop.
|
||||||
|
|
||||||
|
result = await async_call(some_function, ...)
|
||||||
|
"""
|
||||||
|
return function(*args, **kwargs)
|
||||||
|
|
||||||
|
|
||||||
|
def wrap_async(function):
|
||||||
|
"""
|
||||||
|
Wraps the provided function in an async function.
|
||||||
|
"""
|
||||||
|
return partial(async_call, function)
|
||||||
|
|
||||||
|
|
||||||
|
def deprecated(msg: str):
|
||||||
|
"""
|
||||||
|
Throw deprecation warning before execution
|
||||||
|
"""
|
||||||
|
|
||||||
|
def wrapper(function):
|
||||||
|
@wraps(function)
|
||||||
|
def inner(*args, **kwargs):
|
||||||
|
warnings.warn(msg, DeprecationWarning)
|
||||||
|
return function(*args, **kwargs)
|
||||||
|
|
||||||
|
return inner
|
||||||
|
|
||||||
|
return wrapper
|
||||||
|
|||||||
Vendored
Vendored
+318
@@ -0,0 +1,318 @@
|
|||||||
|
# Copyright 2021-2023 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 struct
|
||||||
|
|
||||||
|
from bumble.hci import (
|
||||||
|
name_or_number,
|
||||||
|
hci_vendor_command_op_code,
|
||||||
|
Address,
|
||||||
|
HCI_Constant,
|
||||||
|
HCI_Object,
|
||||||
|
HCI_Command,
|
||||||
|
HCI_Vendor_Event,
|
||||||
|
STATUS_SPEC,
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Constants
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
# Android Vendor Specific Commands and Events.
|
||||||
|
# Only a subset of the commands are implemented here currently.
|
||||||
|
#
|
||||||
|
# pylint: disable-next=line-too-long
|
||||||
|
# See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#chip-capabilities-and-configuration
|
||||||
|
HCI_LE_GET_VENDOR_CAPABILITIES_COMMAND = hci_vendor_command_op_code(0x153)
|
||||||
|
HCI_LE_APCF_COMMAND = hci_vendor_command_op_code(0x157)
|
||||||
|
HCI_GET_CONTROLLER_ACTIVITY_ENERGY_INFO_COMMAND = hci_vendor_command_op_code(0x159)
|
||||||
|
HCI_A2DP_HARDWARE_OFFLOAD_COMMAND = hci_vendor_command_op_code(0x15D)
|
||||||
|
HCI_BLUETOOTH_QUALITY_REPORT_COMMAND = hci_vendor_command_op_code(0x15E)
|
||||||
|
HCI_DYNAMIC_AUDIO_BUFFER_COMMAND = hci_vendor_command_op_code(0x15F)
|
||||||
|
|
||||||
|
HCI_BLUETOOTH_QUALITY_REPORT_EVENT = 0x58
|
||||||
|
|
||||||
|
HCI_Command.register_commands(globals())
|
||||||
|
HCI_Vendor_Event.register_subevents(globals())
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
('max_advt_instances', 1),
|
||||||
|
('offloaded_resolution_of_private_address', 1),
|
||||||
|
('total_scan_results_storage', 2),
|
||||||
|
('max_irk_list_sz', 1),
|
||||||
|
('filtering_support', 1),
|
||||||
|
('max_filter', 1),
|
||||||
|
('activity_energy_info_support', 1),
|
||||||
|
('version_supported', 2),
|
||||||
|
('total_num_of_advt_tracked', 2),
|
||||||
|
('extended_scan_support', 1),
|
||||||
|
('debug_logging_supported', 1),
|
||||||
|
('le_address_generation_offloading_support', 1),
|
||||||
|
('a2dp_source_offload_capability_mask', 4),
|
||||||
|
('bluetooth_quality_report_support', 1),
|
||||||
|
('dynamic_audio_buffer_support', 4),
|
||||||
|
]
|
||||||
|
)
|
||||||
|
class HCI_LE_Get_Vendor_Capabilities_Command(HCI_Command):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#vendor-specific-capabilities
|
||||||
|
'''
|
||||||
|
|
||||||
|
@classmethod
|
||||||
|
def parse_return_parameters(cls, parameters):
|
||||||
|
# There are many versions of this data structure, so we need to parse until
|
||||||
|
# there are no more bytes to parse, and leave un-signal parameters set to
|
||||||
|
# None (older versions)
|
||||||
|
nones = {field: None for field, _ in cls.return_parameters_fields}
|
||||||
|
return_parameters = HCI_Object(cls.return_parameters_fields, **nones)
|
||||||
|
|
||||||
|
try:
|
||||||
|
offset = 0
|
||||||
|
for field in cls.return_parameters_fields:
|
||||||
|
field_name, field_type = field
|
||||||
|
field_value, field_size = HCI_Object.parse_field(
|
||||||
|
parameters, offset, field_type
|
||||||
|
)
|
||||||
|
setattr(return_parameters, field_name, field_value)
|
||||||
|
offset += field_size
|
||||||
|
except struct.error:
|
||||||
|
pass
|
||||||
|
|
||||||
|
return return_parameters
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
fields=[
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_LE_APCF_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_LE_APCF_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_LE_APCF_Command(HCI_Command):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#le_apcf_command
|
||||||
|
|
||||||
|
NOTE: the subcommand-specific payloads are left as opaque byte arrays in this
|
||||||
|
implementation. A future enhancement may define subcommand-specific data structures.
|
||||||
|
'''
|
||||||
|
|
||||||
|
# APCF Subcommands
|
||||||
|
# TODO: use the OpenIntEnum class (when upcoming PR is merged)
|
||||||
|
APCF_ENABLE = 0x00
|
||||||
|
APCF_SET_FILTERING_PARAMETERS = 0x01
|
||||||
|
APCF_BROADCASTER_ADDRESS = 0x02
|
||||||
|
APCF_SERVICE_UUID = 0x03
|
||||||
|
APCF_SERVICE_SOLICITATION_UUID = 0x04
|
||||||
|
APCF_LOCAL_NAME = 0x05
|
||||||
|
APCF_MANUFACTURER_DATA = 0x06
|
||||||
|
APCF_SERVICE_DATA = 0x07
|
||||||
|
APCF_TRANSPORT_DISCOVERY_SERVICE = 0x08
|
||||||
|
APCF_AD_TYPE_FILTER = 0x09
|
||||||
|
APCF_READ_EXTENDED_FEATURES = 0xFF
|
||||||
|
|
||||||
|
OPCODE_NAMES = {
|
||||||
|
APCF_ENABLE: 'APCF_ENABLE',
|
||||||
|
APCF_SET_FILTERING_PARAMETERS: 'APCF_SET_FILTERING_PARAMETERS',
|
||||||
|
APCF_BROADCASTER_ADDRESS: 'APCF_BROADCASTER_ADDRESS',
|
||||||
|
APCF_SERVICE_UUID: 'APCF_SERVICE_UUID',
|
||||||
|
APCF_SERVICE_SOLICITATION_UUID: 'APCF_SERVICE_SOLICITATION_UUID',
|
||||||
|
APCF_LOCAL_NAME: 'APCF_LOCAL_NAME',
|
||||||
|
APCF_MANUFACTURER_DATA: 'APCF_MANUFACTURER_DATA',
|
||||||
|
APCF_SERVICE_DATA: 'APCF_SERVICE_DATA',
|
||||||
|
APCF_TRANSPORT_DISCOVERY_SERVICE: 'APCF_TRANSPORT_DISCOVERY_SERVICE',
|
||||||
|
APCF_AD_TYPE_FILTER: 'APCF_AD_TYPE_FILTER',
|
||||||
|
APCF_READ_EXTENDED_FEATURES: 'APCF_READ_EXTENDED_FEATURES',
|
||||||
|
}
|
||||||
|
|
||||||
|
@classmethod
|
||||||
|
def opcode_name(cls, opcode):
|
||||||
|
return name_or_number(cls.OPCODE_NAMES, opcode)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
('total_tx_time_ms', 4),
|
||||||
|
('total_rx_time_ms', 4),
|
||||||
|
('total_idle_time_ms', 4),
|
||||||
|
('total_energy_used', 4),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_Get_Controller_Activity_Energy_Info_Command(HCI_Command):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#le_get_controller_activity_energy_info
|
||||||
|
'''
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
fields=[
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_A2DP_Hardware_Offload_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_A2DP_Hardware_Offload_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_A2DP_Hardware_Offload_Command(HCI_Command):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#a2dp-hardware-offload-support
|
||||||
|
|
||||||
|
NOTE: the subcommand-specific payloads are left as opaque byte arrays in this
|
||||||
|
implementation. A future enhancement may define subcommand-specific data structures.
|
||||||
|
'''
|
||||||
|
|
||||||
|
# A2DP Hardware Offload Subcommands
|
||||||
|
# TODO: use the OpenIntEnum class (when upcoming PR is merged)
|
||||||
|
START_A2DP_OFFLOAD = 0x01
|
||||||
|
STOP_A2DP_OFFLOAD = 0x02
|
||||||
|
|
||||||
|
OPCODE_NAMES = {
|
||||||
|
START_A2DP_OFFLOAD: 'START_A2DP_OFFLOAD',
|
||||||
|
STOP_A2DP_OFFLOAD: 'STOP_A2DP_OFFLOAD',
|
||||||
|
}
|
||||||
|
|
||||||
|
@classmethod
|
||||||
|
def opcode_name(cls, opcode):
|
||||||
|
return name_or_number(cls.OPCODE_NAMES, opcode)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
fields=[
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_Dynamic_Audio_Buffer_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
(
|
||||||
|
'opcode',
|
||||||
|
{
|
||||||
|
'size': 1,
|
||||||
|
'mapper': lambda x: HCI_Dynamic_Audio_Buffer_Command.opcode_name(x),
|
||||||
|
},
|
||||||
|
),
|
||||||
|
('payload', '*'),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_Dynamic_Audio_Buffer_Command(HCI_Command):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#dynamic-audio-buffer-command
|
||||||
|
|
||||||
|
NOTE: the subcommand-specific payloads are left as opaque byte arrays in this
|
||||||
|
implementation. A future enhancement may define subcommand-specific data structures.
|
||||||
|
'''
|
||||||
|
|
||||||
|
# Dynamic Audio Buffer Subcommands
|
||||||
|
# TODO: use the OpenIntEnum class (when upcoming PR is merged)
|
||||||
|
GET_AUDIO_BUFFER_TIME_CAPABILITY = 0x01
|
||||||
|
|
||||||
|
OPCODE_NAMES = {
|
||||||
|
GET_AUDIO_BUFFER_TIME_CAPABILITY: 'GET_AUDIO_BUFFER_TIME_CAPABILITY',
|
||||||
|
}
|
||||||
|
|
||||||
|
@classmethod
|
||||||
|
def opcode_name(cls, opcode):
|
||||||
|
return name_or_number(cls.OPCODE_NAMES, opcode)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Vendor_Event.event(
|
||||||
|
fields=[
|
||||||
|
('quality_report_id', 1),
|
||||||
|
('packet_types', 1),
|
||||||
|
('connection_handle', 2),
|
||||||
|
('connection_role', {'size': 1, 'mapper': HCI_Constant.role_name}),
|
||||||
|
('tx_power_level', -1),
|
||||||
|
('rssi', -1),
|
||||||
|
('snr', 1),
|
||||||
|
('unused_afh_channel_count', 1),
|
||||||
|
('afh_select_unideal_channel_count', 1),
|
||||||
|
('lsto', 2),
|
||||||
|
('connection_piconet_clock', 4),
|
||||||
|
('retransmission_count', 4),
|
||||||
|
('no_rx_count', 4),
|
||||||
|
('nak_count', 4),
|
||||||
|
('last_tx_ack_timestamp', 4),
|
||||||
|
('flow_off_count', 4),
|
||||||
|
('last_flow_on_timestamp', 4),
|
||||||
|
('buffer_overflow_bytes', 4),
|
||||||
|
('buffer_underflow_bytes', 4),
|
||||||
|
('bdaddr', Address.parse_address),
|
||||||
|
('cal_failed_item_count', 1),
|
||||||
|
('tx_total_packets', 4),
|
||||||
|
('tx_unacked_packets', 4),
|
||||||
|
('tx_flushed_packets', 4),
|
||||||
|
('tx_last_subevent_packets', 4),
|
||||||
|
('crc_error_packets', 4),
|
||||||
|
('rx_duplicate_packets', 4),
|
||||||
|
('vendor_specific_parameters', '*'),
|
||||||
|
]
|
||||||
|
)
|
||||||
|
class HCI_Bluetooth_Quality_Report_Event(HCI_Vendor_Event):
|
||||||
|
# pylint: disable=line-too-long
|
||||||
|
'''
|
||||||
|
See https://source.android.com/docs/core/connect/bluetooth/hci_requirements#bluetooth-quality-report-sub-event
|
||||||
|
'''
|
||||||
Vendored
+88
@@ -0,0 +1,88 @@
|
|||||||
|
# Copyright 2021-2023 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 bumble.hci import (
|
||||||
|
hci_vendor_command_op_code,
|
||||||
|
HCI_Command,
|
||||||
|
STATUS_SPEC,
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
# Constants
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
|
||||||
|
# Zephyr RTOS Vendor Specific Commands and Events.
|
||||||
|
# Only a subset of the commands are implemented here currently.
|
||||||
|
#
|
||||||
|
# pylint: disable-next=line-too-long
|
||||||
|
# See https://github.com/zephyrproject-rtos/zephyr/blob/main/include/zephyr/bluetooth/hci_vs.h
|
||||||
|
HCI_WRITE_TX_POWER_LEVEL_COMMAND = hci_vendor_command_op_code(0x000E)
|
||||||
|
HCI_READ_TX_POWER_LEVEL_COMMAND = hci_vendor_command_op_code(0x000F)
|
||||||
|
|
||||||
|
HCI_Command.register_commands(globals())
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
class TX_Power_Level_Command:
|
||||||
|
'''
|
||||||
|
Base class for read and write TX power level HCI commands
|
||||||
|
'''
|
||||||
|
|
||||||
|
TX_POWER_HANDLE_TYPE_ADV = 0x00
|
||||||
|
TX_POWER_HANDLE_TYPE_SCAN = 0x01
|
||||||
|
TX_POWER_HANDLE_TYPE_CONN = 0x02
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
fields=[('handle_type', 1), ('connection_handle', 2), ('tx_power_level', -1)],
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
('handle_type', 1),
|
||||||
|
('connection_handle', 2),
|
||||||
|
('selected_tx_power_level', -1),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_Write_Tx_Power_Level_Command(HCI_Command, TX_Power_Level_Command):
|
||||||
|
'''
|
||||||
|
Write TX power level. See BT_HCI_OP_VS_WRITE_TX_POWER_LEVEL in
|
||||||
|
https://github.com/zephyrproject-rtos/zephyr/blob/main/include/zephyr/bluetooth/hci_vs.h
|
||||||
|
|
||||||
|
Power level is in dB. Connection handle for TX_POWER_HANDLE_TYPE_ADV and
|
||||||
|
TX_POWER_HANDLE_TYPE_SCAN should be zero.
|
||||||
|
'''
|
||||||
|
|
||||||
|
|
||||||
|
# -----------------------------------------------------------------------------
|
||||||
|
@HCI_Command.command(
|
||||||
|
fields=[('handle_type', 1), ('connection_handle', 2)],
|
||||||
|
return_parameters_fields=[
|
||||||
|
('status', STATUS_SPEC),
|
||||||
|
('handle_type', 1),
|
||||||
|
('connection_handle', 2),
|
||||||
|
('tx_power_level', -1),
|
||||||
|
],
|
||||||
|
)
|
||||||
|
class HCI_Read_Tx_Power_Level_Command(HCI_Command, TX_Power_Level_Command):
|
||||||
|
'''
|
||||||
|
Read TX power level. See BT_HCI_OP_VS_READ_TX_POWER_LEVEL in
|
||||||
|
https://github.com/zephyrproject-rtos/zephyr/blob/main/include/zephyr/bluetooth/hci_vs.h
|
||||||
|
|
||||||
|
Power level is in dB. Connection handle for TX_POWER_HANDLE_TYPE_ADV and
|
||||||
|
TX_POWER_HANDLE_TYPE_SCAN should be zero.
|
||||||
|
'''
|
||||||
+20
-7
@@ -10,7 +10,7 @@ nav:
|
|||||||
- Contributing: development/contributing.md
|
- Contributing: development/contributing.md
|
||||||
- Code Style: development/code_style.md
|
- Code Style: development/code_style.md
|
||||||
- Use Cases:
|
- Use Cases:
|
||||||
- Overview: use_cases/index.md
|
- use_cases/index.md
|
||||||
- Use Case 1: use_cases/use_case_1.md
|
- Use Case 1: use_cases/use_case_1.md
|
||||||
- Use Case 2: use_cases/use_case_2.md
|
- Use Case 2: use_cases/use_case_2.md
|
||||||
- Use Case 3: use_cases/use_case_3.md
|
- Use Case 3: use_cases/use_case_3.md
|
||||||
@@ -23,7 +23,7 @@ nav:
|
|||||||
- GATT: components/gatt.md
|
- GATT: components/gatt.md
|
||||||
- Security Manager: components/security_manager.md
|
- Security Manager: components/security_manager.md
|
||||||
- Transports:
|
- Transports:
|
||||||
- Overview: transports/index.md
|
- transports/index.md
|
||||||
- Serial: transports/serial.md
|
- Serial: transports/serial.md
|
||||||
- USB: transports/usb.md
|
- USB: transports/usb.md
|
||||||
- PTY: transports/pty.md
|
- PTY: transports/pty.md
|
||||||
@@ -37,14 +37,14 @@ nav:
|
|||||||
- Android Emulator: transports/android_emulator.md
|
- Android Emulator: transports/android_emulator.md
|
||||||
- File: transports/file.md
|
- File: transports/file.md
|
||||||
- Drivers:
|
- Drivers:
|
||||||
- Overview: drivers/index.md
|
- drivers/index.md
|
||||||
- Realtek: drivers/realtek.md
|
- Realtek: drivers/realtek.md
|
||||||
- API:
|
- API:
|
||||||
- Guide: api/guide.md
|
- Guide: api/guide.md
|
||||||
- Examples: api/examples.md
|
- Examples: api/examples.md
|
||||||
- Reference: api/reference.md
|
- Reference: api/reference.md
|
||||||
- Apps & Tools:
|
- Apps & Tools:
|
||||||
- Overview: apps_and_tools/index.md
|
- apps_and_tools/index.md
|
||||||
- Console: apps_and_tools/console.md
|
- Console: apps_and_tools/console.md
|
||||||
- Bench: apps_and_tools/bench.md
|
- Bench: apps_and_tools/bench.md
|
||||||
- Speaker: apps_and_tools/speaker.md
|
- Speaker: apps_and_tools/speaker.md
|
||||||
@@ -57,15 +57,24 @@ nav:
|
|||||||
- USB Probe: apps_and_tools/usb_probe.md
|
- USB Probe: apps_and_tools/usb_probe.md
|
||||||
- Link Relay: apps_and_tools/link_relay.md
|
- Link Relay: apps_and_tools/link_relay.md
|
||||||
- Hardware:
|
- Hardware:
|
||||||
- Overview: hardware/index.md
|
- hardware/index.md
|
||||||
- Platforms:
|
- Platforms:
|
||||||
- Overview: platforms/index.md
|
- platforms/index.md
|
||||||
- macOS: platforms/macos.md
|
- macOS: platforms/macos.md
|
||||||
- Linux: platforms/linux.md
|
- Linux: platforms/linux.md
|
||||||
- Windows: platforms/windows.md
|
- Windows: platforms/windows.md
|
||||||
- Android: platforms/android.md
|
- Android: platforms/android.md
|
||||||
|
- Zephyr: platforms/zephyr.md
|
||||||
- Examples:
|
- Examples:
|
||||||
- Overview: examples/index.md
|
- examples/index.md
|
||||||
|
- Extras:
|
||||||
|
- extras/index.md
|
||||||
|
- Android Remote HCI: extras/android_remote_hci.md
|
||||||
|
- Hive:
|
||||||
|
- hive/index.md
|
||||||
|
- Speaker: hive/web/speaker/speaker.html
|
||||||
|
- Scanner: hive/web/scanner/scanner.html
|
||||||
|
- Heart Rate Monitor: hive/web/heart_rate_monitor/heart_rate_monitor.html
|
||||||
|
|
||||||
copyright: Copyright 2021-2023 Google LLC
|
copyright: Copyright 2021-2023 Google LLC
|
||||||
|
|
||||||
@@ -74,6 +83,8 @@ theme:
|
|||||||
logo: 'images/logo.png'
|
logo: 'images/logo.png'
|
||||||
favicon: 'images/favicon.ico'
|
favicon: 'images/favicon.ico'
|
||||||
custom_dir: 'theme'
|
custom_dir: 'theme'
|
||||||
|
features:
|
||||||
|
- navigation.indexes
|
||||||
|
|
||||||
plugins:
|
plugins:
|
||||||
- mkdocstrings:
|
- mkdocstrings:
|
||||||
@@ -98,6 +109,8 @@ markdown_extensions:
|
|||||||
- pymdownx.emoji:
|
- pymdownx.emoji:
|
||||||
emoji_index: !!python/name:materialx.emoji.twemoji
|
emoji_index: !!python/name:materialx.emoji.twemoji
|
||||||
emoji_generator: !!python/name:materialx.emoji.to_svg
|
emoji_generator: !!python/name:materialx.emoji.to_svg
|
||||||
|
- pymdownx.tabbed:
|
||||||
|
alternate_style: true
|
||||||
- codehilite:
|
- codehilite:
|
||||||
guess_lang: false
|
guess_lang: false
|
||||||
- toc:
|
- toc:
|
||||||
|
|||||||
Binary file not shown.
@@ -0,0 +1,141 @@
|
|||||||
|
ANDROID REMOTE HCI APP
|
||||||
|
======================
|
||||||
|
|
||||||
|
This application allows using an android phone's built-in Bluetooth controller with
|
||||||
|
a Bumble host stack running outside the phone (typically a development laptop or desktop).
|
||||||
|
The app runs an HCI proxy between a TCP socket on the "outside" and the Bluetooth HCI HAL
|
||||||
|
on the "inside". (See [this page](https://source.android.com/docs/core/connect/bluetooth) for a high level
|
||||||
|
description of the Android Bluetooth HCI HAL).
|
||||||
|
The HCI packets received on the TCP socket are forwarded to the phone's controller, and the
|
||||||
|
packets coming from the controller are forwarded to the TCP socket.
|
||||||
|
|
||||||
|
|
||||||
|
Building
|
||||||
|
--------
|
||||||
|
|
||||||
|
You can build the app by running `./gradlew build` (use `gradlew.bat` on Windows) from the `RemoteHCI` top level directory.
|
||||||
|
You can also build with Android Studio: open the `RemoteHCI` project. You can build and/or debug from there.
|
||||||
|
|
||||||
|
If the build succeeds, you can find the app APKs (debug and release) at:
|
||||||
|
|
||||||
|
* [Release] ``app/build/outputs/apk/release/app-release-unsigned.apk``
|
||||||
|
* [Debug] ``app/build/outputs/apk/debug/app-debug.apk``
|
||||||
|
|
||||||
|
|
||||||
|
Running
|
||||||
|
-------
|
||||||
|
|
||||||
|
### Preconditions
|
||||||
|
When the proxy starts (tapping the "Start" button in the app's main activity), it will try to
|
||||||
|
bind to the Bluetooth HAL. This requires disabling SELinux temporarily, and being the only HAL client.
|
||||||
|
|
||||||
|
#### Disabling SELinux
|
||||||
|
Binding to the Bluetooth HCI HAL requires certain SELinux permissions that can't simply be changed
|
||||||
|
on a device without rebuilding its system image. To bypass these restrictions, you will need
|
||||||
|
to disable SELinux on your phone (please be aware that this is global, not just for the proxy app,
|
||||||
|
so proceed with caution).
|
||||||
|
In order to disable SELinux, you need to root the phone (it may be advisable to do this on a
|
||||||
|
development phone).
|
||||||
|
|
||||||
|
!!! tip "Disabling SELinux Temporarily"
|
||||||
|
Restart `adb` as root:
|
||||||
|
```bash
|
||||||
|
$ adb root
|
||||||
|
```
|
||||||
|
|
||||||
|
Then disable SELinux
|
||||||
|
```bash
|
||||||
|
$ adb shell setenforce 0
|
||||||
|
```
|
||||||
|
|
||||||
|
Once you're done using the proxy, you can restore SELinux, if you need to, with
|
||||||
|
```bash
|
||||||
|
$ adb shell setenforce 1
|
||||||
|
```
|
||||||
|
|
||||||
|
This state will also reset to the normal SELinux enforcement when you reboot.
|
||||||
|
|
||||||
|
#### Stopping the bluetooth process
|
||||||
|
Since the Bluetooth HAL service can only accept one client, and that in normal conditions
|
||||||
|
that client is the Android's bluetooth stack, it is required to first shut down the
|
||||||
|
Android bluetooth stack process.
|
||||||
|
|
||||||
|
!!! tip "Checking if the Bluetooth process is running"
|
||||||
|
```bash
|
||||||
|
$ adb shell "ps -A | grep com.google.android.bluetooth"
|
||||||
|
```
|
||||||
|
If the process is running, you will get a line like:
|
||||||
|
```
|
||||||
|
bluetooth 10759 876 17455796 136620 do_epoll_wait 0 S com.google.android.bluetooth
|
||||||
|
```
|
||||||
|
If you don't, it means that the process is not running and you are clear to proceed.
|
||||||
|
|
||||||
|
Simply turning Bluetooth off from the phone's settings does not ensure that the bluetooth process will exit.
|
||||||
|
If the bluetooth process is still running after toggling Bluetooth off from the settings, you may try enabling
|
||||||
|
Airplane Mode, then rebooting. The bluetooth process should, in theory, not restart after the reboot.
|
||||||
|
|
||||||
|
!!! tip "Stopping the bluetooth process with adb"
|
||||||
|
```bash
|
||||||
|
$ adb shell cmd bluetooth_manager disable
|
||||||
|
```
|
||||||
|
|
||||||
|
### Starting the app
|
||||||
|
You can start the app from the Android launcher, from Android Studio, or with `adb`
|
||||||
|
|
||||||
|
#### Launching from the launcher
|
||||||
|
Just tap the app icon on the launcher, check the TCP port that is configured, and tap
|
||||||
|
the "Start" button.
|
||||||
|
|
||||||
|
#### Launching with `adb`
|
||||||
|
Using the `am` command, you can start the activity, and pass it arguments so that you can
|
||||||
|
automatically start the proxy, and/or set the port number.
|
||||||
|
|
||||||
|
!!! tip "Launching from adb with auto-start"
|
||||||
|
```bash
|
||||||
|
$ adb shell am start -n com.github.google.bumble.remotehci/.MainActivity --ez autostart true
|
||||||
|
```
|
||||||
|
|
||||||
|
!!! tip "Launching from adb with auto-start and a port"
|
||||||
|
In this example, we auto-start the proxy upon launch, with the port set to 9995
|
||||||
|
```bash
|
||||||
|
$ adb shell am start -n com.github.google.bumble.remotehci/.MainActivity --ez autostart true --ei port 9995
|
||||||
|
```
|
||||||
|
|
||||||
|
#### Selecting a TCP port
|
||||||
|
The RemoteHCI app's main activity has a "TCP Port" setting where you can change the port on
|
||||||
|
which the proxy is accepting connections. If the default value isn't suitable, you can
|
||||||
|
change it there (you can also use the special value 0 to let the OS assign a port number for you).
|
||||||
|
|
||||||
|
### Connecting to the proxy
|
||||||
|
To connect the Bumble stack to the proxy, you need to be able to reach the phone's network
|
||||||
|
stack. This can be done over the phone's WiFi connection, or, alternatively, using an `adb`
|
||||||
|
TCP forward (which should be faster than over WiFi).
|
||||||
|
|
||||||
|
!!! tip "Forwarding TCP with `adb`"
|
||||||
|
To connect to the proxy via an `adb` TCP forward, use:
|
||||||
|
```bash
|
||||||
|
$ adb forward tcp:<outside-port> tcp:<inside-port>
|
||||||
|
```
|
||||||
|
Where ``<outside-port>`` is the port number for a listening socket on your laptop or
|
||||||
|
desktop machine, and <inside-port> is the TCP port selected in the app's user interface.
|
||||||
|
Those two ports may be the same, of course.
|
||||||
|
For example, with the default TCP port 9993:
|
||||||
|
```bash
|
||||||
|
$ adb forward tcp:9993 tcp:9993
|
||||||
|
```
|
||||||
|
|
||||||
|
Once you've ensured that you can reach the proxy's TCP port on the phone, either directly or
|
||||||
|
via an `adb` forward, you can then use it as a Bumble transport, using the transport name:
|
||||||
|
``tcp-client:<host>:<port>`` syntax.
|
||||||
|
|
||||||
|
!!! example "Connecting a Bumble client"
|
||||||
|
Connecting the `bumble-controller-info` app to the phone's controller.
|
||||||
|
Assuming you have set up an `adb` forward on port 9993:
|
||||||
|
```bash
|
||||||
|
$ bumble-controller-info tcp-client:localhost:9993
|
||||||
|
```
|
||||||
|
|
||||||
|
Or over WiFi with, in this example, the IP address of the phone being ```192.168.86.27```
|
||||||
|
```bash
|
||||||
|
$ bumble-controller-info tcp-client:192.168.86.27:9993
|
||||||
|
```
|
||||||
@@ -0,0 +1,11 @@
|
|||||||
|
EXTRAS
|
||||||
|
======
|
||||||
|
|
||||||
|
A collection of add-ons, apps and tools, to the Bumble project.
|
||||||
|
|
||||||
|
Android Remote HCI
|
||||||
|
------------------
|
||||||
|
|
||||||
|
Allows using an Android phone's built-in Bluetooth controller with a Bumble
|
||||||
|
stack running on a development machine.
|
||||||
|
See [Android Remote HCI](android_remote_hci.md) for details.
|
||||||
@@ -3,7 +3,7 @@ HARDWARE
|
|||||||
|
|
||||||
The Bumble Host connects to a controller over an [HCI Transport](../transports/index.md).
|
The Bumble Host connects to a controller over an [HCI Transport](../transports/index.md).
|
||||||
To use a hardware controller attached to the host on which the host application is running, the transport is typically either [HCI over UART](../transports/serial.md) or [HCI over USB](../transports/usb.md).
|
To use a hardware controller attached to the host on which the host application is running, the transport is typically either [HCI over UART](../transports/serial.md) or [HCI over USB](../transports/usb.md).
|
||||||
On Linux, the [VHCI Transport](../transports/vhci.md) can be used to communicate with any controller hardware managed by the operating system. Alternatively, a remote controller (a phyiscal controller attached to a remote host) can be used by connecting one of the networked transports (such as the [TCP Client transport](../transports/tcp_client.md), the [TCP Server transport](../transports/tcp_server.md) or the [UDP Transport](../transports/udp.md)) to an [HCI Bridge](../apps_and_tools/hci_bridge) bridging the network transport to a physical controller on a remote host.
|
On Linux, the [VHCI Transport](../transports/vhci.md) can be used to communicate with any controller hardware managed by the operating system. Alternatively, a remote controller (a phyiscal controller attached to a remote host) can be used by connecting one of the networked transports (such as the [TCP Client transport](../transports/tcp_client.md), the [TCP Server transport](../transports/tcp_server.md) or the [UDP Transport](../transports/udp.md)) to an [HCI Bridge](../apps_and_tools/hci_bridge.md) bridging the network transport to a physical controller on a remote host.
|
||||||
|
|
||||||
In theory, any controller that is compliant with the HCI over UART or HCI over USB protocols can be used.
|
In theory, any controller that is compliant with the HCI over UART or HCI over USB protocols can be used.
|
||||||
|
|
||||||
|
|||||||
@@ -0,0 +1,59 @@
|
|||||||
|
HIVE
|
||||||
|
====
|
||||||
|
|
||||||
|
Welcome to the Bumble Hive.
|
||||||
|
This is a collection of apps and virtual devices that can run entirely in a browser page.
|
||||||
|
The code for the apps and devices, as well as the Bumble runtime code, runs via [Pyodide](https://pyodide.org/).
|
||||||
|
Pyodide is a Python distribution for the browser and Node.js based on WebAssembly.
|
||||||
|
|
||||||
|
The Bumble stack uses a WebSocket to exchange HCI packets with a virtual or physical
|
||||||
|
Bluetooth controller.
|
||||||
|
|
||||||
|
The apps and devices in the hive can be accessed by following the links below. Each
|
||||||
|
page has a settings button that may be used to configure the WebSocket URL to use for
|
||||||
|
the virtual HCI connection. This will typically be the WebSocket URL for a `netsim`
|
||||||
|
daemon.
|
||||||
|
There is also a [TOML index](index.toml) that can be used by tools to know at which URL to access
|
||||||
|
each of the apps and devices, as well as their names and short descriptions.
|
||||||
|
|
||||||
|
!!! tip "Using `netsim`"
|
||||||
|
When the `netsimd` daemon is running (for example when using the Android Emulator that
|
||||||
|
is included in Android Studio), the daemon listens for connections on a TCP port.
|
||||||
|
To find out what this TCP port is, you can read the `netsim.ini` file that `netsimd`
|
||||||
|
creates, it includes a line with `web.port=<tcp-port>` (for example `web.port=7681`).
|
||||||
|
The location of the `netsim.ini` file is platform-specific.
|
||||||
|
|
||||||
|
=== "macOS"
|
||||||
|
On macOS, the directory where `netsim.ini` is stored is $TMPDIR
|
||||||
|
```bash
|
||||||
|
$ cat $TMPDIR/netsim.ini
|
||||||
|
```
|
||||||
|
|
||||||
|
=== "Linux"
|
||||||
|
On Linux, the directory where `netsim.ini` is stored is $XDG_RUNTIME_DIR
|
||||||
|
```bash
|
||||||
|
$ cat $XDG_RUNTIME_DIR/netsim.ini
|
||||||
|
```
|
||||||
|
|
||||||
|
|
||||||
|
!!! tip "Using a local radio"
|
||||||
|
You can connect the hive virtual apps and devices to a local Bluetooth radio, like,
|
||||||
|
for example, a USB dongle.
|
||||||
|
For that, you need to run a local HCI bridge to bridge a local HCI device to a WebSocket
|
||||||
|
that a web page can connect to.
|
||||||
|
Use the `bumble-hci-bridge` app, with the host transport set to a WebSocket server on an
|
||||||
|
available port (ex: `ws-server:_:7682`) and the controller transport set to the transport
|
||||||
|
name for the radio you want to use (ex: `usb:0` for the first USB dongle)
|
||||||
|
|
||||||
|
|
||||||
|
Applications
|
||||||
|
------------
|
||||||
|
|
||||||
|
* [Scanner](web/scanner/scanner.html) - Scans for BLE devices.
|
||||||
|
|
||||||
|
Virtual Devices
|
||||||
|
---------------
|
||||||
|
|
||||||
|
* [Speaker](web/speaker/speaker.html) - Virtual speaker that plays audio in a browser page.
|
||||||
|
* [Heart Rate Monitor](web/heart_rate_monitor/heart_rate_monitor.html) - Virtual heart rate monitor.
|
||||||
|
|
||||||
@@ -0,0 +1,21 @@
|
|||||||
|
version = "1.0.0"
|
||||||
|
base_url = "https://google.github.io/bumble/hive/web"
|
||||||
|
default_hci_query_param = "hci"
|
||||||
|
|
||||||
|
[[index]]
|
||||||
|
name = "speaker"
|
||||||
|
description = "Bumble Virtual Speaker"
|
||||||
|
type = "Device"
|
||||||
|
url = "speaker/speaker.html"
|
||||||
|
|
||||||
|
[[index]]
|
||||||
|
name = "scanner"
|
||||||
|
description = "Simple Scanner Application"
|
||||||
|
type = "Application"
|
||||||
|
url = "scanner/scanner.html"
|
||||||
|
|
||||||
|
[[index]]
|
||||||
|
name = "heart-rate-monitor"
|
||||||
|
description = "Virtual Heart Rate Monitor"
|
||||||
|
type = "Device"
|
||||||
|
url = "heart_rate_monitor/heart_rate_monitor.html"
|
||||||
+1
@@ -0,0 +1 @@
|
|||||||
|
../../../../../web/bumble.js
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/heart_rate_monitor/heart_rate_monitor.html
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/heart_rate_monitor/heart_rate_monitor.js
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/heart_rate_monitor/heart_rate_monitor.py
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/scanner/scanner.css
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/scanner/scanner.html
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/scanner/scanner.js
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/scanner/scanner.py
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/speaker/logo.svg
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/speaker/speaker.css
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/speaker/speaker.html
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/speaker/speaker.js
|
||||||
@@ -0,0 +1 @@
|
|||||||
|
../../../../../../web/speaker/speaker.py
|
||||||
Symlink
+1
@@ -0,0 +1 @@
|
|||||||
|
../../../../../web/ui.js
|
||||||
@@ -152,11 +152,23 @@ Some platforms support features that not all platforms support
|
|||||||
|
|
||||||
See the [Platforms page](platforms/index.md) for details.
|
See the [Platforms page](platforms/index.md) for details.
|
||||||
|
|
||||||
|
|
||||||
|
Hive
|
||||||
|
----
|
||||||
|
|
||||||
|
The Hive is a collection of example apps and virtual devices that are implemented using the
|
||||||
|
Python Bumble API, running entirely in a web page. This is a convenient way to try out some
|
||||||
|
of the examples without any Python installation, when you have some other virtual Bluetooth
|
||||||
|
device that you can connect to or from, such as the Android Emulator.
|
||||||
|
|
||||||
|
See the [Bumble Hive](hive/index.md) for details.
|
||||||
|
|
||||||
Roadmap
|
Roadmap
|
||||||
-------
|
-------
|
||||||
|
|
||||||
Future features to be considered include:
|
Future features to be considered include:
|
||||||
|
|
||||||
|
* More profiles
|
||||||
* More device examples
|
* More device examples
|
||||||
* Add a new type of virtual link (beyond the two existing ones) to allow for link-level simulation (timing, loss, etc)
|
* Add a new type of virtual link (beyond the two existing ones) to allow for link-level simulation (timing, loss, etc)
|
||||||
* Bindings for languages other than Python
|
* Bindings for languages other than Python
|
||||||
|
|||||||
@@ -9,3 +9,4 @@ For platform-specific information, see the following pages:
|
|||||||
* :material-linux: Linux - see the [Linux platform page](linux.md)
|
* :material-linux: Linux - see the [Linux platform page](linux.md)
|
||||||
* :material-microsoft-windows: Windows - see the [Windows platform page](windows.md)
|
* :material-microsoft-windows: Windows - see the [Windows platform page](windows.md)
|
||||||
* :material-android: Android - see the [Android platform page](android.md)
|
* :material-android: Android - see the [Android platform page](android.md)
|
||||||
|
* :material-memory: Zephyr - see the [Zephyr platform page](zephyr.md)
|
||||||
|
|||||||
@@ -0,0 +1,51 @@
|
|||||||
|
:material-memory: ZEPHYR PLATFORM
|
||||||
|
=================================
|
||||||
|
|
||||||
|
Set TX Power on nRF52840
|
||||||
|
------------------------
|
||||||
|
|
||||||
|
The Nordic nRF52840 supports Zephyr's vendor specific HCI command for setting TX
|
||||||
|
power during advertising, connection, or scanning. With the example [HCI
|
||||||
|
USB](https://docs.zephyrproject.org/latest/samples/bluetooth/hci_usb/README.html)
|
||||||
|
application, an [nRF52840
|
||||||
|
dongle](https://www.nordicsemi.com/Products/Development-
|
||||||
|
hardware/nRF52840-Dongle) can be used as a Bumble controller.
|
||||||
|
|
||||||
|
To add dynamic TX power support to the HCI USB application, add the following to
|
||||||
|
`zephyr/samples/bluetooth/hci_usb/prj.conf` and build.
|
||||||
|
|
||||||
|
```
|
||||||
|
CONFIG_BT_CTLR_ADVANCED_FEATURES=y
|
||||||
|
CONFIG_BT_CTLR_CONN_RSSI=y
|
||||||
|
CONFIG_BT_CTLR_TX_PWR_DYNAMIC_CONTROL=y
|
||||||
|
```
|
||||||
|
|
||||||
|
Alternatively, a prebuilt firmware application can be downloaded here:
|
||||||
|
[hci_usb.zip](../downloads/zephyr/hci_usb.zip).
|
||||||
|
|
||||||
|
Put the nRF52840 dongle into bootloader mode by pressing the RESET button. The
|
||||||
|
LED should pulse red. Load the firmware application with the `nrfutil` tool:
|
||||||
|
|
||||||
|
```
|
||||||
|
nrfutil dfu usb-serial -pkg hci_usb.zip -p /dev/ttyACM0
|
||||||
|
```
|
||||||
|
|
||||||
|
The vendor specific HCI commands to read and write TX power are defined in
|
||||||
|
`bumble/vendor/zephyr/hci.py` and may be used as such:
|
||||||
|
|
||||||
|
```python
|
||||||
|
from bumble.vendor.zephyr.hci import HCI_Write_Tx_Power_Level_Command
|
||||||
|
|
||||||
|
# set advertising power to -4 dB
|
||||||
|
response = await host.send_command(
|
||||||
|
HCI_Write_Tx_Power_Level_Command(
|
||||||
|
handle_type=HCI_Write_Tx_Power_Level_Command.TX_POWER_HANDLE_TYPE_ADV,
|
||||||
|
connection_handle=0,
|
||||||
|
tx_power_level=-4,
|
||||||
|
)
|
||||||
|
)
|
||||||
|
|
||||||
|
if response.return_parameters.status == HCI_SUCCESS:
|
||||||
|
print(f"TX power set to {response.return_parameters.selected_tx_power_level}")
|
||||||
|
|
||||||
|
```
|
||||||
@@ -14,7 +14,7 @@ connections.
|
|||||||
|
|
||||||
## Moniker
|
## Moniker
|
||||||
The moniker syntax for an Android Emulator "netsim" transport is: `android-netsim:[<host>:<port>][<options>]`,
|
The moniker syntax for an Android Emulator "netsim" transport is: `android-netsim:[<host>:<port>][<options>]`,
|
||||||
where `<options>` is a ','-separated list of `<name>=<value>` pairs`.
|
where `<options>` is a comma-separated list of `<name>=<value>` pairs.
|
||||||
The `mode` parameter name can specify running as a host or a controller, and `<hostname>:<port>` can specify a host name (or IP address) and TCP port number on which to reach the gRPC server for the emulator (in "host" mode), or to accept gRPC connections (in "controller" mode).
|
The `mode` parameter name can specify running as a host or a controller, and `<hostname>:<port>` can specify a host name (or IP address) and TCP port number on which to reach the gRPC server for the emulator (in "host" mode), or to accept gRPC connections (in "controller" mode).
|
||||||
Both the `mode=<host|controller>` and `<hostname>:<port>` parameters are optional (so the moniker `android-netsim` by itself is a valid moniker, which will create a transport in `host` mode, connected to `localhost` on the default gRPC port for the Netsim background process).
|
Both the `mode=<host|controller>` and `<hostname>:<port>` parameters are optional (so the moniker `android-netsim` by itself is a valid moniker, which will create a transport in `host` mode, connected to `localhost` on the default gRPC port for the Netsim background process).
|
||||||
|
|
||||||
|
|||||||
+1
-1
@@ -3,7 +3,7 @@ channels:
|
|||||||
- defaults
|
- defaults
|
||||||
- conda-forge
|
- conda-forge
|
||||||
dependencies:
|
dependencies:
|
||||||
- pip=20
|
- pip=23
|
||||||
- python=3.8
|
- python=3.8
|
||||||
- pip:
|
- pip:
|
||||||
- --editable .[development,documentation,test]
|
- --editable .[development,documentation,test]
|
||||||
|
|||||||
@@ -29,6 +29,7 @@ from bumble.device import Device
|
|||||||
from bumble.transport import open_transport_or_link
|
from bumble.transport import open_transport_or_link
|
||||||
from bumble.profiles.device_information_service import DeviceInformationService
|
from bumble.profiles.device_information_service import DeviceInformationService
|
||||||
from bumble.profiles.heart_rate_service import HeartRateService
|
from bumble.profiles.heart_rate_service import HeartRateService
|
||||||
|
from bumble.utils import AsyncRunner
|
||||||
|
|
||||||
|
|
||||||
# -----------------------------------------------------------------------------
|
# -----------------------------------------------------------------------------
|
||||||
@@ -98,6 +99,17 @@ async def main():
|
|||||||
)
|
)
|
||||||
)
|
)
|
||||||
|
|
||||||
|
# Notify subscribers of the current value as soon as they subscribe
|
||||||
|
@heart_rate_service.heart_rate_measurement_characteristic.on('subscription')
|
||||||
|
def on_subscription(connection, notify_enabled, indicate_enabled):
|
||||||
|
if notify_enabled or indicate_enabled:
|
||||||
|
AsyncRunner.spawn(
|
||||||
|
device.notify_subscriber(
|
||||||
|
connection,
|
||||||
|
heart_rate_service.heart_rate_measurement_characteristic,
|
||||||
|
)
|
||||||
|
)
|
||||||
|
|
||||||
# Go!
|
# Go!
|
||||||
await device.power_on()
|
await device.power_on()
|
||||||
await device.start_advertising(auto_restart=True)
|
await device.start_advertising(auto_restart=True)
|
||||||
|
|||||||
@@ -0,0 +1,248 @@
|
|||||||
|
# shift map
|
||||||
|
|
||||||
|
# letters
|
||||||
|
shift_map = {
|
||||||
|
'a': 'A',
|
||||||
|
'b': 'B',
|
||||||
|
'c': 'C',
|
||||||
|
'd': 'D',
|
||||||
|
'e': 'E',
|
||||||
|
'f': 'F',
|
||||||
|
'g': 'G',
|
||||||
|
'h': 'H',
|
||||||
|
'i': 'I',
|
||||||
|
'j': 'J',
|
||||||
|
'k': 'K',
|
||||||
|
'l': 'L',
|
||||||
|
'm': 'M',
|
||||||
|
'n': 'N',
|
||||||
|
'o': 'O',
|
||||||
|
'p': 'P',
|
||||||
|
'q': 'Q',
|
||||||
|
'r': 'R',
|
||||||
|
's': 'S',
|
||||||
|
't': 'T',
|
||||||
|
'u': 'U',
|
||||||
|
'v': 'V',
|
||||||
|
'w': 'W',
|
||||||
|
'x': 'X',
|
||||||
|
'y': 'Y',
|
||||||
|
'z': 'Z',
|
||||||
|
# numbers
|
||||||
|
'1': '!',
|
||||||
|
'2': '@',
|
||||||
|
'3': '#',
|
||||||
|
'4': '$',
|
||||||
|
'5': '%',
|
||||||
|
'6': '^',
|
||||||
|
'7': '&',
|
||||||
|
'8': '*',
|
||||||
|
'9': '(',
|
||||||
|
'0': ')',
|
||||||
|
# symbols
|
||||||
|
'-': '_',
|
||||||
|
'=': '+',
|
||||||
|
'[': '{',
|
||||||
|
']': '}',
|
||||||
|
'\\': '|',
|
||||||
|
';': ':',
|
||||||
|
'\'': '"',
|
||||||
|
',': '<',
|
||||||
|
'.': '>',
|
||||||
|
'/': '?',
|
||||||
|
'`': '~',
|
||||||
|
}
|
||||||
|
|
||||||
|
# hex map
|
||||||
|
|
||||||
|
# modifier keys
|
||||||
|
mod_keys = {
|
||||||
|
'00': '',
|
||||||
|
'01': 'left_ctrl',
|
||||||
|
'02': 'left_shift',
|
||||||
|
'04': 'left_alt',
|
||||||
|
'08': 'left_meta',
|
||||||
|
'10': 'right_ctrl',
|
||||||
|
'20': 'right_shift',
|
||||||
|
'40': 'right_alt',
|
||||||
|
'80': 'right_meta',
|
||||||
|
}
|
||||||
|
|
||||||
|
# base keys
|
||||||
|
|
||||||
|
base_keys = {
|
||||||
|
# meta
|
||||||
|
'00': '', # none
|
||||||
|
'01': 'error_ovf',
|
||||||
|
# letters
|
||||||
|
'04': 'a',
|
||||||
|
'05': 'b',
|
||||||
|
'06': 'c',
|
||||||
|
'07': 'd',
|
||||||
|
'08': 'e',
|
||||||
|
'09': 'f',
|
||||||
|
'0a': 'g',
|
||||||
|
'0b': 'h',
|
||||||
|
'0c': 'i',
|
||||||
|
'0d': 'j',
|
||||||
|
'0e': 'k',
|
||||||
|
'0f': 'l',
|
||||||
|
'10': 'm',
|
||||||
|
'11': 'n',
|
||||||
|
'12': 'o',
|
||||||
|
'13': 'p',
|
||||||
|
'14': 'q',
|
||||||
|
'15': 'r',
|
||||||
|
'16': 's',
|
||||||
|
'17': 't',
|
||||||
|
'18': 'u',
|
||||||
|
'19': 'v',
|
||||||
|
'1a': 'w',
|
||||||
|
'1b': 'x',
|
||||||
|
'1c': 'y',
|
||||||
|
'1d': 'z',
|
||||||
|
# numbers
|
||||||
|
'1e': '1',
|
||||||
|
'1f': '2',
|
||||||
|
'20': '3',
|
||||||
|
'21': '4',
|
||||||
|
'22': '5',
|
||||||
|
'23': '6',
|
||||||
|
'24': '7',
|
||||||
|
'25': '8',
|
||||||
|
'26': '9',
|
||||||
|
'27': '0',
|
||||||
|
# misc
|
||||||
|
'28': 'enter', # enter \n
|
||||||
|
'29': 'esc',
|
||||||
|
'2a': 'backspace',
|
||||||
|
'2b': 'tab',
|
||||||
|
'2c': 'spacebar', # space
|
||||||
|
'2d': '-',
|
||||||
|
'2e': '=',
|
||||||
|
'2f': '[',
|
||||||
|
'30': ']',
|
||||||
|
'31': '\\',
|
||||||
|
'32': '=',
|
||||||
|
'33': '_SEMICOLON',
|
||||||
|
'34': 'KEY_APOSTROPHE',
|
||||||
|
'35': 'KEY_GRAVE',
|
||||||
|
'36': 'KEY_COMMA',
|
||||||
|
'37': 'KEY_DOT',
|
||||||
|
'38': 'KEY_SLASH',
|
||||||
|
'39': 'KEY_CAPSLOCK',
|
||||||
|
'3a': 'KEY_F1',
|
||||||
|
'3b': 'KEY_F2',
|
||||||
|
'3c': 'KEY_F3',
|
||||||
|
'3d': 'KEY_F4',
|
||||||
|
'3e': 'KEY_F5',
|
||||||
|
'3f': 'KEY_F6',
|
||||||
|
'40': 'KEY_F7',
|
||||||
|
'41': 'KEY_F8',
|
||||||
|
'42': 'KEY_F9',
|
||||||
|
'43': 'KEY_F10',
|
||||||
|
'44': 'KEY_F11',
|
||||||
|
'45': 'KEY_F12',
|
||||||
|
'46': 'KEY_SYSRQ',
|
||||||
|
'47': 'KEY_SCROLLLOCK',
|
||||||
|
'48': 'KEY_PAUSE',
|
||||||
|
'49': 'KEY_INSERT',
|
||||||
|
'4a': 'KEY_HOME',
|
||||||
|
'4b': 'KEY_PAGEUP',
|
||||||
|
'4c': 'KEY_DELETE',
|
||||||
|
'4d': 'KEY_END',
|
||||||
|
'4e': 'KEY_PAGEDOWN',
|
||||||
|
'4f': 'KEY_RIGHT',
|
||||||
|
'50': 'KEY_LEFT',
|
||||||
|
'51': 'KEY_DOWN',
|
||||||
|
'52': 'KEY_UP',
|
||||||
|
'53': 'KEY_NUMLOCK',
|
||||||
|
'54': 'KEY_KPSLASH',
|
||||||
|
'55': 'KEY_KPASTERISK',
|
||||||
|
'56': 'KEY_KPMINUS',
|
||||||
|
'57': 'KEY_KPPLUS',
|
||||||
|
'58': 'KEY_KPENTER',
|
||||||
|
'59': 'KEY_KP1',
|
||||||
|
'5a': 'KEY_KP2',
|
||||||
|
'5b': 'KEY_KP3',
|
||||||
|
'5c': 'KEY_KP4',
|
||||||
|
'5d': 'KEY_KP5',
|
||||||
|
'5e': 'KEY_KP6',
|
||||||
|
'5f': 'KEY_KP7',
|
||||||
|
'60': 'KEY_KP8',
|
||||||
|
'61': 'KEY_KP9',
|
||||||
|
'62': 'KEY_KP0',
|
||||||
|
'63': 'KEY_KPDOT',
|
||||||
|
'64': 'KEY_102ND',
|
||||||
|
'65': 'KEY_COMPOSE',
|
||||||
|
'66': 'KEY_POWER',
|
||||||
|
'67': 'KEY_KPEQUAL',
|
||||||
|
'68': 'KEY_F13',
|
||||||
|
'69': 'KEY_F14',
|
||||||
|
'6a': 'KEY_F15',
|
||||||
|
'6b': 'KEY_F16',
|
||||||
|
'6c': 'KEY_F17',
|
||||||
|
'6d': 'KEY_F18',
|
||||||
|
'6e': 'KEY_F19',
|
||||||
|
'6f': 'KEY_F20',
|
||||||
|
'70': 'KEY_F21',
|
||||||
|
'71': 'KEY_F22',
|
||||||
|
'72': 'KEY_F23',
|
||||||
|
'73': 'KEY_F24',
|
||||||
|
'74': 'KEY_OPEN',
|
||||||
|
'75': 'KEY_HELP',
|
||||||
|
'76': 'KEY_PROPS',
|
||||||
|
'77': 'KEY_FRONT',
|
||||||
|
'78': 'KEY_STOP',
|
||||||
|
'79': 'KEY_AGAIN',
|
||||||
|
'7a': 'KEY_UNDO',
|
||||||
|
'7b': 'KEY_CUT',
|
||||||
|
'7c': 'KEY_COPY',
|
||||||
|
'7d': 'KEY_PASTE',
|
||||||
|
'7e': 'KEY_FIND',
|
||||||
|
'7f': 'KEY_MUTE',
|
||||||
|
'80': 'KEY_VOLUMEUP',
|
||||||
|
'81': 'KEY_VOLUMEDOWN',
|
||||||
|
'85': 'KEY_KPCOMMA',
|
||||||
|
'87': 'KEY_RO',
|
||||||
|
'88': 'KEY_KATAKANAHIRAGANA',
|
||||||
|
'89': 'KEY_YEN',
|
||||||
|
'8a': 'KEY_HENKAN',
|
||||||
|
'8b': 'KEY_MUHENKAN',
|
||||||
|
'8c': 'KEY_KPJPCOMMA',
|
||||||
|
'90': 'KEY_HANGEUL',
|
||||||
|
'91': 'KEY_HANJA',
|
||||||
|
'92': 'KEY_KATAKANA',
|
||||||
|
'93': 'KEY_HIRAGANA',
|
||||||
|
'94': 'KEY_ZENKAKUHANKAKU',
|
||||||
|
'b6': 'KEY_KPLEFTPAREN',
|
||||||
|
'b7': 'KEY_KPRIGHTPAREN',
|
||||||
|
'e0': 'KEY_LEFTCTRL',
|
||||||
|
'e1': 'KEY_LEFTSHIFT',
|
||||||
|
'e2': 'KEY_LEFTALT',
|
||||||
|
'e3': 'KEY_LEFTMETA',
|
||||||
|
'e4': 'KEY_RIGHTCTRL',
|
||||||
|
'e5': 'KEY_RIGHTSHIFT',
|
||||||
|
'e6': 'KEY_RIGHTALT',
|
||||||
|
'e7': 'KEY_RIGHTMETA',
|
||||||
|
'e8': 'KEY_MEDIA_PLAYPAUSE',
|
||||||
|
'e9': 'KEY_MEDIA_STOPCD',
|
||||||
|
'ea': 'KEY_MEDIA_PREVIOUSSONG',
|
||||||
|
'eb': 'KEY_MEDIA_NEXTSONG',
|
||||||
|
'ec': 'KEY_MEDIA_EJECTCD',
|
||||||
|
'ed': 'KEY_MEDIA_VOLUMEUP',
|
||||||
|
'ee': 'KEY_MEDIA_VOLUMEDOWN',
|
||||||
|
'ef': 'KEY_MEDIA_MUTE',
|
||||||
|
'f0': 'KEY_MEDIA_WWW',
|
||||||
|
'f1': 'KEY_MEDIA_BACK',
|
||||||
|
'f2': 'KEY_MEDIA_FORWARD',
|
||||||
|
'f3': 'KEY_MEDIA_STOP',
|
||||||
|
'f4': 'KEY_MEDIA_FIND',
|
||||||
|
'f5': 'KEY_MEDIA_SCROLLUP',
|
||||||
|
'f6': 'KEY_MEDIA_SCROLLDOWN',
|
||||||
|
'f7': 'KEY_MEDIA_EDIT',
|
||||||
|
'f8': 'KEY_MEDIA_SLEEP',
|
||||||
|
'f9': 'KEY_MEDIA_COFFEE',
|
||||||
|
'fa': 'KEY_MEDIA_REFRESH',
|
||||||
|
'fb': 'KEY_MEDIA_CALC',
|
||||||
|
}
|
||||||
@@ -0,0 +1,159 @@
|
|||||||
|
from bumble.colors import color
|
||||||
|
from hid_key_map import base_keys, mod_keys, shift_map
|
||||||
|
|
||||||
|
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
def get_key(modifier: str, key: str) -> str:
|
||||||
|
if modifier == '22':
|
||||||
|
modifier = '02'
|
||||||
|
if modifier in mod_keys:
|
||||||
|
modifier = mod_keys[modifier]
|
||||||
|
else:
|
||||||
|
return ''
|
||||||
|
if key in base_keys:
|
||||||
|
key = base_keys[key]
|
||||||
|
else:
|
||||||
|
return ''
|
||||||
|
if (modifier == 'left_shift' or modifier == 'right_shift') and key in shift_map:
|
||||||
|
key = shift_map[key]
|
||||||
|
|
||||||
|
return key
|
||||||
|
|
||||||
|
|
||||||
|
class Keyboard:
|
||||||
|
def __init__(self): # type: ignore
|
||||||
|
self.report = [
|
||||||
|
[ # Bit array for Modifier keys
|
||||||
|
0, # Right GUI - (usually the Windows key)
|
||||||
|
0, # Right ALT
|
||||||
|
0, # Right Shift
|
||||||
|
0, # Right Control
|
||||||
|
0, # Left GUI - (usually the Windows key)
|
||||||
|
0, # Left ALT
|
||||||
|
0, # Left Shift
|
||||||
|
0, # Left Control
|
||||||
|
],
|
||||||
|
0x00, # Vendor reserved
|
||||||
|
'', # Rest is space for 6 keys
|
||||||
|
'',
|
||||||
|
'',
|
||||||
|
'',
|
||||||
|
'',
|
||||||
|
'',
|
||||||
|
]
|
||||||
|
|
||||||
|
def decode_keyboard_report(self, input_report: bytes, report_length: int) -> None:
|
||||||
|
if report_length >= 8:
|
||||||
|
modifier = input_report[1]
|
||||||
|
self.report[0] = [int(x) for x in '{0:08b}'.format(modifier)]
|
||||||
|
self.report[0].reverse() # type: ignore
|
||||||
|
|
||||||
|
modifier_key = str((modifier & 0x22).to_bytes(1, "big").hex())
|
||||||
|
keycodes = []
|
||||||
|
for k in range(3, report_length):
|
||||||
|
keycodes.append(str(input_report[k].to_bytes(1, "big").hex()))
|
||||||
|
self.report[k - 1] = get_key(modifier_key, keycodes[k - 3])
|
||||||
|
else:
|
||||||
|
print(color('Warning: Not able to parse report', 'yellow'))
|
||||||
|
|
||||||
|
def print_keyboard_report(self) -> None:
|
||||||
|
print(color('\tKeyboard Input Received', 'green', None, 'bold'))
|
||||||
|
print(color(f'Keys:', 'white', None, 'bold'))
|
||||||
|
for i in range(1, 7):
|
||||||
|
print(
|
||||||
|
color(f' Key{i}{" ":>8s}= ', 'cyan', None, 'bold'), self.report[i + 1]
|
||||||
|
)
|
||||||
|
print(color(f'\nModifier Keys:', 'white', None, 'bold'))
|
||||||
|
print(
|
||||||
|
color(f' Left Ctrl : ', 'cyan'),
|
||||||
|
f'{self.report[0][0] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Left Shift : ', 'cyan'),
|
||||||
|
f'{self.report[0][1] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Left ALT : ', 'cyan'),
|
||||||
|
f'{self.report[0][2] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Left GUI : ', 'cyan'),
|
||||||
|
f'{self.report[0][3] == 1!s:<5}\n', # type: ignore
|
||||||
|
color(f' Right Ctrl : ', 'cyan'),
|
||||||
|
f'{self.report[0][4] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Right Shift : ', 'cyan'),
|
||||||
|
f'{self.report[0][5] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Right ALT : ', 'cyan'),
|
||||||
|
f'{self.report[0][6] == 1!s:<5}', # type: ignore
|
||||||
|
color(f' Right GUI : ', 'cyan'),
|
||||||
|
f'{self.report[0][7] == 1!s:<5}', # type: ignore
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
class Mouse:
|
||||||
|
def __init__(self): # type: ignore
|
||||||
|
self.report = [
|
||||||
|
[ # Bit array for Buttons
|
||||||
|
0, # Button 1 (primary/trigger
|
||||||
|
0, # Button 2 (secondary)
|
||||||
|
0, # Button 3 (tertiary)
|
||||||
|
0, # Button 4
|
||||||
|
0, # Button 5
|
||||||
|
0, # unused padding bits
|
||||||
|
0, # unused padding bits
|
||||||
|
0, # unused padding bits
|
||||||
|
],
|
||||||
|
0, # X
|
||||||
|
0, # Y
|
||||||
|
0, # Wheel
|
||||||
|
0, # AC Pan
|
||||||
|
]
|
||||||
|
|
||||||
|
def decode_mouse_report(self, input_report: bytes, report_length: int) -> None:
|
||||||
|
self.report[0] = [int(x) for x in '{0:08b}'.format(input_report[1])]
|
||||||
|
self.report[0].reverse() # type: ignore
|
||||||
|
self.report[1] = input_report[2]
|
||||||
|
self.report[2] = input_report[3]
|
||||||
|
if report_length in [5, 6]:
|
||||||
|
self.report[3] = input_report[4]
|
||||||
|
self.report[4] = input_report[5] if report_length == 6 else 0
|
||||||
|
|
||||||
|
def print_mouse_report(self) -> None:
|
||||||
|
print(color('\tMouse Input Received', 'green', None, 'bold'))
|
||||||
|
print(
|
||||||
|
color(f' Button 1 (primary/trigger) = ', 'cyan'),
|
||||||
|
self.report[0][0] == 1, # type: ignore
|
||||||
|
color(f'\n Button 2 (secondary) = ', 'cyan'),
|
||||||
|
self.report[0][1] == 1, # type: ignore
|
||||||
|
color(f'\n Button 3 (tertiary) = ', 'cyan'),
|
||||||
|
self.report[0][2] == 1, # type: ignore
|
||||||
|
color(f'\n Button4 = ', 'cyan'),
|
||||||
|
self.report[0][3] == 1, # type: ignore
|
||||||
|
color(f'\n Button5 = ', 'cyan'),
|
||||||
|
self.report[0][4] == 1, # type: ignore
|
||||||
|
color(f'\n X (X-axis displacement) = ', 'cyan'),
|
||||||
|
self.report[1],
|
||||||
|
color(f'\n Y (Y-axis displacement) = ', 'cyan'),
|
||||||
|
self.report[2],
|
||||||
|
color(f'\n Wheel = ', 'cyan'),
|
||||||
|
self.report[3],
|
||||||
|
color(f'\n AC PAN = ', 'cyan'),
|
||||||
|
self.report[4],
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
class ReportParser:
|
||||||
|
@staticmethod
|
||||||
|
def parse_input_report(input_report: bytes) -> None:
|
||||||
|
|
||||||
|
report_id = input_report[0] # pylint: disable=unsubscriptable-object
|
||||||
|
report_length = len(input_report)
|
||||||
|
|
||||||
|
# Keyboard input report (report id = 1)
|
||||||
|
if report_id == 1 and report_length >= 8:
|
||||||
|
keyboard = Keyboard() # type: ignore
|
||||||
|
keyboard.decode_keyboard_report(input_report, report_length)
|
||||||
|
keyboard.print_keyboard_report()
|
||||||
|
# Mouse input report (report id = 2)
|
||||||
|
elif report_id == 2 and report_length in [4, 5, 6]:
|
||||||
|
mouse = Mouse() # type: ignore
|
||||||
|
mouse.decode_mouse_report(input_report, report_length)
|
||||||
|
mouse.print_mouse_report()
|
||||||
|
else:
|
||||||
|
print(color(f'Warning: Parse Error Report ID {report_id}', 'yellow'))
|
||||||
@@ -131,7 +131,7 @@ async def main():
|
|||||||
await device.power_on()
|
await device.power_on()
|
||||||
|
|
||||||
# Create a listener to wait for AVDTP connections
|
# Create a listener to wait for AVDTP connections
|
||||||
listener = Listener(Listener.create_registrar(device))
|
listener = Listener.for_device(device)
|
||||||
listener.on('connection', on_avdtp_connection)
|
listener.on('connection', on_avdtp_connection)
|
||||||
|
|
||||||
if len(sys.argv) >= 5:
|
if len(sys.argv) >= 5:
|
||||||
|
|||||||
@@ -179,7 +179,7 @@ async def main():
|
|||||||
await stream_packets(read, protocol)
|
await stream_packets(read, protocol)
|
||||||
else:
|
else:
|
||||||
# Create a listener to wait for AVDTP connections
|
# Create a listener to wait for AVDTP connections
|
||||||
listener = Listener(Listener.create_registrar(device), version=(1, 2))
|
listener = Listener.for_device(device=device, version=(1, 2))
|
||||||
listener.on(
|
listener.on(
|
||||||
'connection', lambda protocol: on_avdtp_connection(read, protocol)
|
'connection', lambda protocol: on_avdtp_connection(read, protocol)
|
||||||
)
|
)
|
||||||
|
|||||||
@@ -21,6 +21,7 @@ import sys
|
|||||||
import os
|
import os
|
||||||
import logging
|
import logging
|
||||||
|
|
||||||
|
from bumble import l2cap
|
||||||
from bumble.core import AdvertisingData
|
from bumble.core import AdvertisingData
|
||||||
from bumble.device import Device
|
from bumble.device import Device
|
||||||
from bumble.transport import open_transport_or_link
|
from bumble.transport import open_transport_or_link
|
||||||
@@ -95,8 +96,10 @@ async def main():
|
|||||||
|
|
||||||
channel.sink = on_data
|
channel.sink = on_data
|
||||||
|
|
||||||
psm = device.register_l2cap_channel_server(0, on_coc, 8)
|
server = device.create_l2cap_server(
|
||||||
print(f'### LE_PSM_OUT = {psm}')
|
spec=l2cap.LeCreditBasedChannelSpec(max_credits=8), handler=on_coc
|
||||||
|
)
|
||||||
|
print(f'### LE_PSM_OUT = {server.psm}')
|
||||||
|
|
||||||
# Add the ASHA service to the GATT server
|
# Add the ASHA service to the GATT server
|
||||||
read_only_properties_characteristic = Characteristic(
|
read_only_properties_characteristic = Characteristic(
|
||||||
@@ -147,7 +150,7 @@ async def main():
|
|||||||
ASHA_LE_PSM_OUT_CHARACTERISTIC,
|
ASHA_LE_PSM_OUT_CHARACTERISTIC,
|
||||||
Characteristic.Properties.READ,
|
Characteristic.Properties.READ,
|
||||||
Characteristic.READABLE,
|
Characteristic.READABLE,
|
||||||
struct.pack('<H', psm),
|
struct.pack('<H', server.psm),
|
||||||
)
|
)
|
||||||
device.add_service(
|
device.add_service(
|
||||||
Service(
|
Service(
|
||||||
|
|||||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user