2018-01-15 06:47:23 -05:00
/*
This example code is in the Public Domain ( or CC0 licensed , at your option . )
2017-07-17 04:57:17 -04:00
2018-01-15 06:47:23 -05:00
Unless required by applicable law or agreed to in writing , this
software is distributed on an " AS IS " BASIS , WITHOUT WARRANTIES OR
CONDITIONS OF ANY KIND , either express or implied .
*/
2017-07-17 04:57:17 -04:00
/****************************************************************************
*
* This file is for gatt client . It can scan ble device , connect multiple devices ,
* The gattc_multi_connect demo can connect three ble slaves at the same time .
* Modify the name of gatt_server demo named ESP_GATTS_DEMO_a ,
* ESP_GATTS_DEMO_b and ESP_GATTS_DEMO_c , then run three demos , the gattc_multi_connect demo will connect
* the three gatt_server demos , and then exchange data .
* Of course you can also modify the code to connect more devices , we default to connect
* up to 4 devices , more than 4 you need to modify menuconfig .
*
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
# include <stdint.h>
# include <string.h>
# include <stdbool.h>
# include <stdio.h>
# include "nvs.h"
# include "nvs_flash.h"
# include "controller.h"
2017-12-07 08:48:27 -05:00
# include "esp_bt.h"
2017-07-17 04:57:17 -04:00
# include "esp_gap_ble_api.h"
# include "esp_gattc_api.h"
# include "esp_gatt_defs.h"
# include "esp_bt_main.h"
2017-08-24 07:54:41 -04:00
# include "esp_gatt_common_api.h"
2017-07-17 04:57:17 -04:00
# define GATTC_TAG "GATTC_MULTIPLE_DEMO"
# define REMOTE_SERVICE_UUID 0x00FF
# define REMOTE_NOTIFY_CHAR_UUID 0xFF01
2017-08-24 02:24:04 -04:00
/* register three profiles, each profile corresponds to one connection,
which makes it easy to handle each connection event */
# define PROFILE_NUM 3
# define PROFILE_A_APP_ID 0
# define PROFILE_B_APP_ID 1
# define PROFILE_C_APP_ID 2
# define INVALID_HANDLE 0
/* Declare static functions */
2017-07-17 04:57:17 -04:00
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_a_event_handler ( esp_gattc_cb_event_t event , esp_gatt_if_t gattc_if , esp_ble_gattc_cb_param_t * param ) ;
static void gattc_profile_b_event_handler ( esp_gattc_cb_event_t event , esp_gatt_if_t gattc_if , esp_ble_gattc_cb_param_t * param ) ;
static void gattc_profile_c_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 , } ,
} ;
2017-08-24 02:24:04 -04:00
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 notify_descr_uuid = {
. len = ESP_UUID_LEN_16 ,
. uuid = { . uuid16 = ESP_GATT_UUID_CHAR_CLIENT_CONFIG , } ,
2017-07-17 04:57:17 -04:00
} ;
static bool conn_device_a = false ;
static bool conn_device_b = false ;
static bool conn_device_c = false ;
static bool get_service_a = false ;
static bool get_service_b = false ;
static bool get_service_c = false ;
static bool Isconnecting = false ;
static bool stop_scan_done = false ;
2017-08-24 02:24:04 -04:00
static esp_gattc_char_elem_t * char_elem_result_a = NULL ;
static esp_gattc_descr_elem_t * descr_elem_result_a = NULL ;
static esp_gattc_char_elem_t * char_elem_result_b = NULL ;
static esp_gattc_descr_elem_t * descr_elem_result_b = NULL ;
static esp_gattc_char_elem_t * char_elem_result_c = NULL ;
static esp_gattc_descr_elem_t * descr_elem_result_c = NULL ;
2017-07-17 04:57:17 -04:00
static const char remote_device_name [ 3 ] [ 20 ] = { " ESP_GATTS_DEMO_a " , " ESP_GATTS_DEMO_b " , " ESP_GATTS_DEMO_c " } ;
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
} ;
struct gattc_profile_inst {
esp_gattc_cb_t gattc_cb ;
uint16_t gattc_if ;
uint16_t app_id ;
uint16_t conn_id ;
2017-08-24 02:24:04 -04:00
uint16_t service_start_handle ;
uint16_t service_end_handle ;
uint16_t char_handle ;
2017-07-17 04:57:17 -04:00
esp_bd_addr_t remote_bda ;
} ;
/* 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_A_APP_ID ] = {
. gattc_cb = gattc_profile_a_event_handler ,
. gattc_if = ESP_GATT_IF_NONE , /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
} ,
[ PROFILE_B_APP_ID ] = {
. gattc_cb = gattc_profile_b_event_handler ,
. gattc_if = ESP_GATT_IF_NONE , /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
} ,
[ PROFILE_C_APP_ID ] = {
. gattc_cb = gattc_profile_c_event_handler ,
. gattc_if = ESP_GATT_IF_NONE , /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
} ,
} ;
static void start_scan ( void )
{
stop_scan_done = false ;
Isconnecting = false ;
uint32_t duration = 30 ;
esp_ble_gap_start_scanning ( duration ) ;
}
static void gattc_profile_a_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 ( GATTC_TAG , " REG_EVT " ) ;
esp_err_t scan_ret = esp_ble_gap_set_scan_params ( & ble_scan_params ) ;
if ( scan_ret ) {
ESP_LOGE ( GATTC_TAG , " set scan params error, error code = %x " , scan_ret ) ;
}
break ;
/* one device connect successfully, all profiles callback function will get the ESP_GATTC_CONNECT_EVT,
so must compare the mac address to check which device is connected , so it is a good choice to use ESP_GATTC_OPEN_EVT . */
case ESP_GATTC_CONNECT_EVT :
break ;
case ESP_GATTC_OPEN_EVT :
if ( p_data - > open . status ! = ESP_GATT_OK ) {
//open failed, ignore the first device, connect the second device
ESP_LOGE ( GATTC_TAG , " connect device failed, status %d " , p_data - > open . status ) ;
conn_device_a = false ;
2017-08-24 02:24:04 -04:00
//start_scan();
2017-07-17 04:57:17 -04:00
break ;
}
memcpy ( gl_profile_tab [ PROFILE_A_APP_ID ] . remote_bda , p_data - > open . remote_bda , 6 ) ;
gl_profile_tab [ PROFILE_A_APP_ID ] . conn_id = p_data - > open . conn_id ;
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_OPEN_EVT conn_id %d, if %d, status %d, mtu %d " , p_data - > open . conn_id , gattc_if , p_data - > open . status , p_data - > open . mtu ) ;
ESP_LOGI ( GATTC_TAG , " REMOTE BDA: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > open . remote_bda , sizeof ( esp_bd_addr_t ) ) ;
2017-08-24 07:54:41 -04:00
esp_err_t mtu_ret = esp_ble_gattc_send_mtu_req ( gattc_if , p_data - > open . conn_id ) ;
2017-07-17 04:57:17 -04:00
if ( mtu_ret ) {
ESP_LOGE ( GATTC_TAG , " config MTU error, error code = %x " , mtu_ret ) ;
}
break ;
case ESP_GATTC_CFG_MTU_EVT :
if ( param - > cfg_mtu . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " Config mtu failed " ) ;
}
ESP_LOGI ( GATTC_TAG , " Status %d, MTU %d, conn_id %d " , param - > cfg_mtu . status , param - > cfg_mtu . mtu , param - > cfg_mtu . conn_id ) ;
esp_ble_gattc_search_service ( gattc_if , param - > cfg_mtu . conn_id , & remote_filter_service_uuid ) ;
break ;
case ESP_GATTC_SEARCH_RES_EVT : {
2018-03-20 07:27:50 -04:00
ESP_LOGI ( GATTC_TAG , " SEARCH RES: conn_id = %x is primary service %d " , p_data - > search_res . conn_id , p_data - > search_res . is_primary ) ;
ESP_LOGI ( GATTC_TAG , " start handle %d end handle %d current handle value %d " , p_data - > search_res . start_handle , p_data - > search_res . start_handle , p_data - > search_res . srvc_id . inst_id ) ;
if ( p_data - > search_res . srvc_id . uuid . len = = ESP_UUID_LEN_16 & & p_data - > search_res . srvc_id . uuid . uuid . uuid16 = = REMOTE_SERVICE_UUID ) {
ESP_LOGI ( GATTC_TAG , " UUID16: %x " , p_data - > search_res . srvc_id . uuid . uuid . uuid16 ) ;
2017-07-17 04:57:17 -04:00
get_service_a = true ;
2017-08-24 02:24:04 -04:00
gl_profile_tab [ PROFILE_A_APP_ID ] . service_start_handle = p_data - > search_res . start_handle ;
gl_profile_tab [ PROFILE_A_APP_ID ] . service_end_handle = p_data - > search_res . end_handle ;
2017-07-17 04:57:17 -04:00
}
break ;
}
case ESP_GATTC_SEARCH_CMPL_EVT :
if ( p_data - > search_cmpl . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " search service failed, error status = %x " , p_data - > search_cmpl . status ) ;
break ;
}
if ( get_service_a ) {
2017-08-24 02:24:04 -04:00
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_A_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_A_APP_ID ] . service_end_handle ,
INVALID_HANDLE ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
char_elem_result_a = ( esp_gattc_char_elem_t * ) malloc ( sizeof ( esp_gattc_char_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! char_elem_result_a ) {
ESP_LOGE ( GATTC_TAG , " gattc no mem " ) ;
} else {
status = esp_ble_gattc_get_char_by_uuid ( gattc_if ,
p_data - > search_cmpl . conn_id ,
gl_profile_tab [ PROFILE_A_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_A_APP_ID ] . service_end_handle ,
remote_filter_char_uuid ,
char_elem_result_a ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_char_by_uuid error " ) ;
}
2017-07-17 04:57:17 -04:00
2017-08-24 02:24:04 -04:00
/* 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_a [ 0 ] . properties & ESP_GATT_CHAR_PROP_BIT_NOTIFY ) ) {
gl_profile_tab [ PROFILE_A_APP_ID ] . char_handle = char_elem_result_a [ 0 ] . char_handle ;
esp_ble_gattc_register_for_notify ( gattc_if , gl_profile_tab [ PROFILE_A_APP_ID ] . remote_bda , char_elem_result_a [ 0 ] . char_handle ) ;
}
}
/* free char_elem_result */
free ( char_elem_result_a ) ;
} else {
ESP_LOGE ( GATTC_TAG , " no char found " ) ;
}
2017-07-17 04:57:17 -04:00
}
break ;
case ESP_GATTC_REG_FOR_NOTIFY_EVT : {
if ( p_data - > reg_for_notify . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " reg notify failed, error status =%x " , p_data - > reg_for_notify . status ) ;
break ;
}
2017-08-24 02:24:04 -04:00
uint16_t count = 0 ;
2017-07-17 04:57:17 -04:00
uint16_t notify_en = 1 ;
2017-08-24 02:24:04 -04:00
esp_gatt_status_t ret_status = esp_ble_gattc_get_attr_count ( gattc_if ,
gl_profile_tab [ PROFILE_A_APP_ID ] . conn_id ,
ESP_GATT_DB_DESCRIPTOR ,
gl_profile_tab [ PROFILE_A_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_A_APP_ID ] . service_end_handle ,
gl_profile_tab [ PROFILE_A_APP_ID ] . char_handle ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
descr_elem_result_a = ( esp_gattc_descr_elem_t * ) malloc ( sizeof ( esp_gattc_descr_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! descr_elem_result_a ) {
ESP_LOGE ( GATTC_TAG , " malloc error, gattc no mem " ) ;
} else {
ret_status = esp_ble_gattc_get_descr_by_char_handle ( gattc_if ,
gl_profile_tab [ PROFILE_A_APP_ID ] . conn_id ,
p_data - > reg_for_notify . handle ,
notify_descr_uuid ,
descr_elem_result_a ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_descr_by_char_handle error " ) ;
}
2018-02-13 01:55:18 -05:00
/* Every char has only one descriptor in our 'ESP_GATTS_DEMO' demo, so we used first 'descr_elem_result' */
2017-08-24 02:24:04 -04:00
if ( count > 0 & & descr_elem_result_a [ 0 ] . uuid . len = = ESP_UUID_LEN_16 & & descr_elem_result_a [ 0 ] . uuid . uuid . uuid16 = = ESP_GATT_UUID_CHAR_CLIENT_CONFIG ) {
ret_status = esp_ble_gattc_write_char_descr ( gattc_if ,
gl_profile_tab [ PROFILE_A_APP_ID ] . conn_id ,
descr_elem_result_a [ 0 ] . handle ,
sizeof ( notify_en ) ,
( uint8_t * ) & notify_en ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
}
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_write_char_descr error " ) ;
}
/* free descr_elem_result */
free ( descr_elem_result_a ) ;
}
}
else {
ESP_LOGE ( GATTC_TAG , " decsr not found " ) ;
}
2017-07-17 04:57:17 -04:00
break ;
}
case ESP_GATTC_NOTIFY_EVT :
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_NOTIFY_EVT, Receive notify value: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > notify . value , p_data - > notify . value_len ) ;
break ;
case ESP_GATTC_WRITE_DESCR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " write descr failed, error status = %x " , p_data - > write . status ) ;
break ;
}
ESP_LOGI ( GATTC_TAG , " write descr success " ) ;
2017-08-24 02:24:04 -04:00
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_A_APP_ID ] . conn_id ,
gl_profile_tab [ PROFILE_A_APP_ID ] . char_handle ,
sizeof ( write_char_data ) ,
write_char_data ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
2017-07-17 04:57:17 -04:00
break ;
case ESP_GATTC_WRITE_CHAR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " write char failed, error status = %x " , p_data - > write . status ) ;
} else {
ESP_LOGI ( GATTC_TAG , " write char success " ) ;
}
start_scan ( ) ;
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 ( GATTC_TAG , " ESP_GATTC_SRVC_CHG_EVT, bd_addr:%08x%04x " , ( bda [ 0 ] < < 24 ) + ( bda [ 1 ] < < 16 ) + ( bda [ 2 ] < < 8 ) + bda [ 3 ] ,
( bda [ 4 ] < < 8 ) + bda [ 5 ] ) ;
break ;
}
case ESP_GATTC_DISCONNECT_EVT :
//Start scanning again
start_scan ( ) ;
if ( memcmp ( p_data - > disconnect . remote_bda , gl_profile_tab [ PROFILE_A_APP_ID ] . remote_bda , 6 ) = = 0 ) {
ESP_LOGI ( GATTC_TAG , " device a disconnect " ) ;
conn_device_a = false ;
get_service_a = false ;
}
break ;
default :
break ;
}
}
static void gattc_profile_b_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 ( GATTC_TAG , " REG_EVT " ) ;
break ;
case ESP_GATTC_CONNECT_EVT :
break ;
case ESP_GATTC_OPEN_EVT :
if ( p_data - > open . status ! = ESP_GATT_OK ) {
//open failed, ignore the second device, connect the third device
ESP_LOGE ( GATTC_TAG , " connect device failed, status %d " , p_data - > open . status ) ;
conn_device_b = false ;
2017-08-24 02:24:04 -04:00
//start_scan();
2017-07-17 04:57:17 -04:00
break ;
}
memcpy ( gl_profile_tab [ PROFILE_B_APP_ID ] . remote_bda , p_data - > open . remote_bda , 6 ) ;
gl_profile_tab [ PROFILE_B_APP_ID ] . conn_id = p_data - > open . conn_id ;
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_OPEN_EVT conn_id %d, if %d, status %d, mtu %d " , p_data - > open . conn_id , gattc_if , p_data - > open . status , p_data - > open . mtu ) ;
ESP_LOGI ( GATTC_TAG , " REMOTE BDA: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > open . remote_bda , sizeof ( esp_bd_addr_t ) ) ;
2017-08-24 07:54:41 -04:00
esp_err_t mtu_ret = esp_ble_gattc_send_mtu_req ( gattc_if , p_data - > open . conn_id ) ;
2017-07-17 04:57:17 -04:00
if ( mtu_ret ) {
ESP_LOGE ( GATTC_TAG , " config MTU error, error code = %x " , mtu_ret ) ;
}
break ;
case ESP_GATTC_CFG_MTU_EVT :
if ( param - > cfg_mtu . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " Config mtu failed " ) ;
}
ESP_LOGI ( GATTC_TAG , " Status %d, MTU %d, conn_id %d " , param - > cfg_mtu . status , param - > cfg_mtu . mtu , param - > cfg_mtu . conn_id ) ;
esp_ble_gattc_search_service ( gattc_if , param - > cfg_mtu . conn_id , & remote_filter_service_uuid ) ;
break ;
case ESP_GATTC_SEARCH_RES_EVT : {
2018-03-20 07:27:50 -04:00
ESP_LOGI ( GATTC_TAG , " SEARCH RES: conn_id = %x is primary service %d " , p_data - > search_res . conn_id , p_data - > search_res . is_primary ) ;
ESP_LOGI ( GATTC_TAG , " start handle %d end handle %d current handle value %d " , p_data - > search_res . start_handle , p_data - > search_res . start_handle , p_data - > search_res . srvc_id . inst_id ) ;
if ( p_data - > search_res . srvc_id . uuid . len = = ESP_UUID_LEN_16 & & p_data - > search_res . srvc_id . uuid . uuid . uuid16 = = REMOTE_SERVICE_UUID ) {
ESP_LOGI ( GATTC_TAG , " UUID16: %x " , p_data - > search_res . srvc_id . uuid . uuid . uuid16 ) ;
2017-07-17 04:57:17 -04:00
get_service_b = true ;
2017-08-24 02:24:04 -04:00
gl_profile_tab [ PROFILE_B_APP_ID ] . service_start_handle = p_data - > search_res . start_handle ;
gl_profile_tab [ PROFILE_B_APP_ID ] . service_end_handle = p_data - > search_res . end_handle ;
2017-07-17 04:57:17 -04:00
}
break ;
}
case ESP_GATTC_SEARCH_CMPL_EVT :
if ( p_data - > search_cmpl . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " search service failed, error status = %x " , p_data - > search_cmpl . status ) ;
break ;
}
if ( get_service_b ) {
2017-08-24 02:24:04 -04:00
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_B_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_B_APP_ID ] . service_end_handle ,
INVALID_HANDLE ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
char_elem_result_b = ( esp_gattc_char_elem_t * ) malloc ( sizeof ( esp_gattc_char_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! char_elem_result_b ) {
ESP_LOGE ( GATTC_TAG , " gattc no mem " ) ;
} else {
status = esp_ble_gattc_get_char_by_uuid ( gattc_if ,
p_data - > search_cmpl . conn_id ,
gl_profile_tab [ PROFILE_B_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_B_APP_ID ] . service_end_handle ,
remote_filter_char_uuid ,
char_elem_result_b ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " 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_b [ 0 ] . properties & ESP_GATT_CHAR_PROP_BIT_NOTIFY ) ) {
gl_profile_tab [ PROFILE_B_APP_ID ] . char_handle = char_elem_result_b [ 0 ] . char_handle ;
esp_ble_gattc_register_for_notify ( gattc_if , gl_profile_tab [ PROFILE_B_APP_ID ] . remote_bda , char_elem_result_b [ 0 ] . char_handle ) ;
}
}
/* free char_elem_result */
free ( char_elem_result_b ) ;
} else {
ESP_LOGE ( GATTC_TAG , " no char found " ) ;
}
2017-07-17 04:57:17 -04:00
}
break ;
2017-08-24 02:24:04 -04:00
case ESP_GATTC_REG_FOR_NOTIFY_EVT : {
if ( p_data - > reg_for_notify . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " reg notify failed, error status =%x " , p_data - > reg_for_notify . status ) ;
2017-07-17 04:57:17 -04:00
break ;
}
2017-08-24 02:24:04 -04:00
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_B_APP_ID ] . conn_id ,
ESP_GATT_DB_DESCRIPTOR ,
gl_profile_tab [ PROFILE_B_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_B_APP_ID ] . service_end_handle ,
gl_profile_tab [ PROFILE_B_APP_ID ] . char_handle ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
descr_elem_result_b = ( esp_gattc_descr_elem_t * ) malloc ( sizeof ( esp_gattc_descr_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! descr_elem_result_b ) {
ESP_LOGE ( GATTC_TAG , " malloc error, gattc no mem " ) ;
} else {
ret_status = esp_ble_gattc_get_descr_by_char_handle ( gattc_if ,
gl_profile_tab [ PROFILE_B_APP_ID ] . conn_id ,
p_data - > reg_for_notify . handle ,
notify_descr_uuid ,
descr_elem_result_b ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_descr_by_char_handle error " ) ;
}
2017-07-17 04:57:17 -04:00
2018-02-13 01:55:18 -05:00
/* Every char has only one descriptor in our 'ESP_GATTS_DEMO' demo, so we used first 'descr_elem_result' */
2017-08-24 02:24:04 -04:00
if ( count > 0 & & descr_elem_result_b [ 0 ] . uuid . len = = ESP_UUID_LEN_16 & & descr_elem_result_b [ 0 ] . uuid . uuid . uuid16 = = ESP_GATT_UUID_CHAR_CLIENT_CONFIG ) {
ret_status = esp_ble_gattc_write_char_descr ( gattc_if ,
gl_profile_tab [ PROFILE_B_APP_ID ] . conn_id ,
descr_elem_result_b [ 0 ] . handle ,
sizeof ( notify_en ) ,
( uint8_t * ) & notify_en ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
}
2017-07-17 04:57:17 -04:00
2017-08-24 02:24:04 -04:00
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_write_char_descr error " ) ;
}
2017-07-17 04:57:17 -04:00
2017-08-24 02:24:04 -04:00
/* free descr_elem_result */
free ( descr_elem_result_b ) ;
}
}
else {
ESP_LOGE ( GATTC_TAG , " decsr not found " ) ;
}
2017-07-17 04:57:17 -04:00
break ;
}
case ESP_GATTC_NOTIFY_EVT :
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_NOTIFY_EVT, Receive notify value: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > notify . value , p_data - > notify . value_len ) ;
break ;
case ESP_GATTC_WRITE_DESCR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " write descr failed, error status = %x " , p_data - > write . status ) ;
break ;
}
ESP_LOGI ( GATTC_TAG , " write descr success " ) ;
2017-08-24 02:24:04 -04:00
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_B_APP_ID ] . conn_id ,
gl_profile_tab [ PROFILE_B_APP_ID ] . char_handle ,
sizeof ( write_char_data ) ,
write_char_data ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
2017-07-17 04:57:17 -04:00
break ;
case ESP_GATTC_WRITE_CHAR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " Write char failed, error status = %x " , p_data - > write . status ) ;
} else {
ESP_LOGI ( GATTC_TAG , " Write char success " ) ;
}
start_scan ( ) ;
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 ( GATTC_TAG , " ESP_GATTC_SRVC_CHG_EVT, bd_addr:%08x%04x " , ( bda [ 0 ] < < 24 ) + ( bda [ 1 ] < < 16 ) + ( bda [ 2 ] < < 8 ) + bda [ 3 ] ,
( bda [ 4 ] < < 8 ) + bda [ 5 ] ) ;
break ;
}
case ESP_GATTC_DISCONNECT_EVT :
if ( memcmp ( p_data - > disconnect . remote_bda , gl_profile_tab [ PROFILE_B_APP_ID ] . remote_bda , 6 ) = = 0 ) {
ESP_LOGI ( GATTC_TAG , " device b disconnect " ) ;
conn_device_b = false ;
get_service_b = false ;
}
break ;
default :
break ;
}
}
static void gattc_profile_c_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 ( GATTC_TAG , " REG_EVT " ) ;
break ;
case ESP_GATTC_CONNECT_EVT :
break ;
case ESP_GATTC_OPEN_EVT :
if ( p_data - > open . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " connect device failed, status %d " , p_data - > open . status ) ;
conn_device_c = false ;
2017-08-24 02:24:04 -04:00
//start_scan();
2017-07-17 04:57:17 -04:00
break ;
}
memcpy ( gl_profile_tab [ PROFILE_C_APP_ID ] . remote_bda , p_data - > open . remote_bda , 6 ) ;
gl_profile_tab [ PROFILE_C_APP_ID ] . conn_id = p_data - > open . conn_id ;
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_OPEN_EVT conn_id %d, if %d, status %d, mtu %d " , p_data - > open . conn_id , gattc_if , p_data - > open . status , p_data - > open . mtu ) ;
ESP_LOGI ( GATTC_TAG , " REMOTE BDA: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > open . remote_bda , sizeof ( esp_bd_addr_t ) ) ;
2017-08-24 07:54:41 -04:00
esp_err_t mtu_ret = esp_ble_gattc_send_mtu_req ( gattc_if , p_data - > open . conn_id ) ;
2017-07-17 04:57:17 -04:00
if ( mtu_ret ) {
ESP_LOGE ( GATTC_TAG , " config MTU error, error code = %x " , mtu_ret ) ;
}
break ;
case ESP_GATTC_CFG_MTU_EVT :
if ( param - > cfg_mtu . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " Config mtu failed " ) ;
}
ESP_LOGI ( GATTC_TAG , " Status %d, MTU %d, conn_id %d " , param - > cfg_mtu . status , param - > cfg_mtu . mtu , param - > cfg_mtu . conn_id ) ;
esp_ble_gattc_search_service ( gattc_if , param - > cfg_mtu . conn_id , & remote_filter_service_uuid ) ;
break ;
case ESP_GATTC_SEARCH_RES_EVT : {
2018-03-20 07:27:50 -04:00
ESP_LOGI ( GATTC_TAG , " SEARCH RES: conn_id = %x is primary service %d " , p_data - > search_res . conn_id , p_data - > search_res . is_primary ) ;
ESP_LOGI ( GATTC_TAG , " start handle %d end handle %d current handle value %d " , p_data - > search_res . start_handle , p_data - > search_res . start_handle , p_data - > search_res . srvc_id . inst_id ) ;
if ( p_data - > search_res . srvc_id . uuid . len = = ESP_UUID_LEN_16 & & p_data - > search_res . srvc_id . uuid . uuid . uuid16 = = REMOTE_SERVICE_UUID ) {
ESP_LOGI ( GATTC_TAG , " UUID16: %x " , p_data - > search_res . srvc_id . uuid . uuid . uuid16 ) ;
2017-07-17 04:57:17 -04:00
get_service_c = true ;
2017-08-24 02:24:04 -04:00
gl_profile_tab [ PROFILE_C_APP_ID ] . service_start_handle = p_data - > search_res . start_handle ;
gl_profile_tab [ PROFILE_C_APP_ID ] . service_end_handle = p_data - > search_res . end_handle ;
2017-07-17 04:57:17 -04:00
}
break ;
}
case ESP_GATTC_SEARCH_CMPL_EVT :
if ( p_data - > search_cmpl . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " search service failed, error status = %x " , p_data - > search_cmpl . status ) ;
break ;
}
if ( get_service_c ) {
2017-08-24 02:24:04 -04:00
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_C_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_C_APP_ID ] . service_end_handle ,
INVALID_HANDLE ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
char_elem_result_c = ( esp_gattc_char_elem_t * ) malloc ( sizeof ( esp_gattc_char_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! char_elem_result_c ) {
ESP_LOGE ( GATTC_TAG , " gattc no mem " ) ;
} else {
status = esp_ble_gattc_get_char_by_uuid ( gattc_if ,
p_data - > search_cmpl . conn_id ,
gl_profile_tab [ PROFILE_C_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_C_APP_ID ] . service_end_handle ,
remote_filter_char_uuid ,
char_elem_result_c ,
& count ) ;
if ( status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " 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_c [ 0 ] . properties & ESP_GATT_CHAR_PROP_BIT_NOTIFY ) ) {
gl_profile_tab [ PROFILE_C_APP_ID ] . char_handle = char_elem_result_c [ 0 ] . char_handle ;
esp_ble_gattc_register_for_notify ( gattc_if , gl_profile_tab [ PROFILE_C_APP_ID ] . remote_bda , char_elem_result_c [ 0 ] . char_handle ) ;
}
}
/* free char_elem_result */
free ( char_elem_result_c ) ;
} else {
ESP_LOGE ( GATTC_TAG , " no char found " ) ;
}
2017-07-17 04:57:17 -04:00
}
break ;
2017-08-24 02:24:04 -04:00
case ESP_GATTC_REG_FOR_NOTIFY_EVT : {
if ( p_data - > reg_for_notify . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " reg notify failed, error status =%x " , p_data - > reg_for_notify . status ) ;
2017-07-17 04:57:17 -04:00
break ;
}
2017-08-24 02:24:04 -04:00
uint16_t count = 0 ;
2017-07-17 04:57:17 -04:00
uint16_t notify_en = 1 ;
2017-08-24 02:24:04 -04:00
esp_gatt_status_t ret_status = esp_ble_gattc_get_attr_count ( gattc_if ,
gl_profile_tab [ PROFILE_C_APP_ID ] . conn_id ,
ESP_GATT_DB_DESCRIPTOR ,
gl_profile_tab [ PROFILE_C_APP_ID ] . service_start_handle ,
gl_profile_tab [ PROFILE_C_APP_ID ] . service_end_handle ,
gl_profile_tab [ PROFILE_C_APP_ID ] . char_handle ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_attr_count error " ) ;
}
if ( count > 0 ) {
2017-10-22 23:07:03 -04:00
descr_elem_result_c = ( esp_gattc_descr_elem_t * ) malloc ( sizeof ( esp_gattc_descr_elem_t ) * count ) ;
2017-08-24 02:24:04 -04:00
if ( ! descr_elem_result_c ) {
ESP_LOGE ( GATTC_TAG , " malloc error, gattc no mem " ) ;
} else {
ret_status = esp_ble_gattc_get_descr_by_char_handle ( gattc_if ,
gl_profile_tab [ PROFILE_C_APP_ID ] . conn_id ,
p_data - > reg_for_notify . handle ,
notify_descr_uuid ,
descr_elem_result_c ,
& count ) ;
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_get_descr_by_char_handle error " ) ;
}
2018-02-13 01:55:18 -05:00
/* Every char has only one descriptor in our 'ESP_GATTS_DEMO' demo, so we used first 'descr_elem_result' */
2017-08-24 02:24:04 -04:00
if ( count > 0 & & descr_elem_result_c [ 0 ] . uuid . len = = ESP_UUID_LEN_16 & & descr_elem_result_c [ 0 ] . uuid . uuid . uuid16 = = ESP_GATT_UUID_CHAR_CLIENT_CONFIG ) {
ret_status = esp_ble_gattc_write_char_descr ( gattc_if ,
gl_profile_tab [ PROFILE_C_APP_ID ] . conn_id ,
descr_elem_result_c [ 0 ] . handle ,
sizeof ( notify_en ) ,
( uint8_t * ) & notify_en ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
}
if ( ret_status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " esp_ble_gattc_write_char_descr error " ) ;
}
/* free descr_elem_result */
free ( descr_elem_result_c ) ;
}
}
else {
ESP_LOGE ( GATTC_TAG , " decsr not found " ) ;
}
2017-07-17 04:57:17 -04:00
break ;
}
case ESP_GATTC_NOTIFY_EVT :
ESP_LOGI ( GATTC_TAG , " ESP_GATTC_NOTIFY_EVT, Receive notify value: " ) ;
esp_log_buffer_hex ( GATTC_TAG , p_data - > notify . value , p_data - > notify . value_len ) ;
break ;
case ESP_GATTC_WRITE_DESCR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " write descr failed, error status = %x " , p_data - > write . status ) ;
break ;
}
ESP_LOGI ( GATTC_TAG , " write descr success " ) ;
2017-08-24 02:24:04 -04:00
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_C_APP_ID ] . conn_id ,
gl_profile_tab [ PROFILE_C_APP_ID ] . char_handle ,
sizeof ( write_char_data ) ,
write_char_data ,
ESP_GATT_WRITE_TYPE_RSP ,
ESP_GATT_AUTH_REQ_NONE ) ;
2017-07-17 04:57:17 -04:00
break ;
case ESP_GATTC_WRITE_CHAR_EVT :
if ( p_data - > write . status ! = ESP_GATT_OK ) {
ESP_LOGE ( GATTC_TAG , " Write char failed, error status = %x " , p_data - > write . status ) ;
break ;
}
ESP_LOGI ( GATTC_TAG , " Write char success " ) ;
start_scan ( ) ;
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 ( GATTC_TAG , " ESP_GATTC_SRVC_CHG_EVT, bd_addr:%08x%04x " , ( bda [ 0 ] < < 24 ) + ( bda [ 1 ] < < 16 ) + ( bda [ 2 ] < < 8 ) + bda [ 3 ] ,
( bda [ 4 ] < < 8 ) + bda [ 5 ] ) ;
break ;
}
case ESP_GATTC_DISCONNECT_EVT :
if ( memcmp ( p_data - > disconnect . remote_bda , gl_profile_tab [ PROFILE_C_APP_ID ] . remote_bda , 6 ) = = 0 ) {
ESP_LOGI ( GATTC_TAG , " device c disconnect " ) ;
conn_device_c = false ;
get_service_c = false ;
}
break ;
default :
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 ) {
2017-08-24 02:24:04 -04:00
case ESP_GAP_BLE_UPDATE_CONN_PARAMS_EVT :
2018-02-13 01:55:18 -05:00
ESP_LOGI ( GATTC_TAG , " update connection params status = %d, min_int = %d, max_int = %d,conn_int = %d,latency = %d, timeout = %d " ,
2017-08-24 02:24:04 -04:00
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 ;
2017-07-17 04:57:17 -04:00
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 ) {
2018-01-17 06:23:41 -05:00
ESP_LOGI ( GATTC_TAG , " Scan start success " ) ;
2017-07-17 04:57:17 -04:00
} else {
ESP_LOGE ( GATTC_TAG , " Scan start failed " ) ;
}
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 ( GATTC_TAG , scan_result - > scan_rst . bda , 6 ) ;
ESP_LOGI ( GATTC_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 ( GATTC_TAG , " Searched Device Name Len %d " , adv_name_len ) ;
esp_log_buffer_char ( GATTC_TAG , adv_name , adv_name_len ) ;
ESP_LOGI ( GATTC_TAG , " \n " ) ;
if ( Isconnecting ) {
break ;
}
if ( conn_device_a & & conn_device_b & & conn_device_c & & ! stop_scan_done ) {
stop_scan_done = true ;
esp_ble_gap_stop_scanning ( ) ;
ESP_LOGI ( GATTC_TAG , " all devices are connected " ) ;
break ;
}
if ( adv_name ! = NULL ) {
if ( strlen ( remote_device_name [ 0 ] ) = = adv_name_len & & strncmp ( ( char * ) adv_name , remote_device_name [ 0 ] , adv_name_len ) = = 0 ) {
if ( conn_device_a = = false ) {
conn_device_a = true ;
2017-08-24 02:24:04 -04:00
ESP_LOGI ( GATTC_TAG , " Searched device %s " , remote_device_name [ 0 ] ) ;
2017-07-17 04:57:17 -04:00
esp_ble_gap_stop_scanning ( ) ;
2018-03-22 23:08:03 -04:00
esp_ble_gattc_open ( gl_profile_tab [ PROFILE_A_APP_ID ] . gattc_if , scan_result - > scan_rst . bda , scan_result - > scan_rst . ble_addr_type , true ) ;
2017-07-17 04:57:17 -04:00
Isconnecting = true ;
}
break ;
}
else if ( strlen ( remote_device_name [ 1 ] ) = = adv_name_len & & strncmp ( ( char * ) adv_name , remote_device_name [ 1 ] , adv_name_len ) = = 0 ) {
if ( conn_device_b = = false ) {
conn_device_b = true ;
2017-08-24 02:24:04 -04:00
ESP_LOGI ( GATTC_TAG , " Searched device %s " , remote_device_name [ 1 ] ) ;
2017-07-17 04:57:17 -04:00
esp_ble_gap_stop_scanning ( ) ;
2018-03-22 23:08:03 -04:00
esp_ble_gattc_open ( gl_profile_tab [ PROFILE_B_APP_ID ] . gattc_if , scan_result - > scan_rst . bda , scan_result - > scan_rst . ble_addr_type , true ) ;
2017-07-17 04:57:17 -04:00
Isconnecting = true ;
}
}
else if ( strlen ( remote_device_name [ 2 ] ) = = adv_name_len & & strncmp ( ( char * ) adv_name , remote_device_name [ 2 ] , adv_name_len ) = = 0 ) {
if ( conn_device_c = = false ) {
conn_device_c = true ;
2017-08-24 02:24:04 -04:00
ESP_LOGI ( GATTC_TAG , " Searched device %s " , remote_device_name [ 2 ] ) ;
2017-07-17 04:57:17 -04:00
esp_ble_gap_stop_scanning ( ) ;
2018-03-22 23:08:03 -04:00
esp_ble_gattc_open ( gl_profile_tab [ PROFILE_C_APP_ID ] . gattc_if , scan_result - > scan_rst . bda , scan_result - > scan_rst . ble_addr_type , true ) ;
2017-07-17 04:57:17 -04:00
Isconnecting = true ;
}
break ;
}
}
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 ( GATTC_TAG , " Scan stop failed " ) ;
break ;
}
ESP_LOGI ( GATTC_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 ( GATTC_TAG , " Adv stop failed " ) ;
break ;
}
ESP_LOGI ( GATTC_TAG , " Stop adv successfully " ) ;
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 )
{
//ESP_LOGI(GATTC_TAG, "EVT %d, gattc if %d, app_id %d", event, gattc_if, param->reg.app_id);
/* 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 ( GATTC_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 ) ;
2017-12-12 02:24:43 -05:00
ESP_ERROR_CHECK ( esp_bt_controller_mem_release ( ESP_BT_MODE_CLASSIC_BT ) ) ;
2017-07-17 04:57:17 -04:00
esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT ( ) ;
ret = esp_bt_controller_init ( & bt_cfg ) ;
if ( ret ) {
2018-02-22 08:48:53 -05:00
ESP_LOGE ( GATTC_TAG , " %s initialize controller failed: %s \n " , __func__ , esp_err_to_name ( ret ) ) ;
2017-07-17 04:57:17 -04:00
return ;
}
2017-12-12 02:24:43 -05:00
ret = esp_bt_controller_enable ( ESP_BT_MODE_BLE ) ;
2017-07-17 04:57:17 -04:00
if ( ret ) {
2018-02-22 08:48:53 -05:00
ESP_LOGE ( GATTC_TAG , " %s enable controller failed: %s \n " , __func__ , esp_err_to_name ( ret ) ) ;
2017-07-17 04:57:17 -04:00
return ;
}
ret = esp_bluedroid_init ( ) ;
if ( ret ) {
2018-02-22 08:48:53 -05:00
ESP_LOGE ( GATTC_TAG , " %s init bluetooth failed: %s \n " , __func__ , esp_err_to_name ( ret ) ) ;
2017-07-17 04:57:17 -04:00
return ;
}
ret = esp_bluedroid_enable ( ) ;
if ( ret ) {
2018-02-22 08:48:53 -05:00
ESP_LOGE ( GATTC_TAG , " %s enable bluetooth failed: %s \n " , __func__ , esp_err_to_name ( ret ) ) ;
2017-07-17 04:57:17 -04:00
return ;
}
//register the callback function to the gap module
ret = esp_ble_gap_register_callback ( esp_gap_cb ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " gap register error, error code = %x " , ret ) ;
return ;
}
//register the callback function to the gattc module
ret = esp_ble_gattc_register_callback ( esp_gattc_cb ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " gattc register error, error code = %x " , ret ) ;
return ;
}
ret = esp_ble_gattc_app_register ( PROFILE_A_APP_ID ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " gattc app register error, error code = %x " , ret ) ;
return ;
}
ret = esp_ble_gattc_app_register ( PROFILE_B_APP_ID ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " gattc app register error, error code = %x " , ret ) ;
return ;
}
ret = esp_ble_gattc_app_register ( PROFILE_C_APP_ID ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " gattc app register error, error code = %x " , ret ) ;
return ;
}
2017-08-24 07:54:41 -04:00
ret = esp_ble_gatt_set_local_mtu ( 200 ) ;
if ( ret ) {
ESP_LOGE ( GATTC_TAG , " set local MTU failed, error code = %x " , ret ) ;
}
2017-07-17 04:57:17 -04:00
}
