#include "sdkconfig.h"
#if defined(CONFIG_BT_ENABLED)
#include "BLEUtils.h"
#include "BLEUUID.h"
#include "BLEClient.h"
#include "BLEAddress.h"
#include "GeneralUtils.h"
#include <freertos/FreeRTOS.h>
#include <freertos/event_groups.h>
#include <bt.h>
#include <esp_bt_main.h>
#include <esp_gap_ble_api.h>
#include <esp_gattc_api.h>
#include <esp_err.h>
#include <esp_log.h>
#include <map>
#include <sstream>
#include <iomanip>
static const char* LOG_TAG = "BLEUtils";
typedef struct {
uint32_t assignedNumber;
std::string name;
} characteristicMap_t;
static characteristicMap_t g_characteristicsMappings[] = {
{0x2a00, "Device Name"},
{0x2a01, "Appearance"},
{0, ""}
};
typedef struct {
std::string name;
std::string type;
uint32_t assignedNumber;
} gattService_t;
static const gattService_t g_gattServices[] = {
{"Alert Notification Service", "org.bluetooth.service.alert_notification", 0x1811},
{"Automation IO", "org.bluetooth.service.automation_io", 0x1815 },
{"Battery Service","org.bluetooth.service.battery_service", 0x180F},
{"Blood Pressure", "org.bluetooth.service.blood_pressure", 0x1810},
{"Body Composition", "org.bluetooth.service.body_composition", 0x181B},
{"Bond Management", "org.bluetooth.service.bond_management", 0x181E},
{"Continuous Glucose Monitoring", "org.bluetooth.service.continuous_glucose_monitoring", 0x181F},
{"Current Time Service", "org.bluetooth.service.current_time", 0x1805},
{"Cycling Power", "org.bluetooth.service.cycling_power", 0x1818},
{"Cycling Speed and Cadence", "org.bluetooth.service.cycling_speed_and_cadence", 0x1816},
{"Device Information", "org.bluetooth.service.device_information", 0x180A},
{"Environmental Sensing", "org.bluetooth.service.environmental_sensing", 0x181A},
{"Generic Access", "org.bluetooth.service.generic_access", 0x1800},
{"Generic Attribute", "org.bluetooth.service.generic_attribute", 0x1801},
{"Glucose", "org.bluetooth.service.glucose", 0x1808},
{"Health Thermometer", "org.bluetooth.service.health_thermometer", 0x1809},
{"Heart Rate", "org.bluetooth.service.heart_rate", 0x180D},
{"HTTP Proxy", "org.bluetooth.service.http_proxy", 0x1823},
{"Human Interface Device", "org.bluetooth.service.human_interface_device", 0x1812},
{"Immediate Alert", "org.bluetooth.service.immediate_alert", 0x1802},
{"Indoor Positioning", "org.bluetooth.service.indoor_positioning", 0x1821},
{"Internet Protocol Support", "org.bluetooth.service.internet_protocol_support", 0x1820},
{"Link Loss", "org.bluetooth.service.link_loss", 0x1803},
{"Location and Navigation", "org.bluetooth.service.location_and_navigation", 0x1819},
{"Next DST Change Service", "org.bluetooth.service.next_dst_change", 0x1807},
{"Object Transfer", "org.bluetooth.service.object_transfer", 0x1825},
{"Phone Alert Status Service", "org.bluetooth.service.phone_alert_status", 0x180E},
{"Pulse Oximeter", "org.bluetooth.service.pulse_oximeter", 0x1822},
{"Reference Time Update Service", "org.bluetooth.service.reference_time_update", 0x1806},
{"Running Speed and Cadence", "org.bluetooth.service.running_speed_and_cadence", 0x1814},
{"Scan Parameters", "org.bluetooth.service.scan_parameters", 0x1813},
{"Transport Discovery", "org.bluetooth.service.transport_discovery", 0x1824},
{"Tx Power", "org.bluetooth.service.tx_power", 0x1804},
{"User Data", "org.bluetooth.service.user_data", 0x181C},
{"Weight Scale", "org.bluetooth.service.weight_scale", 0x181D},
{"", "", 0 }
};
std::string BLEUtils::characteristicPropertiesToString(esp_gatt_char_prop_t prop) {
std::stringstream stream;
stream <<
"broadcast: " << ((prop & ESP_GATT_CHAR_PROP_BIT_BROADCAST)?"1":"0") <<
", read: " << ((prop & ESP_GATT_CHAR_PROP_BIT_READ)?"1":"0") <<
", write_nr: " << ((prop & ESP_GATT_CHAR_PROP_BIT_WRITE_NR)?"1":"0") <<
", write: " << ((prop & ESP_GATT_CHAR_PROP_BIT_WRITE)?"1":"0") <<
", notify: " << ((prop & ESP_GATT_CHAR_PROP_BIT_NOTIFY)?"1":"0") <<
", indicate: " << ((prop & ESP_GATT_CHAR_PROP_BIT_INDICATE)?"1":"0") <<
", auth: " << ((prop & ESP_GATT_CHAR_PROP_BIT_AUTH)?"1":"0");
return stream.str();
}
static std::string gattIdToString(esp_gatt_id_t gattId) {
std::stringstream stream;
stream << "uuid: " << BLEUUID(gattId.uuid).toString() << ", inst_id: " << (int)gattId.inst_id;
return stream.str();
}
const char* BLEUtils::addressTypeToString(esp_ble_addr_type_t type) {
switch(type) {
case BLE_ADDR_TYPE_PUBLIC:
return "BLE_ADDR_TYPE_PUBLIC";
case BLE_ADDR_TYPE_RANDOM:
return "BLE_ADDR_TYPE_RANDOM";
case BLE_ADDR_TYPE_RPA_PUBLIC:
return "BLE_ADDR_TYPE_RPA_PUBLIC";
case BLE_ADDR_TYPE_RPA_RANDOM:
return "BLE_ADDR_TYPE_RPA_RANDOM";
default:
return "Unknown addr_t";
}
}
const char* BLEUtils::advTypeToString(uint8_t advType) {
switch(advType) {
case ESP_BLE_AD_TYPE_FLAG:
return "ESP_BLE_AD_TYPE_FLAG";
case ESP_BLE_AD_TYPE_16SRV_PART:
return "ESP_BLE_AD_TYPE_16SRV_PART";
case ESP_BLE_AD_TYPE_16SRV_CMPL:
return "ESP_BLE_AD_TYPE_16SRV_CMPL";
case ESP_BLE_AD_TYPE_32SRV_PART:
return "ESP_BLE_AD_TYPE_32SRV_PART";
case ESP_BLE_AD_TYPE_32SRV_CMPL:
return "ESP_BLE_AD_TYPE_32SRV_CMPL";
case ESP_BLE_AD_TYPE_128SRV_PART:
return "ESP_BLE_AD_TYPE_128SRV_PART";
case ESP_BLE_AD_TYPE_128SRV_CMPL:
return "ESP_BLE_AD_TYPE_128SRV_CMPL";
case ESP_BLE_AD_TYPE_NAME_SHORT:
return "ESP_BLE_AD_TYPE_NAME_SHORT";
case ESP_BLE_AD_TYPE_NAME_CMPL:
return "ESP_BLE_AD_TYPE_NAME_CMPL";
case ESP_BLE_AD_TYPE_TX_PWR:
return "ESP_BLE_AD_TYPE_TX_PWR";
case ESP_BLE_AD_TYPE_DEV_CLASS:
return "ESP_BLE_AD_TYPE_DEV_CLASS";
case ESP_BLE_AD_TYPE_SM_TK:
return "ESP_BLE_AD_TYPE_SM_TK";
case ESP_BLE_AD_TYPE_SM_OOB_FLAG:
return "ESP_BLE_AD_TYPE_SM_OOB_FLAG";
case ESP_BLE_AD_TYPE_INT_RANGE:
return "ESP_BLE_AD_TYPE_INT_RANGE";
case ESP_BLE_AD_TYPE_SOL_SRV_UUID:
return "ESP_BLE_AD_TYPE_SOL_SRV_UUID";
case ESP_BLE_AD_TYPE_128SOL_SRV_UUID:
return "ESP_BLE_AD_TYPE_128SOL_SRV_UUID";
case ESP_BLE_AD_TYPE_SERVICE_DATA:
return "ESP_BLE_AD_TYPE_SERVICE_DATA";
case ESP_BLE_AD_TYPE_PUBLIC_TARGET:
return "ESP_BLE_AD_TYPE_PUBLIC_TARGET";
case ESP_BLE_AD_TYPE_RANDOM_TARGET:
return "ESP_BLE_Amap1D_TYPE_RANDOM_TARGET";
case ESP_BLE_AD_TYPE_APPEARANCE:
return "ESP_BLE_AD_TYPE_APPEARANCE";
case ESP_BLE_AD_TYPE_ADV_INT:
return "ESP_BLE_AD_TYPE_ADV_INT";
case ESP_BLE_AD_TYPE_32SOL_SRV_UUID:
return "ESP_BLE_AD_TYPE_32SOL_SRV_UUID";
case ESP_BLE_AD_TYPE_32SERVICE_DATA:
return "ESP_BLE_AD_TYPE_32SERVICE_DATA";
case ESP_BLE_AD_TYPE_128SERVICE_DATA:
return "ESP_BLE_AD_TYPE_128SERVICE_DATA";
case ESP_BLE_AD_MANUFACTURER_SPECIFIC_TYPE:
return "ESP_BLE_AD_MANUFACTURER_SPECIFIC_TYPE";
default:
ESP_LOGD(LOG_TAG, "Unknown adv data type: 0x%x", advType);
return "Unknown";
}
}
esp_gatt_id_t BLEUtils::buildGattId(esp_bt_uuid_t uuid, uint8_t inst_id) {
esp_gatt_id_t retGattId;
retGattId.uuid = uuid;
retGattId.inst_id = inst_id;
return retGattId;
}
esp_gatt_srvc_id_t BLEUtils::buildGattSrvcId(esp_gatt_id_t gattId,
bool is_primary) {
esp_gatt_srvc_id_t retSrvcId;
retSrvcId.id = gattId;
retSrvcId.is_primary = is_primary;
return retSrvcId;
}
char *BLEUtils::buildHexData(uint8_t *target, uint8_t *source, uint8_t length) {
if (length > 100) {
length = 100;
}
if (target == nullptr) {
target = (uint8_t *)malloc(length * 2 + 1);
if (target == nullptr) {
ESP_LOGE(LOG_TAG, "buildHexData: malloc failed");
return nullptr;
}
}
char *startOfData = (char *)target;
int i;
for (i=0; i<length; i++) {
sprintf((char *)target, "%.2x", (char)*source);
source++;
target +=2;
}
if (length == 0) {
*startOfData = 0;
}
return startOfData;
}
std::string BLEUtils::buildPrintData(uint8_t* source, size_t length) {
std::ostringstream ss;
for (int i=0; i<length; i++) {
char c = *source;
if (isprint(c)) {
ss << c;
} else {
ss << '.';
}
source++;
}
return ss.str();
}
std::string BLEUtils::gattCloseReasonToString(esp_gatt_conn_reason_t reason) {
switch(reason) {
case ESP_GATT_CONN_UNKNOWN:
return "ESP_GATT_CONN_UNKNOWN";
case ESP_GATT_CONN_L2C_FAILURE:
return "ESP_GATT_CONN_L2C_FAILURE";
case ESP_GATT_CONN_TIMEOUT:
return "ESP_GATT_CONN_TIMEOUT";
case ESP_GATT_CONN_TERMINATE_PEER_USER:
return "ESP_GATT_CONN_TERMINATE_PEER_USER";
case ESP_GATT_CONN_TERMINATE_LOCAL_HOST:
return "ESP_GATT_CONN_TERMINATE_LOCAL_HOST";
case ESP_GATT_CONN_FAIL_ESTABLISH:
return "ESP_GATT_CONN_FAIL_ESTABLISH";
case ESP_GATT_CONN_LMP_TIMEOUT:
return "ESP_GATT_CONN_LMP_TIMEOUT";
case ESP_GATT_CONN_CONN_CANCEL:
return "ESP_GATT_CONN_CONN_CANCEL";
case ESP_GATT_CONN_NONE:
return "ESP_GATT_CONN_NONE";
default:
return "Unknown";
}
}
std::string BLEUtils::gattClientEventTypeToString(esp_gattc_cb_event_t eventType) {
switch(eventType) {
case ESP_GATTC_ACL_EVT:
return "ESP_GATTC_ACL_EVT";
case ESP_GATTC_ADV_DATA_EVT:
return "ESP_GATTC_ADV_DATA_EVT";
case ESP_GATTC_ADV_VSC_EVT:
return "ESP_GATTC_ADV_VSC_EVT";
case ESP_GATTC_BTH_SCAN_CFG_EVT:
return "ESP_GATTC_BTH_SCAN_CFG_EVT";
case ESP_GATTC_BTH_SCAN_DIS_EVT:
return "ESP_GATTC_BTH_SCAN_DIS_EVT";
case ESP_GATTC_BTH_SCAN_ENB_EVT:
return "ESP_GATTC_BTH_SCAN_ENB_EVT";
case ESP_GATTC_BTH_SCAN_PARAM_EVT:
return "ESP_GATTC_BTH_SCAN_PARAM_EVT";
case ESP_GATTC_BTH_SCAN_RD_EVT:
return "ESP_GATTC_BTH_SCAN_RD_EVT";
case ESP_GATTC_BTH_SCAN_THR_EVT:
return "ESP_GATTC_BTH_SCAN_THR_EVT";
case ESP_GATTC_CANCEL_OPEN_EVT:
return "ESP_GATTC_CANCEL_OPEN_EVT";
case ESP_GATTC_CFG_MTU_EVT:
return "ESP_GATTC_CFG_MTU_EVT";
case ESP_GATTC_CLOSE_EVT:
return "ESP_GATTC_CLOSE_EVT";
case ESP_GATTC_CONGEST_EVT:
return "ESP_GATTC_CONGEST_EVT";
case ESP_GATTC_CONNECT_EVT:
return "ESP_GATTC_CONNECT_EVT";
case ESP_GATTC_DISCONNECT_EVT:
return "ESP_GATTC_DISCONNECT_EVT";
case ESP_GATTC_ENC_CMPL_CB_EVT:
return "ESP_GATTC_ENC_CMPL_CB_EVT";
case ESP_GATTC_EXEC_EVT:
return "ESP_GATTC_EXEC_EVT";
case ESP_GATTC_GET_CHAR_EVT:
return "ESP_GATTC_GET_CHAR_EVT";
case ESP_GATTC_GET_DESCR_EVT:
return "ESP_GATTC_GET_DESCR_EVT";
case ESP_GATTC_GET_INCL_SRVC_EVT:
return "ESP_GATTC_GET_INCL_SRVC_EVT";
case ESP_GATTC_MULT_ADV_DATA_EVT:
return "ESP_GATTC_MULT_ADV_DATA_EVT";
case ESP_GATTC_MULT_ADV_DIS_EVT:
return "ESP_GATTC_MULT_ADV_DIS_EVT";
case ESP_GATTC_MULT_ADV_ENB_EVT:
return "ESP_GATTC_MULT_ADV_ENB_EVT";
case ESP_GATTC_MULT_ADV_UPD_EVT:
return "ESP_GATTC_MULT_ADV_UPD_EVT";
case ESP_GATTC_NOTIFY_EVT:
return "ESP_GATTC_NOTIFY_EVT";
case ESP_GATTC_OPEN_EVT:
return "ESP_GATTC_OPEN_EVT";
case ESP_GATTC_PREP_WRITE_EVT:
return "ESP_GATTC_PREP_WRITE_EVT";
case ESP_GATTC_READ_CHAR_EVT:
return "ESP_GATTC_READ_CHAR_EVT";
case ESP_GATTC_REG_EVT:
return "ESP_GATTC_REG_EVT";
case ESP_GATTC_REG_FOR_NOTIFY_EVT:
return "ESP_GATTC_REG_FOR_NOTIFY_EVT";
case ESP_GATTC_SCAN_FLT_CFG_EVT:
return "ESP_GATTC_SCAN_FLT_CFG_EVT";
case ESP_GATTC_SCAN_FLT_PARAM_EVT:
return "ESP_GATTC_SCAN_FLT_PARAM_EVT";
case ESP_GATTC_SCAN_FLT_STATUS_EVT:
return "ESP_GATTC_SCAN_FLT_STATUS_EVT";
case ESP_GATTC_SEARCH_CMPL_EVT:
return "ESP_GATTC_SEARCH_CMPL_EVT";
case ESP_GATTC_SEARCH_RES_EVT:
return "ESP_GATTC_SEARCH_RES_EVT";
case ESP_GATTC_SRVC_CHG_EVT:
return "ESP_GATTC_SRVC_CHG_EVT";
case ESP_GATTC_READ_DESCR_EVT:
return "ESP_GATTC_READ_DESCR_EVT";
case ESP_GATTC_UNREG_EVT:
return "ESP_GATTC_UNREG_EVT";
case ESP_GATTC_UNREG_FOR_NOTIFY_EVT:
return "ESP_GATTC_UNREG_FOR_NOTIFY_EVT";
case ESP_GATTC_WRITE_CHAR_EVT:
return "ESP_GATTC_WRITE_CHAR_EVT";
case ESP_GATTC_WRITE_DESCR_EVT:
return "ESP_GATTC_WRITE_DESCR_EVT";
default:
ESP_LOGW(LOG_TAG, "Unknown GATT Client event type: %d", eventType);
return "Unknown";
}
}
std::string BLEUtils::gattServerEventTypeToString(esp_gatts_cb_event_t eventType) {
switch(eventType) {
case ESP_GATTS_REG_EVT:
return "ESP_GATTS_REG_EVT";
case ESP_GATTS_READ_EVT:
return "ESP_GATTS_READ_EVT";
case ESP_GATTS_WRITE_EVT:
return "ESP_GATTS_WRITE_EVT";
case ESP_GATTS_EXEC_WRITE_EVT:
return "ESP_GATTS_EXEC_WRITE_EVT";
case ESP_GATTS_MTU_EVT:
return "ESP_GATTS_MTU_EVT";
case ESP_GATTS_CONF_EVT:
return "ESP_GATTS_CONF_EVT";
case ESP_GATTS_UNREG_EVT:
return "ESP_GATTS_UNREG_EVT";
case ESP_GATTS_CREATE_EVT:
return "ESP_GATTS_CREATE_EVT";
case ESP_GATTS_ADD_INCL_SRVC_EVT:
return "ESP_GATTS_ADD_INCL_SRVC_EVT";
case ESP_GATTS_ADD_CHAR_EVT:
return "ESP_GATTS_ADD_CHAR_EVT";
case ESP_GATTS_ADD_CHAR_DESCR_EVT:
return "ESP_GATTS_ADD_CHAR_DESCR_EVT";
case ESP_GATTS_DELETE_EVT:
return "ESP_GATTS_DELETE_EVT";
case ESP_GATTS_START_EVT:
return "ESP_GATTS_START_EVT";
case ESP_GATTS_STOP_EVT:
return "ESP_GATTS_STOP_EVT";
case ESP_GATTS_CONNECT_EVT:
return "ESP_GATTS_CONNECT_EVT";
case ESP_GATTS_DISCONNECT_EVT:
return "ESP_GATTS_DISCONNECT_EVT";
case ESP_GATTS_OPEN_EVT:
return "ESP_GATTS_OPEN_EVT";
case ESP_GATTS_CANCEL_OPEN_EVT:
return "ESP_GATTS_CANCEL_OPEN_EVT";
case ESP_GATTS_CLOSE_EVT:
return "ESP_GATTS_CLOSE_EVT";
case ESP_GATTS_LISTEN_EVT:
return "ESP_GATTS_LISTEN_EVT";
case ESP_GATTS_CONGEST_EVT:
return "ESP_GATTS_CONGEST_EVT";
case ESP_GATTS_RESPONSE_EVT:
return "ESP_GATTS_RESPONSE_EVT";
case ESP_GATTS_CREAT_ATTR_TAB_EVT:
return "ESP_GATTS_CREAT_ATTR_TAB_EVT";
case ESP_GATTS_SET_ATTR_VAL_EVT:
return "ESP_GATTS_SET_ATTR_VAL_EVT";
}
return "Unknown";
}
const char* BLEUtils::devTypeToString(esp_bt_dev_type_t type) {
switch(type) {
case ESP_BT_DEVICE_TYPE_BREDR:
return "ESP_BT_DEVICE_TYPE_BREDR";
case ESP_BT_DEVICE_TYPE_BLE:
return "ESP_BT_DEVICE_TYPE_BLE";
case ESP_BT_DEVICE_TYPE_DUMO:
return "ESP_BT_DEVICE_TYPE_DUMO";
default:
return "Unknown";
}
}
void BLEUtils::dumpGapEvent(
esp_gap_ble_cb_event_t event,
esp_ble_gap_cb_param_t *param) {
ESP_LOGD(LOG_TAG, "Received a GAP event: %s", gapEventToString(event));
switch(event) {
case ESP_GAP_BLE_ADV_DATA_SET_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_rsp_data_cmpl.status);
break;
}
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_start_cmpl.status);
break;
}
case ESP_GAP_BLE_ADV_STOP_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_stop_cmpl.status);
break;
}
case ESP_GAP_BLE_AUTH_CMPL_EVT: {
ESP_LOGD(LOG_TAG, "[bd_addr: %s, key_present: %d, key: ***, key_type: %d, success: %d, fail_reason: %d, addr_type: ***, dev_type: %s]",
BLEAddress(param->ble_security.auth_cmpl.bd_addr).toString().c_str(),
param->ble_security.auth_cmpl.key_present,
param->ble_security.auth_cmpl.key_type,
param->ble_security.auth_cmpl.success,
param->ble_security.auth_cmpl.fail_reason,
BLEUtils::devTypeToString(param->ble_security.auth_cmpl.dev_type)
);
break;
}
case ESP_GAP_BLE_LOCAL_IR_EVT: {
break;
}
case ESP_GAP_BLE_LOCAL_ER_EVT: {
break;
}
case ESP_GAP_BLE_NC_REQ_EVT: {
ESP_LOGD(LOG_TAG, "[bd_addr: %s, passkey: %d]",
BLEAddress(param->ble_security.key_notif.bd_addr).toString().c_str(),
param->ble_security.key_notif.passkey);
break;
}
case ESP_GAP_BLE_SCAN_PARAM_SET_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_param_cmpl.status);
break;
}
case ESP_GAP_BLE_SCAN_RESULT_EVT: {
switch(param->scan_rst.search_evt) {
case ESP_GAP_SEARCH_INQ_RES_EVT: {
ESP_LOGD(LOG_TAG, "search_evt: %s, bda: %s, dev_type: %s, ble_addr_type: %s, ble_evt_type: %s, rssi: %d, ble_adv: ??, flag: %d, num_resps: %d, adv_data_len: %d, scan_rsp_len: %d",
searchEventTypeToString(param->scan_rst.search_evt),
BLEAddress(param->scan_rst.bda).toString().c_str(),
devTypeToString(param->scan_rst.dev_type),
addressTypeToString(param->scan_rst.ble_addr_type),
eventTypeToString(param->scan_rst.ble_evt_type),
param->scan_rst.rssi,
param->scan_rst.flag,
param->scan_rst.num_resps,
param->scan_rst.adv_data_len,
param->scan_rst.scan_rsp_len
);
break;
}
default: {
ESP_LOGD(LOG_TAG, "search_evt: %s",searchEventTypeToString(param->scan_rst.search_evt));
break;
}
}
break;
}
case ESP_GAP_BLE_SCAN_START_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_start_cmpl.status);
break;
}
case ESP_GAP_BLE_SEC_REQ_EVT: {
ESP_LOGD(LOG_TAG, "[bd_addr: %s]", BLEAddress(param->ble_security.ble_req.bd_addr).toString().c_str());
break;
}
case ESP_GAP_BLE_SCAN_STOP_COMPLETE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %d]", param->scan_stop_cmpl.status);
break;
}
default: {
ESP_LOGD(LOG_TAG, "*** dumpGapEvent: Logger not coded ***");
break;
}
}
}
void BLEUtils::dumpGattClientEvent(
esp_gattc_cb_event_t event,
esp_gatt_if_t gattc_if,
esp_ble_gattc_cb_param_t *evtParam) {
ESP_LOGD(LOG_TAG, "GATT Event: %s", BLEUtils::gattClientEventTypeToString(event).c_str());
switch(event) {
case ESP_GATTC_CLOSE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, reason:%s, conn_id: %d]",
BLEUtils::gattStatusToString(evtParam->close.status).c_str(),
BLEUtils::gattCloseReasonToString(evtParam->close.reason).c_str(),
evtParam->close.conn_id);
break;
}
case ESP_GATTC_CONNECT_EVT: {
ESP_LOGD(LOG_TAG, "[staus: %s, conn_id: %d, remote_bda: %s]",
BLEUtils::gattStatusToString(evtParam->connect.status).c_str(),
evtParam->connect.conn_id,
BLEAddress(evtParam->connect.remote_bda).toString().c_str()
);
break;
}
case ESP_GATTC_DISCONNECT_EVT: {
ESP_LOGD(LOG_TAG, "[staus: %s, conn_id: %d, remote_bda: %s]",
BLEUtils::gattStatusToString(evtParam->disconnect.status).c_str(),
evtParam->disconnect.conn_id,
BLEAddress(evtParam->disconnect.remote_bda).toString().c_str()
);
break;
}
case ESP_GATTC_GET_CHAR_EVT: {
if (evtParam->get_char.status == ESP_GATT_OK) {
std::string description = "Unknown";
if (evtParam->get_char.char_id.uuid.len == ESP_UUID_LEN_16) {
description = BLEUtils::gattCharacteristicUUIDToString(evtParam->get_char.char_id.uuid.uuid.uuid16);
}
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d, srvc_id: %s, char_id: %s [description: %s]\nchar_prop: %s]",
BLEUtils::gattStatusToString(evtParam->get_char.status).c_str(),
evtParam->get_char.conn_id,
BLEUtils::gattServiceIdToString(evtParam->get_char.srvc_id).c_str(),
gattIdToString(evtParam->get_char.char_id).c_str(),
description.c_str(),
BLEUtils::characteristicPropertiesToString(evtParam->get_char.char_prop).c_str()
);
} else {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d, srvc_id: %s]",
BLEUtils::gattStatusToString(evtParam->get_char.status).c_str(),
evtParam->get_char.conn_id,
BLEUtils::gattServiceIdToString(evtParam->get_char.srvc_id).c_str()
);
}
break;
}
case ESP_GATTC_NOTIFY_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, remote_bda: %s, srvc_id: <%s>, char_id: <%s>, descr_id: <%s>, value_len: %d, is_notify: %d]",
evtParam->notify.conn_id,
BLEAddress(evtParam->notify.remote_bda).toString().c_str(),
BLEUtils::gattServiceIdToString(evtParam->notify.srvc_id).c_str(),
gattIdToString(evtParam->notify.char_id).c_str(),
gattIdToString(evtParam->notify.descr_id).c_str(),
evtParam->notify.value_len,
evtParam->notify.is_notify
);
break;
}
case ESP_GATTC_OPEN_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d, remote_bda: %s, mtu: %d]",
BLEUtils::gattStatusToString(evtParam->open.status).c_str(),
evtParam->open.conn_id,
BLEAddress(evtParam->open.remote_bda).toString().c_str(),
evtParam->open.mtu);
break;
}
case ESP_GATTC_READ_CHAR_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d, srvc_id: <%s>, char_id: <%s>, descr_id: <%s>, value_type: 0x%x, value_len: %d]",
BLEUtils::gattStatusToString(evtParam->read.status).c_str(),
evtParam->read.conn_id,
BLEUtils::gattServiceIdToString(evtParam->read.srvc_id).c_str(),
gattIdToString(evtParam->read.char_id).c_str(),
gattIdToString(evtParam->read.descr_id).c_str(),
evtParam->read.value_type,
evtParam->read.value_len
);
if (evtParam->read.status == ESP_GATT_OK) {
GeneralUtils::hexDump(evtParam->read.value, evtParam->read.value_len);
}
break;
}
case ESP_GATTC_REG_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, app_id: 0x%x]",
BLEUtils::gattStatusToString(evtParam->reg.status).c_str(),
evtParam->reg.app_id);
break;
}
case ESP_GATTC_REG_FOR_NOTIFY_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, srvc_id: <%s>, char_id: <%s>]",
BLEUtils::gattStatusToString(evtParam->reg_for_notify.status).c_str(),
BLEUtils::gattServiceIdToString(evtParam->reg_for_notify.srvc_id).c_str(),
gattIdToString(evtParam->reg_for_notify.char_id).c_str());
break;
}
case ESP_GATTC_SEARCH_CMPL_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d]",
BLEUtils::gattStatusToString(evtParam->search_cmpl.status).c_str(),
evtParam->search_cmpl.conn_id);
break;
}
case ESP_GATTC_SEARCH_RES_EVT: {
std::string name = "";
if (evtParam->search_res.srvc_id.id.uuid.len == ESP_UUID_LEN_16) {
name = BLEUtils::gattServiceToString(evtParam->search_res.srvc_id.id.uuid.uuid.uuid16);
}
if (name.length() == 0) {
name = "<Unknown Service>";
}
ESP_LOGD(LOG_TAG, "[srvc_id: %s [%s], instanceId: 0x%.2x conn_id: %d]",
BLEUtils::gattServiceIdToString(evtParam->search_res.srvc_id).c_str(),
name.c_str(),
evtParam->search_res.srvc_id.id.inst_id,
evtParam->search_res.conn_id);
break;
}
case ESP_GATTC_WRITE_CHAR_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: %d, srvc_id: <%s>, char_id: <%s>, descr_id: <%s>]",
BLEUtils::gattStatusToString(evtParam->write.status).c_str(),
evtParam->write.conn_id,
BLEUtils::gattServiceIdToString(evtParam->write.srvc_id).c_str(),
gattIdToString(evtParam->write.char_id).c_str(),
gattIdToString(evtParam->write.descr_id).c_str()
);
break;
}
default:
break;
}
}
void BLEUtils::dumpGattServerEvent(
esp_gatts_cb_event_t event,
esp_gatt_if_t gatts_if,
esp_ble_gatts_cb_param_t *evtParam) {
ESP_LOGD(LOG_TAG, "GATT ServerEvent: %s", BLEUtils::gattServerEventTypeToString(event).c_str());
switch(event) {
case ESP_GATTS_ADD_CHAR_DESCR_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, attr_handle: 0x%.2x, service_handle: 0x%.2x, char_uuid: %s]",
gattStatusToString(evtParam->add_char_descr.status).c_str(),
evtParam->add_char_descr.attr_handle,
evtParam->add_char_descr.service_handle,
BLEUUID(evtParam->add_char_descr.char_uuid).toString().c_str());
break;
}
case ESP_GATTS_ADD_CHAR_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, attr_handle: 0x%.2x, service_handle: 0x%.2x, char_uuid: %s]",
gattStatusToString(evtParam->add_char.status).c_str(),
evtParam->add_char.attr_handle,
evtParam->add_char.service_handle,
BLEUUID(evtParam->add_char.char_uuid).toString().c_str());
break;
}
case ESP_GATTS_CONF_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, conn_id: 0x%.2x]",
gattStatusToString(evtParam->conf.status).c_str(),
evtParam->conf.conn_id);
break;
}
case ESP_GATTS_CONGEST_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, congested: %d]",
evtParam->congest.conn_id,
evtParam->congest.congested);
break;
}
case ESP_GATTS_CONNECT_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, remote_bda: %s, is_connected: %d]",
evtParam->connect.conn_id,
BLEAddress(evtParam->connect.remote_bda).toString().c_str(),
evtParam->connect.is_connected);
break;
}
case ESP_GATTS_CREATE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, service_handle: 0x%.2x, service_id: [%s]]",
gattStatusToString(evtParam->create.status).c_str(),
evtParam->create.service_handle,
gattServiceIdToString(evtParam->create.service_id).c_str());
break;
}
case ESP_GATTS_DISCONNECT_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, remote_bda: %s, is_connected: %d]",
evtParam->connect.conn_id,
BLEAddress(evtParam->connect.remote_bda).toString().c_str(),
evtParam->connect.is_connected);
break;
}
case ESP_GATTS_EXEC_WRITE_EVT: {
char* pWriteFlagText;
switch(evtParam->exec_write.exec_write_flag) {
case ESP_GATT_PREP_WRITE_EXEC: {
pWriteFlagText = (char*)"WRITE";
break;
}
case ESP_GATT_PREP_WRITE_CANCEL: {
pWriteFlagText = (char*)"CANCEL";
break;
}
default:
pWriteFlagText = (char*)"<Unknown>";
break;
}
ESP_LOGD(LOG_TAG, "[conn_id: %d, trans_id: %d, bda: %s, exec_write_flag: 0x%.2x=%s]",
evtParam->exec_write.conn_id,
evtParam->exec_write.trans_id,
BLEAddress(evtParam->exec_write.bda).toString().c_str(),
evtParam->exec_write.exec_write_flag,
pWriteFlagText);
break;
}
case ESP_GATTS_MTU_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, mtu: %d]",
evtParam->mtu.conn_id,
evtParam->mtu.mtu);
break;
}
case ESP_GATTS_READ_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, trans_id: %d, bda: %s, handle: 0x%.2x, is_long: %d, need_rsp:%d]",
evtParam->read.conn_id,
evtParam->read.trans_id,
BLEAddress(evtParam->read.bda).toString().c_str(),
evtParam->read.handle,
evtParam->read.is_long,
evtParam->read.need_rsp);
break;
}
case ESP_GATTS_RESPONSE_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, handle: 0x%.2x]",
gattStatusToString(evtParam->rsp.status).c_str(),
evtParam->rsp.handle);
break;
}
case ESP_GATTS_REG_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, app_id: %d]",
gattStatusToString(evtParam->reg.status).c_str(),
evtParam->reg.app_id);
break;
}
case ESP_GATTS_START_EVT: {
ESP_LOGD(LOG_TAG, "[status: %s, service_handle: 0x%.2x]",
gattStatusToString(evtParam->start.status).c_str(),
evtParam->start.service_handle);
break;
}
case ESP_GATTS_WRITE_EVT: {
ESP_LOGD(LOG_TAG, "[conn_id: %d, trans_id: %d, bda: %s, handle: 0x%.2x, offset: %d, need_rsp: %d, is_prep: %d, len: %d]",
evtParam->write.conn_id,
evtParam->write.trans_id,
BLEAddress(evtParam->write.bda).toString().c_str(),
evtParam->write.handle,
evtParam->write.offset,
evtParam->write.need_rsp,
evtParam->write.is_prep,
evtParam->write.len);
char *pHex = buildHexData(nullptr, evtParam->write.value, evtParam->write.len);
ESP_LOGD(LOG_TAG, "[Data: %s]", pHex);
free(pHex);
break;
}
default:
ESP_LOGD(LOG_TAG, "dumpGattServerEvent: *** NOT CODED ***");
break;
}
}
const char* BLEUtils::eventTypeToString(esp_ble_evt_type_t eventType) {
switch(eventType) {
case ESP_BLE_EVT_CONN_ADV:
return "ESP_BLE_EVT_CONN_ADV";
case ESP_BLE_EVT_CONN_DIR_ADV:
return "ESP_BLE_EVT_CONN_DIR_ADV";
case ESP_BLE_EVT_DISC_ADV:
return "ESP_BLE_EVT_DISC_ADV";
case ESP_BLE_EVT_NON_CONN_ADV:
return "ESP_BLE_EVT_NON_CONN_ADV";
case ESP_BLE_EVT_SCAN_RSP:
return "ESP_BLE_EVT_SCAN_RSP";
default:
ESP_LOGD(LOG_TAG, "Unknown esp_ble_evt_type_t: %d", eventType);
return "*** Unknown ***";
}
}
const char* BLEUtils::gapEventToString(uint32_t eventType) {
switch(eventType) {
case ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT:
return "ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT";
case ESP_GAP_BLE_ADV_DATA_SET_COMPLETE_EVT:
return "ESP_GAP_BLE_ADV_DATA_SET_COMPLETE_EVT";
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT:
return "ESP_GAP_BLE_ADV_START_COMPLETE_EVT";
case ESP_GAP_BLE_SCAN_PARAM_SET_COMPLETE_EVT:
return "ESP_GAP_BLE_SCAN_PARAM_SET_COMPLETE_EVT";
case ESP_GAP_BLE_SCAN_RESULT_EVT:
return "ESP_GAP_BLE_SCAN_RESULT_EVT";
case ESP_GAP_BLE_SCAN_RSP_DATA_RAW_SET_COMPLETE_EVT:
return "ESP_GAP_BLE_SCAN_RSP_DATA_RAW_SET_COMPLETE_EVT";
case ESP_GAP_BLE_SCAN_RSP_DATA_SET_COMPLETE_EVT:
return "ESP_GAP_BLE_SCAN_RSP_DATA_SET_COMPLETE_EVT";
case ESP_GAP_BLE_SCAN_START_COMPLETE_EVT:
return "ESP_GAP_BLE_SCAN_START_COMPLETE_EVT";
case ESP_GAP_BLE_AUTH_CMPL_EVT:
return "ESP_GAP_BLE_AUTH_CMPL_EVT";
case ESP_GAP_BLE_KEY_EVT:
return "ESP_GAP_BLE_KEY_EVT";
case ESP_GAP_BLE_SEC_REQ_EVT:
return "ESP_GAP_BLE_SEC_REQ_EVT";
case ESP_GAP_BLE_PASSKEY_NOTIF_EVT:
return "ESP_GAP_BLE_PASSKEY_NOTIF_EVT";
case ESP_GAP_BLE_PASSKEY_REQ_EVT:
return "ESP_GAP_BLE_PASSKEY_REQ_EVT";
case ESP_GAP_BLE_OOB_REQ_EVT:
return "ESP_GAP_BLE_OOB_REQ_EVT";
case ESP_GAP_BLE_LOCAL_IR_EVT:
return "ESP_GAP_BLE_LOCAL_IR_EVT";
case ESP_GAP_BLE_LOCAL_ER_EVT:
return "ESP_GAP_BLE_LOCAL_ER_EVT";
case ESP_GAP_BLE_NC_REQ_EVT:
return "ESP_GAP_BLE_NC_REQ_EVT";
case ESP_GAP_BLE_ADV_STOP_COMPLETE_EVT:
return "ESP_GAP_BLE_ADV_STOP_COMPLETE_EVT";
case ESP_GAP_BLE_SCAN_STOP_COMPLETE_EVT:
return "ESP_GAP_BLE_SCAN_STOP_COMPLETE_EVT";
default:
ESP_LOGD(LOG_TAG, "gapEventToString: Unknown event type 0x%x", eventType);
return "Unknown event type";
}
}
std::string BLEUtils::gattCharacteristicUUIDToString(uint32_t characteristicUUID) {
characteristicMap_t *p = g_characteristicsMappings;
while (p->name.length() > 0) {
if (p->assignedNumber == characteristicUUID) {
return p->name;
}
p++;
}
return "Unknown";
}
std::string BLEUtils::gattServiceIdToString(esp_gatt_srvc_id_t srvcId) {
return gattIdToString(srvcId.id);
}
std::string BLEUtils::gattServiceToString(uint32_t serviceId) {
gattService_t* p = (gattService_t *)g_gattServices;
while (p->name.length() > 0) {
if (p->assignedNumber == serviceId) {
return p->name;
}
p++;
}
return "Unknown";
}
std::string BLEUtils::gattStatusToString(esp_gatt_status_t status) {
switch(status) {
case ESP_GATT_OK:
return "ESP_GATT_OK";
case ESP_GATT_INVALID_HANDLE:
return "ESP_GATT_INVALID_HANDLE";
case ESP_GATT_READ_NOT_PERMIT:
return "ESP_GATT_READ_NOT_PERMIT";
case ESP_GATT_WRITE_NOT_PERMIT:
return "ESP_GATT_WRITE_NOT_PERMIT";
case ESP_GATT_INVALID_PDU:
return "ESP_GATT_INVALID_PDU";
case ESP_GATT_INSUF_AUTHENTICATION:
return "ESP_GATT_INSUF_AUTHENTICATION";
case ESP_GATT_REQ_NOT_SUPPORTED:
return "ESP_GATT_REQ_NOT_SUPPORTED";
case ESP_GATT_INVALID_OFFSET:
return "ESP_GATT_INVALID_OFFSET";
case ESP_GATT_INSUF_AUTHORIZATION:
return "ESP_GATT_INSUF_AUTHORIZATION";
case ESP_GATT_PREPARE_Q_FULL:
return "ESP_GATT_PREPARE_Q_FULL";
case ESP_GATT_NOT_FOUND:
return "ESP_GATT_NOT_FOUND";
case ESP_GATT_NOT_LONG:
return "ESP_GATT_NOT_LONG";
case ESP_GATT_INSUF_KEY_SIZE:
return "ESP_GATT_INSUF_KEY_SIZE";
case ESP_GATT_INVALID_ATTR_LEN:
return "ESP_GATT_INVALID_ATTR_LEN";
case ESP_GATT_ERR_UNLIKELY:
return "ESP_GATT_ERR_UNLIKELY";
case ESP_GATT_INSUF_ENCRYPTION:
return "ESP_GATT_INSUF_ENCRYPTION";
case ESP_GATT_UNSUPPORT_GRP_TYPE:
return "ESP_GATT_UNSUPPORT_GRP_TYPE";
case ESP_GATT_INSUF_RESOURCE:
return "ESP_GATT_INSUF_RESOURCE";
case ESP_GATT_NO_RESOURCES:
return "ESP_GATT_NO_RESOURCES";
case ESP_GATT_INTERNAL_ERROR:
return "ESP_GATT_INTERNAL_ERROR";
case ESP_GATT_WRONG_STATE:
return "ESP_GATT_WRONG_STATE";
case ESP_GATT_DB_FULL:
return "ESP_GATT_DB_FULL";
case ESP_GATT_BUSY:
return "ESP_GATT_BUSY";
case ESP_GATT_ERROR:
return "ESP_GATT_ERROR";
case ESP_GATT_CMD_STARTED:
return "ESP_GATT_CMD_STARTED";
case ESP_GATT_ILLEGAL_PARAMETER:
return "ESP_GATT_ILLEGAL_PARAMETER";
case ESP_GATT_PENDING:
return "ESP_GATT_PENDING";
case ESP_GATT_AUTH_FAIL:
return "ESP_GATT_AUTH_FAIL";
case ESP_GATT_MORE:
return "ESP_GATT_MORE";
case ESP_GATT_INVALID_CFG:
return "ESP_GATT_INVALID_CFG";
case ESP_GATT_SERVICE_STARTED:
return "ESP_GATT_SERVICE_STARTED";
case ESP_GATT_ENCRYPED_NO_MITM:
return "ESP_GATT_ENCRYPED_NO_MITM";
case ESP_GATT_NOT_ENCRYPTED:
return "ESP_GATT_NOT_ENCRYPTED";
case ESP_GATT_CONGESTED:
return "ESP_GATT_CONGESTED";
case ESP_GATT_DUP_REG:
return "ESP_GATT_DUP_REG";
case ESP_GATT_ALREADY_OPEN:
return "ESP_GATT_ALREADY_OPEN";
case ESP_GATT_CANCEL:
return "ESP_GATT_CANCEL";
case ESP_GATT_CCC_CFG_ERR:
return "ESP_GATT_CCC_CFG_ERR";
case ESP_GATT_PRC_IN_PROGRESS:
return "ESP_GATT_PRC_IN_PROGRESS";
default:
return "Unknown";
}
}
const char* BLEUtils::searchEventTypeToString(esp_gap_search_evt_t searchEvt) {
switch(searchEvt) {
case ESP_GAP_SEARCH_INQ_RES_EVT:
return "ESP_GAP_SEARCH_INQ_RES_EVT";
case ESP_GAP_SEARCH_INQ_CMPL_EVT:
return "ESP_GAP_SEARCH_INQ_CMPL_EVT";
case ESP_GAP_SEARCH_DISC_RES_EVT:
return "ESP_GAP_SEARCH_DISC_RES_EVT";
case ESP_GAP_SEARCH_DISC_BLE_RES_EVT:
return "ESP_GAP_SEARCH_DISC_BLE_RES_EVT";
case ESP_GAP_SEARCH_DISC_CMPL_EVT:
return "ESP_GAP_SEARCH_DISC_CMPL_EVT";
case ESP_GAP_SEARCH_DI_DISC_CMPL_EVT:
return "ESP_GAP_SEARCH_DI_DISC_CMPL_EVT";
case ESP_GAP_SEARCH_SEARCH_CANCEL_CMPL_EVT:
return "ESP_GAP_SEARCH_SEARCH_CANCEL_CMPL_EVT";
default:
ESP_LOGD(LOG_TAG, "Unknown event type: 0x%x", searchEvt);
return "Unknown event type";
}
}
#endif