refactor(split): move peripheral service out of Bluetooth directory
This commit is contained in:
parent
2b3de1bc1a
commit
a8bbde0215
6 changed files with 156 additions and 119 deletions
|
@ -10,6 +10,7 @@
|
||||||
#include <zmk/sensors.h>
|
#include <zmk/sensors.h>
|
||||||
|
|
||||||
#define ZMK_SPLIT_RUN_BEHAVIOR_DEV_LEN 9
|
#define ZMK_SPLIT_RUN_BEHAVIOR_DEV_LEN 9
|
||||||
|
#define ZMK_SPLIT_POS_STATE_LEN 16
|
||||||
|
|
||||||
struct sensor_event {
|
struct sensor_event {
|
||||||
uint8_t sensor_index;
|
uint8_t sensor_index;
|
||||||
|
@ -30,8 +31,13 @@ struct zmk_split_run_behavior_payload {
|
||||||
char behavior_dev[ZMK_SPLIT_RUN_BEHAVIOR_DEV_LEN];
|
char behavior_dev[ZMK_SPLIT_RUN_BEHAVIOR_DEV_LEN];
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
||||||
int zmk_split_bt_position_pressed(uint8_t position);
|
int zmk_split_position_pressed(uint8_t position);
|
||||||
int zmk_split_bt_position_released(uint8_t position);
|
int zmk_split_position_released(uint8_t position);
|
||||||
int zmk_split_bt_sensor_triggered(uint8_t sensor_index,
|
int zmk_split_sensor_triggered(uint8_t sensor_index,
|
||||||
const struct zmk_sensor_channel_data channel_data[],
|
const struct zmk_sensor_channel_data channel_data[],
|
||||||
size_t channel_data_size);
|
size_t channel_data_size);
|
||||||
|
|
||||||
|
void send_position_state_impl(uint8_t *state, int len);
|
||||||
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
|
void send_sensor_state_impl(struct sensor_event *event, int len);
|
||||||
|
#endif
|
|
@ -3,6 +3,7 @@
|
||||||
|
|
||||||
if (CONFIG_ZMK_SPLIT_BLE AND (NOT CONFIG_ZMK_SPLIT_ROLE_CENTRAL))
|
if (CONFIG_ZMK_SPLIT_BLE AND (NOT CONFIG_ZMK_SPLIT_ROLE_CENTRAL))
|
||||||
target_sources(app PRIVATE listener.c)
|
target_sources(app PRIVATE listener.c)
|
||||||
|
target_sources(app PRIVATE service.c)
|
||||||
endif()
|
endif()
|
||||||
|
|
||||||
if (CONFIG_ZMK_SPLIT_BLE)
|
if (CONFIG_ZMK_SPLIT_BLE)
|
||||||
|
|
|
@ -24,7 +24,7 @@ LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
#include <zmk/behavior.h>
|
#include <zmk/behavior.h>
|
||||||
#include <zmk/sensors.h>
|
#include <zmk/sensors.h>
|
||||||
#include <zmk/split/bluetooth/uuid.h>
|
#include <zmk/split/bluetooth/uuid.h>
|
||||||
#include <zmk/split/bluetooth/service.h>
|
#include <zmk/split/service.h>
|
||||||
#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>
|
||||||
|
|
|
@ -20,7 +20,7 @@ LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
#include <zmk/behavior.h>
|
#include <zmk/behavior.h>
|
||||||
#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/service.h>
|
||||||
|
|
||||||
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
#if IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
#include <zmk/events/hid_indicators_changed.h>
|
#include <zmk/events/hid_indicators_changed.h>
|
||||||
|
@ -43,10 +43,8 @@ static void split_svc_sensor_state_ccc(const struct bt_gatt_attr *attr, uint16_t
|
||||||
}
|
}
|
||||||
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
|
|
||||||
#define POS_STATE_LEN 16
|
|
||||||
|
|
||||||
static uint8_t num_of_positions = ZMK_KEYMAP_LEN;
|
static uint8_t num_of_positions = ZMK_KEYMAP_LEN;
|
||||||
static uint8_t position_state[POS_STATE_LEN];
|
static uint8_t position_state[ZMK_SPLIT_POS_STATE_LEN];
|
||||||
|
|
||||||
static struct zmk_split_run_behavior_payload behavior_run_payload;
|
static struct zmk_split_run_behavior_payload behavior_run_payload;
|
||||||
|
|
||||||
|
@ -162,116 +160,20 @@ BT_GATT_SERVICE_DEFINE(
|
||||||
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
#endif // IS_ENABLED(CONFIG_ZMK_SPLIT_PERIPHERAL_HID_INDICATORS)
|
||||||
);
|
);
|
||||||
|
|
||||||
K_THREAD_STACK_DEFINE(service_q_stack, CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_STACK_SIZE);
|
void send_position_state_impl(uint8_t *state, int len) {
|
||||||
|
memcpy(position_state, state, MIN(len, sizeof(position_state)));
|
||||||
struct k_work_q service_work_q;
|
int err = bt_gatt_notify(NULL, &split_svc.attrs[1], state, len);
|
||||||
|
|
||||||
K_MSGQ_DEFINE(position_state_msgq, sizeof(char[POS_STATE_LEN]),
|
|
||||||
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_POSITION_QUEUE_SIZE, 4);
|
|
||||||
|
|
||||||
void send_position_state_callback(struct k_work *work) {
|
|
||||||
uint8_t state[POS_STATE_LEN];
|
|
||||||
|
|
||||||
while (k_msgq_get(&position_state_msgq, &state, K_NO_WAIT) == 0) {
|
|
||||||
int err = bt_gatt_notify(NULL, &split_svc.attrs[1], &state, sizeof(state));
|
|
||||||
if (err) {
|
|
||||||
LOG_DBG("Error notifying %d", err);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
};
|
|
||||||
|
|
||||||
K_WORK_DEFINE(service_position_notify_work, send_position_state_callback);
|
|
||||||
|
|
||||||
int send_position_state() {
|
|
||||||
int err = k_msgq_put(&position_state_msgq, position_state, K_MSEC(100));
|
|
||||||
if (err) {
|
if (err) {
|
||||||
switch (err) {
|
LOG_DBG("Error notifying %d", err);
|
||||||
case -EAGAIN: {
|
|
||||||
LOG_WRN("Position state message queue full, popping first message and queueing again");
|
|
||||||
uint8_t discarded_state[POS_STATE_LEN];
|
|
||||||
k_msgq_get(&position_state_msgq, &discarded_state, K_NO_WAIT);
|
|
||||||
return send_position_state();
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
LOG_WRN("Failed to queue position state to send (%d)", err);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
k_work_submit_to_queue(&service_work_q, &service_position_notify_work);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int zmk_split_bt_position_pressed(uint8_t position) {
|
|
||||||
WRITE_BIT(position_state[position / 8], position % 8, true);
|
|
||||||
return send_position_state();
|
|
||||||
}
|
|
||||||
|
|
||||||
int zmk_split_bt_position_released(uint8_t position) {
|
|
||||||
WRITE_BIT(position_state[position / 8], position % 8, false);
|
|
||||||
return send_position_state();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#if ZMK_KEYMAP_HAS_SENSORS
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
K_MSGQ_DEFINE(sensor_state_msgq, sizeof(struct sensor_event),
|
void send_sensor_state_impl(struct sensor_event *event, int len) {
|
||||||
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_POSITION_QUEUE_SIZE, 4);
|
memcpy(&last_sensor_event, event, MIN(len, sizeof(last_sensor_event)));
|
||||||
|
int err = bt_gatt_notify(NULL, &split_svc.attrs[8], event, len);
|
||||||
void send_sensor_state_callback(struct k_work *work) {
|
|
||||||
while (k_msgq_get(&sensor_state_msgq, &last_sensor_event, K_NO_WAIT) == 0) {
|
|
||||||
int err = bt_gatt_notify(NULL, &split_svc.attrs[8], &last_sensor_event,
|
|
||||||
sizeof(last_sensor_event));
|
|
||||||
if (err) {
|
|
||||||
LOG_DBG("Error notifying %d", err);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
};
|
|
||||||
|
|
||||||
K_WORK_DEFINE(service_sensor_notify_work, send_sensor_state_callback);
|
|
||||||
|
|
||||||
int send_sensor_state(struct sensor_event ev) {
|
|
||||||
int err = k_msgq_put(&sensor_state_msgq, &ev, K_MSEC(100));
|
|
||||||
if (err) {
|
if (err) {
|
||||||
// retry...
|
LOG_DBG("Error notifying %d", err);
|
||||||
switch (err) {
|
|
||||||
case -EAGAIN: {
|
|
||||||
LOG_WRN("Sensor state message queue full, popping first message and queueing again");
|
|
||||||
struct sensor_event discarded_state;
|
|
||||||
k_msgq_get(&sensor_state_msgq, &discarded_state, K_NO_WAIT);
|
|
||||||
return send_sensor_state(ev);
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
LOG_WRN("Failed to queue sensor state to send (%d)", err);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
k_work_submit_to_queue(&service_work_q, &service_sensor_notify_work);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int zmk_split_bt_sensor_triggered(uint8_t sensor_index,
|
|
||||||
const struct zmk_sensor_channel_data channel_data[],
|
|
||||||
size_t channel_data_size) {
|
|
||||||
if (channel_data_size > ZMK_SENSOR_EVENT_MAX_CHANNELS) {
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct sensor_event ev =
|
|
||||||
(struct sensor_event){.sensor_index = sensor_index, .channel_data_size = channel_data_size};
|
|
||||||
memcpy(ev.channel_data, channel_data,
|
|
||||||
channel_data_size * sizeof(struct zmk_sensor_channel_data));
|
|
||||||
return send_sensor_state(ev);
|
|
||||||
}
|
}
|
||||||
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
|
|
||||||
static int service_init(void) {
|
|
||||||
static const struct k_work_queue_config queue_config = {
|
|
||||||
.name = "Split Peripheral Notification Queue"};
|
|
||||||
k_work_queue_start(&service_work_q, service_q_stack, K_THREAD_STACK_SIZEOF(service_q_stack),
|
|
||||||
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_PRIORITY, &queue_config);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
SYS_INIT(service_init, APPLICATION, CONFIG_ZMK_BLE_INIT_PRIORITY);
|
|
||||||
|
|
|
@ -7,7 +7,7 @@
|
||||||
#include <zephyr/device.h>
|
#include <zephyr/device.h>
|
||||||
#include <zephyr/logging/log.h>
|
#include <zephyr/logging/log.h>
|
||||||
|
|
||||||
#include <zmk/split/bluetooth/service.h>
|
#include <zmk/split/service.h>
|
||||||
|
|
||||||
LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
|
|
||||||
|
@ -23,17 +23,17 @@ int split_listener(const zmk_event_t *eh) {
|
||||||
const struct zmk_position_state_changed *pos_ev;
|
const struct zmk_position_state_changed *pos_ev;
|
||||||
if ((pos_ev = as_zmk_position_state_changed(eh)) != NULL) {
|
if ((pos_ev = as_zmk_position_state_changed(eh)) != NULL) {
|
||||||
if (pos_ev->state) {
|
if (pos_ev->state) {
|
||||||
return zmk_split_bt_position_pressed(pos_ev->position);
|
return zmk_split_position_pressed(pos_ev->position);
|
||||||
} else {
|
} else {
|
||||||
return zmk_split_bt_position_released(pos_ev->position);
|
return zmk_split_position_released(pos_ev->position);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#if ZMK_KEYMAP_HAS_SENSORS
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
const struct zmk_sensor_event *sensor_ev;
|
const struct zmk_sensor_event *sensor_ev;
|
||||||
if ((sensor_ev = as_zmk_sensor_event(eh)) != NULL) {
|
if ((sensor_ev = as_zmk_sensor_event(eh)) != NULL) {
|
||||||
return zmk_split_bt_sensor_triggered(sensor_ev->sensor_index, sensor_ev->channel_data,
|
return zmk_split_sensor_triggered(sensor_ev->sensor_index, sensor_ev->channel_data,
|
||||||
sensor_ev->channel_data_size);
|
sensor_ev->channel_data_size);
|
||||||
}
|
}
|
||||||
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
return ZMK_EV_EVENT_BUBBLE;
|
return ZMK_EV_EVENT_BUBBLE;
|
||||||
|
|
128
app/src/split/service.c
Normal file
128
app/src/split/service.c
Normal file
|
@ -0,0 +1,128 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2023 The ZMK Contributors
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: MIT
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <zephyr/types.h>
|
||||||
|
#include <zephyr/sys/util.h>
|
||||||
|
#include <zephyr/init.h>
|
||||||
|
|
||||||
|
#include <zmk/events/sensor_event.h>
|
||||||
|
#include <zmk/sensors.h>
|
||||||
|
#include <zmk/split/service.h>
|
||||||
|
|
||||||
|
#include <zephyr/logging/log.h>
|
||||||
|
LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
|
||||||
|
|
||||||
|
static uint8_t position_state[ZMK_SPLIT_POS_STATE_LEN];
|
||||||
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
|
static struct sensor_event last_sensor_event;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
K_THREAD_STACK_DEFINE(service_q_stack, CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_STACK_SIZE);
|
||||||
|
|
||||||
|
struct k_work_q service_work_q;
|
||||||
|
|
||||||
|
K_MSGQ_DEFINE(position_state_msgq, sizeof(char[ZMK_SPLIT_POS_STATE_LEN]),
|
||||||
|
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_POSITION_QUEUE_SIZE, 4);
|
||||||
|
|
||||||
|
void send_position_state_callback(struct k_work *work) {
|
||||||
|
uint8_t state[ZMK_SPLIT_POS_STATE_LEN];
|
||||||
|
|
||||||
|
while (k_msgq_get(&position_state_msgq, &state, K_NO_WAIT) == 0) {
|
||||||
|
send_position_state_impl(state, sizeof(state));
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
K_WORK_DEFINE(service_position_notify_work, send_position_state_callback);
|
||||||
|
|
||||||
|
int send_position_state() {
|
||||||
|
int err = k_msgq_put(&position_state_msgq, position_state, K_MSEC(100));
|
||||||
|
if (err) {
|
||||||
|
switch (err) {
|
||||||
|
case -EAGAIN: {
|
||||||
|
LOG_WRN("Position state message queue full, popping first message and queueing again");
|
||||||
|
uint8_t discarded_state[ZMK_SPLIT_POS_STATE_LEN];
|
||||||
|
k_msgq_get(&position_state_msgq, &discarded_state, K_NO_WAIT);
|
||||||
|
return send_position_state();
|
||||||
|
}
|
||||||
|
default:
|
||||||
|
LOG_WRN("Failed to queue position state to send (%d)", err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
k_work_submit_to_queue(&service_work_q, &service_position_notify_work);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int zmk_split_position_pressed(uint8_t position) {
|
||||||
|
WRITE_BIT(position_state[position / 8], position % 8, true);
|
||||||
|
return send_position_state();
|
||||||
|
}
|
||||||
|
|
||||||
|
int zmk_split_position_released(uint8_t position) {
|
||||||
|
WRITE_BIT(position_state[position / 8], position % 8, false);
|
||||||
|
return send_position_state();
|
||||||
|
}
|
||||||
|
|
||||||
|
#if ZMK_KEYMAP_HAS_SENSORS
|
||||||
|
K_MSGQ_DEFINE(sensor_state_msgq, sizeof(struct sensor_event),
|
||||||
|
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_POSITION_QUEUE_SIZE, 4);
|
||||||
|
|
||||||
|
void send_sensor_state_callback(struct k_work *work) {
|
||||||
|
while (k_msgq_get(&sensor_state_msgq, &last_sensor_event, K_NO_WAIT) == 0) {
|
||||||
|
send_sensor_state_impl(&last_sensor_event, sizeof(last_sensor_event));
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
K_WORK_DEFINE(service_sensor_notify_work, send_sensor_state_callback);
|
||||||
|
|
||||||
|
int send_sensor_state(struct sensor_event ev) {
|
||||||
|
int err = k_msgq_put(&sensor_state_msgq, &ev, K_MSEC(100));
|
||||||
|
if (err) {
|
||||||
|
// retry...
|
||||||
|
switch (err) {
|
||||||
|
case -EAGAIN: {
|
||||||
|
LOG_WRN("Sensor state message queue full, popping first message and queueing again");
|
||||||
|
struct sensor_event discarded_state;
|
||||||
|
k_msgq_get(&sensor_state_msgq, &discarded_state, K_NO_WAIT);
|
||||||
|
return send_sensor_state(ev);
|
||||||
|
}
|
||||||
|
default:
|
||||||
|
LOG_WRN("Failed to queue sensor state to send (%d)", err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
k_work_submit_to_queue(&service_work_q, &service_sensor_notify_work);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int zmk_split_sensor_triggered(uint8_t sensor_index,
|
||||||
|
const struct zmk_sensor_channel_data channel_data[],
|
||||||
|
size_t channel_data_size) {
|
||||||
|
if (channel_data_size > ZMK_SENSOR_EVENT_MAX_CHANNELS) {
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
struct sensor_event ev =
|
||||||
|
(struct sensor_event){.sensor_index = sensor_index, .channel_data_size = channel_data_size};
|
||||||
|
memcpy(ev.channel_data, channel_data,
|
||||||
|
channel_data_size * sizeof(struct zmk_sensor_channel_data));
|
||||||
|
return send_sensor_state(ev);
|
||||||
|
}
|
||||||
|
#endif /* ZMK_KEYMAP_HAS_SENSORS */
|
||||||
|
|
||||||
|
static int service_init(void) {
|
||||||
|
static const struct k_work_queue_config queue_config = {
|
||||||
|
.name = "Split Peripheral Notification Queue"};
|
||||||
|
k_work_queue_start(&service_work_q, service_q_stack, K_THREAD_STACK_SIZEOF(service_q_stack),
|
||||||
|
CONFIG_ZMK_SPLIT_BLE_PERIPHERAL_PRIORITY, &queue_config);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
SYS_INIT(service_init, APPLICATION, CONFIG_ZMK_BLE_INIT_PRIORITY);
|
Loading…
Add table
Reference in a new issue