feat: LED indicators on peripheral side
This commit is contained in:
parent
c23cc8ee42
commit
f14ac2b3d6
6 changed files with 119 additions and 4 deletions
|
@ -4,5 +4,15 @@
|
||||||
#include <zephyr/bluetooth/addr.h>
|
#include <zephyr/bluetooth/addr.h>
|
||||||
#include <zmk/behavior.h>
|
#include <zmk/behavior.h>
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
#include <zmk/hid_indicators_types.h>
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
int zmk_split_bt_invoke_behavior(uint8_t source, struct zmk_behavior_binding *binding,
|
int zmk_split_bt_invoke_behavior(uint8_t source, struct zmk_behavior_binding *binding,
|
||||||
struct zmk_behavior_binding_event event, bool state);
|
struct zmk_behavior_binding_event event, bool state);
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
|
int zmk_split_bt_update_hid_indicator(zmk_hid_indicators indicators);
|
||||||
|
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
|
@ -17,3 +17,4 @@
|
||||||
#define ZMK_SPLIT_BT_CHAR_POSITION_STATE_UUID ZMK_BT_SPLIT_UUID(0x00000001)
|
#define ZMK_SPLIT_BT_CHAR_POSITION_STATE_UUID ZMK_BT_SPLIT_UUID(0x00000001)
|
||||||
#define ZMK_SPLIT_BT_CHAR_RUN_BEHAVIOR_UUID ZMK_BT_SPLIT_UUID(0x00000002)
|
#define ZMK_SPLIT_BT_CHAR_RUN_BEHAVIOR_UUID ZMK_BT_SPLIT_UUID(0x00000002)
|
||||||
#define ZMK_SPLIT_BT_CHAR_SENSOR_STATE_UUID ZMK_BT_SPLIT_UUID(0x00000003)
|
#define ZMK_SPLIT_BT_CHAR_SENSOR_STATE_UUID ZMK_BT_SPLIT_UUID(0x00000003)
|
||||||
|
#define ZMK_SPLIT_BT_UPDATE_HID_INDICATORS_UUID ZMK_BT_SPLIT_UUID(0x00000004)
|
||||||
|
|
|
@ -28,8 +28,14 @@ zmk_hid_indicators zmk_hid_indicators_get_profile(struct zmk_endpoint_instance e
|
||||||
}
|
}
|
||||||
|
|
||||||
static void raise_led_changed_event(struct k_work *_work) {
|
static void raise_led_changed_event(struct k_work *_work) {
|
||||||
ZMK_EVENT_RAISE(new_zmk_hid_indicators_changed((struct zmk_hid_indicators_changed){
|
zmk_hid_indicators indicators = zmk_hid_indicators_get_current_profile();
|
||||||
.indicators = zmk_hid_indicators_get_current_profile()}));
|
|
||||||
|
ZMK_EVENT_RAISE(new_zmk_hid_indicators_changed(
|
||||||
|
(struct zmk_hid_indicators_changed){.indicators = indicators}));
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS) && IS_ENABLED(CONFIG_ZMK_SPLIT_BLE)
|
||||||
|
zmk_split_bt_update_hid_indicator(indicators);
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
static K_WORK_DEFINE(led_changed_work, raise_led_changed_event);
|
static K_WORK_DEFINE(led_changed_work, raise_led_changed_event);
|
||||||
|
|
|
@ -20,6 +20,12 @@ config ZMK_SPLIT_BLE
|
||||||
|
|
||||||
endchoice
|
endchoice
|
||||||
|
|
||||||
|
config ZMK_SPLIT_PERIPHERAL_HID_INDICATORS
|
||||||
|
bool "Peripheral HID Indicators"
|
||||||
|
depends on ZMK_HID_INDICATORS
|
||||||
|
help
|
||||||
|
Enable propogating the HID (LED) Indicator state to the split peripheral(s).
|
||||||
|
|
||||||
#ZMK_SPLIT
|
#ZMK_SPLIT
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
|
|
@ -27,6 +27,7 @@ LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
#include <zmk/event_manager.h>
|
#include <zmk/event_manager.h>
|
||||||
#include <zmk/events/position_state_changed.h>
|
#include <zmk/events/position_state_changed.h>
|
||||||
#include <zmk/events/sensor_event.h>
|
#include <zmk/events/sensor_event.h>
|
||||||
|
#include <zmk/hid_indicators_types.h>
|
||||||
|
|
||||||
static int start_scanning(void);
|
static int start_scanning(void);
|
||||||
|
|
||||||
|
@ -46,6 +47,9 @@ struct peripheral_slot {
|
||||||
struct bt_gatt_subscribe_params sensor_subscribe_params;
|
struct bt_gatt_subscribe_params sensor_subscribe_params;
|
||||||
struct bt_gatt_discover_params sub_discover_params;
|
struct bt_gatt_discover_params sub_discover_params;
|
||||||
uint16_t run_behavior_handle;
|
uint16_t run_behavior_handle;
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
uint16_t update_hid_indicators;
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
uint8_t position_state[POSITION_STATE_DATA_LEN];
|
uint8_t position_state[POSITION_STATE_DATA_LEN];
|
||||||
uint8_t changed_positions[POSITION_STATE_DATA_LEN];
|
uint8_t changed_positions[POSITION_STATE_DATA_LEN];
|
||||||
};
|
};
|
||||||
|
@ -131,6 +135,9 @@ int release_peripheral_slot(int index) {
|
||||||
// Clean up previously discovered handles;
|
// Clean up previously discovered handles;
|
||||||
slot->subscribe_params.value_handle = 0;
|
slot->subscribe_params.value_handle = 0;
|
||||||
slot->run_behavior_handle = 0;
|
slot->run_behavior_handle = 0;
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
slot->update_hid_indicators = 0;
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -329,13 +336,23 @@ static uint8_t split_central_chrc_discovery_func(struct bt_conn *conn,
|
||||||
slot->discover_params.uuid = NULL;
|
slot->discover_params.uuid = NULL;
|
||||||
slot->discover_params.start_handle = attr->handle + 2;
|
slot->discover_params.start_handle = attr->handle + 2;
|
||||||
slot->run_behavior_handle = bt_gatt_attr_value_handle(attr);
|
slot->run_behavior_handle = bt_gatt_attr_value_handle(attr);
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
} else if (!bt_uuid_cmp(((struct bt_gatt_chrc *)attr->user_data)->uuid,
|
||||||
|
BT_UUID_DECLARE_128(ZMK_SPLIT_BT_UPDATE_HID_INDICATORS_UUID))) {
|
||||||
|
LOG_DBG("Found update HID indicators handle");
|
||||||
|
slot->update_hid_indicators = bt_gatt_attr_value_handle(attr);
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
}
|
}
|
||||||
|
|
||||||
bool subscribed = slot->run_behavior_handle && slot->subscribe_params.value_handle;
|
bool subscribed = (slot->run_behavior_handle && slot->subscribe_params.value_handle);
|
||||||
#if ZMK_KEYMAP_HAS_SENSORS
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
subscribed = subscribed && slot->sensor_subscribe_params.value_handle;
|
subscribed = subscribed && slot->sensor_subscribe_params.value_handle;
|
||||||
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
subscribed = subscribed && slot->update_hid_indicators;
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
return subscribed ? BT_GATT_ITER_STOP : BT_GATT_ITER_CONTINUE;
|
return subscribed ? BT_GATT_ITER_STOP : BT_GATT_ITER_CONTINUE;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -685,6 +702,43 @@ int zmk_split_bt_invoke_behavior(uint8_t source, struct zmk_behavior_binding *bi
|
||||||
return split_bt_invoke_behavior_payload(wrapper);
|
return split_bt_invoke_behavior_payload(wrapper);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
|
static zmk_hid_indicators hid_indicators = 0;
|
||||||
|
|
||||||
|
static void split_central_update_indicators_callback(struct k_work *work) {
|
||||||
|
zmk_hid_indicators indicators = hid_indicators;
|
||||||
|
for (int i = 0; i < ZMK_SPLIT_BLE_PERIPHERAL_COUNT; i++) {
|
||||||
|
if (peripherals[i].state != PERIPHERAL_SLOT_STATE_CONNECTED) {
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (peripherals[i].update_hid_indicators == 0) {
|
||||||
|
// It appears that sometimes the peripheral is considered connected
|
||||||
|
// before the GATT characteristics have been discovered. If this is
|
||||||
|
// the case, the update_hid_indicators handle will not yet be set.
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
int err = bt_gatt_write_without_response(peripherals[i].conn,
|
||||||
|
peripherals[i].update_hid_indicators, &indicators,
|
||||||
|
sizeof(indicators), true);
|
||||||
|
|
||||||
|
if (err) {
|
||||||
|
LOG_ERR("Failed to write HID indicator characteristic (err %d)", err);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static K_WORK_DEFINE(split_central_update_indicators, split_central_update_indicators_callback);
|
||||||
|
|
||||||
|
int zmk_split_bt_update_hid_indicator(zmk_hid_indicators indicators) {
|
||||||
|
hid_indicators = indicators;
|
||||||
|
return k_work_submit_to_queue(&split_central_split_run_q, &split_central_update_indicators);
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
int zmk_split_bt_central_init(const struct device *_arg) {
|
int zmk_split_bt_central_init(const struct device *_arg) {
|
||||||
k_work_queue_start(&split_central_split_run_q, split_central_split_run_q_stack,
|
k_work_queue_start(&split_central_split_run_q, split_central_split_run_q_stack,
|
||||||
K_THREAD_STACK_SIZEOF(split_central_split_run_q_stack),
|
K_THREAD_STACK_SIZEOF(split_central_split_run_q_stack),
|
||||||
|
|
|
@ -21,6 +21,11 @@ LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
#include <zmk/matrix.h>
|
#include <zmk/matrix.h>
|
||||||
#include <zmk/split/bluetooth/uuid.h>
|
#include <zmk/split/bluetooth/uuid.h>
|
||||||
#include <zmk/split/bluetooth/service.h>
|
#include <zmk/split/bluetooth/service.h>
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
#include <zmk/events/hid_indicators_changed.h>
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
#include <zmk/events/sensor_event.h>
|
#include <zmk/events/sensor_event.h>
|
||||||
#include <zmk/sensors.h>
|
#include <zmk/sensors.h>
|
||||||
|
|
||||||
|
@ -105,6 +110,34 @@ static void split_svc_pos_state_ccc(const struct bt_gatt_attr *attr, uint16_t va
|
||||||
LOG_DBG("value %d", value);
|
LOG_DBG("value %d", value);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
|
static zmk_hid_indicators hid_indicators = 0;
|
||||||
|
|
||||||
|
static void split_svc_update_indicators_callback(struct k_work *work) {
|
||||||
|
LOG_DBG("Raising HID indicators changed event: %x", hid_indicators);
|
||||||
|
ZMK_EVENT_RAISE(new_zmk_hid_indicators_changed(
|
||||||
|
(struct zmk_hid_indicators_changed){.indicators = hid_indicators}));
|
||||||
|
}
|
||||||
|
|
||||||
|
static K_WORK_DEFINE(split_svc_update_indicators_work, split_svc_update_indicators_callback);
|
||||||
|
|
||||||
|
static ssize_t split_svc_update_indicators(struct bt_conn *conn, const struct bt_gatt_attr *attr,
|
||||||
|
const void *buf, uint16_t len, uint16_t offset,
|
||||||
|
uint8_t flags) {
|
||||||
|
if (offset + len > sizeof(zmk_hid_indicators)) {
|
||||||
|
return BT_GATT_ERR(BT_ATT_ERR_INVALID_OFFSET);
|
||||||
|
}
|
||||||
|
|
||||||
|
memcpy((uint8_t *)&hid_indicators + offset, buf, len);
|
||||||
|
|
||||||
|
k_work_submit(&split_svc_update_indicators_work);
|
||||||
|
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
|
||||||
BT_GATT_SERVICE_DEFINE(
|
BT_GATT_SERVICE_DEFINE(
|
||||||
split_svc, BT_GATT_PRIMARY_SERVICE(BT_UUID_DECLARE_128(ZMK_SPLIT_BT_SERVICE_UUID)),
|
split_svc, BT_GATT_PRIMARY_SERVICE(BT_UUID_DECLARE_128(ZMK_SPLIT_BT_SERVICE_UUID)),
|
||||||
BT_GATT_CHARACTERISTIC(BT_UUID_DECLARE_128(ZMK_SPLIT_BT_CHAR_POSITION_STATE_UUID),
|
BT_GATT_CHARACTERISTIC(BT_UUID_DECLARE_128(ZMK_SPLIT_BT_CHAR_POSITION_STATE_UUID),
|
||||||
|
@ -122,6 +155,11 @@ BT_GATT_SERVICE_DEFINE(
|
||||||
split_svc_sensor_state, NULL, &last_sensor_event),
|
split_svc_sensor_state, NULL, &last_sensor_event),
|
||||||
BT_GATT_CCC(split_svc_sensor_state_ccc, BT_GATT_PERM_READ_ENCRYPT | BT_GATT_PERM_WRITE_ENCRYPT),
|
BT_GATT_CCC(split_svc_sensor_state_ccc, BT_GATT_PERM_READ_ENCRYPT | BT_GATT_PERM_WRITE_ENCRYPT),
|
||||||
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
|
BT_GATT_CHARACTERISTIC(BT_UUID_DECLARE_128(ZMK_SPLIT_BT_UPDATE_HID_INDICATORS_UUID),
|
||||||
|
BT_GATT_CHRC_WRITE_WITHOUT_RESP, BT_GATT_PERM_WRITE_ENCRYPT, NULL,
|
||||||
|
split_svc_update_indicators, NULL),
|
||||||
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
);
|
);
|
||||||
|
|
||||||
K_THREAD_STACK_DEFINE(service_q_stack, CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_STACK_SIZE);
|
K_THREAD_STACK_DEFINE(service_q_stack, CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_STACK_SIZE);
|
||||||
|
|
Loading…
Add table
Reference in a new issue