|
|
@@ -0,0 +1,457 @@
|
|
|
+/*
|
|
|
+ * SPDX-FileCopyrightText: 2021-2022 Espressif Systems (Shanghai) CO LTD
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: Unlicense OR CC0-1.0
|
|
|
+ */
|
|
|
+
|
|
|
+#include <stdio.h>
|
|
|
+#include <stdint.h>
|
|
|
+#include <string.h>
|
|
|
+#include <stdbool.h>
|
|
|
+#include <stdio.h>
|
|
|
+#include "nvs.h"
|
|
|
+#include "nvs_flash.h"
|
|
|
+#include "freertos/FreeRTOS.h"
|
|
|
+#include "freertos/task.h"
|
|
|
+#include "esp_log.h"
|
|
|
+#include "esp_bt.h"
|
|
|
+#include "esp_bt_main.h"
|
|
|
+#include "esp_gap_bt_api.h"
|
|
|
+#include "esp_bt_device.h"
|
|
|
+#include "esp_l2cap_bt_api.h"
|
|
|
+
|
|
|
+#include "time.h"
|
|
|
+#include "sys/time.h"
|
|
|
+#include "esp_vfs.h"
|
|
|
+#include "esp_sdp_api.h"
|
|
|
+#include "bt_app_core.h"
|
|
|
+
|
|
|
+#define L2CAP_TAG "L2CAP_TAG"
|
|
|
+#define SDP_TAG "SDP_TAG"
|
|
|
+#define EXAMPLE_DEVICE_NAME "ESP_BT_L2CAP_CLIENT"
|
|
|
+#define TARGET_DEVICE_NAME "ESP_BT_L2CAP_SERVER"
|
|
|
+#define L2CAP_DATA_LEN 100
|
|
|
+#define BT_L2CAP_DYNMIC_PSM 0x1001
|
|
|
+#define BT_UNUSED_RFCOMM -1
|
|
|
+#define BT_UNKONWN_PROFILE_VERSION 0x0102
|
|
|
+
|
|
|
+static esp_bt_l2cap_cntl_flags_t sec_mask = ESP_BT_L2CAP_SEC_AUTHENTICATE;
|
|
|
+static char *sdp_service_name = "Unknown_profile";
|
|
|
+static const uint8_t UUID_UNKNOWN[] = {0x00, 0x00, 0x10, 0x10, 0x00, 0x00, 0x10, 0x00,
|
|
|
+ 0x80, 0x00, 0x00, 0x80, 0x5F, 0x9B, 0x34, 0xFB
|
|
|
+ };
|
|
|
+
|
|
|
+static void esp_bt_l2cap_cb(esp_bt_l2cap_cb_event_t event, esp_bt_l2cap_cb_param_t *param);
|
|
|
+static void esp_hdl_bt_l2cap_cb_evt(uint16_t event, void *p_param);
|
|
|
+static void esp_hdl_sdp_cb_evt(uint16_t event, void *p_param);
|
|
|
+
|
|
|
+static char *bda2str(esp_bd_addr_t bda, char *str, size_t size)
|
|
|
+{
|
|
|
+ if (bda == NULL || str == NULL || size < 18) {
|
|
|
+ return NULL;
|
|
|
+ }
|
|
|
+
|
|
|
+ sprintf(str, "%02x:%02x:%02x:%02x:%02x:%02x",
|
|
|
+ bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
|
|
|
+ return str;
|
|
|
+}
|
|
|
+
|
|
|
+static bool get_name_from_eir(uint8_t *eir, uint8_t *bdname, uint8_t *bdname_len)
|
|
|
+{
|
|
|
+ uint8_t *rmt_bdname = NULL;
|
|
|
+ uint8_t rmt_bdname_len = 0;
|
|
|
+
|
|
|
+ if (!eir) {
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* get complete or short local name from eir data */
|
|
|
+ rmt_bdname = esp_bt_gap_resolve_eir_data(eir, ESP_BT_EIR_TYPE_CMPL_LOCAL_NAME, &rmt_bdname_len);
|
|
|
+ if (!rmt_bdname) {
|
|
|
+ rmt_bdname = esp_bt_gap_resolve_eir_data(eir, ESP_BT_EIR_TYPE_SHORT_LOCAL_NAME, &rmt_bdname_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (rmt_bdname) {
|
|
|
+ if (rmt_bdname_len > ESP_BT_GAP_MAX_BDNAME_LEN) {
|
|
|
+ rmt_bdname_len = ESP_BT_GAP_MAX_BDNAME_LEN;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (bdname) {
|
|
|
+ memcpy(bdname, rmt_bdname, rmt_bdname_len);
|
|
|
+ bdname[rmt_bdname_len] = '\0';
|
|
|
+ }
|
|
|
+ if (bdname_len) {
|
|
|
+ *bdname_len = rmt_bdname_len;
|
|
|
+ }
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+
|
|
|
+ return false;
|
|
|
+}
|
|
|
+
|
|
|
+static void filter_inquiry_scan_result(esp_bt_gap_cb_param_t *param)
|
|
|
+{
|
|
|
+ char bda_str[18];
|
|
|
+ uint32_t cod = 0; /* class of device */
|
|
|
+ int32_t rssi = -129; /* invalid value */
|
|
|
+ uint8_t *eir = NULL;
|
|
|
+ uint8_t peer_bdname[ESP_BT_GAP_MAX_BDNAME_LEN + 1];
|
|
|
+ esp_bt_gap_dev_prop_t *p;
|
|
|
+ esp_bt_uuid_t uuid = {0};
|
|
|
+
|
|
|
+ /* handle the discovery results */
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Scanned device: %s", bda2str(param->disc_res.bda, bda_str, 18));
|
|
|
+ for (int i = 0; i < param->disc_res.num_prop; i++) {
|
|
|
+ p = param->disc_res.prop + i;
|
|
|
+ switch (p->type) {
|
|
|
+ case ESP_BT_GAP_DEV_PROP_COD:
|
|
|
+ cod = *(uint32_t *)(p->val);
|
|
|
+ ESP_LOGI(L2CAP_TAG, "--Class of Device: 0x%x", cod);
|
|
|
+ break;
|
|
|
+ case ESP_BT_GAP_DEV_PROP_RSSI:
|
|
|
+ rssi = *(int8_t *)(p->val);
|
|
|
+ ESP_LOGI(L2CAP_TAG, "--RSSI: %d", rssi);
|
|
|
+ break;
|
|
|
+ case ESP_BT_GAP_DEV_PROP_EIR:
|
|
|
+ eir = (uint8_t *)(p->val);
|
|
|
+ break;
|
|
|
+ case ESP_BT_GAP_DEV_PROP_BDNAME:
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* search for target device in its Extended Inqury Response */
|
|
|
+ if (eir) {
|
|
|
+ get_name_from_eir(eir, peer_bdname, NULL);
|
|
|
+ if (strcmp((char *)peer_bdname, TARGET_DEVICE_NAME) == 0) {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Found a target device, address %s, name %s", bda_str, peer_bdname);
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Cancel device discovery ...");
|
|
|
+ esp_bt_gap_cancel_discovery();
|
|
|
+
|
|
|
+ uuid.len = sizeof(UUID_UNKNOWN);
|
|
|
+ memcpy(uuid.uuid.uuid128, UUID_UNKNOWN, sizeof(UUID_UNKNOWN));
|
|
|
+ esp_sdp_search_record(param->disc_res.bda, uuid);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void esp_bt_gap_cb(esp_bt_gap_cb_event_t event, esp_bt_gap_cb_param_t *param)
|
|
|
+{
|
|
|
+ char bda_str[18] = {0};
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ /* when device discovered a result, this event comes */
|
|
|
+ case ESP_BT_GAP_DISC_RES_EVT: {
|
|
|
+ filter_inquiry_scan_result(param);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ /* when Legacy Pairing pin code requested, this event comes */
|
|
|
+ case ESP_BT_GAP_AUTH_CMPL_EVT:{
|
|
|
+ if (param->auth_cmpl.stat == ESP_BT_STATUS_SUCCESS) {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "authentication success: %s bda:[%s]", param->auth_cmpl.device_name,
|
|
|
+ bda2str(param->auth_cmpl.bda, bda_str, sizeof(bda_str)));
|
|
|
+ } else {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "authentication failed, status:%d", param->auth_cmpl.stat);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ /* when Security Simple Pairing user confirmation requested, this event comes */
|
|
|
+ case ESP_BT_GAP_PIN_REQ_EVT:{
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_GAP_PIN_REQ_EVT min_16_digit:%d", param->pin_req.min_16_digit);
|
|
|
+ if (param->pin_req.min_16_digit) {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Input pin code: 0000 0000 0000 0000");
|
|
|
+ esp_bt_pin_code_t pin_code = {0};
|
|
|
+ esp_bt_gap_pin_reply(param->pin_req.bda, true, 16, pin_code);
|
|
|
+ } else {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Input pin code: 1234");
|
|
|
+ esp_bt_pin_code_t pin_code;
|
|
|
+ pin_code[0] = '1';
|
|
|
+ pin_code[1] = '2';
|
|
|
+ pin_code[2] = '3';
|
|
|
+ pin_code[3] = '4';
|
|
|
+ esp_bt_gap_pin_reply(param->pin_req.bda, true, 4, pin_code);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+#if (CONFIG_BT_SSP_ENABLED == true)
|
|
|
+ /* when Security Simple Pairing user confirmation requested, this event comes */
|
|
|
+ case ESP_BT_GAP_CFM_REQ_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_GAP_CFM_REQ_EVT Please compare the numeric value: %d", param->cfm_req.num_val);
|
|
|
+ esp_bt_gap_ssp_confirm_reply(param->cfm_req.bda, true);
|
|
|
+ break;
|
|
|
+ /* when Security Simple Pairing passkey notified, this event comes */
|
|
|
+ case ESP_BT_GAP_KEY_NOTIF_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_GAP_KEY_NOTIF_EVT passkey: %d", param->key_notif.passkey);
|
|
|
+ break;
|
|
|
+ /* when Security Simple Pairing passkey requested, this event comes */
|
|
|
+ case ESP_BT_GAP_KEY_REQ_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_GAP_KEY_REQ_EVT Please enter passkey!");
|
|
|
+ break;
|
|
|
+#endif
|
|
|
+
|
|
|
+ /* when GAP mode changed, this event comes */
|
|
|
+ case ESP_BT_GAP_MODE_CHG_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_GAP_MODE_CHG_EVT mode:%d bda:[%s]", param->mode_chg.mode,
|
|
|
+ bda2str(param->mode_chg.bda, bda_str, sizeof(bda_str)));
|
|
|
+ break;
|
|
|
+ /* other */
|
|
|
+ default: {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "event: %d", event);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+static void l2cap_write_handle(void * param)
|
|
|
+{
|
|
|
+ int size = 0;
|
|
|
+ int fd = (int)param;
|
|
|
+ uint8_t *l2cap_data = NULL;
|
|
|
+ uint16_t i = 0;
|
|
|
+
|
|
|
+ l2cap_data = malloc(L2CAP_DATA_LEN);
|
|
|
+ if (!l2cap_data) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "malloc l2cap_data failed, fd:%d", fd);
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ for (i = 0; i < L2CAP_DATA_LEN; ++i) {
|
|
|
+ l2cap_data[i] = i;
|
|
|
+ }
|
|
|
+
|
|
|
+ do {
|
|
|
+ /*
|
|
|
+ * The write function is blocked until all the target length of data has been sent to the lower layer
|
|
|
+ * successfully an error occurs.
|
|
|
+ */
|
|
|
+ size = write(fd, l2cap_data, L2CAP_DATA_LEN);
|
|
|
+ if (size == -1) {
|
|
|
+ break;
|
|
|
+ } else if (size == 0) {
|
|
|
+ /*write fail due to ringbuf is full, retry after 500 ms*/
|
|
|
+ vTaskDelay(500 / portTICK_PERIOD_MS);
|
|
|
+ } else {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "fd = %d data_len = %d", fd, size);
|
|
|
+ vTaskDelay(50 / portTICK_PERIOD_MS);
|
|
|
+ }
|
|
|
+ } while (1);
|
|
|
+done:
|
|
|
+ if (l2cap_data) {
|
|
|
+ free(l2cap_data);
|
|
|
+ }
|
|
|
+ l2cap_wr_task_shut_down();
|
|
|
+}
|
|
|
+
|
|
|
+static void esp_bt_l2cap_cb(esp_bt_l2cap_cb_event_t event, esp_bt_l2cap_cb_param_t *param)
|
|
|
+{
|
|
|
+ switch (event) {
|
|
|
+ case ESP_BT_L2CAP_INIT_EVT:
|
|
|
+ case ESP_BT_L2CAP_UNINIT_EVT:
|
|
|
+ case ESP_BT_L2CAP_OPEN_EVT:
|
|
|
+ case ESP_BT_L2CAP_CLOSE_EVT:
|
|
|
+ case ESP_BT_L2CAP_CL_INIT_EVT:
|
|
|
+ case ESP_BT_L2CAP_START_EVT:
|
|
|
+ case ESP_BT_L2CAP_SRV_STOP_EVT: {
|
|
|
+ bt_app_work_dispatch(esp_hdl_bt_l2cap_cb_evt, event, param, sizeof(esp_bt_l2cap_cb_param_t), NULL);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ ESP_LOGE(L2CAP_TAG, "Invalid L2CAP event: %d", event);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void esp_hdl_bt_l2cap_cb_evt(uint16_t event, void *p_param)
|
|
|
+{
|
|
|
+ char bda_str[18] = {0};
|
|
|
+ esp_bt_l2cap_cb_param_t *l2cap_param = (esp_bt_l2cap_cb_param_t *)p_param;
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case ESP_BT_L2CAP_INIT_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_INIT_EVT: status:%d\n", l2cap_param->init.status);
|
|
|
+ if (l2cap_param->init.status == ESP_BT_L2CAP_SUCCESS) {
|
|
|
+ esp_bt_l2cap_vfs_register();
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_UNINIT_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_UNINIT_EVT: status:%d\n", l2cap_param->uninit.status);
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_OPEN_EVT:
|
|
|
+ if (l2cap_param->open.status == ESP_BT_L2CAP_SUCCESS) {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_OPEN_EVT: status:%d, fd = %d, tx mtu = %d, remote_address:%s\n", l2cap_param->open.status,
|
|
|
+ l2cap_param->open.fd, l2cap_param->open.tx_mtu, bda2str(l2cap_param->open.rem_bda, bda_str, sizeof(bda_str)));
|
|
|
+ l2cap_wr_task_start_up(l2cap_write_handle, l2cap_param->open.fd);
|
|
|
+ } else {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_OPEN_EVT: status:%d\n", l2cap_param->open.status);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_CLOSE_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_CLOSE_EVT: status:%d\n", l2cap_param->close.status);
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_CL_INIT_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_CL_INIT_EVT: status:%d\n", l2cap_param->cl_init.status);
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_START_EVT:
|
|
|
+ if (l2cap_param->start.status == ESP_BT_L2CAP_SUCCESS) {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_START_EVT: status:%d, hdl:0x%x, sec_id:0x%x\n",
|
|
|
+ l2cap_param->start.status, l2cap_param->start.handle, l2cap_param->start.sec_id);
|
|
|
+ } else {
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_START_EVT: status:%d\n", l2cap_param->start.status);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_BT_L2CAP_SRV_STOP_EVT:
|
|
|
+ ESP_LOGI(L2CAP_TAG, "ESP_BT_L2CAP_CLOSE_EVT: status:%d, psm = 0x%x\n", l2cap_param->srv_stop.status, l2cap_param->srv_stop.psm);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+}
|
|
|
+
|
|
|
+static void esp_sdp_cb(esp_sdp_cb_event_t event, esp_sdp_cb_param_t *param)
|
|
|
+{
|
|
|
+ switch (event) {
|
|
|
+ case ESP_SDP_INIT_EVT:
|
|
|
+ case ESP_SDP_DEINIT_EVT:
|
|
|
+ case ESP_SDP_SEARCH_COMP_EVT:
|
|
|
+ case ESP_SDP_CREATE_RECORD_COMP_EVT:
|
|
|
+ case ESP_SDP_REMOVE_RECORD_COMP_EVT: {
|
|
|
+ bt_app_work_dispatch(esp_hdl_sdp_cb_evt, event, param, sizeof(esp_sdp_cb_param_t), NULL);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ ESP_LOGE(SDP_TAG, "Invalid SDP event: %d", event);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void esp_hdl_sdp_cb_evt(uint16_t event, void *p_param)
|
|
|
+{
|
|
|
+ esp_bluetooth_sdp_record_t record = {0};
|
|
|
+ esp_sdp_cb_param_t *sdp_param = (esp_sdp_cb_param_t *)p_param;
|
|
|
+ char bda_str[18] = {0};
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case ESP_SDP_INIT_EVT:
|
|
|
+ ESP_LOGI(SDP_TAG, "ESP_SDP_INIT_EVT: status:%d\n", sdp_param->init.status);
|
|
|
+ if (sdp_param->init.status == ESP_SDP_SUCCESS) {
|
|
|
+ record.hdr.type = ESP_SDP_TYPE_RAW;
|
|
|
+ record.hdr.uuid.len = sizeof(UUID_UNKNOWN);
|
|
|
+ memcpy(record.hdr.uuid.uuid.uuid128, UUID_UNKNOWN, sizeof(UUID_UNKNOWN));
|
|
|
+ record.hdr.service_name_length = strlen(sdp_service_name) + 1;
|
|
|
+ record.hdr.service_name = sdp_service_name;
|
|
|
+ record.hdr.rfcomm_channel_number = BT_UNUSED_RFCOMM;
|
|
|
+ record.hdr.l2cap_psm = BT_L2CAP_DYNMIC_PSM;
|
|
|
+ record.hdr.profile_version = BT_UNKONWN_PROFILE_VERSION;
|
|
|
+ esp_sdp_create_record(&record);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_SDP_DEINIT_EVT:
|
|
|
+ ESP_LOGI(SDP_TAG, "ESP_SDP_DEINIT_EVT: status:%d\n", sdp_param->deinit.status);
|
|
|
+ break;
|
|
|
+ case ESP_SDP_SEARCH_COMP_EVT:
|
|
|
+ ESP_LOGI(SDP_TAG, "ESP_SDP_SEARCH_COMP_EVT: status:%d\n", sdp_param->search.status);
|
|
|
+ if (sdp_param->search.status == ESP_SDP_SUCCESS) {
|
|
|
+ ESP_LOGI(SDP_TAG, "Remote device address: %s\n", bda2str(sdp_param->search.remote_addr, bda_str, sizeof(bda_str)));
|
|
|
+ ESP_LOGI(SDP_TAG, "Remote device record count: %d\n", sdp_param->search.record_count);
|
|
|
+ ESP_LOGI(SDP_TAG, "Remote device rfcomm channel number: %d\n", sdp_param->search.records->hdr.rfcomm_channel_number);
|
|
|
+ ESP_LOGI(SDP_TAG, "Remote device l2cap psm: 0x%04x\n", sdp_param->search.records->hdr.l2cap_psm);
|
|
|
+ esp_bt_l2cap_connect(sec_mask, sdp_param->search.records->hdr.l2cap_psm, sdp_param->search.remote_addr);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_SDP_CREATE_RECORD_COMP_EVT:
|
|
|
+ ESP_LOGI(SDP_TAG, "ESP_SDP_CREATE_RECORD_COMP_EVT: status:%d\n", sdp_param->create_record.status);
|
|
|
+ if (sdp_param->create_record.status == ESP_SDP_SUCCESS) {
|
|
|
+ esp_bt_dev_set_device_name(EXAMPLE_DEVICE_NAME);
|
|
|
+ esp_bt_gap_set_scan_mode(ESP_BT_CONNECTABLE, ESP_BT_GENERAL_DISCOVERABLE);
|
|
|
+ esp_bt_gap_start_discovery(ESP_BT_INQ_MODE_GENERAL_INQUIRY, 10, 0);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case ESP_SDP_REMOVE_RECORD_COMP_EVT:
|
|
|
+ ESP_LOGI(SDP_TAG, "ESP_SDP_REMOVE_RECORD_COMP_EVT: status:%d\n", sdp_param->remove_record.status);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void app_main(void)
|
|
|
+{
|
|
|
+ char bda_str[18] = {0};
|
|
|
+ esp_err_t ret = nvs_flash_init();
|
|
|
+ if (ret == ESP_ERR_NVS_NO_FREE_PAGES || ret == ESP_ERR_NVS_NEW_VERSION_FOUND) {
|
|
|
+ ESP_ERROR_CHECK(nvs_flash_erase());
|
|
|
+ ret = nvs_flash_init();
|
|
|
+ }
|
|
|
+ ESP_ERROR_CHECK( ret );
|
|
|
+
|
|
|
+ ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_BLE));
|
|
|
+
|
|
|
+ esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
|
+ if ((ret = esp_bt_controller_init(&bt_cfg)) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s initialize controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_bt_controller_enable(ESP_BT_MODE_CLASSIC_BT)) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_bluedroid_init()) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s initialize bluedroid failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_bluedroid_enable()) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s enable bluedroid failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ bt_app_task_start_up();
|
|
|
+
|
|
|
+ if ((ret = esp_bt_gap_register_callback(esp_bt_gap_cb)) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s gap register failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_bt_l2cap_register_callback(esp_bt_l2cap_cb)) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s l2cap register failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_bt_l2cap_init()) != ESP_OK) {
|
|
|
+ ESP_LOGE(L2CAP_TAG, "%s l2cap init failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_sdp_register_callback(esp_sdp_cb)) != ESP_OK) {
|
|
|
+ ESP_LOGE(SDP_TAG, "%s sdp register failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((ret = esp_sdp_init()) != ESP_OK) {
|
|
|
+ ESP_LOGE(SDP_TAG, "%s sdp init failed: %s\n", __func__, esp_err_to_name(ret));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+#if (CONFIG_BT_SSP_ENABLED == true)
|
|
|
+ /* Set default parameters for Secure Simple Pairing */
|
|
|
+ esp_bt_sp_param_t param_type = ESP_BT_SP_IOCAP_MODE;
|
|
|
+ esp_bt_io_cap_t iocap = ESP_BT_IO_CAP_IO;
|
|
|
+ esp_bt_gap_set_security_param(param_type, &iocap, sizeof(uint8_t));
|
|
|
+#endif
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Set default parameters for Legacy Pairing
|
|
|
+ * Use variable pin, input pin code when pairing
|
|
|
+ */
|
|
|
+ esp_bt_pin_type_t pin_type = ESP_BT_PIN_TYPE_VARIABLE;
|
|
|
+ esp_bt_pin_code_t pin_code;
|
|
|
+ esp_bt_gap_set_pin(pin_type, 0, pin_code);
|
|
|
+
|
|
|
+ ESP_LOGI(L2CAP_TAG, "Own address:[%s]", bda2str((uint8_t *)esp_bt_dev_get_address(), bda_str, sizeof(bda_str)));
|
|
|
+}
|