267 lines
8.6 KiB
C
267 lines
8.6 KiB
C
/*
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
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.
|
|
*/
|
|
|
|
/****************************************************************************
|
|
*
|
|
* This file is for bt_spp_vfs_initiator demo. It can discovery servers, connect one device and send data.
|
|
* run bt_spp_vfs_initiator demo, the bt_spp_vfs_initiator demo will automatically connect the bt_spp_vfs_acceptor demo,
|
|
* then send data.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#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_spp_api.h"
|
|
#include "spp_task.h"
|
|
|
|
#include "time.h"
|
|
#include "sys/time.h"
|
|
|
|
#include "esp_vfs.h"
|
|
#include "sys/unistd.h"
|
|
|
|
#define SPP_TAG "SPP_INITIATOR_DEMO"
|
|
#define EXCAMPLE_DEVICE_NAME "ESP_SPP_INITIATOR"
|
|
|
|
static const esp_spp_mode_t esp_spp_mode = ESP_SPP_MODE_VFS;
|
|
|
|
static const esp_spp_sec_t sec_mask = ESP_SPP_SEC_NONE;
|
|
static const esp_spp_role_t role_master = ESP_SPP_ROLE_MASTER;
|
|
|
|
static esp_bd_addr_t peer_bd_addr;
|
|
static uint8_t peer_bdname_len;
|
|
static char peer_bdname[ESP_BT_GAP_MAX_BDNAME_LEN + 1];
|
|
static const char remote_device_name[] = "ESP_SPP_ACCEPTOR";
|
|
static const esp_bt_inq_mode_t inq_mode = ESP_BT_INQ_MODE_GENERAL_INQUIRY;
|
|
static const uint8_t inq_len = 30;
|
|
static const uint8_t inq_num_rsps = 0;
|
|
|
|
#define SPP_DATA_LEN 20
|
|
static uint8_t spp_data[SPP_DATA_LEN];
|
|
|
|
static void spp_write_handle(void * param)
|
|
{
|
|
int size = 0;
|
|
int fd = (int)param;
|
|
printf("%s %d %p\n", __func__,fd,param);
|
|
do {
|
|
size = write (fd, spp_data, SPP_DATA_LEN);
|
|
ESP_LOGI(SPP_TAG, "fd = %d data_len = %d",fd, size);
|
|
if (size == -1) {
|
|
break;
|
|
} else if ( size == 0) {
|
|
/*write fail due to ringbuf is full, retry after 1s*/
|
|
vTaskDelay(1000 / portTICK_PERIOD_MS);
|
|
}
|
|
} while (1);
|
|
spp_wr_task_shut_down();
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
static void esp_spp_cb(esp_spp_cb_event_t event, esp_spp_cb_param_t *param)
|
|
{
|
|
switch (event) {
|
|
case ESP_SPP_INIT_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_INIT_EVT");
|
|
esp_bt_dev_set_device_name(EXCAMPLE_DEVICE_NAME);
|
|
esp_bt_gap_set_scan_mode(ESP_BT_SCAN_MODE_CONNECTABLE_DISCOVERABLE);
|
|
esp_bt_gap_start_discovery(inq_mode, inq_len, inq_num_rsps);
|
|
|
|
break;
|
|
case ESP_SPP_DISCOVERY_COMP_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_DISCOVERY_COMP_EVT status=%d scn_num=%d",param->disc_comp.status, param->disc_comp.scn_num);
|
|
if (param->disc_comp.status == ESP_SPP_SUCCESS) {
|
|
esp_spp_connect(sec_mask, role_master, param->disc_comp.scn[0], peer_bd_addr);
|
|
}
|
|
break;
|
|
case ESP_SPP_OPEN_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_OPEN_EVT");
|
|
spp_wr_task_start_up(spp_write_handle, param->open.fd);
|
|
break;
|
|
case ESP_SPP_CLOSE_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_CLOSE_EVT");
|
|
break;
|
|
case ESP_SPP_START_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_START_EVT");
|
|
break;
|
|
case ESP_SPP_CL_INIT_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_CL_INIT_EVT");
|
|
break;
|
|
case ESP_SPP_SRV_OPEN_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_SPP_SRV_OPEN_EVT");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static 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:
|
|
ESP_LOGI(SPP_TAG, "ESP_BT_GAP_DISC_RES_EVT");
|
|
esp_log_buffer_hex(SPP_TAG, param->disc_res.bda, ESP_BD_ADDR_LEN);
|
|
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)){
|
|
esp_log_buffer_char(SPP_TAG, peer_bdname, peer_bdname_len);
|
|
if (strlen(remote_device_name) == peer_bdname_len
|
|
&& strncmp(peer_bdname, remote_device_name, peer_bdname_len) == 0) {
|
|
memcpy(peer_bd_addr, param->disc_res.bda, ESP_BD_ADDR_LEN);
|
|
esp_spp_start_discovery(peer_bd_addr);
|
|
esp_bt_gap_cancel_discovery();
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case ESP_BT_GAP_DISC_STATE_CHANGED_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_BT_GAP_DISC_STATE_CHANGED_EVT");
|
|
break;
|
|
case ESP_BT_GAP_RMT_SRVCS_EVT:
|
|
ESP_LOGI(SPP_TAG, "ESP_BT_GAP_RMT_SRVCS_EVT");
|
|
break;
|
|
case ESP_BT_GAP_RMT_SRVC_REC_EVT:
|
|
ESP_LOGI(SPP_TAG, "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(SPP_TAG, "authentication success: %s", param->auth_cmpl.device_name);
|
|
esp_log_buffer_hex(SPP_TAG, param->auth_cmpl.bda, ESP_BD_ADDR_LEN);
|
|
} else {
|
|
ESP_LOGE(SPP_TAG, "authentication failed, status:%d", param->auth_cmpl.stat);
|
|
}
|
|
break;
|
|
}
|
|
case ESP_BT_GAP_PIN_REQ_EVT:{
|
|
ESP_LOGI(SPP_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(SPP_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(SPP_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;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void esp_spp_stack_cb(esp_spp_cb_event_t event, esp_spp_cb_param_t *param)
|
|
{
|
|
spp_task_work_dispatch((spp_task_cb_t)esp_spp_cb, event, param, sizeof(esp_spp_cb_param_t), NULL);
|
|
}
|
|
|
|
void app_main()
|
|
{
|
|
for (int i = 0; i < SPP_DATA_LEN; ++i) {
|
|
spp_data[i] = i;
|
|
}
|
|
|
|
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_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
if (esp_bt_controller_init(&bt_cfg) != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s initialize controller failed", __func__);
|
|
return;
|
|
}
|
|
|
|
if (esp_bt_controller_enable(ESP_BT_MODE_CLASSIC_BT) != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s enable controller failed", __func__);
|
|
return;
|
|
}
|
|
|
|
if (esp_bluedroid_init() != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s initialize bluedroid failed", __func__);
|
|
return;
|
|
}
|
|
|
|
if (esp_bluedroid_enable() != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s enable bluedroid failed", __func__);
|
|
return;
|
|
}
|
|
|
|
if (esp_bt_gap_register_callback(esp_bt_gap_cb) != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s gap register failed", __func__);
|
|
return;
|
|
}
|
|
|
|
if (esp_spp_register_callback(esp_spp_stack_cb) != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s spp register failed", __func__);
|
|
return;
|
|
}
|
|
esp_spp_vfs_register();
|
|
spp_task_task_start_up();
|
|
if (esp_spp_init(esp_spp_mode) != ESP_OK) {
|
|
ESP_LOGE(SPP_TAG, "%s spp init failed", __func__);
|
|
return;
|
|
}
|
|
/*
|
|
* 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);
|
|
}
|
|
|