#include #include #include #include #include #define MODULE ble_serial_module #include #include #include #include #include #include #include #include #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);