Compare commits
2 Commits
dev
...
d86f0d6b78
| Author | SHA1 | Date | |
|---|---|---|---|
| d86f0d6b78 | |||
| 15307dfde5 |
@@ -24,6 +24,7 @@ target_sources(app PRIVATE
|
||||
src/ble_adv_uuid16.c
|
||||
src/ble_bas_module.c
|
||||
src/ble_hid_module.c
|
||||
src/ble_serial_module.c
|
||||
src/display_module.c
|
||||
src/encoder_module.c
|
||||
src/hid_flowctrl_module.c
|
||||
@@ -35,6 +36,8 @@ target_sources(app PRIVATE
|
||||
src/usb_device_module.c
|
||||
src/usb_hid_module.c
|
||||
src/events/bat_state_event.c
|
||||
src/events/ble_serial_rx_event.c
|
||||
src/events/ble_serial_tx_event.c
|
||||
src/events/encoder_event.c
|
||||
src/events/hid_led_event.c
|
||||
src/events/hid_report_sent_event.c
|
||||
|
||||
22
inc/events/ble_serial_rx_event.h
Normal file
22
inc/events/ble_serial_rx_event.h
Normal file
@@ -0,0 +1,22 @@
|
||||
#ifndef BLINKY_BLE_SERIAL_RX_EVENT_H_
|
||||
#define BLINKY_BLE_SERIAL_RX_EVENT_H_
|
||||
|
||||
#include <app_event_manager.h>
|
||||
#include <app_event_manager_profiler_tracer.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
struct ble_serial_rx_event {
|
||||
struct app_event_header header;
|
||||
struct event_dyndata dyndata;
|
||||
};
|
||||
|
||||
APP_EVENT_TYPE_DYNDATA_DECLARE(ble_serial_rx_event);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* BLINKY_BLE_SERIAL_RX_EVENT_H_ */
|
||||
22
inc/events/ble_serial_tx_event.h
Normal file
22
inc/events/ble_serial_tx_event.h
Normal file
@@ -0,0 +1,22 @@
|
||||
#ifndef BLINKY_BLE_SERIAL_TX_EVENT_H_
|
||||
#define BLINKY_BLE_SERIAL_TX_EVENT_H_
|
||||
|
||||
#include <app_event_manager.h>
|
||||
#include <app_event_manager_profiler_tracer.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
struct ble_serial_tx_event {
|
||||
struct app_event_header header;
|
||||
struct event_dyndata dyndata;
|
||||
};
|
||||
|
||||
APP_EVENT_TYPE_DYNDATA_DECLARE(ble_serial_tx_event);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* BLINKY_BLE_SERIAL_TX_EVENT_H_ */
|
||||
3
prj.conf
3
prj.conf
@@ -48,6 +48,9 @@ CONFIG_BT_SETTINGS=y
|
||||
CONFIG_BT_MAX_CONN=1
|
||||
CONFIG_BT_MAX_PAIRED=1
|
||||
CONFIG_BT_ATT_TX_COUNT=5
|
||||
CONFIG_BT_L2CAP_TX_MTU=65
|
||||
CONFIG_BT_BUF_ACL_RX_SIZE=69
|
||||
CONFIG_BT_BUF_ACL_TX_SIZE=69
|
||||
CONFIG_BT_CONN_CTX=y
|
||||
CONFIG_BT_DEVICE_NAME="WH Mini Keyboard"
|
||||
CONFIG_BT_DEVICE_APPEARANCE=961
|
||||
|
||||
308
src/ble_serial_module.c
Normal file
308
src/ble_serial_module.c
Normal file
@@ -0,0 +1,308 @@
|
||||
#include <errno.h>
|
||||
#include <stdbool.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <app_event_manager.h>
|
||||
|
||||
#define MODULE ble_serial_module
|
||||
#include <caf/events/module_state_event.h>
|
||||
#include <caf/events/power_event.h>
|
||||
|
||||
#include <caf/events/ble_common_event.h>
|
||||
#include <zephyr/bluetooth/att.h>
|
||||
#include <zephyr/bluetooth/conn.h>
|
||||
#include <zephyr/bluetooth/gatt.h>
|
||||
#include <zephyr/bluetooth/uuid.h>
|
||||
#include <zephyr/logging/log.h>
|
||||
|
||||
#include "ble_serial_rx_event.h"
|
||||
#include "ble_serial_tx_event.h"
|
||||
|
||||
LOG_MODULE_REGISTER(MODULE, LOG_LEVEL_INF);
|
||||
|
||||
#define BLE_SERIAL_RX_MAX_LEN 64U
|
||||
#define BLE_SERIAL_MIN_PAYLOAD_LEN 32U
|
||||
#define BLE_SERIAL_NOTIFY_OVERHEAD 3U
|
||||
#define BLE_SERIAL_SERVICE_UUID_VAL \
|
||||
BT_UUID_128_ENCODE(0x0b7f6000, 0x38d2, 0x4f62, 0x8f6f, 0x36c4fd73a110)
|
||||
#define BLE_SERIAL_RX_UUID_VAL \
|
||||
BT_UUID_128_ENCODE(0x0b7f6001, 0x38d2, 0x4f62, 0x8f6f, 0x36c4fd73a110)
|
||||
#define BLE_SERIAL_TX_UUID_VAL \
|
||||
BT_UUID_128_ENCODE(0x0b7f6002, 0x38d2, 0x4f62, 0x8f6f, 0x36c4fd73a110)
|
||||
|
||||
static struct bt_conn *active_conn;
|
||||
static bool initialized;
|
||||
static bool running;
|
||||
static bool ble_ready;
|
||||
static bool secured;
|
||||
static bool tx_notify_enabled;
|
||||
|
||||
static const struct bt_uuid_128 ble_serial_service_uuid =
|
||||
BT_UUID_INIT_128(BLE_SERIAL_SERVICE_UUID_VAL);
|
||||
static const struct bt_uuid_128 ble_serial_rx_uuid =
|
||||
BT_UUID_INIT_128(BLE_SERIAL_RX_UUID_VAL);
|
||||
static const struct bt_uuid_128 ble_serial_tx_uuid =
|
||||
BT_UUID_INIT_128(BLE_SERIAL_TX_UUID_VAL);
|
||||
|
||||
static void submit_ble_serial_rx_event(const uint8_t *data, size_t len)
|
||||
{
|
||||
struct ble_serial_rx_event *event = new_ble_serial_rx_event(len);
|
||||
|
||||
memcpy(event->dyndata.data, data, len);
|
||||
APP_EVENT_SUBMIT(event);
|
||||
}
|
||||
|
||||
static void tx_ccc_cfg_changed(const struct bt_gatt_attr *attr, uint16_t value)
|
||||
{
|
||||
ARG_UNUSED(attr);
|
||||
|
||||
tx_notify_enabled = (value == BT_GATT_CCC_NOTIFY);
|
||||
LOG_INF("BLE serial TX notify %s", tx_notify_enabled ? "enabled" : "disabled");
|
||||
}
|
||||
|
||||
static ssize_t rx_write_handler(struct bt_conn *conn,
|
||||
const struct bt_gatt_attr *attr,
|
||||
const void *buf,
|
||||
uint16_t len,
|
||||
uint16_t offset,
|
||||
uint8_t flags)
|
||||
{
|
||||
ARG_UNUSED(attr);
|
||||
ARG_UNUSED(flags);
|
||||
|
||||
if (!running || !ble_ready || !secured || (conn != active_conn)) {
|
||||
return BT_GATT_ERR(BT_ATT_ERR_WRITE_REQ_REJECTED);
|
||||
}
|
||||
|
||||
if (offset != 0U) {
|
||||
return BT_GATT_ERR(BT_ATT_ERR_INVALID_OFFSET);
|
||||
}
|
||||
|
||||
if ((buf == NULL) || (len == 0U) || (len > BLE_SERIAL_RX_MAX_LEN)) {
|
||||
return BT_GATT_ERR(BT_ATT_ERR_INVALID_ATTRIBUTE_LEN);
|
||||
}
|
||||
|
||||
submit_ble_serial_rx_event(buf, len);
|
||||
return len;
|
||||
}
|
||||
|
||||
BT_GATT_SERVICE_DEFINE(ble_serial_svc,
|
||||
BT_GATT_PRIMARY_SERVICE(&ble_serial_service_uuid.uuid),
|
||||
BT_GATT_CHARACTERISTIC(&ble_serial_rx_uuid.uuid,
|
||||
BT_GATT_CHRC_WRITE | BT_GATT_CHRC_WRITE_WITHOUT_RESP,
|
||||
BT_GATT_PERM_WRITE_ENCRYPT,
|
||||
NULL, rx_write_handler, NULL),
|
||||
BT_GATT_CHARACTERISTIC(&ble_serial_tx_uuid.uuid,
|
||||
BT_GATT_CHRC_NOTIFY,
|
||||
BT_GATT_PERM_NONE,
|
||||
NULL, NULL, NULL),
|
||||
BT_GATT_CCC(tx_ccc_cfg_changed,
|
||||
BT_GATT_PERM_READ | BT_GATT_PERM_WRITE_ENCRYPT)
|
||||
);
|
||||
|
||||
static void mtu_updated(struct bt_conn *conn, uint16_t tx, uint16_t rx)
|
||||
{
|
||||
if (conn != active_conn) {
|
||||
return;
|
||||
}
|
||||
|
||||
LOG_INF("BLE serial MTU updated tx:%u rx:%u", tx, rx);
|
||||
}
|
||||
|
||||
static struct bt_gatt_cb gatt_callbacks = {
|
||||
.att_mtu_updated = mtu_updated,
|
||||
};
|
||||
|
||||
static size_t notify_payload_max(void)
|
||||
{
|
||||
uint16_t mtu;
|
||||
|
||||
if (active_conn == NULL) {
|
||||
return 0U;
|
||||
}
|
||||
|
||||
mtu = bt_gatt_get_mtu(active_conn);
|
||||
if (mtu <= BLE_SERIAL_NOTIFY_OVERHEAD) {
|
||||
return 0U;
|
||||
}
|
||||
|
||||
return (size_t)(mtu - BLE_SERIAL_NOTIFY_OVERHEAD);
|
||||
}
|
||||
|
||||
static void reset_connection_state(void)
|
||||
{
|
||||
active_conn = NULL;
|
||||
secured = false;
|
||||
tx_notify_enabled = false;
|
||||
}
|
||||
|
||||
static int module_init(void)
|
||||
{
|
||||
bt_gatt_cb_register(&gatt_callbacks);
|
||||
reset_connection_state();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int module_start(void)
|
||||
{
|
||||
if (running) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
running = true;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void module_pause(void)
|
||||
{
|
||||
if (!running) {
|
||||
return;
|
||||
}
|
||||
|
||||
running = false;
|
||||
tx_notify_enabled = false;
|
||||
}
|
||||
|
||||
static bool handle_ble_peer_event(const struct ble_peer_event *event)
|
||||
{
|
||||
switch (event->state) {
|
||||
case PEER_STATE_CONNECTED:
|
||||
if (active_conn != NULL) {
|
||||
return false;
|
||||
}
|
||||
|
||||
active_conn = event->id;
|
||||
secured = false;
|
||||
tx_notify_enabled = false;
|
||||
return false;
|
||||
|
||||
case PEER_STATE_SECURED:
|
||||
if (active_conn != event->id) {
|
||||
return false;
|
||||
}
|
||||
|
||||
secured = true;
|
||||
return false;
|
||||
|
||||
case PEER_STATE_DISCONNECTED:
|
||||
if (active_conn != event->id) {
|
||||
return false;
|
||||
}
|
||||
|
||||
reset_connection_state();
|
||||
return false;
|
||||
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static bool handle_ble_serial_tx_event(const struct ble_serial_tx_event *event)
|
||||
{
|
||||
size_t payload_max;
|
||||
int err;
|
||||
|
||||
if (!running || !ble_ready || (active_conn == NULL) || !secured || !tx_notify_enabled) {
|
||||
return false;
|
||||
}
|
||||
|
||||
payload_max = notify_payload_max();
|
||||
if (payload_max < BLE_SERIAL_MIN_PAYLOAD_LEN) {
|
||||
LOG_WRN("BLE serial MTU payload too small:%u", (uint32_t)payload_max);
|
||||
return false;
|
||||
}
|
||||
|
||||
if (event->dyndata.size > payload_max) {
|
||||
LOG_WRN("BLE serial TX too large len:%u max:%u",
|
||||
(uint32_t)event->dyndata.size, (uint32_t)payload_max);
|
||||
return false;
|
||||
}
|
||||
|
||||
err = bt_gatt_notify(active_conn, &ble_serial_svc.attrs[4],
|
||||
event->dyndata.data,
|
||||
(uint16_t)event->dyndata.size);
|
||||
if (err) {
|
||||
LOG_WRN("bt_gatt_notify failed (%d)", err);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool app_event_handler(const struct app_event_header *aeh)
|
||||
{
|
||||
if (is_ble_serial_tx_event(aeh)) {
|
||||
return handle_ble_serial_tx_event(cast_ble_serial_tx_event(aeh));
|
||||
}
|
||||
|
||||
if (is_ble_peer_event(aeh)) {
|
||||
return handle_ble_peer_event(cast_ble_peer_event(aeh));
|
||||
}
|
||||
|
||||
if (is_module_state_event(aeh)) {
|
||||
const struct module_state_event *event = cast_module_state_event(aeh);
|
||||
int err;
|
||||
|
||||
if (check_state(event, MODULE_ID(main), MODULE_STATE_READY)) {
|
||||
if (!initialized) {
|
||||
err = module_init();
|
||||
if (err) {
|
||||
module_set_state(MODULE_STATE_ERROR);
|
||||
return false;
|
||||
}
|
||||
|
||||
initialized = true;
|
||||
}
|
||||
|
||||
err = module_start();
|
||||
if (err) {
|
||||
module_set_state(MODULE_STATE_ERROR);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
if (check_state(event, MODULE_ID(ble_state), MODULE_STATE_READY)) {
|
||||
ble_ready = true;
|
||||
if (running) {
|
||||
module_set_state(MODULE_STATE_READY);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
if (is_power_down_event(aeh)) {
|
||||
if (initialized) {
|
||||
module_pause();
|
||||
module_set_state(MODULE_STATE_STANDBY);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
if (is_wake_up_event(aeh)) {
|
||||
if (initialized) {
|
||||
int err = module_start();
|
||||
|
||||
if (err) {
|
||||
module_set_state(MODULE_STATE_ERROR);
|
||||
} else if (ble_ready) {
|
||||
module_set_state(MODULE_STATE_READY);
|
||||
}
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
APP_EVENT_LISTENER(MODULE, app_event_handler);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, module_state_event);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, ble_serial_tx_event);
|
||||
APP_EVENT_SUBSCRIBE_EARLY(MODULE, ble_peer_event);
|
||||
APP_EVENT_SUBSCRIBE_EARLY(MODULE, power_down_event);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, wake_up_event);
|
||||
73
src/events/ble_serial_rx_event.c
Normal file
73
src/events/ble_serial_rx_event.c
Normal file
@@ -0,0 +1,73 @@
|
||||
#include <ctype.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "ble_serial_rx_event.h"
|
||||
|
||||
#define BLE_SERIAL_RX_EVENT_LOG_BUF_LEN 384
|
||||
|
||||
static void log_ble_serial_rx_event(const struct app_event_header *aeh)
|
||||
{
|
||||
const struct ble_serial_rx_event *event = cast_ble_serial_rx_event(aeh);
|
||||
char log_buf[BLE_SERIAL_RX_EVENT_LOG_BUF_LEN];
|
||||
int pos;
|
||||
|
||||
pos = snprintf(log_buf, sizeof(log_buf), "len:%zu ascii:\"",
|
||||
event->dyndata.size);
|
||||
if ((pos < 0) || (pos >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "log message preparation failure");
|
||||
return;
|
||||
}
|
||||
|
||||
for (size_t i = 0; i < event->dyndata.size; i++) {
|
||||
int tmp = snprintf(&log_buf[pos], sizeof(log_buf) - pos, "%c",
|
||||
isprint(event->dyndata.data[i]) ?
|
||||
event->dyndata.data[i] : '.');
|
||||
|
||||
if ((tmp < 0) || ((pos + tmp) >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "len:%zu ascii:\"...\"",
|
||||
event->dyndata.size);
|
||||
return;
|
||||
}
|
||||
|
||||
pos += tmp;
|
||||
}
|
||||
|
||||
pos += snprintf(&log_buf[pos], sizeof(log_buf) - pos, "\" hex:");
|
||||
if ((pos < 0) || (pos >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "len:%zu ascii:\"...\"",
|
||||
event->dyndata.size);
|
||||
return;
|
||||
}
|
||||
|
||||
for (size_t i = 0; i < event->dyndata.size; i++) {
|
||||
int tmp = snprintf(&log_buf[pos], sizeof(log_buf) - pos, " %02x",
|
||||
event->dyndata.data[i]);
|
||||
|
||||
if ((tmp < 0) || ((pos + tmp) >= sizeof(log_buf))) {
|
||||
break;
|
||||
}
|
||||
|
||||
pos += tmp;
|
||||
}
|
||||
|
||||
APP_EVENT_MANAGER_LOG(aeh, "%s", log_buf);
|
||||
}
|
||||
|
||||
static void profile_ble_serial_rx_event(struct log_event_buf *buf,
|
||||
const struct app_event_header *aeh)
|
||||
{
|
||||
const struct ble_serial_rx_event *event = cast_ble_serial_rx_event(aeh);
|
||||
|
||||
nrf_profiler_log_encode_uint8(buf, (uint8_t)event->dyndata.size);
|
||||
}
|
||||
|
||||
APP_EVENT_INFO_DEFINE(ble_serial_rx_event,
|
||||
ENCODE(NRF_PROFILER_ARG_U8),
|
||||
ENCODE("len"),
|
||||
profile_ble_serial_rx_event);
|
||||
|
||||
APP_EVENT_TYPE_DEFINE(ble_serial_rx_event,
|
||||
log_ble_serial_rx_event,
|
||||
&ble_serial_rx_event_info,
|
||||
APP_EVENT_FLAGS_CREATE(
|
||||
APP_EVENT_TYPE_FLAGS_INIT_LOG_ENABLE));
|
||||
62
src/events/ble_serial_tx_event.c
Normal file
62
src/events/ble_serial_tx_event.c
Normal file
@@ -0,0 +1,62 @@
|
||||
#include <ctype.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "ble_serial_tx_event.h"
|
||||
|
||||
#define BLE_SERIAL_TX_EVENT_LOG_BUF_LEN 256
|
||||
|
||||
static void log_ble_serial_tx_event(const struct app_event_header *aeh)
|
||||
{
|
||||
const struct ble_serial_tx_event *event = cast_ble_serial_tx_event(aeh);
|
||||
char log_buf[BLE_SERIAL_TX_EVENT_LOG_BUF_LEN];
|
||||
int pos;
|
||||
|
||||
pos = snprintf(log_buf, sizeof(log_buf), "len:%zu ascii:\"",
|
||||
event->dyndata.size);
|
||||
if ((pos < 0) || (pos >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "log message preparation failure");
|
||||
return;
|
||||
}
|
||||
|
||||
for (size_t i = 0; i < event->dyndata.size; i++) {
|
||||
int tmp = snprintf(&log_buf[pos], sizeof(log_buf) - pos, "%c",
|
||||
isprint(event->dyndata.data[i]) ?
|
||||
event->dyndata.data[i] : '.');
|
||||
|
||||
if ((tmp < 0) || ((pos + tmp) >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "len:%zu ascii:\"...\"",
|
||||
event->dyndata.size);
|
||||
return;
|
||||
}
|
||||
|
||||
pos += tmp;
|
||||
}
|
||||
|
||||
pos += snprintf(&log_buf[pos], sizeof(log_buf) - pos, "\"");
|
||||
if ((pos < 0) || (pos >= sizeof(log_buf))) {
|
||||
APP_EVENT_MANAGER_LOG(aeh, "len:%zu ascii:\"...\"",
|
||||
event->dyndata.size);
|
||||
return;
|
||||
}
|
||||
|
||||
APP_EVENT_MANAGER_LOG(aeh, "%s", log_buf);
|
||||
}
|
||||
|
||||
static void profile_ble_serial_tx_event(struct log_event_buf *buf,
|
||||
const struct app_event_header *aeh)
|
||||
{
|
||||
const struct ble_serial_tx_event *event = cast_ble_serial_tx_event(aeh);
|
||||
|
||||
nrf_profiler_log_encode_uint8(buf, (uint8_t)event->dyndata.size);
|
||||
}
|
||||
|
||||
APP_EVENT_INFO_DEFINE(ble_serial_tx_event,
|
||||
ENCODE(NRF_PROFILER_ARG_U8),
|
||||
ENCODE("len"),
|
||||
profile_ble_serial_tx_event);
|
||||
|
||||
APP_EVENT_TYPE_DEFINE(ble_serial_tx_event,
|
||||
log_ble_serial_tx_event,
|
||||
&ble_serial_tx_event_info,
|
||||
APP_EVENT_FLAGS_CREATE(
|
||||
APP_EVENT_TYPE_FLAGS_INIT_LOG_ENABLE));
|
||||
@@ -7,9 +7,12 @@
|
||||
#include <caf/events/module_state_event.h>
|
||||
#include <caf/events/power_event.h>
|
||||
|
||||
#include <caf/events/ble_common_event.h>
|
||||
|
||||
#include <zephyr/kernel.h>
|
||||
#include <zephyr/logging/log.h>
|
||||
|
||||
#include "ble_serial_tx_event.h"
|
||||
#include "usb_cdc_tx_event.h"
|
||||
#include "usb_device_state_event.h"
|
||||
|
||||
@@ -18,11 +21,13 @@ LOG_MODULE_REGISTER(MODULE, LOG_LEVEL_INF);
|
||||
#define USB_CDC_TEST_PERIOD K_SECONDS(1)
|
||||
|
||||
static const uint8_t hello_message[] = "hello\r\n";
|
||||
static const uint8_t ble_hello_message[] = "ble_hello\r\n";
|
||||
|
||||
static struct k_work_delayable hello_work;
|
||||
static bool initialized;
|
||||
static bool running;
|
||||
static bool usb_active;
|
||||
static bool ble_active;
|
||||
|
||||
static void submit_hello_message(void)
|
||||
{
|
||||
@@ -33,15 +38,31 @@ static void submit_hello_message(void)
|
||||
APP_EVENT_SUBMIT(event);
|
||||
}
|
||||
|
||||
static void submit_ble_hello_message(void)
|
||||
{
|
||||
struct ble_serial_tx_event *event =
|
||||
new_ble_serial_tx_event(sizeof(ble_hello_message) - 1U);
|
||||
|
||||
memcpy(event->dyndata.data, ble_hello_message, sizeof(ble_hello_message) - 1U);
|
||||
APP_EVENT_SUBMIT(event);
|
||||
}
|
||||
|
||||
static void hello_work_handler(struct k_work *work)
|
||||
{
|
||||
ARG_UNUSED(work);
|
||||
|
||||
if (!running || !usb_active) {
|
||||
if (!running) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (usb_active) {
|
||||
submit_hello_message();
|
||||
}
|
||||
|
||||
if (ble_active) {
|
||||
submit_ble_hello_message();
|
||||
}
|
||||
|
||||
k_work_reschedule(&hello_work, USB_CDC_TEST_PERIOD);
|
||||
}
|
||||
|
||||
@@ -58,7 +79,7 @@ static int module_start(void)
|
||||
}
|
||||
|
||||
running = true;
|
||||
if (usb_active) {
|
||||
if (usb_active || ble_active) {
|
||||
k_work_reschedule(&hello_work, USB_CDC_TEST_PERIOD);
|
||||
}
|
||||
|
||||
@@ -98,12 +119,56 @@ static bool handle_usb_device_state_event(const struct usb_device_state_event *e
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool handle_ble_peer_event(const struct ble_peer_event *event)
|
||||
{
|
||||
bool new_ble_active = ble_active;
|
||||
|
||||
switch (event->state) {
|
||||
case PEER_STATE_CONNECTED:
|
||||
new_ble_active = false;
|
||||
break;
|
||||
|
||||
case PEER_STATE_SECURED:
|
||||
new_ble_active = true;
|
||||
break;
|
||||
|
||||
case PEER_STATE_DISCONNECTED:
|
||||
new_ble_active = false;
|
||||
break;
|
||||
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
|
||||
if (new_ble_active == ble_active) {
|
||||
return false;
|
||||
}
|
||||
|
||||
ble_active = new_ble_active;
|
||||
|
||||
if (!running) {
|
||||
return false;
|
||||
}
|
||||
|
||||
if (usb_active || ble_active) {
|
||||
k_work_reschedule(&hello_work, USB_CDC_TEST_PERIOD);
|
||||
} else {
|
||||
k_work_cancel_delayable(&hello_work);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool app_event_handler(const struct app_event_header *aeh)
|
||||
{
|
||||
if (is_usb_device_state_event(aeh)) {
|
||||
return handle_usb_device_state_event(cast_usb_device_state_event(aeh));
|
||||
}
|
||||
|
||||
if (is_ble_peer_event(aeh)) {
|
||||
return handle_ble_peer_event(cast_ble_peer_event(aeh));
|
||||
}
|
||||
|
||||
if (is_module_state_event(aeh)) {
|
||||
const struct module_state_event *event = cast_module_state_event(aeh);
|
||||
|
||||
@@ -159,6 +224,7 @@ static bool app_event_handler(const struct app_event_header *aeh)
|
||||
|
||||
APP_EVENT_LISTENER(MODULE, app_event_handler);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, module_state_event);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, ble_peer_event);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, usb_device_state_event);
|
||||
APP_EVENT_SUBSCRIBE_EARLY(MODULE, power_down_event);
|
||||
APP_EVENT_SUBSCRIBE(MODULE, wake_up_event);
|
||||
|
||||
Reference in New Issue
Block a user