mirror of
https://github.com/espressif/esp-idf.git
synced 2024-10-05 20:47:46 -04:00
283 lines
9.6 KiB
C
283 lines
9.6 KiB
C
/*
|
|
* SPDX-FileCopyrightText: 2021-2024 Espressif Systems (Shanghai) CO LTD
|
|
*
|
|
* SPDX-License-Identifier: Unlicense OR CC0-1.0
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <inttypes.h>
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/task.h"
|
|
#include "nvs.h"
|
|
#include "nvs_flash.h"
|
|
#include "esp_system.h"
|
|
#include "esp_log.h"
|
|
#include "esp_bt.h"
|
|
#include "bt_app_core.h"
|
|
#include "esp_bt_main.h"
|
|
#include "esp_bt_device.h"
|
|
#include "esp_gap_bt_api.h"
|
|
#include "esp_hf_client_api.h"
|
|
#include "bt_app_hf.h"
|
|
#include "gpio_pcm_config.h"
|
|
#include "esp_console.h"
|
|
#include "app_hf_msg_set.h"
|
|
|
|
esp_bd_addr_t peer_addr = {0};
|
|
static char peer_bdname[ESP_BT_GAP_MAX_BDNAME_LEN + 1];
|
|
static uint8_t peer_bdname_len;
|
|
static const char remote_device_name[] = CONFIG_EXAMPLE_PEER_DEVICE_NAME;
|
|
|
|
static char *bda2str(esp_bd_addr_t bda, char *str, size_t size)
|
|
{
|
|
if (bda == NULL || str == NULL || size < 18) {
|
|
return NULL;
|
|
}
|
|
|
|
uint8_t *p = bda;
|
|
sprintf(str, "%02x:%02x:%02x:%02x:%02x:%02x",
|
|
p[0], p[1], p[2], p[3], p[4], p[5]);
|
|
return str;
|
|
}
|
|
|
|
static bool get_name_from_eir(uint8_t *eir, char *bdname, uint8_t *bdname_len)
|
|
{
|
|
uint8_t *rmt_bdname = NULL;
|
|
uint8_t rmt_bdname_len = 0;
|
|
|
|
if (!eir) {
|
|
return false;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
void esp_bt_gap_cb(esp_bt_gap_cb_event_t event, esp_bt_gap_cb_param_t *param)
|
|
{
|
|
switch (event) {
|
|
case ESP_BT_GAP_DISC_RES_EVT: {
|
|
for (int i = 0; i < param->disc_res.num_prop; i++){
|
|
if (param->disc_res.prop[i].type == ESP_BT_GAP_DEV_PROP_EIR
|
|
&& get_name_from_eir(param->disc_res.prop[i].val, peer_bdname, &peer_bdname_len)){
|
|
if (strcmp(peer_bdname, remote_device_name) == 0) {
|
|
memcpy(peer_addr, param->disc_res.bda, ESP_BD_ADDR_LEN);
|
|
ESP_LOGI(BT_HF_TAG, "Found a target device address:");
|
|
ESP_LOG_BUFFER_HEX(BT_HF_TAG, peer_addr, ESP_BD_ADDR_LEN);
|
|
ESP_LOGI(BT_HF_TAG, "Found a target device name: %s", peer_bdname);
|
|
printf("Connect.\n");
|
|
esp_hf_client_connect(peer_addr);
|
|
esp_bt_gap_cancel_discovery();
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
case ESP_BT_GAP_DISC_STATE_CHANGED_EVT:
|
|
ESP_LOGI(BT_HF_TAG, "ESP_BT_GAP_DISC_STATE_CHANGED_EVT");
|
|
case ESP_BT_GAP_RMT_SRVCS_EVT:
|
|
case ESP_BT_GAP_RMT_SRVC_REC_EVT:
|
|
break;
|
|
case ESP_BT_GAP_AUTH_CMPL_EVT: {
|
|
if (param->auth_cmpl.stat == ESP_BT_STATUS_SUCCESS) {
|
|
ESP_LOGI(BT_HF_TAG, "authentication success: %s", param->auth_cmpl.device_name);
|
|
ESP_LOG_BUFFER_HEX(BT_HF_TAG, param->auth_cmpl.bda, ESP_BD_ADDR_LEN);
|
|
} else {
|
|
ESP_LOGE(BT_HF_TAG, "authentication failed, status:%d", param->auth_cmpl.stat);
|
|
}
|
|
break;
|
|
}
|
|
case ESP_BT_GAP_PIN_REQ_EVT: {
|
|
ESP_LOGI(BT_HF_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(BT_HF_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(BT_HF_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_EXAMPLE_SSP_ENABLED == true)
|
|
case ESP_BT_GAP_CFM_REQ_EVT:
|
|
ESP_LOGI(BT_HF_TAG, "ESP_BT_GAP_CFM_REQ_EVT Please compare the numeric value: %"PRIu32, param->cfm_req.num_val);
|
|
esp_bt_gap_ssp_confirm_reply(param->cfm_req.bda, true);
|
|
break;
|
|
case ESP_BT_GAP_KEY_NOTIF_EVT:
|
|
ESP_LOGI(BT_HF_TAG, "ESP_BT_GAP_KEY_NOTIF_EVT passkey:%"PRIu32, param->key_notif.passkey);
|
|
break;
|
|
case ESP_BT_GAP_KEY_REQ_EVT:
|
|
ESP_LOGI(BT_HF_TAG, "ESP_BT_GAP_KEY_REQ_EVT Please enter passkey!");
|
|
break;
|
|
#endif
|
|
|
|
case ESP_BT_GAP_MODE_CHG_EVT:
|
|
ESP_LOGI(BT_HF_TAG, "ESP_BT_GAP_MODE_CHG_EVT mode:%d", param->mode_chg.mode);
|
|
break;
|
|
|
|
default: {
|
|
ESP_LOGI(BT_HF_TAG, "event: %d", event);
|
|
break;
|
|
}
|
|
}
|
|
return;
|
|
}
|
|
|
|
/* event for handler "bt_av_hdl_stack_up */
|
|
enum {
|
|
BT_APP_EVT_STACK_UP = 0,
|
|
};
|
|
|
|
/* handler for bluetooth stack enabled events */
|
|
static void bt_hf_client_hdl_stack_evt(uint16_t event, void *p_param);
|
|
|
|
void app_main(void)
|
|
{
|
|
char bda_str[18] = {0};
|
|
/* Initialize NVS — it is used to store PHY calibration data */
|
|
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 );
|
|
|
|
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(BT_HF_TAG, "%s initialize controller failed: %s", __func__, esp_err_to_name(ret));
|
|
return;
|
|
}
|
|
|
|
if ((ret = esp_bt_controller_enable(ESP_BT_MODE_CLASSIC_BT)) != ESP_OK) {
|
|
ESP_LOGE(BT_HF_TAG, "%s enable controller failed: %s", __func__, esp_err_to_name(ret));
|
|
return;
|
|
}
|
|
|
|
esp_bluedroid_config_t bluedroid_cfg = BT_BLUEDROID_INIT_CONFIG_DEFAULT();
|
|
#if (CONFIG_EXAMPLE_SSP_ENABLED == false)
|
|
bluedroid_cfg.ssp_en = false;
|
|
#endif
|
|
if ((ret = esp_bluedroid_init_with_cfg(&bluedroid_cfg)) != ESP_OK) {
|
|
ESP_LOGE(BT_HF_TAG, "%s initialize bluedroid failed: %s", __func__, esp_err_to_name(ret));
|
|
return;
|
|
}
|
|
|
|
if ((ret = esp_bluedroid_enable()) != ESP_OK) {
|
|
ESP_LOGE(BT_HF_TAG, "%s enable bluedroid failed: %s", __func__, esp_err_to_name(ret));
|
|
return;
|
|
}
|
|
|
|
ESP_LOGI(BT_HF_TAG, "Own address:[%s]", bda2str((uint8_t *)esp_bt_dev_get_address(), bda_str, sizeof(bda_str)));
|
|
/* create application task */
|
|
bt_app_task_start_up();
|
|
|
|
/* Bluetooth device name, connection mode and profile set up */
|
|
bt_app_work_dispatch(bt_hf_client_hdl_stack_evt, BT_APP_EVT_STACK_UP, NULL, 0, NULL);
|
|
|
|
#if CONFIG_BT_HFP_AUDIO_DATA_PATH_PCM
|
|
/* configure the PCM interface and PINs used */
|
|
app_gpio_pcm_io_cfg();
|
|
#endif
|
|
|
|
/* configure external chip for acoustic echo cancellation */
|
|
#if ACOUSTIC_ECHO_CANCELLATION_ENABLE
|
|
app_gpio_aec_io_cfg();
|
|
#endif /* ACOUSTIC_ECHO_CANCELLATION_ENABLE */
|
|
esp_console_repl_t *repl = NULL;
|
|
esp_console_repl_config_t repl_config = ESP_CONSOLE_REPL_CONFIG_DEFAULT();
|
|
esp_console_dev_uart_config_t uart_config = ESP_CONSOLE_DEV_UART_CONFIG_DEFAULT();
|
|
repl_config.prompt = "hfp_hf>";
|
|
|
|
// init console REPL environment
|
|
ESP_ERROR_CHECK(esp_console_new_repl_uart(&uart_config, &repl_config, &repl));
|
|
|
|
/* Register commands */
|
|
register_hfp_hf();
|
|
printf("\n ==================================================\n");
|
|
printf(" | Steps to test hfp_hf |\n");
|
|
printf(" | |\n");
|
|
printf(" | 1. Print 'help' to gain overview of commands |\n");
|
|
printf(" | 2. Setup a service level connection |\n");
|
|
printf(" | 3. Run hfp_hf to test |\n");
|
|
printf(" | |\n");
|
|
printf(" =================================================\n\n");
|
|
|
|
// start console REPL
|
|
ESP_ERROR_CHECK(esp_console_start_repl(repl));
|
|
}
|
|
|
|
|
|
static void bt_hf_client_hdl_stack_evt(uint16_t event, void *p_param)
|
|
{
|
|
ESP_LOGD(BT_HF_TAG, "%s evt %d", __func__, event);
|
|
switch (event) {
|
|
case BT_APP_EVT_STACK_UP: {
|
|
/* set up device name */
|
|
char *dev_name = "ESP_HFP_HF";
|
|
esp_bt_gap_set_device_name(dev_name);
|
|
|
|
/* register GAP callback function */
|
|
esp_bt_gap_register_callback(esp_bt_gap_cb);
|
|
esp_hf_client_register_callback(bt_app_hf_client_cb);
|
|
esp_hf_client_init();
|
|
|
|
#if (CONFIG_EXAMPLE_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
|
|
|
|
esp_bt_pin_type_t pin_type = ESP_BT_PIN_TYPE_FIXED;
|
|
esp_bt_pin_code_t pin_code;
|
|
pin_code[0] = '0';
|
|
pin_code[1] = '0';
|
|
pin_code[2] = '0';
|
|
pin_code[3] = '0';
|
|
esp_bt_gap_set_pin(pin_type, 4, pin_code);
|
|
|
|
/* set discoverable and connectable mode, wait to be connected */
|
|
esp_bt_gap_set_scan_mode(ESP_BT_CONNECTABLE, ESP_BT_GENERAL_DISCOVERABLE);
|
|
|
|
/* start device discovery */
|
|
ESP_LOGI(BT_HF_TAG, "Starting device discovery...");
|
|
esp_bt_gap_start_discovery(ESP_BT_INQ_MODE_GENERAL_INQUIRY, 10, 0);
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_HF_TAG, "%s unhandled evt %d", __func__, event);
|
|
break;
|
|
}
|
|
}
|