diff -r 7448b8dd4288 -r ec5c7794dcd6 main/ble_gatts.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main/ble_gatts.c Mon Apr 17 14:54:35 2023 +0200 @@ -0,0 +1,337 @@ +/** + * @file ble_gatts.c + * @brief BLE GATTS services. + */ + +#include "config.h" + +static const char *TAG = "ble_gatts"; + +#define PROFILE_NUM 1 +#define PROFILE_RGB_APP_ID 0 +#define PROFILE_RGB_NUM_HANDLE 3 + +#ifdef USE_BATTERY +/// characteristic presentation information +struct char_pres_fmt +{ + uint16_t unit; ///< Unit (The Unit is a UUID) + uint16_t description; ///< Description + uint8_t format; + uint8_t exponent; + uint8_t name_space; ///< Name space +}; + + +static const uint16_t primary_service_uuid = ESP_GATT_UUID_PRI_SERVICE; +static const uint16_t character_declaration_uuid = ESP_GATT_UUID_CHAR_DECLARE; +static const uint16_t character_client_config_uuid = ESP_GATT_UUID_CHAR_CLIENT_CONFIG; + +static const uint8_t char_prop_notify = ESP_GATT_CHAR_PROP_BIT_NOTIFY; +static const uint8_t char_prop_read = ESP_GATT_CHAR_PROP_BIT_READ; +static const uint8_t char_prop_read_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_NOTIFY; +#endif + +uint8_t rgb_service_uuid[ESP_UUID_LEN_128] = {0x00, 0x56, 0xa5, 0x97, 0xd2, 0xb7, 0x2e, 0x81, 0x57, 0x49, 0x00, 0x47, 0x6c, 0x55, 0x02, 0x3b}; +uint8_t rgb_characteristic_uuid[ESP_UUID_LEN_128] = {0x00, 0x56, 0xa5, 0x97, 0xd2, 0xb7, 0x2e, 0x81, 0x57, 0x49, 0x00, 0x47, 0x6c, 0x55, 0x02, 0x3c}; + +static void gatts_profile_rgb_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param); + +struct gatts_profile_inst { + esp_gatts_cb_t gatts_cb; + uint16_t gatts_if; + uint16_t app_id; + uint16_t conn_id; + uint16_t service_handle; + esp_gatt_srvc_id_t service_id; + uint16_t char_handle; + esp_bt_uuid_t char_uuid; + esp_gatt_perm_t perm; + esp_gatt_char_prop_t property; +}; + + +/********************/ + +#ifdef USE_BATTERY +/// battery Service +static const uint16_t battary_svc = ESP_GATT_UUID_BATTERY_SERVICE_SVC; + +static const uint16_t bat_lev_uuid = ESP_GATT_UUID_BATTERY_LEVEL; +static const uint8_t bat_lev_ccc[2] ={ 0x00, 0x00}; +static const uint16_t char_format_uuid = ESP_GATT_UUID_CHAR_PRESENT_FORMAT; + +static uint8_t battary_lev = 50; + +/// Full HRS Database Description - Used to add attributes into the database +static const esp_gatts_attr_db_t bas_att_db[BAS_IDX_NB] = +{ + // Battary Service Declaration + [BAS_IDX_SVC] = {{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&primary_service_uuid, ESP_GATT_PERM_READ, + sizeof(uint16_t), sizeof(battary_svc), (uint8_t *)&battary_svc}}, + + // Battary level Characteristic Declaration + [BAS_IDX_BATT_LVL_CHAR] = {{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ, + sizeof(uint8_t),sizeof(uint8_t), (uint8_t *)&char_prop_read_notify}}, + + // Battary level Characteristic Value + [BAS_IDX_BATT_LVL_VAL] = {{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&bat_lev_uuid, ESP_GATT_PERM_READ, + sizeof(uint8_t),sizeof(uint8_t), &battary_lev}}, + + // Battary level Characteristic - Client Characteristic Configuration Descriptor + [BAS_IDX_BATT_LVL_NTF_CFG] = {{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE, + sizeof(uint16_t),sizeof(bat_lev_ccc), (uint8_t *)bat_lev_ccc}}, + + // Battary level report Characteristic Declaration + [BAS_IDX_BATT_LVL_PRES_FMT] = {{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&char_format_uuid, ESP_GATT_PERM_READ, + sizeof(struct char_pres_fmt), 0, NULL}}, +}; +#endif + + + +/*******************/ + + +/* One gatt-based profile one app_id and one gatts_if, this array will store the gatts_if returned by ESP_GATTS_REG_EVT */ +static struct gatts_profile_inst gl_profile_tab[PROFILE_NUM] = { + [PROFILE_RGB_APP_ID] = { + .gatts_cb = gatts_profile_rgb_event_handler, + .gatts_if = ESP_GATT_IF_NONE, /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */ + } +}; + +static void create_rgb_service(esp_gatt_if_t gatts_if) +{ + gl_profile_tab[PROFILE_RGB_APP_ID].service_id.is_primary = true; + gl_profile_tab[PROFILE_RGB_APP_ID].service_id.id.inst_id = 0x00; + gl_profile_tab[PROFILE_RGB_APP_ID].service_id.id.uuid.len = ESP_UUID_LEN_128; + memcpy(gl_profile_tab[PROFILE_RGB_APP_ID].service_id.id.uuid.uuid.uuid128, rgb_service_uuid, ESP_UUID_LEN_128); + + esp_ble_gatts_create_service(gatts_if, &gl_profile_tab[PROFILE_RGB_APP_ID].service_id, PROFILE_RGB_NUM_HANDLE); +} + +static void start_rgb_service(esp_ble_gatts_cb_param_t *param) +{ + gl_profile_tab[PROFILE_RGB_APP_ID].service_handle = param->create.service_handle; + esp_ble_gatts_start_service(gl_profile_tab[PROFILE_RGB_APP_ID].service_handle); +} + +static void add_rgb_characteristic(void) +{ + uint8_t char_value[] = {0x00}; + + esp_attr_value_t rgb_char_val = + { + .attr_max_len = sizeof(char_value), + .attr_len = sizeof(char_value), + .attr_value = char_value, + }; + + gl_profile_tab[PROFILE_RGB_APP_ID].char_uuid.len = ESP_UUID_LEN_128; + memcpy(gl_profile_tab[PROFILE_RGB_APP_ID].char_uuid.uuid.uuid128, rgb_characteristic_uuid, ESP_UUID_LEN_128); + + esp_err_t add_char_ret = esp_ble_gatts_add_char(gl_profile_tab[PROFILE_RGB_APP_ID].service_handle, &gl_profile_tab[PROFILE_RGB_APP_ID].char_uuid, + ESP_GATT_PERM_READ | ESP_GATT_PERM_WRITE, + ESP_GATT_CHAR_PROP_BIT_WRITE, + &rgb_char_val, NULL); + if (add_char_ret){ + ESP_LOGE(TAG, "add char failed, error code =%x",add_char_ret); + } +} + +static void handle_write_event(uint8_t * p_data, uint16_t len) +{ + uint8_t opcode = p_data[0]; + ESP_LOGI(TAG, "opcode = 0x%x", opcode); + switch (opcode) + { + case 1: +// rgb_ctrl(RGB_RED, RGB_ON); +// rgb_ctrl(RGB_GREEN, RGB_OFF); +// rgb_ctrl(RGB_BLUE, RGB_OFF); + break; + case 2: +// rgb_ctrl(RGB_RED, RGB_OFF); +// rgb_ctrl(RGB_GREEN, RGB_ON); +// rgb_ctrl(RGB_BLUE, RGB_OFF); + break; + case 3: +// rgb_ctrl(RGB_RED, RGB_OFF); +// rgb_ctrl(RGB_GREEN, RGB_OFF); +// rgb_ctrl(RGB_BLUE, RGB_ON); + break; + case 4: +// rgb_ctrl(RGB_RED, RGB_OFF); +// rgb_ctrl(RGB_GREEN, RGB_OFF); +// rgb_ctrl(RGB_BLUE, RGB_OFF); + break; + default: + break; + } +} + + +static void gatts_profile_rgb_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param) +{ + ESP_LOGI(TAG, "gatts_profile_rgb_event_handler()"); + + switch (event) { + case ESP_GATTS_REG_EVT: + ESP_LOGI(TAG, "REGISTER_APP_EVT, status %d, app_id %d", param->reg.status, param->reg.app_id); + ble_balkon_adv_config(); + create_rgb_service(gatts_if); + break; + case ESP_GATTS_READ_EVT: { + ESP_LOGI(TAG, "GATT_READ_EVT, conn_id %d, trans_id %lu, handle %d\n", param->read.conn_id, param->read.trans_id, param->read.handle); + break; + } + case ESP_GATTS_WRITE_EVT: { + ESP_LOGI(TAG, "GATT_WRITE_EVT, conn_id %d, trans_id %lu, handle %d", param->write.conn_id, param->write.trans_id, param->write.handle); + if (!param->write.is_prep){ + ESP_LOGI(TAG, "GATT_WRITE_EVT, value len %d, value :", param->write.len); + esp_log_buffer_hex(TAG, param->write.value, param->write.len); + handle_write_event(param->write.value, param->write.len); + } + esp_gatt_status_t status = ESP_GATT_OK; + if (param->write.need_rsp){ + if (!param->write.is_prep){ + esp_ble_gatts_send_response(gatts_if, param->write.conn_id, param->write.trans_id, status, NULL); + } + } + break; + } + case ESP_GATTS_EXEC_WRITE_EVT: + ESP_LOGI(TAG,"ESP_GATTS_EXEC_WRITE_EVT"); + break; + case ESP_GATTS_MTU_EVT: + ESP_LOGI(TAG, "ESP_GATTS_MTU_EVT, MTU %d", param->mtu.mtu); + break; + case ESP_GATTS_UNREG_EVT: + break; + case ESP_GATTS_CREATE_EVT: + ESP_LOGI(TAG, "CREATE_SERVICE_EVT, status %d, service_handle %d", param->create.status, param->create.service_handle); + start_rgb_service(param); + add_rgb_characteristic(); + break; + case ESP_GATTS_ADD_INCL_SRVC_EVT: + break; + case ESP_GATTS_ADD_CHAR_EVT: { + ESP_LOGI(TAG, "ADD_CHAR_EVT, status %d, attr_handle %d, service_handle %d", + param->add_char.status, param->add_char.attr_handle, param->add_char.service_handle); + break; + } + case ESP_GATTS_ADD_CHAR_DESCR_EVT: + ESP_LOGI(TAG, "ADD_DESCR_EVT, status %d, attr_handle %d, service_handle %d", + param->add_char_descr.status, param->add_char_descr.attr_handle, param->add_char_descr.service_handle); + break; + case ESP_GATTS_DELETE_EVT: + break; + case ESP_GATTS_START_EVT: + ESP_LOGI(TAG, "SERVICE_START_EVT, status %d, service_handle %d", param->start.status, param->start.service_handle); + break; + case ESP_GATTS_STOP_EVT: + break; + case ESP_GATTS_CONNECT_EVT: { + esp_ble_conn_update_params_t conn_params = {0}; + memcpy(conn_params.bda, param->connect.remote_bda, sizeof(esp_bd_addr_t)); + /* For the IOS system, please reference the apple official documents about the ble connection parameters restrictions. */ + conn_params.latency = 0; + conn_params.max_int = 0x20; // max_int = 0x20*1.25ms = 40ms + conn_params.min_int = 0x10; // min_int = 0x10*1.25ms = 20ms + conn_params.timeout = 400; // timeout = 400*10ms = 4000ms + ESP_LOGI(TAG, "ESP_GATTS_CONNECT_EVT, conn_id %d, remote %02x:%02x:%02x:%02x:%02x:%02x:", + param->connect.conn_id, + param->connect.remote_bda[0], param->connect.remote_bda[1], param->connect.remote_bda[2], + param->connect.remote_bda[3], param->connect.remote_bda[4], param->connect.remote_bda[5]); + gl_profile_tab[PROFILE_RGB_APP_ID].conn_id = param->connect.conn_id; + //start sent the update connection parameters to the peer device. + esp_ble_gap_update_conn_params(&conn_params); + break; + } + case ESP_GATTS_DISCONNECT_EVT: + ESP_LOGI(TAG, "ESP_GATTS_DISCONNECT_EVT, disconnect reason 0x%x", param->disconnect.reason); + ble_balkon_adv_start(); + break; + case ESP_GATTS_CONF_EVT: + ESP_LOGI(TAG, "ESP_GATTS_CONF_EVT, status %d attr_handle %d", param->conf.status, param->conf.handle); + if (param->conf.status != ESP_GATT_OK){ + esp_log_buffer_hex(TAG, param->conf.value, param->conf.len); + } + break; + case ESP_GATTS_OPEN_EVT: + case ESP_GATTS_CANCEL_OPEN_EVT: + case ESP_GATTS_CLOSE_EVT: + case ESP_GATTS_LISTEN_EVT: + case ESP_GATTS_CONGEST_EVT: + default: + break; + } +} + + +static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param) +{ + ESP_LOGI(TAG, "gatts_event_handler(%x)", event); + + /* If event is register event, store the gatts_if for each profile */ + if (event == ESP_GATTS_REG_EVT) { + if (param->reg.status == ESP_GATT_OK) { + gl_profile_tab[param->reg.app_id].gatts_if = gatts_if; + } else { + ESP_LOGI(TAG, "Reg app failed, app_id %04x, status %d", param->reg.app_id, param->reg.status); + return; + } + } + + /* If the gatts_if equal to profile A, call profile A cb handler, + * so here call each profile's callback */ + do { + int idx; + for (idx = 0; idx < PROFILE_NUM; idx++) { + if (gatts_if == ESP_GATT_IF_NONE || /* ESP_GATT_IF_NONE, not specify a certain gatt_if, need to call every profile cb function */ + gatts_if == gl_profile_tab[idx].gatts_if) { + if (gl_profile_tab[idx].gatts_cb) { + gl_profile_tab[idx].gatts_cb(event, gatts_if, param); + } + } + } + } while (0); +} + + +/***************************************************************************************************************************/ + +esp_err_t ble_balkon_gatts_register(void) +{ + esp_err_t ret = esp_ble_gatts_register_callback(gatts_event_handler); + if (ret){ + ESP_LOGE(TAG, "gatts register error, error code = %x", ret); + } + + return ret; +} + + +esp_err_t ble_balkon_gatts_app_register(void) +{ + esp_err_t ret = esp_ble_gatts_app_register(PROFILE_RGB_APP_ID); + if (ret){ + ESP_LOGE(TAG, "gatts app register error, error code = %x", ret); + } + + return ret; +} + + +esp_err_t ble_balkon_gatts_set_mtu(void) +{ + esp_err_t local_mtu_ret = esp_ble_gatt_set_local_mtu(500); + if (local_mtu_ret){ + ESP_LOGE(TAG, "set local MTU failed, error code = %x", local_mtu_ret); + } + + return local_mtu_ret; +} + +