309 lines
11 KiB
Python
309 lines
11 KiB
Python
|
'''Enables splitting keyboards wirelessly or wired'''
|
||
|
|
import busio
|
||
|
|
from micropython import const
|
||
|
|
|
||
|
|
from kmk.hid import HIDModes
|
||
|
|
from kmk.kmktime import ticks_diff, ticks_ms
|
||
|
|
from kmk.matrix import intify_coordinate
|
||
|
|
from kmk.modules import Module
|
||
|
|
from storage import getmount
|
||
|
|
|
||
|
|
|
||
|
|
class SplitSide:
|
||
|
|
LEFT = const(1)
|
||
|
|
RIGHT = const(2)
|
||
|
|
|
||
|
|
|
||
|
|
class SplitType:
|
||
|
|
UART = const(1)
|
||
|
|
I2C = const(2) # unused
|
||
|
|
ONEWIRE = const(3) # unused
|
||
|
|
BLE = const(4)
|
||
|
|
|
||
|
|
|
||
|
|
class Split(Module):
|
||
|
|
'''Enables splitting keyboards wirelessly, or wired'''
|
||
|
|
|
||
|
|
def __init__(
|
||
|
|
self,
|
||
|
|
split_flip=True,
|
||
|
|
split_side=None,
|
||
|
|
split_type=SplitType.UART,
|
||
|
|
split_target_left=True,
|
||
|
|
uart_interval=20,
|
||
|
|
data_pin=None,
|
||
|
|
data_pin2=None,
|
||
|
|
target_left=True,
|
||
|
|
uart_flip=True,
|
||
|
|
):
|
||
|
|
self._is_target = True
|
||
|
|
self._uart_buffer = []
|
||
|
|
self.split_flip = split_flip
|
||
|
|
self.split_side = split_side
|
||
|
|
self.split_type = split_type
|
||
|
|
self.split_target_left = split_target_left
|
||
|
|
self.split_offset = None
|
||
|
|
self.data_pin = data_pin
|
||
|
|
self.data_pin2 = data_pin2
|
||
|
|
self.target_left = target_left
|
||
|
|
self.uart_flip = uart_flip
|
||
|
|
self._is_target = True
|
||
|
|
self._uart = None
|
||
|
|
self._uart_interval = uart_interval
|
||
|
|
self._debug_enabled = False
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
try:
|
||
|
|
from adafruit_ble import BLERadio
|
||
|
|
from adafruit_ble.advertising.standard import (
|
||
|
|
ProvideServicesAdvertisement,
|
||
|
|
)
|
||
|
|
from adafruit_ble.services.nordic import UARTService
|
||
|
|
|
||
|
|
self.ProvideServicesAdvertisement = ProvideServicesAdvertisement
|
||
|
|
self.UARTService = UARTService
|
||
|
|
except ImportError:
|
||
|
|
pass # BLE isn't supported on this platform
|
||
|
|
self._ble = BLERadio()
|
||
|
|
self._ble_last_scan = ticks_ms() - 5000
|
||
|
|
self._connection_count = 0
|
||
|
|
self._uart_connection = None
|
||
|
|
self._advertisment = None
|
||
|
|
self._advertising = False
|
||
|
|
self._psave_enable = False
|
||
|
|
|
||
|
|
def __repr__(self):
|
||
|
|
return f'BLE_SPLIT({self._to_dict()})'
|
||
|
|
|
||
|
|
def _to_dict(self):
|
||
|
|
return {
|
||
|
|
'_ble': self._ble,
|
||
|
|
'_ble_last_scan': self._ble_last_scan,
|
||
|
|
'_is_target': self._is_target,
|
||
|
|
'uart_buffer': self._uart_buffer,
|
||
|
|
'_split_flip': self.split_flip,
|
||
|
|
'_split_side': self.split_side,
|
||
|
|
}
|
||
|
|
|
||
|
|
def during_bootup(self, keyboard):
|
||
|
|
# Set up name for target side detection and BLE advertisment
|
||
|
|
name = str(getmount('/').label)
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
self._ble.name = name
|
||
|
|
else:
|
||
|
|
# Try to guess data pins if not supplied
|
||
|
|
if not self.data_pin:
|
||
|
|
self.data_pin = keyboard.data_pin
|
||
|
|
|
||
|
|
# Detect split side from name
|
||
|
|
if self.split_side is None:
|
||
|
|
if name.endswith('L'):
|
||
|
|
# If name ends in 'L' assume left and strip from name
|
||
|
|
self._is_target = bool(self.split_target_left)
|
||
|
|
self.split_side = SplitSide.LEFT
|
||
|
|
elif name.endswith('R'):
|
||
|
|
# If name ends in 'R' assume right and strip from name
|
||
|
|
self._is_target = not bool(self.split_target_left)
|
||
|
|
self.split_side = SplitSide.RIGHT
|
||
|
|
|
||
|
|
# if split side was given, find master from split_side.
|
||
|
|
elif self.split_side == SplitSide.LEFT:
|
||
|
|
self._is_target = bool(self.split_target_left)
|
||
|
|
elif self.split_side == SplitSide.RIGHT:
|
||
|
|
self._is_target = not bool(self.split_target_left)
|
||
|
|
|
||
|
|
# Flips the col pins if PCB is the same but flipped on right
|
||
|
|
if self.split_flip and self.split_side == SplitSide.RIGHT:
|
||
|
|
keyboard.col_pins = list(reversed(keyboard.col_pins))
|
||
|
|
|
||
|
|
self.split_offset = len(keyboard.col_pins)
|
||
|
|
|
||
|
|
if self.split_type == SplitType.UART and self.data_pin is not None:
|
||
|
|
if self._is_target:
|
||
|
|
self._uart = busio.UART(
|
||
|
|
tx=self.data_pin2, rx=self.data_pin, timeout=self._uart_interval
|
||
|
|
)
|
||
|
|
else:
|
||
|
|
self._uart = busio.UART(
|
||
|
|
tx=self.data_pin, rx=self.data_pin2, timeout=self._uart_interval
|
||
|
|
)
|
||
|
|
|
||
|
|
# Attempt to sanely guess a coord_mapping if one is not provided.
|
||
|
|
if not keyboard.coord_mapping:
|
||
|
|
keyboard.coord_mapping = []
|
||
|
|
|
||
|
|
rows_to_calc = len(keyboard.row_pins) * 2
|
||
|
|
cols_to_calc = len(keyboard.col_pins) * 2
|
||
|
|
|
||
|
|
for ridx in range(rows_to_calc):
|
||
|
|
for cidx in range(cols_to_calc):
|
||
|
|
keyboard.coord_mapping.append(intify_coordinate(ridx, cidx))
|
||
|
|
|
||
|
|
def before_matrix_scan(self, keyboard):
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
self._check_all_connections(keyboard._hid_helper)
|
||
|
|
self._receive_ble(keyboard)
|
||
|
|
elif self.split_type == SplitType.UART:
|
||
|
|
if self._is_target or self.data_pin2:
|
||
|
|
self._receive_uart(keyboard)
|
||
|
|
elif self.split_type == SplitType.ONEWIRE:
|
||
|
|
pass # Protocol needs written
|
||
|
|
return
|
||
|
|
|
||
|
|
def after_matrix_scan(self, keyboard):
|
||
|
|
if keyboard.matrix_update:
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
self._send_ble(keyboard.matrix_update)
|
||
|
|
elif self.split_type == SplitType.UART and self.data_pin2:
|
||
|
|
self._send_uart(keyboard.matrix_update)
|
||
|
|
elif self.split_type == SplitType.ONEWIRE:
|
||
|
|
pass # Protocol needs written
|
||
|
|
|
||
|
|
return
|
||
|
|
|
||
|
|
def before_hid_send(self, keyboard):
|
||
|
|
return
|
||
|
|
|
||
|
|
def after_hid_send(self, keyboard):
|
||
|
|
return
|
||
|
|
|
||
|
|
def on_powersave_enable(self, keyboard):
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
if self._uart_connection and not self._psave_enable:
|
||
|
|
self._uart_connection.connection_interval = self._uart_interval
|
||
|
|
self._psave_enable = True
|
||
|
|
|
||
|
|
def on_powersave_disable(self, keyboard):
|
||
|
|
if self.split_type == SplitType.BLE:
|
||
|
|
if self._uart_connection and self._psave_enable:
|
||
|
|
self._uart_connection.connection_interval = 11.25
|
||
|
|
self._psave_enable = False
|
||
|
|
|
||
|
|
def _check_all_connections(self, hid_type):
|
||
|
|
'''Validates the correct number of BLE connections'''
|
||
|
|
self._connection_count = len(self._ble.connections)
|
||
|
|
if self._is_target and hid_type == HIDModes.BLE and self._connection_count < 2:
|
||
|
|
self._target_advertise()
|
||
|
|
elif not self._is_target and self._connection_count < 1:
|
||
|
|
self._initiator_scan()
|
||
|
|
|
||
|
|
def _initiator_scan(self):
|
||
|
|
'''Scans for target device'''
|
||
|
|
self._uart = None
|
||
|
|
self._uart_connection = None
|
||
|
|
# See if any existing connections are providing UARTService.
|
||
|
|
self._connection_count = len(self._ble.connections)
|
||
|
|
if self._connection_count > 0 and not self._uart:
|
||
|
|
for connection in self._ble.connections:
|
||
|
|
if self.UARTService in connection:
|
||
|
|
self._uart_connection = connection
|
||
|
|
self._uart_connection.connection_interval = 11.25
|
||
|
|
self._uart = self._uart_connection[self.UARTService]
|
||
|
|
break
|
||
|
|
|
||
|
|
if not self._uart:
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Scanning')
|
||
|
|
self._ble.stop_scan()
|
||
|
|
for adv in self._ble.start_scan(
|
||
|
|
self.ProvideServicesAdvertisement, timeout=20
|
||
|
|
):
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Scanning')
|
||
|
|
if self.UARTService in adv.services and adv.rssi > -70:
|
||
|
|
self._uart_connection = self._ble.connect(adv)
|
||
|
|
self._uart_connection.connection_interval = 11.25
|
||
|
|
self._uart = self._uart_connection[self.UARTService]
|
||
|
|
self._ble.stop_scan()
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Scan complete')
|
||
|
|
break
|
||
|
|
self._ble.stop_scan()
|
||
|
|
|
||
|
|
def _target_advertise(self):
|
||
|
|
'''Advertises the target for the initiator to find'''
|
||
|
|
self._ble.stop_advertising()
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Advertising')
|
||
|
|
# Uart must not change on this connection if reconnecting
|
||
|
|
if not self._uart:
|
||
|
|
self._uart = self.UARTService()
|
||
|
|
advertisement = self.ProvideServicesAdvertisement(self._uart)
|
||
|
|
|
||
|
|
self._ble.start_advertising(advertisement)
|
||
|
|
|
||
|
|
self.ble_time_reset()
|
||
|
|
while not self.ble_rescan_timer():
|
||
|
|
self._connection_count = len(self._ble.connections)
|
||
|
|
if self._connection_count > 1:
|
||
|
|
self.ble_time_reset()
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Advertising complete')
|
||
|
|
break
|
||
|
|
self._ble.stop_advertising()
|
||
|
|
|
||
|
|
def ble_rescan_timer(self):
|
||
|
|
'''If true, the rescan timer is up'''
|
||
|
|
return bool(ticks_diff(ticks_ms(), self._ble_last_scan) > 5000)
|
||
|
|
|
||
|
|
def ble_time_reset(self):
|
||
|
|
'''Resets the rescan timer'''
|
||
|
|
self._ble_last_scan = ticks_ms()
|
||
|
|
|
||
|
|
def _send_ble(self, update):
|
||
|
|
if self._uart:
|
||
|
|
try:
|
||
|
|
if not self._is_target:
|
||
|
|
update[1] += self.split_offset
|
||
|
|
self._uart.write(update)
|
||
|
|
except OSError:
|
||
|
|
try:
|
||
|
|
self._uart.disconnect()
|
||
|
|
except: # noqa: E722
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('UART disconnect failed')
|
||
|
|
|
||
|
|
if self._debug_enabled:
|
||
|
|
print('Connection error')
|
||
|
|
self._uart_connection = None
|
||
|
|
self._uart = None
|
||
|
|
|
||
|
|
def _receive_ble(self, keyboard):
|
||
|
|
if self._uart is not None and self._uart.in_waiting > 0 or self._uart_buffer:
|
||
|
|
while self._uart.in_waiting >= 3:
|
||
|
|
self._uart_buffer.append(self._uart.read(3))
|
||
|
|
if self._uart_buffer:
|
||
|
|
keyboard.secondary_matrix_update = bytearray(self._uart_buffer.pop(0))
|
||
|
|
return
|
||
|
|
|
||
|
|
def _send_uart(self, update):
|
||
|
|
# Change offsets depending on where the data is going to match the correct
|
||
|
|
# matrix location of the receiever
|
||
|
|
if self._is_target:
|
||
|
|
if self.split_target_left:
|
||
|
|
update[1] += self.split_offset
|
||
|
|
else:
|
||
|
|
update[1] -= self.split_offset
|
||
|
|
else:
|
||
|
|
if self.split_target_left:
|
||
|
|
update[1] -= self.split_offset
|
||
|
|
else:
|
||
|
|
update[1] += self.split_offset
|
||
|
|
|
||
|
|
if self._uart is not None:
|
||
|
|
self._uart.write(update)
|
||
|
|
|
||
|
|
def _receive_uart(self, keyboard):
|
||
|
|
if self._uart is not None and self._uart.in_waiting > 0 or self._uart_buffer:
|
||
|
|
if self._uart.in_waiting >= 60:
|
||
|
|
# This is a dirty hack to prevent crashes in unrealistic cases
|
||
|
|
import microcontroller
|
||
|
|
|
||
|
|
microcontroller.reset()
|
||
|
|
|
||
|
|
while self._uart.in_waiting >= 3:
|
||
|
|
self._uart_buffer.append(self._uart.read(3))
|
||
|
|
if self._uart_buffer:
|
||
|
|
keyboard.secondary_matrix_update = bytearray(self._uart_buffer.pop(0))
|
||
|
|
|
||
|
|
return
|