Read BLE characteristic from Battery Service as gatt client

newsettler_AI
Posts: 121
Joined: Wed Apr 05, 2017 12:49 pm

Read BLE characteristic from Battery Service as gatt client

Postby newsettler_AI » Mon May 21, 2018 2:37 pm

Hi,

I'm trying to connect and read characteristics of BLE Battery Service:
https://www.bluetooth.com/specification ... ervice.xml

ESP32 is running as gatt CLIENT, and gatt SERVER is nRF52840 with default Heart Rate example
http://infocenter.nordicsemi.com/topic/ ... 0_4_1_2_13
There are 3 services (Battery Service, Device Information and Heart Rate).

Here is how it looks like through BLE Monitor:
esp32_nordic.jpg
HRM example
esp32_nordic.jpg (210.25 KiB) Viewed 3697 times
Problem:
Now I'm trying to read at least Battery Service.
I got next error and I dont know how to handle it, why connection is unknown?
BT: bta_gattc_cmpl_cback unknown conn_id = 1, ignore data

After that I got disconnect from nRF52 with some timeout reason.

Full log:

Code: Select all

[2018-05-21_16:54:46]з ets Jun  8 2016 00:22:57

[2018-05-21_16:54:47]rst:0x1 (POWERON_RESET),boot:0x13 (SPI_FAST_FLASH_BOOT)
[2018-05-21_16:54:47]ets Jun  8 2016 00:22:57

[2018-05-21_16:54:47]rst:0x10 (RTCWDT_RTC_RESET),boot:0x13 (SPI_FAST_FLASH_BOOT)
[2018-05-21_16:54:47]configsip: 0, SPIWP:0xee
[2018-05-21_16:54:47]clk_drv:0x00,q_drv:0x00,d_drv:0x00,cs0_drv:0x00,hd_drv:0x00,wp_drv:0x00
[2018-05-21_16:54:47]mode:DIO, clock div:2
[2018-05-21_16:54:47]load:0x3fff0018,len:4
[2018-05-21_16:54:47]load:0x3fff001c,len:5672
[2018-05-21_16:54:47]load:0x40078000,len:0
[2018-05-21_16:54:47]ho 12 tail 0 room 4
[2018-05-21_16:54:47]load:0x40078000,len:13912
[2018-05-21_16:54:47]entry 0x40078fd8
[2018-05-21_16:54:47][0;32mI (31) boot: ESP-IDF v3.1-dev-578-g9ea38560 2nd stage bootloader[0m
[2018-05-21_16:54:47][0;32mI (31) boot: compile time 19:20:37[0m
[2018-05-21_16:54:47][0;32mI (31) boot: Enabling RNG early entropy source...[0m
[2018-05-21_16:54:47][0;32mI (37) boot: SPI Speed      : 40MHz[0m
[2018-05-21_16:54:47][0;32mI (41) boot: SPI Mode       : DIO[0m
[2018-05-21_16:54:47][0;32mI (45) boot: SPI Flash Size : 4MB[0m
[2018-05-21_16:54:47][0;32mI (49) boot: Partition Table:[0m
[2018-05-21_16:54:47][0;32mI (52) boot: ## Label            Usage          Type ST Offset   Length[0m
[2018-05-21_16:54:47][0;32mI (60) boot:  0 nvs              WiFi data        01 02 00009000 00006000[0m
[2018-05-21_16:54:47][0;32mI (67) boot:  1 phy_init         RF data          01 01 0000f000 00001000[0m
[2018-05-21_16:54:47][0;32mI (75) boot:  2 factory          factory app      00 00 00010000 00200000[0m
[2018-05-21_16:54:47][0;32mI (82) boot: End of partition table[0m
[2018-05-21_16:54:47][0;32mI (86) esp_image: segment 0: paddr=0x00010020 vaddr=0x3f400020 size=0x330ec (209132) map[0m
[2018-05-21_16:54:47][0;32mI (168) esp_image: segment 1: paddr=0x00043114 vaddr=0x3ffc0000 size=0x029d4 ( 10708) load[0m
[2018-05-21_16:54:47][0;32mI (172) esp_image: segment 2: paddr=0x00045af0 vaddr=0x40080000 size=0x00400 (  1024) load[0m
[2018-05-21_16:54:47][0;32mI (175) esp_image: segment 3: paddr=0x00045ef8 vaddr=0x40080400 size=0x0a118 ( 41240) load[0m
[2018-05-21_16:54:47][0;32mI (200) esp_image: segment 4: paddr=0x00050018 vaddr=0x400d0018 size=0x7f8d4 (522452) map[0m
[2018-05-21_16:54:48][0;32mI (382) esp_image: segment 5: paddr=0x000cf8f4 vaddr=0x4008a518 size=0x035c8 ( 13768) load[0m
[2018-05-21_16:54:48][0;32mI (388) esp_image: segment 6: paddr=0x000d2ec4 vaddr=0x400c0000 size=0x00000 (     0) load[0m
[2018-05-21_16:54:48][0;32mI (397) boot: Loaded app from partition at offset 0x10000[0m
[2018-05-21_16:54:48][0;32mI (397) boot: Disabling RNG early entropy source...[0m
[2018-05-21_16:54:48][0;32mI (401) cpu_start: Pro cpu up.[0m
[2018-05-21_16:54:48][0;32mI (404) cpu_start: Starting app cpu, entry point is 0x40080f38[0m
[2018-05-21_16:54:48][0;32mI (0) cpu_start: App cpu up.[0m
[2018-05-21_16:54:48][0;32mI (415) heap_init: Initializing. RAM available for dynamic allocation:[0m
[2018-05-21_16:54:48][0;32mI (421) heap_init: At 3FFAFF10 len 000000F0 (0 KiB): DRAM[0m
[2018-05-21_16:54:48][0;32mI (427) heap_init: At 3FFCF258 len 00010DA8 (67 KiB): DRAM[0m
[2018-05-21_16:54:48][0;32mI (434) heap_init: At 3FFE0440 len 00003BC0 (14 KiB): D/IRAM[0m
[2018-05-21_16:54:48][0;32mI (440) heap_init: At 3FFE4350 len 0001BCB0 (111 KiB): D/IRAM[0m
[2018-05-21_16:54:48][0;32mI (446) heap_init: At 4008DAE0 len 00012520 (73 KiB): IRAM[0m
[2018-05-21_16:54:48][0;32mI (453) cpu_start: Pro cpu start user code[0m
[2018-05-21_16:54:48][0;32mI (135) cpu_start: Starting scheduler on PRO CPU.[0m
[2018-05-21_16:54:48][0;32mI (0) cpu_start: Starting scheduler on APP CPU.[0m
[2018-05-21_16:54:48][0;32mI (214) system_api: Base MAC address is not set, read default base MAC address from BLK0 of EFUSE[0m
[2018-05-21_16:54:48][0;32mI (524) phy: phy_version: 383.0, 79a622c, Jan 30 2018, 15:38:06, 0, 0[0m
[2018-05-21_16:54:48][0;32mI (604) BLE: (battery)REG_EVT[0m
[2018-05-21_16:54:48][0;32mI (614) BLE: scan start success[0m
[2018-05-21_16:54:48][0;32mI (724) BLE: e2 04 59 ac ac a7 [0m
[2018-05-21_16:54:48][0;32mI (724) BLE: searched Adv Data Len 27, Scan Response Len 0[0m
[2018-05-21_16:54:48][0;32mI (724) BLE: searched Device Name Len 10[0m
[2018-05-21_16:54:48][0;32mI (724) BLE: Nordic_HRM[0m
[2018-05-21_16:54:48][0;32mI (734) BLE: 
[2018-05-21_16:54:48][0m
[2018-05-21_16:54:48][0;32mI (734) BLE: searched device Nordic_HRM
[2018-05-21_16:54:48][0m
[2018-05-21_16:54:48][0;32mI (734) BLE: connect to the remote device.[0m
[2018-05-21_16:54:48][0;32mI (744) BLE: stop scan successfully[0m
[2018-05-21_16:54:49][0;32mI (1314) BLE: (battery)ESP_GATTC_CONNECT_EVT conn_id 0, if 2[0m
[2018-05-21_16:54:49][0;32mI (1314) BLE: (battery)REMOTE BDA:[0m
[2018-05-21_16:54:49][0;32mI (1314) BLE: e2 04 59 ac ac a7 [0m
[2018-05-21_16:54:49][0;32mI (1314) BLE: (battery)open success[0m
[2018-05-21_16:54:49][0;32mI (1994) BLE: (battery)ESP_GATTC_CFG_MTU_EVT, Status 0, MTU 247, conn_id 0[0m
[2018-05-21_16:54:49][0;32mI (2004) BLE: (battery)service found[0m
[2018-05-21_16:54:49][0;32mI (2004) BLE: (battery)ESP_GATTC_SEARCH_RES_EVT[0m
[2018-05-21_16:54:49][0;32mI (2004) BLE: (battery)srvc_id_len:2 [2][0m
[2018-05-21_16:54:49][0;32mI (2014) BLE: (battery)service found[0m
[2018-05-21_16:54:49][0;32mI (2014) BLE: (battery)UUID16: 180f[0m
[2018-05-21_16:54:49][0;32mI (2014) BLE: (battery)ESP_GATTC_SEARCH_CMPL_EVT[0m
[2018-05-21_16:54:49][0;32mI (2024) BLE: (battery)get_server[0m
[2018-05-21_16:54:49][0;32mI (2024) BLE: (battery)esp_ble_gattc_register_for_notify success[0m
[2018-05-21_16:54:49][0;32mI (2034) BLE: (battery)ESP_GATTC_REG_FOR_NOTIFY_EVT[0m
[2018-05-21_16:54:49][0;32mI (2054) BLE: (battery)ESP_GATTC_READ_DESCR_EVT[0m
[2018-05-21_16:54:49][0;32mI (2064) BLE: (battery)read descr success [0m
[2018-05-21_16:54:49][0;32mI (2064) BLE: (battery) esp_ble_gattc_read_char success [0m
[2018-05-21_16:54:50][0;32mI (2084) BLE: (battery)ESP_GATTC_READ_CHAR_EVT[0m
[2018-05-21_16:54:50][0;32mI (2084) BLE: (battery)read char success [0m
[2018-05-21_16:54:50][0;31mE (2324) BT: bta_gattc_cmpl_cback unknown conn_id =  1, ignore data[0m
[2018-05-21_16:55:19][0;31mE (31324) BT: bta_gattc_conn_cback() - cif=1 connected=0 conn_id=1 reason=0x0013[0m
[2018-05-21_16:55:19][0;31mE (31324) BT: bta_gattc_conn_cback() - cif=2 connected=0 conn_id=2 reason=0x0013[0m
[2018-05-21_16:55:19][0;32mI (31334) BLE: (battery)ESP_GATTC_DISCONNECT_EVT, reason = 19[0m
[2018-05-21_16:55:19][0;32mI (31334) BLE: unregistered EVT:5[0m
Here is my code:

Code: Select all

#define BLE_TAG          "BLE"
#define DEVICE_NAME      "BLE_TEST"
#define REMOTE_SERVICE_UUID         0x00FF
#define REMOTE_NOTIFY_CHAR_UUID     0xFF01
#define REMOTE_BATTERY_SERVICE_UUID 0x180F
#define PROFILE_NUM      1
#define PROFILE_A_APP_ID 0
#define INVALID_HANDLE   0

#define PROFILE_BATTERY_SERVICE 0 // 0x180F
#define PROFILE_DEVICE_INFO     1 // 0x180A
#define PROFILE_HRM             2 // 0x180D

static const char remote_device_name[] = "Nordic_HRM";
static bool connect_ble    = false;
static bool get_server = false;
static esp_gattc_char_elem_t *char_elem_result   = NULL;
static esp_gattc_descr_elem_t *descr_elem_result = NULL;

struct gattc_profile_inst {
    esp_gattc_cb_t gattc_cb;
    uint16_t gattc_if;
    uint16_t app_id;
    uint16_t conn_id;
    uint16_t service_start_handle;
    uint16_t service_end_handle;
    uint16_t char_handle;
    esp_bd_addr_t remote_bda;
};


/* Declare static functions */
static void esp_gap_cb(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param);
static void esp_gattc_cb(esp_gattc_cb_event_t event, esp_gatt_if_t gattc_if, esp_ble_gattc_cb_param_t *param);
static void gattc_profile_battery_service_event_handler(esp_gattc_cb_event_t event, esp_gatt_if_t gattc_if, esp_ble_gattc_cb_param_t *param);


static esp_bt_uuid_t remote_filter_service_uuid = {
    .len = ESP_UUID_LEN_16,
    .uuid = {.uuid16 = REMOTE_SERVICE_UUID,},
};


static esp_bt_uuid_t remote_filter_battery_service_uuid = {
    .len = ESP_UUID_LEN_16,
    .uuid = {.uuid16 = REMOTE_BATTERY_SERVICE_UUID,},
};

static esp_bt_uuid_t remote_filter_char_uuid = {
    .len = ESP_UUID_LEN_16,
    .uuid = {.uuid16 = REMOTE_NOTIFY_CHAR_UUID,},
};

static esp_bt_uuid_t remote_battery_filter_char_uuid = {
    .len = ESP_UUID_LEN_16,
    .uuid = {.uuid16 = ESP_GATT_UUID_BATTERY_LEVEL,},
};

static esp_bt_uuid_t notify_descr_uuid = {
    .len = ESP_UUID_LEN_16,
    .uuid = {.uuid16 = ESP_GATT_UUID_CHAR_CLIENT_CONFIG,},
};

static esp_ble_scan_params_t ble_scan_params = {
    .scan_type              = BLE_SCAN_TYPE_ACTIVE,
    .own_addr_type          = BLE_ADDR_TYPE_PUBLIC,
    .scan_filter_policy     = BLE_SCAN_FILTER_ALLOW_ALL,
    .scan_interval          = 0x50,
    .scan_window            = 0x30
};


/* One gatt-based profile one app_id and one gattc_if, this array will store the gattc_if returned by ESP_GATTS_REG_EVT */
static struct gattc_profile_inst gl_profile_tab[PROFILE_NUM] = {
    [PROFILE_BATTERY_SERVICE] = {
        .gattc_cb = gattc_profile_battery_service_event_handler,
        .gattc_if = ESP_GATT_IF_NONE,
    },
	
//    [PROFILE_DEVICE_INFO] = {
//        .gattc_cb = gattc_profile_device_info_event_handler,
//        .gattc_if = ESP_GATT_IF_NONE,       /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
//    },

//    [PROFILE_HRM] = {
//        .gattc_cb = gattc_profile_hrm_event_handler,
//        .gattc_if = ESP_GATT_IF_NONE,
//    },
};


static void gattc_profile_battery_service_event_handler(esp_gattc_cb_event_t event, esp_gatt_if_t gattc_if, esp_ble_gattc_cb_param_t *param)
{
    esp_ble_gattc_cb_param_t *p_data = (esp_ble_gattc_cb_param_t *)param;

    switch (event) {
    case ESP_GATTC_REG_EVT:
        ESP_LOGI(BLE_TAG, "(battery)REG_EVT");
        esp_err_t scan_ret = esp_ble_gap_set_scan_params(&ble_scan_params);
        if (scan_ret){
            ESP_LOGE(BLE_TAG, "(battery)set scan params error, error code = %x", scan_ret);
        }
        break;
    case ESP_GATTC_CONNECT_EVT:{
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_CONNECT_EVT conn_id %d, if %d", p_data->connect.conn_id, gattc_if);
        gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id = p_data->connect.conn_id;
        memcpy(gl_profile_tab[PROFILE_BATTERY_SERVICE].remote_bda, p_data->connect.remote_bda, sizeof(esp_bd_addr_t));
        ESP_LOGI(BLE_TAG, "(battery)REMOTE BDA:");
        esp_log_buffer_hex(BLE_TAG, gl_profile_tab[PROFILE_BATTERY_SERVICE].remote_bda, sizeof(esp_bd_addr_t));
        esp_err_t mtu_ret = esp_ble_gattc_send_mtu_req (gattc_if, p_data->connect.conn_id);
        if (mtu_ret){
            ESP_LOGE(BLE_TAG, "(battery)config MTU error, error code = %x", mtu_ret);
        }
        break;
    }
    case ESP_GATTC_OPEN_EVT:
        if (param->open.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG, "(battery)open failed, status %d", p_data->open.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "(battery)open success");
        break;
    case ESP_GATTC_CFG_MTU_EVT:
        if (param->cfg_mtu.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG,"(battery)config mtu failed, error status = %x", param->cfg_mtu.status);
        }
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_CFG_MTU_EVT, Status %d, MTU %d, conn_id %d", param->cfg_mtu.status, param->cfg_mtu.mtu, param->cfg_mtu.conn_id);
        esp_err_t ret_search_gatt;
        ret_search_gatt = esp_ble_gattc_search_service(gattc_if, param->cfg_mtu.conn_id, &remote_filter_battery_service_uuid); // with filter
        //ret_search_gatt = esp_ble_gattc_search_service(gattc_if, param->cfg_mtu.conn_id, NULL);
        if(ret_search_gatt){
            ESP_LOGI(BLE_TAG, "(battery)service not found, error code = %x", ret_search_gatt);
        }else{
        	ESP_LOGI(BLE_TAG, "(battery)service found");
        }
        break;
    case ESP_GATTC_SEARCH_RES_EVT: {
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_SEARCH_RES_EVT");
        esp_gatt_srvc_id_t *srvc_id =(esp_gatt_srvc_id_t *)&p_data->search_res.srvc_id;

        ESP_LOGI(BLE_TAG, "(battery)srvc_id_len:%d [%x]", srvc_id->id.uuid.len, srvc_id->id.uuid.len);
//        for (uint8_t i = 0; i < 15; i++)
//        {
//            ESP_LOGI(BLE_TAG, "(battery)srvc_id:%d [%x]", i, srvc_id->id.uuid.uuid.uuid128[i]);
//        }

        if (srvc_id->id.uuid.len == ESP_UUID_LEN_16 && srvc_id->id.uuid.uuid.uuid16 == REMOTE_BATTERY_SERVICE_UUID) {
            ESP_LOGI(BLE_TAG, "(battery)service found");
            get_server = true;
            gl_profile_tab[PROFILE_BATTERY_SERVICE].service_start_handle = p_data->search_res.start_handle;
            gl_profile_tab[PROFILE_BATTERY_SERVICE].service_end_handle = p_data->search_res.end_handle;
            ESP_LOGI(BLE_TAG, "(battery)UUID16: %x", srvc_id->id.uuid.uuid.uuid16);
        }
        break;
    }
    case ESP_GATTC_SEARCH_CMPL_EVT:
        if (p_data->search_cmpl.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG, "(battery)search service failed, error status = %x", p_data->search_cmpl.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_SEARCH_CMPL_EVT");
        if (get_server){
            ESP_LOGI(BLE_TAG, "(battery)get_server");
            uint16_t count = 0;
            esp_gatt_status_t status = esp_ble_gattc_get_attr_count( gattc_if,
                                                                     p_data->search_cmpl.conn_id,
                                                                     ESP_GATT_DB_CHARACTERISTIC,
                                                                     gl_profile_tab[PROFILE_BATTERY_SERVICE].service_start_handle,
                                                                     gl_profile_tab[PROFILE_BATTERY_SERVICE].service_end_handle,
                                                                     INVALID_HANDLE,
                                                                     &count);
            if (status != ESP_GATT_OK){
                ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_get_attr_count error");
            }

            if (count > 0){
                char_elem_result = (esp_gattc_char_elem_t *)malloc(sizeof(esp_gattc_char_elem_t) * count);
                if (!char_elem_result){
                    ESP_LOGE(BLE_TAG, "(battery)gattc no mem");
                }else{
                    status = esp_ble_gattc_get_char_by_uuid( gattc_if,
                                                             p_data->search_cmpl.conn_id,
                                                             gl_profile_tab[PROFILE_BATTERY_SERVICE].service_start_handle,
                                                             gl_profile_tab[PROFILE_BATTERY_SERVICE].service_end_handle,
															 remote_battery_filter_char_uuid, //remote_filter_char_uuid,
                                                             char_elem_result,
                                                             &count);
                    if (status != ESP_GATT_OK){
                        ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_get_char_by_uuid error");
                    }

                    /*  Every service have only one char in our 'ESP_GATTS_DEMO' demo, so we used first 'char_elem_result' */
                    if (count > 0 && (char_elem_result[0].properties & ESP_GATT_CHAR_PROP_BIT_NOTIFY)){
                        gl_profile_tab[PROFILE_BATTERY_SERVICE].char_handle = char_elem_result[0].char_handle;
                        esp_err_t errorcode = esp_ble_gattc_register_for_notify (gattc_if, gl_profile_tab[PROFILE_BATTERY_SERVICE].remote_bda, char_elem_result[0].char_handle);

                        if(errorcode)
                        {
                        	ESP_LOGI(BLE_TAG, "(battery)esp_ble_gattc_register_for_notify error, code: %x", errorcode);
                        }else{
                            ESP_LOGI(BLE_TAG, "(battery)esp_ble_gattc_register_for_notify success");
                        }
                    }
                }
                /* free char_elem_result */
                free(char_elem_result);
            }else{
                ESP_LOGE(BLE_TAG, "(battery)no char found");
            }
        }else{
            ESP_LOGI(BLE_TAG, "(battery)GATT server not found");
        }
         break;
    case ESP_GATTC_REG_FOR_NOTIFY_EVT: {
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_REG_FOR_NOTIFY_EVT");
        if (p_data->reg_for_notify.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG, "(battery)REG FOR NOTIFY failed: error status = %d", p_data->reg_for_notify.status);
        }else{
            uint16_t count = 0;
            uint16_t notify_en = 1;
            esp_gatt_status_t ret_status = esp_ble_gattc_get_attr_count( gattc_if,
                                                                         gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
																		 ESP_GATT_DB_DESCRIPTOR,
                                                                         gl_profile_tab[PROFILE_BATTERY_SERVICE].service_start_handle,
                                                                         gl_profile_tab[PROFILE_BATTERY_SERVICE].service_end_handle,
                                                                         gl_profile_tab[PROFILE_BATTERY_SERVICE].char_handle,
                                                                         &count);
            if (ret_status != ESP_GATT_OK){
                ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_get_attr_count error");
            }
            if (count > 0)
            {
                descr_elem_result = malloc(sizeof(esp_gattc_descr_elem_t) * count);
                if (!descr_elem_result){
                    ESP_LOGE(BLE_TAG, "(battery)malloc error, gattc no mem");
                }else{
                    ret_status = esp_ble_gattc_get_descr_by_char_handle( gattc_if,
                                                                         gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
                                                                         p_data->reg_for_notify.handle,
                                                                         notify_descr_uuid,
                                                                         descr_elem_result,
                                                                         &count);
                    if (ret_status != ESP_GATT_OK){
                        ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_get_descr_by_char_handle error");
                    }

                    /* Every char has only one descriptor in our 'ESP_GATTS_DEMO' demo, so we used first 'descr_elem_result' */
                    if (count > 0 && descr_elem_result[0].uuid.len == ESP_UUID_LEN_16 && descr_elem_result[0].uuid.uuid.uuid16 == ESP_GATT_UUID_CHAR_CLIENT_CONFIG){
//                        ret_status = esp_ble_gattc_write_char_descr( gattc_if,
//                                                                     gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
//                                                                     descr_elem_result[0].handle,
//                                                                     sizeof(notify_en),
//                                                                     (uint8_t *)&notify_en,
//                                                                     ESP_GATT_WRITE_TYPE_RSP,
//                                                                     ESP_GATT_AUTH_REQ_NONE);
                    	ret_status = esp_ble_gattc_read_char_descr( gattc_if,
                    			 	 	 	 	 	 	 	 	 	gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
																	descr_elem_result[0].handle,
																	ESP_GATT_AUTH_REQ_NONE);
                    }

                    if (ret_status != ESP_GATT_OK){
                        //ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_write_char_descr error");
                    	ESP_LOGE(BLE_TAG, "(battery)esp_ble_gattc_read_char_descr error, code: %x", ret_status);
                    }

                    /* free descr_elem_result */
                    free(descr_elem_result);
                }
            }
            else{
                ESP_LOGE(BLE_TAG, "(battery)decsr not found");
            }

        }
        break;
    }
    case ESP_GATTC_NOTIFY_EVT:
        if (p_data->notify.is_notify){
            ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_NOTIFY_EVT, receive notify value:");
        }else{
            ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_NOTIFY_EVT, receive indicate value:");
        }
        esp_log_buffer_hex(BLE_TAG, p_data->notify.value, p_data->notify.value_len);
        break;
    case ESP_GATTC_READ_CHAR_EVT:
    	ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_READ_CHAR_EVT");

        if (p_data->read.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG, "(battery)read char failed, error status = %x", p_data->read.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "(battery)read char success ");

    	break;
    case ESP_GATTC_READ_DESCR_EVT:
    	ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_READ_DESCR_EVT");
    	if (p_data->read.status != ESP_GATT_OK){
    		 ESP_LOGE(BLE_TAG, "(battery)read descr failed, error status = %x", p_data->write.status);
    		 break;
    	}
    	ESP_LOGI(BLE_TAG, "(battery)read descr success ");

    	esp_gatt_status_t ret_status = esp_ble_gattc_read_char( gattc_if,
    							gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
								gl_profile_tab[PROFILE_BATTERY_SERVICE].char_handle,
								ESP_GATT_AUTH_REQ_NONE);
    	if(ret_status){
    		ESP_LOGE(BLE_TAG, "(battery) esp_ble_gattc_read_char failed, error code = %x", ret_status);
    	}else{
    		ESP_LOGI(BLE_TAG, "(battery) esp_ble_gattc_read_char success ");
    	}
    	break;
    case ESP_GATTC_WRITE_DESCR_EVT:
    	ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_WRITE_DESCR_EVT");
//        if (p_data->write.status != ESP_GATT_OK){
//            ESP_LOGE(BLE_TAG, "(battery)write descr failed, error status = %x", p_data->write.status);
//            break;
//        }
//        ESP_LOGI(BLE_TAG, "(battery)write descr success ");
//        uint8_t write_char_data[35];
//        for (int i = 0; i < sizeof(write_char_data); ++i)
//        {
//            write_char_data[i] = i % 256;
//        }
//        esp_ble_gattc_write_char( gattc_if,
//                                  gl_profile_tab[PROFILE_BATTERY_SERVICE].conn_id,
//                                  gl_profile_tab[PROFILE_BATTERY_SERVICE].char_handle,
//                                  sizeof(write_char_data),
//                                  write_char_data,
//                                  ESP_GATT_WRITE_TYPE_RSP,
//                                  ESP_GATT_AUTH_REQ_NONE);
        break;

    case ESP_GATTC_SRVC_CHG_EVT: {
        esp_bd_addr_t bda;
        memcpy(bda, p_data->srvc_chg.remote_bda, sizeof(esp_bd_addr_t));
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_SRVC_CHG_EVT, bd_addr:");
        esp_log_buffer_hex(BLE_TAG, bda, sizeof(esp_bd_addr_t));
        break;
    }
    case ESP_GATTC_WRITE_CHAR_EVT:
        if (p_data->write.status != ESP_GATT_OK){
            ESP_LOGE(BLE_TAG, "(battery)write char failed, error status = %x", p_data->write.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "(battery)write char success ");
        break;
    case ESP_GATTC_DISCONNECT_EVT:
    	connect_ble = false;
        get_server = false;
        ESP_LOGI(BLE_TAG, "(battery)ESP_GATTC_DISCONNECT_EVT, reason = %d", p_data->disconnect.reason);
        break;
    default:
    	ESP_LOGI(BLE_TAG, "unregistered EVT:%d", event);
        break;
    }
}

static void esp_gap_cb(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param)
{
    uint8_t *adv_name = NULL;
    uint8_t adv_name_len = 0;
    switch (event) {
    case ESP_GAP_BLE_SCAN_PARAM_SET_COMPLETE_EVT: {
        //the unit of the duration is second
        uint32_t duration = 30;
        esp_ble_gap_start_scanning(duration);
        break;
    }
    case ESP_GAP_BLE_SCAN_START_COMPLETE_EVT:
        //scan start complete event to indicate scan start successfully or failed
        if (param->scan_start_cmpl.status != ESP_BT_STATUS_SUCCESS) {
            ESP_LOGE(BLE_TAG, "scan start failed, error status = %x", param->scan_start_cmpl.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "scan start success");
        break;
    case ESP_GAP_BLE_SCAN_RESULT_EVT: {
        esp_ble_gap_cb_param_t *scan_result = (esp_ble_gap_cb_param_t *)param;
        switch (scan_result->scan_rst.search_evt) {
        case ESP_GAP_SEARCH_INQ_RES_EVT:
            esp_log_buffer_hex(BLE_TAG, scan_result->scan_rst.bda, 6);
            ESP_LOGI(BLE_TAG, "searched Adv Data Len %d, Scan Response Len %d", scan_result->scan_rst.adv_data_len, scan_result->scan_rst.scan_rsp_len);
            adv_name = esp_ble_resolve_adv_data(scan_result->scan_rst.ble_adv,
                                                ESP_BLE_AD_TYPE_NAME_CMPL, &adv_name_len);
            ESP_LOGI(BLE_TAG, "searched Device Name Len %d", adv_name_len);
            esp_log_buffer_char(BLE_TAG, adv_name, adv_name_len);
            ESP_LOGI(BLE_TAG, "\n");
            if (adv_name != NULL) {
                if (strlen(remote_device_name) == adv_name_len && strncmp((char *)adv_name, remote_device_name, adv_name_len) == 0) {
                    ESP_LOGI(BLE_TAG, "searched device %s\n", remote_device_name);
                    if (connect_ble == false) {
                        connect_ble = true;
                        ESP_LOGI(BLE_TAG, "connect to the remote device.");
                        esp_ble_gap_stop_scanning();
						esp_ble_gattc_open(gl_profile_tab[PROFILE_BATTERY_SERVICE].gattc_if, scan_result->scan_rst.bda, true);
                        //esp_ble_gattc_open(gl_profile_tab[PROFILE_DEVICE_INFO].gattc_if, scan_result->scan_rst.bda, true);
                        //esp_ble_gattc_open(gl_profile_tab[PROFILE_HRM].gattc_if, scan_result->scan_rst.bda, true);
                    }
                }
            }
            break;
        case ESP_GAP_SEARCH_INQ_CMPL_EVT:
            break;
        default:
            break;
        }
        break;
    }

    case ESP_GAP_BLE_SCAN_STOP_COMPLETE_EVT:
        if (param->scan_stop_cmpl.status != ESP_BT_STATUS_SUCCESS){
            ESP_LOGE(BLE_TAG, "scan stop failed, error status = %x", param->scan_stop_cmpl.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "stop scan successfully");
        break;

    case ESP_GAP_BLE_ADV_STOP_COMPLETE_EVT:
        if (param->adv_stop_cmpl.status != ESP_BT_STATUS_SUCCESS){
            ESP_LOGE(BLE_TAG, "adv stop failed, error status = %x", param->adv_stop_cmpl.status);
            break;
        }
        ESP_LOGI(BLE_TAG, "stop adv successfully");
        break;
    case ESP_GAP_BLE_UPDATE_CONN_PARAMS_EVT:
         ESP_LOGI(BLE_TAG, "update connection params status = %d, min_int = %d, max_int = %d,conn_int = %d,latency = %d, timeout = %d",
                  param->update_conn_params.status,
                  param->update_conn_params.min_int,
                  param->update_conn_params.max_int,
                  param->update_conn_params.conn_int,
                  param->update_conn_params.latency,
                  param->update_conn_params.timeout);
        break;
    default:
        break;
    }
}

static void esp_gattc_cb(esp_gattc_cb_event_t event, esp_gatt_if_t gattc_if, esp_ble_gattc_cb_param_t *param)
{
    /* If event is register event, store the gattc_if for each profile */
    if (event == ESP_GATTC_REG_EVT) {
        if (param->reg.status == ESP_GATT_OK) {
            gl_profile_tab[param->reg.app_id].gattc_if = gattc_if;
        } else {
            ESP_LOGI(BLE_TAG, "reg app failed, app_id %04x, status %d",
                    param->reg.app_id,
                    param->reg.status);
            return;
        }
    }

    /* If the gattc_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 (gattc_if == ESP_GATT_IF_NONE || /* ESP_GATT_IF_NONE, not specify a certain gatt_if, need to call every profile cb function */
                    gattc_if == gl_profile_tab[idx].gattc_if) {
                if (gl_profile_tab[idx].gattc_cb) {
                    gl_profile_tab[idx].gattc_cb(event, gattc_if, param);
                }
            }
        }
    } while (0);
}


void app_main()
{
    esp_err_t ret = nvs_flash_init();
    if (ret == ESP_ERR_NVS_NO_FREE_PAGES)
    {
        ESP_ERROR_CHECK(nvs_flash_erase());
        ret = nvs_flash_init();
    }
    ESP_ERROR_CHECK( ret );


    // BLE
    {
        ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_CLASSIC_BT));

        esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
        ret = esp_bt_controller_init(&bt_cfg);
        if (ret) {
            ESP_LOGE(BLE_TAG, "%s initialize controller failed, error code = %x\n", __func__, ret);
            return;
        }

        ret = esp_bt_controller_enable(ESP_BT_MODE_BLE);
        if (ret) {
            ESP_LOGE(BLE_TAG, "%s enable controller failed, error code = %x\n", __func__, ret);
            return;
        }

        ret = esp_bluedroid_init();
        if (ret) {
            ESP_LOGE(BLE_TAG, "%s init bluetooth failed, error code = %x\n", __func__, ret);
            return;
        }

        ret = esp_bluedroid_enable();
        if (ret) {
            ESP_LOGE(BLE_TAG, "%s enable bluetooth failed, error code = %x\n", __func__, ret);
            return;
        }

        //register the  callback function to the gap module
        ret = esp_ble_gap_register_callback(esp_gap_cb);
        if (ret){
            ESP_LOGE(BLE_TAG, "%s gap register failed, error code = %x\n", __func__, ret);
            return;
        }

        //register the callback function to the gattc module
        ret = esp_ble_gattc_register_callback(esp_gattc_cb);
        if(ret){
            ESP_LOGE(BLE_TAG, "%s gattc register failed, error code = %x\n", __func__, ret);
            return;
        }


        ret = esp_ble_gattc_app_register(PROFILE_BATTERY_SERVICE);
        if (ret){
            ESP_LOGE(BLE_TAG, "%s gattc app register failed, error code = %x\n", __func__, ret);
        }

//        ret = esp_ble_gattc_app_register(PROFILE_DEVICE_INFO);
//        if (ret){
//            ESP_LOGE(BLE_TAG, "%s gattc app register failed, error code = %x\n", __func__, ret);
//        }		
		
//        ret = esp_ble_gattc_app_register(PROFILE_HRM);
//        if (ret){
//            ESP_LOGE(BLE_TAG, "%s gattc app register failed, error code = %x\n", __func__, ret);
//        }

        esp_err_t local_mtu_ret = esp_ble_gatt_set_local_mtu(500);
        if (local_mtu_ret){
            ESP_LOGE(BLE_TAG, "set local  MTU failed, error code = %x", local_mtu_ret);
        }
    }
}
And at pastebin:
https://pastebin.com/k6Wm2tLM

Who is online

Users browsing this forum: Bing [Bot] and 105 guests