Compare commits
2 Commits
1c19c69c05
...
79a0eb73b7
| Author | SHA1 | Date | |
|---|---|---|---|
|
79a0eb73b7 | ||
|
|
d7e84e433d |
@ -282,11 +282,11 @@ static void gap_event_handler(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param
|
|||||||
|
|
||||||
/*
|
/*
|
||||||
* [0]: 标识 F0--写多个modbus内存地址
|
* [0]: 标识 F0--写多个modbus内存地址
|
||||||
* [2:1]: 起始地址
|
* [2:1]: 寄存器起始地址，即寄存器下标
|
||||||
* [3]: 写的字节数 0-255
|
* [3]: 写的字节数 0-255
|
||||||
* ...： 数据内容
|
* ...： 数据内容
|
||||||
*/
|
*/
|
||||||
void gatts_write_data_cb(uint8_t *data, uint32_t len, esp_ble_gatts_cb_param_t *param)
|
void gatts_write_data_cb(uint8_t *data, uint32_t len)
|
||||||
{
|
{
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "gatts_write_data_cb");
|
ESP_LOGI(GATTS_TABLE_TAG, "gatts_write_data_cb");
|
||||||
|
|
||||||
@ -381,7 +381,7 @@ void example_prepare_write_event_env(esp_gatt_if_t gatts_if, prepare_type_env_t
|
|||||||
void example_exec_write_event_env(prepare_type_env_t *prepare_write_env, esp_ble_gatts_cb_param_t *param){
|
void example_exec_write_event_env(prepare_type_env_t *prepare_write_env, esp_ble_gatts_cb_param_t *param){
|
||||||
if (param->exec_write.exec_write_flag == ESP_GATT_PREP_WRITE_EXEC && prepare_write_env->prepare_buf){
|
if (param->exec_write.exec_write_flag == ESP_GATT_PREP_WRITE_EXEC && prepare_write_env->prepare_buf){
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, prepare_write_env->prepare_buf, prepare_write_env->prepare_len);
|
esp_log_buffer_hex(GATTS_TABLE_TAG, prepare_write_env->prepare_buf, prepare_write_env->prepare_len);
|
||||||
gatts_write_data_cb(prepare_write_env->prepare_buf, prepare_write_env->prepare_len, param); /* 此处有隐患，有可能不是data_write特征的数据 */
|
gatts_write_data_cb(prepare_write_env->prepare_buf); /* 此处有隐患，有可能不是data_write特征的数据 */
|
||||||
}else{
|
}else{
|
||||||
ESP_LOGI(GATTS_TABLE_TAG,"ESP_GATT_PREP_WRITE_CANCEL");
|
ESP_LOGI(GATTS_TABLE_TAG,"ESP_GATT_PREP_WRITE_CANCEL");
|
||||||
}
|
}
|
||||||
@ -453,7 +453,7 @@ static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_
|
|||||||
ESP_LOGI(GATTS_TABLE_TAG, "GATT_WRITE_EVT, handle = %d, value len = %d, value :", param->write.handle, param->write.len);
|
ESP_LOGI(GATTS_TABLE_TAG, "GATT_WRITE_EVT, handle = %d, value len = %d, value :", param->write.handle, param->write.len);
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, param->write.value, param->write.len);
|
esp_log_buffer_hex(GATTS_TABLE_TAG, param->write.value, param->write.len);
|
||||||
if (ble_gatts_handle_table[IDX_DATA_READ_WRITE_VAL] == param->write.handle)
|
if (ble_gatts_handle_table[IDX_DATA_READ_WRITE_VAL] == param->write.handle)
|
||||||
gatts_write_data_cb(param->write.value, param->write.len, param);
|
gatts_write_data_cb(param->write.value, param->write.len);
|
||||||
if (ble_gatts_handle_table[IDX_DATA_NOTIFY_CFG] == param->write.handle && param->write.len == 2){
|
if (ble_gatts_handle_table[IDX_DATA_NOTIFY_CFG] == param->write.handle && param->write.len == 2){
|
||||||
uint16_t descr_value = param->write.value[1]<<8 | param->write.value[0];
|
uint16_t descr_value = param->write.value[1]<<8 | param->write.value[0];
|
||||||
if (descr_value == 0x0001){
|
if (descr_value == 0x0001){
|
||||||
@ -581,8 +581,8 @@ static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_
|
|||||||
static uint16_t gatts_mtu_size = 23;
|
static uint16_t gatts_mtu_size = 23;
|
||||||
void notify_data_fun(int id, uint8_t *data, uint32_t len)
|
void notify_data_fun(int id, uint8_t *data, uint32_t len)
|
||||||
{
|
{
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify_data_fun:");
|
// ESP_LOGI(GATTS_TABLE_TAG, "notify_data_fun:");
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, data, len);
|
// esp_log_buffer_hex(GATTS_TABLE_TAG, data, len);
|
||||||
if (len <= gatts_mtu_size - 3) /* 包数据可以一次完整发送 */
|
if (len <= gatts_mtu_size - 3) /* 包数据可以一次完整发送 */
|
||||||
{
|
{
|
||||||
esp_ble_gatts_send_indicate(ble_gatts_if, ble_gatts_conn_id, ble_gatts_handle_table[id], len, data, false);
|
esp_ble_gatts_send_indicate(ble_gatts_if, ble_gatts_conn_id, ble_gatts_handle_table[id], len, data, false);
|
||||||
@ -595,7 +595,7 @@ void notify_data_fun(int id, uint8_t *data, uint32_t len)
|
|||||||
total_num = len / (gatts_mtu_size - 7);
|
total_num = len / (gatts_mtu_size - 7);
|
||||||
else
|
else
|
||||||
total_num = len / (gatts_mtu_size - 7) + 1;
|
total_num = len / (gatts_mtu_size - 7) + 1;
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify packet has %d", total_num);
|
// ESP_LOGI(GATTS_TABLE_TAG, "notify packet has %d", total_num);
|
||||||
|
|
||||||
int i = 0;
|
int i = 0;
|
||||||
buf[0] = '#';
|
buf[0] = '#';
|
||||||
@ -611,18 +611,34 @@ void notify_data_fun(int id, uint8_t *data, uint32_t len)
|
|||||||
buf[3] = i;
|
buf[3] = i;
|
||||||
memcpy(buf + 4, data + i * (gatts_mtu_size - 7), len % (gatts_mtu_size - 7));
|
memcpy(buf + 4, data + i * (gatts_mtu_size - 7), len % (gatts_mtu_size - 7));
|
||||||
esp_ble_gatts_send_indicate(ble_gatts_if, ble_gatts_conn_id, ble_gatts_handle_table[IDX_DATA_NOTIFY_VAL], (len % (gatts_mtu_size - 7)) + 4, buf, false);
|
esp_ble_gatts_send_indicate(ble_gatts_if, ble_gatts_conn_id, ble_gatts_handle_table[IDX_DATA_NOTIFY_VAL], (len % (gatts_mtu_size - 7)) + 4, buf, false);
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify packet send end!");
|
// ESP_LOGI(GATTS_TABLE_TAG, "notify packet send end!");
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
extern flow_t *pflow;
|
extern flow_t *pflow;
|
||||||
extern depth_t *depth_data;
|
extern depth_t *depth_data;
|
||||||
|
extern record_t *record;
|
||||||
|
gps_message_t *gpsMessageP = (gps_message_t *)&gWordVar[REG_GPS_MESSAGE];
|
||||||
|
gps_write_data_t *gpsWriteDataP = (gps_write_data_t *)&gWordVar[REG_GPS_WRITE_DATA];
|
||||||
|
|
||||||
void notify_all_data(void)
|
void notify_all_data(void)
|
||||||
{
|
{
|
||||||
|
ESP_LOGI(GATTS_TABLE_TAG, "notify_all_data");
|
||||||
uint8_t buf[30];
|
uint8_t buf[30];
|
||||||
|
|
||||||
buf[0] = 1; /* tag:1号通道流量:瞬时，每10cm，总 */
|
buf[0] = 1; /* tag:深度：速度 时间 深度 桩号 */
|
||||||
|
buf[1] = depth_data->speed & 0xff;
|
||||||
|
buf[2] = (depth_data->speed >> 8) & 0xff;
|
||||||
|
buf[3] = depth_data->one_pile_work_time & 0xff;
|
||||||
|
buf[4] = (depth_data->one_pile_work_time >> 8) & 0xff;
|
||||||
|
buf[5] = depth_data->depth & 0xff;
|
||||||
|
buf[6] = (depth_data->depth >> 8) & 0xff;
|
||||||
|
buf[7] = gWordVar[LAST_PILE_ID_ADDR] & 0xff;
|
||||||
|
buf[8] = (gWordVar[LAST_PILE_ID_ADDR] >> 8) & 0xff;
|
||||||
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 9);
|
||||||
|
|
||||||
|
buf[0] = 2; /* tag:1号通道流量:瞬时，每10cm，总 */
|
||||||
buf[1] = pflow[0].flow & 0xff;
|
buf[1] = pflow[0].flow & 0xff;
|
||||||
buf[2] = (pflow[0].flow >> 8) & 0xff;
|
buf[2] = (pflow[0].flow >> 8) & 0xff;
|
||||||
buf[3] = depth_data->depth_flow[0] & 0xff;
|
buf[3] = depth_data->depth_flow[0] & 0xff;
|
||||||
@ -631,7 +647,7 @@ void notify_all_data(void)
|
|||||||
buf[6] = (pflow[0].total_flow >> 8) & 0xff;
|
buf[6] = (pflow[0].total_flow >> 8) & 0xff;
|
||||||
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 7);
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 7);
|
||||||
|
|
||||||
buf[0] = 2; /* tag:2号通道流量:瞬时，每10cm，总 */
|
buf[0] = 3; /* tag:2号通道流量:瞬时，每10cm，总 */
|
||||||
buf[1] = pflow[1].flow & 0xff;
|
buf[1] = pflow[1].flow & 0xff;
|
||||||
buf[2] = (pflow[1].flow >> 8) & 0xff;
|
buf[2] = (pflow[1].flow >> 8) & 0xff;
|
||||||
buf[3] = depth_data->depth_flow[1] & 0xff;
|
buf[3] = depth_data->depth_flow[1] & 0xff;
|
||||||
@ -640,26 +656,68 @@ void notify_all_data(void)
|
|||||||
buf[6] = (pflow[1].total_flow >> 8) & 0xff;
|
buf[6] = (pflow[1].total_flow >> 8) & 0xff;
|
||||||
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 7);
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 7);
|
||||||
|
|
||||||
buf[0] = 3; /* tag:深度：速度 深度 */
|
buf[0] = 4; /* tag:电流:三个*/
|
||||||
buf[1] = depth_data->speed & 0xff;
|
buf[1] = gWordVar[AC_CURRENT_REG_ADDR + 0] & 0xff;
|
||||||
buf[2] = (depth_data->speed >> 8) & 0xff;
|
buf[2] = (gWordVar[AC_CURRENT_REG_ADDR + 0] >> 8) & 0xff;
|
||||||
buf[3] = depth_data->depth & 0xff;
|
buf[3] = gWordVar[AC_CURRENT_REG_ADDR + 1] & 0xff;
|
||||||
buf[4] = (depth_data->depth >> 8) & 0xff;
|
buf[4] = (gWordVar[AC_CURRENT_REG_ADDR + 1] >> 8) & 0xff;
|
||||||
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 5);
|
buf[5] = gWordVar[AC_CURRENT_REG_ADDR + 2] & 0xff;
|
||||||
|
buf[6] = (gWordVar[AC_CURRENT_REG_ADDR + 2] >> 8) & 0xff;
|
||||||
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 7);
|
||||||
|
|
||||||
|
|
||||||
|
int64_t x = (int64_t)(gpsMessageP->x * 1000);
|
||||||
|
int64_t y = (int64_t)(gpsMessageP->y * 1000);
|
||||||
|
uint16_t dir = (uint16_t)(gpsMessageP->dir * 100);
|
||||||
|
uint16_t pitch = (uint16_t)(gpsMessageP->pitch * 100);
|
||||||
|
uint8_t gps_status = gpsMessageP->gps_status;
|
||||||
|
uint32_t utc_time = gpsMessageP->utc;
|
||||||
|
// ESP_LOGI(GATTS_TABLE_TAG, "x:%f, %f, %lld", gpsMessageP->x, gpsMessageP->x * 1000, (long long int)(gpsMessageP->x * 1000));
|
||||||
|
// ESP_LOGI(GATTS_TABLE_TAG, "gps message x:%lld, y:%lld, dir:%ud, pitch:%ud, gps_status:%d, utc_time:%ud", (long long)x, (long long)y, (unsigned int)dir, (unsigned int)pitch, (int)gps_status, (unsigned int)utc_time);
|
||||||
|
buf[0] = 5; /* tag:CPS信息1:x, y(int64)*/
|
||||||
|
buf[1] = x & 0xff;
|
||||||
|
buf[2] = (x >> 8) & 0xff;
|
||||||
|
buf[3] = (x >> 16) & 0xff;
|
||||||
|
buf[4] = (x >> 24) & 0xff;
|
||||||
|
buf[5] = (x >> 32) & 0xff;
|
||||||
|
buf[6] = (x >> 40) & 0xff;
|
||||||
|
buf[7] = (x >> 48) & 0xff;
|
||||||
|
buf[8] = (x >> 56) & 0xff;
|
||||||
|
buf[9] = y & 0xff;
|
||||||
|
buf[10] = (y >> 8) & 0xff;
|
||||||
|
buf[11] = (y >> 16) & 0xff;
|
||||||
|
buf[12] = (y >> 24) & 0xff;
|
||||||
|
buf[13] = (y >> 32) & 0xff;
|
||||||
|
buf[14] = (y >> 40) & 0xff;
|
||||||
|
buf[15] = (y >> 48) & 0xff;
|
||||||
|
buf[16] = (y >> 56) & 0xff;
|
||||||
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 17);
|
||||||
|
|
||||||
|
buf[0] = 6; /* tag:CPS信息2:方向，俯仰(uint16)， gps定位状态(uint8)， UTC时间(uint32)*/
|
||||||
|
buf[1] = dir & 0xff;
|
||||||
|
buf[2] = (dir >> 8) & 0xff;
|
||||||
|
buf[3] = pitch & 0xff;
|
||||||
|
buf[4] = (pitch >> 8) & 0xff;
|
||||||
|
buf[5] = utc_time & 0xff;
|
||||||
|
buf[6] = (utc_time >> 8) & 0xff;
|
||||||
|
buf[7] = (utc_time >> 16) & 0xff;
|
||||||
|
buf[8] = (utc_time >> 24) & 0xff;
|
||||||
|
buf[9] = gps_status & 0xff;
|
||||||
|
notify_data_fun(IDX_DATA_NOTIFY_VAL, buf, 10);
|
||||||
/* 需要上报什么数据在此处添加 */
|
/* 需要上报什么数据在此处添加 */
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void notify_task(void *pvParameters)
|
void notify_task(void *pvParameters)
|
||||||
{
|
{
|
||||||
|
ESP_LOGI(GATTS_TABLE_TAG, "notify_task");
|
||||||
while (1)
|
while (1)
|
||||||
{
|
{
|
||||||
if (data_notify_enable && is_connected)
|
if (data_notify_enable && is_connected)
|
||||||
{
|
{
|
||||||
notify_all_data();
|
notify_all_data();
|
||||||
}
|
}
|
||||||
vTaskDelay(pdMS_TO_TICKS(200));
|
vTaskDelay(pdMS_TO_TICKS(100));
|
||||||
}
|
}
|
||||||
|
|
||||||
vTaskDelete(NULL);
|
vTaskDelete(NULL);
|
||||||
|
|||||||
859
main/bt_server.c
859
main/bt_server.c
@ -1,859 +0,0 @@
|
|||||||
/*
|
|
||||||
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.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "freertos/FreeRTOS.h"
|
|
||||||
#include "freertos/task.h"
|
|
||||||
#include "freertos/event_groups.h"
|
|
||||||
#include "esp_system.h"
|
|
||||||
#include "esp_log.h"
|
|
||||||
#include "nvs_flash.h"
|
|
||||||
#include "esp_bt.h"
|
|
||||||
#include "driver/uart.h"
|
|
||||||
#include "string.h"
|
|
||||||
|
|
||||||
#include "esp_gap_ble_api.h"
|
|
||||||
#include "esp_gatts_api.h"
|
|
||||||
#include "esp_bt_defs.h"
|
|
||||||
#include "esp_bt_main.h"
|
|
||||||
#include "bt_server.h"
|
|
||||||
|
|
||||||
#define SPP_DEBUG_MODE 1
|
|
||||||
|
|
||||||
#define GATTS_TABLE_TAG "GATTS_SPP_DEMO"
|
|
||||||
|
|
||||||
#define SPP_PROFILE_NUM 1
|
|
||||||
#define SPP_PROFILE_APP_IDX 0
|
|
||||||
#define ESP_SPP_APP_ID 0x56
|
|
||||||
#define SAMPLE_DEVICE_NAME "ESP_SPP_SERVER" //The Device Name Characteristics in GAP
|
|
||||||
#define SPP_SVC_INST_ID 0
|
|
||||||
|
|
||||||
/// SPP Service
|
|
||||||
static const uint16_t spp_service_uuid = 0xABF0;
|
|
||||||
/// Characteristic UUID
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_RECEIVE 0xABF1
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_NOTIFY 0xABF2
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_RECEIVE 0xABF3
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_NOTIFY 0xABF4
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
#define ESP_GATT_UUID_SPP_HEARTBEAT 0xABF5
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*蓝牙的广播数据*/
|
|
||||||
static const uint8_t spp_adv_data[23] = {
|
|
||||||
/* Flags */
|
|
||||||
0x02,0x01,0x06, //表示设备支持LE General Discoverable Mode（可被发现模式）和BR/EDR Not Supported（不支持传统蓝牙）
|
|
||||||
/* Complete List of 16-bit Service Class UUIDs */
|
|
||||||
0x03,0x03,0xF0,0xAB,//广播数据中的16位服务UUID字段，表示设备提供了一个特定的服务，这里是自定义的16位UUID
|
|
||||||
/* Complete Local Name in advertising */
|
|
||||||
0x0F,0x09, 'E', 'S', 'P', '_', 'S', 'P', 'P', '_', 'S', 'E', 'R','V', 'E', 'R'
|
|
||||||
//广播数据中的16位服务UUID字段，表示设备提供了一个特定的服务，这里是自定义的16位UUID
|
|
||||||
};
|
|
||||||
|
|
||||||
static uint16_t spp_mtu_size = 23;
|
|
||||||
uint16_t spp_conn_id = 0xffff;
|
|
||||||
esp_gatt_if_t spp_gatts_if = 0xff;
|
|
||||||
QueueHandle_t spp_uart_queue = NULL;
|
|
||||||
static QueueHandle_t cmd_cmd_queue = NULL;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static QueueHandle_t cmd_heartbeat_queue = NULL;
|
|
||||||
static uint8_t heartbeat_s[9] = {'E','s','p','r','e','s','s','i','f'};
|
|
||||||
static bool enable_heart_ntf = false;
|
|
||||||
static uint8_t heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static bool enable_data_ntf = false;
|
|
||||||
bool is_connected = false;
|
|
||||||
static esp_bd_addr_t spp_remote_bda = {0x0,};
|
|
||||||
|
|
||||||
uint16_t spp_handle_table[SPP_IDX_NB];
|
|
||||||
|
|
||||||
static esp_ble_adv_params_t spp_adv_params = {
|
|
||||||
.adv_int_min = 0x20,
|
|
||||||
.adv_int_max = 0x40,
|
|
||||||
.adv_type = ADV_TYPE_IND,
|
|
||||||
.own_addr_type = BLE_ADDR_TYPE_PUBLIC,
|
|
||||||
.channel_map = ADV_CHNL_ALL,
|
|
||||||
.adv_filter_policy = ADV_FILTER_ALLOW_SCAN_ANY_CON_ANY,
|
|
||||||
};
|
|
||||||
|
|
||||||
struct gatts_profile_inst {
|
|
||||||
esp_gatts_cb_t gatts_cb;
|
|
||||||
uint16_t gatts_if;
|
|
||||||
uint16_t app_id;
|
|
||||||
uint16_t conn_id;
|
|
||||||
uint16_t service_handle;
|
|
||||||
esp_gatt_srvc_id_t service_id;
|
|
||||||
uint16_t char_handle;
|
|
||||||
esp_bt_uuid_t char_uuid;
|
|
||||||
esp_gatt_perm_t perm;
|
|
||||||
esp_gatt_char_prop_t property;
|
|
||||||
uint16_t descr_handle;
|
|
||||||
esp_bt_uuid_t descr_uuid;
|
|
||||||
};
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_node{
|
|
||||||
int32_t len;
|
|
||||||
uint8_t * node_buff;
|
|
||||||
struct spp_receive_data_node * next_node;
|
|
||||||
}spp_receive_data_node_t;
|
|
||||||
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p1 = NULL;
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p2 = NULL;
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_buff{
|
|
||||||
int32_t node_num;
|
|
||||||
int32_t buff_size;
|
|
||||||
spp_receive_data_node_t * first_node;
|
|
||||||
}spp_receive_data_buff_t;
|
|
||||||
|
|
||||||
static spp_receive_data_buff_t SppRecvDataBuff = {
|
|
||||||
.node_num = 0,
|
|
||||||
.buff_size = 0,
|
|
||||||
.first_node = NULL
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param);
|
|
||||||
|
|
||||||
/* One gatt-based profile one app_id and one gatts_if, this array will store the gatts_if returned by ESP_GATTS_REG_EVT */
|
|
||||||
static struct gatts_profile_inst spp_profile_tab[SPP_PROFILE_NUM] = {
|
|
||||||
[SPP_PROFILE_APP_IDX] = {
|
|
||||||
.gatts_cb = gatts_profile_event_handler,
|
|
||||||
.gatts_if = ESP_GATT_IF_NONE, /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* SPP PROFILE ATTRIBUTES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
|
|
||||||
#define CHAR_DECLARATION_SIZE (sizeof(uint8_t))
|
|
||||||
static const uint16_t primary_service_uuid = ESP_GATT_UUID_PRI_SERVICE; //0x2800
|
|
||||||
static const uint16_t character_declaration_uuid = ESP_GATT_UUID_CHAR_DECLARE; //0x2803
|
|
||||||
static const uint16_t character_client_config_uuid = ESP_GATT_UUID_CHAR_CLIENT_CONFIG; //0x2902
|
|
||||||
|
|
||||||
static const uint8_t char_prop_read_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
static const uint8_t char_prop_read_write = ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_READ;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static const uint8_t char_prop_read_write_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
///SPP Service - data receive characteristic, read&write without response
|
|
||||||
static const uint16_t spp_data_receive_uuid = ESP_GATT_UUID_SPP_DATA_RECEIVE; //0xABF1
|
|
||||||
static const uint8_t spp_data_receive_val[20] = {0x00};
|
|
||||||
|
|
||||||
///SPP Service - data notify characteristic, notify&read
|
|
||||||
static const uint16_t spp_data_notify_uuid = ESP_GATT_UUID_SPP_DATA_NOTIFY; //0xABF2
|
|
||||||
static const uint8_t spp_data_notify_val[20] = {0x00};
|
|
||||||
static const uint8_t spp_data_notify_ccc[2] = {0x00, 0x00};
|
|
||||||
|
|
||||||
///SPP Service - command characteristic, read&write without response
|
|
||||||
static const uint16_t spp_command_uuid = ESP_GATT_UUID_SPP_COMMAND_RECEIVE; //0xABF3
|
|
||||||
static const uint8_t spp_command_val[10] = {0x00};
|
|
||||||
|
|
||||||
///SPP Service - status characteristic, notify&read
|
|
||||||
static const uint16_t spp_status_uuid = ESP_GATT_UUID_SPP_COMMAND_NOTIFY; //0xABF4
|
|
||||||
static const uint8_t spp_status_val[10] = {0x00};
|
|
||||||
static const uint8_t spp_status_ccc[2] = {0x00, 0x00};//状态特征值。这个值允许其他设备配置是否接收状态特征通知,这里是禁用
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
///SPP Server - Heart beat characteristic, notify&write&read
|
|
||||||
static const uint16_t spp_heart_beat_uuid = ESP_GATT_UUID_SPP_HEARTBEAT;
|
|
||||||
static const uint8_t spp_heart_beat_val[2] = {0x00, 0x00};
|
|
||||||
static const uint8_t spp_heart_beat_ccc[2] = {0x00, 0x00};
|
|
||||||
#endif
|
|
||||||
|
|
||||||
///Full HRS Database Description - Used to add attributes into the database
|
|
||||||
static const esp_gatts_attr_db_t spp_gatt_db[SPP_IDX_NB] =
|
|
||||||
{
|
|
||||||
//SPP - Service Declaration 服务声明
|
|
||||||
[SPP_IDX_SVC] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&primary_service_uuid, //0x2800
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
sizeof(spp_service_uuid), //0xABF0
|
|
||||||
sizeof(spp_service_uuid),
|
|
||||||
(uint8_t *)&spp_service_uuid
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Declaration 声明服务中数据接受特征
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_write
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Value spp服务中数据接收特征值
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_data_receive_uuid, //0xABF1
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,
|
|
||||||
sizeof(spp_data_receive_val),
|
|
||||||
(uint8_t *)spp_data_receive_val //0x00
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Declaration spp协议中数据通知特征
|
|
||||||
[SPP_IDX_SPP_DATA_NOTIFY_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_notify
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Value 数据通知特征的值
|
|
||||||
[SPP_IDX_SPP_DATA_NTY_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_data_notify_uuid, //0xABF2
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
SPP_DATA_MAX_LEN,
|
|
||||||
sizeof(spp_data_notify_val),
|
|
||||||
(uint8_t *)spp_data_notify_val //0x00
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
//数据通知特征的客户端特性配置描述符,用于配置特征的行为和交互方式,客户端特性配置描述符用于配置该特征是否可以发送通知给连接的设备
|
|
||||||
[SPP_IDX_SPP_DATA_NTF_CFG] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_client_config_uuid, //0x2902
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),
|
|
||||||
sizeof(spp_data_notify_ccc),
|
|
||||||
(uint8_t *)spp_data_notify_ccc //{0x00, 0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - command characteristic Declaration 命令特征声明
|
|
||||||
[SPP_IDX_SPP_COMMAND_CHAR]= {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_write
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - command characteristic Value 命令特征值
|
|
||||||
[SPP_IDX_SPP_COMMAND_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_command_uuid, //0xABF3
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_CMD_MAX_LEN,
|
|
||||||
sizeof(spp_command_val),
|
|
||||||
(uint8_t *)spp_command_val //{0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_STATUS_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_notify
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic Value
|
|
||||||
[SPP_IDX_SPP_STATUS_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_status_uuid, //0xABF4
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
SPP_STATUS_MAX_LEN,
|
|
||||||
sizeof(spp_status_val),
|
|
||||||
(uint8_t *)spp_status_val //{0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_STATUS_CFG] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_client_config_uuid, //0x2902
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),
|
|
||||||
sizeof(spp_status_ccc),
|
|
||||||
(uint8_t *)spp_status_ccc //{0x00, 0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
//SPP - Heart beat characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write_notify}},
|
|
||||||
|
|
||||||
//SPP - Heart beat characteristic Value
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_heart_beat_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(spp_heart_beat_val), sizeof(spp_heart_beat_val), (uint8_t *)spp_heart_beat_val}},
|
|
||||||
|
|
||||||
//SPP - Heart beat characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_CFG] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),sizeof(spp_data_notify_ccc), (uint8_t *)spp_heart_beat_ccc}},
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
/*在 spp_handle_table 数组中查找与给定句柄匹配的特性或描述符，返回其索引值。如果没有找到匹配的值，则返回 0xff*/
|
|
||||||
static uint8_t find_char_and_desr_index(uint16_t handle)
|
|
||||||
{
|
|
||||||
uint8_t error = 0xff;
|
|
||||||
|
|
||||||
for(int i = 0; i < SPP_IDX_NB ; i++){
|
|
||||||
if(handle == spp_handle_table[i]){
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return error;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*存储写入缓冲区的数据*/
|
|
||||||
static bool store_wr_buffer(esp_ble_gatts_cb_param_t *p_data)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = (spp_receive_data_node_t *)malloc(sizeof(spp_receive_data_node_t));
|
|
||||||
|
|
||||||
if(temp_spp_recv_data_node_p1 == NULL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "malloc error %s %d\n", __func__, __LINE__);
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
if(temp_spp_recv_data_node_p2 != NULL){
|
|
||||||
temp_spp_recv_data_node_p2->next_node = temp_spp_recv_data_node_p1;
|
|
||||||
}
|
|
||||||
temp_spp_recv_data_node_p1->len = p_data->write.len;
|
|
||||||
SppRecvDataBuff.buff_size += p_data->write.len;
|
|
||||||
temp_spp_recv_data_node_p1->next_node = NULL;
|
|
||||||
temp_spp_recv_data_node_p1->node_buff = (uint8_t *)malloc(p_data->write.len);
|
|
||||||
temp_spp_recv_data_node_p2 = temp_spp_recv_data_node_p1;
|
|
||||||
memcpy(temp_spp_recv_data_node_p1->node_buff,p_data->write.value,p_data->write.len);
|
|
||||||
if(SppRecvDataBuff.node_num == 0){
|
|
||||||
SppRecvDataBuff.first_node = temp_spp_recv_data_node_p1;
|
|
||||||
SppRecvDataBuff.node_num++;
|
|
||||||
}else{
|
|
||||||
SppRecvDataBuff.node_num++;
|
|
||||||
}
|
|
||||||
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
//释放缓冲区内存
|
|
||||||
static void free_write_buffer(void)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = SppRecvDataBuff.first_node;
|
|
||||||
|
|
||||||
while(temp_spp_recv_data_node_p1 != NULL){
|
|
||||||
temp_spp_recv_data_node_p2 = temp_spp_recv_data_node_p1->next_node;
|
|
||||||
free(temp_spp_recv_data_node_p1->node_buff);
|
|
||||||
free(temp_spp_recv_data_node_p1);
|
|
||||||
temp_spp_recv_data_node_p1 = temp_spp_recv_data_node_p2;
|
|
||||||
}
|
|
||||||
|
|
||||||
SppRecvDataBuff.node_num = 0;
|
|
||||||
SppRecvDataBuff.buff_size = 0;
|
|
||||||
SppRecvDataBuff.first_node = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*将缓冲区数据写入uart*/
|
|
||||||
static void print_write_buffer(void)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = SppRecvDataBuff.first_node;
|
|
||||||
|
|
||||||
while(temp_spp_recv_data_node_p1 != NULL){
|
|
||||||
uart_write_bytes(UART_NUM_2, (char *)(temp_spp_recv_data_node_p1->node_buff), temp_spp_recv_data_node_p1->len);
|
|
||||||
temp_spp_recv_data_node_p1 = temp_spp_recv_data_node_p1->next_node;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//蓝牙设备接收到消息后将分组数据通过蓝牙的 GATT Indicate 方式发送给蓝牙连接的设备（也就是蓝牙客户端）
|
|
||||||
void uart_task(void *pvParameters)
|
|
||||||
{
|
|
||||||
uart_event_t event;
|
|
||||||
uint8_t total_num = 0;
|
|
||||||
uint8_t current_num = 0;
|
|
||||||
|
|
||||||
for (;;) {
|
|
||||||
//Waiting for UART event.
|
|
||||||
if (xQueueReceive(spp_uart_queue, (void * )&event, 10/portTICK_PERIOD_MS)) {
|
|
||||||
switch (event.type) {
|
|
||||||
//Event of UART receving data
|
|
||||||
case UART_DATA:
|
|
||||||
if ((event.size)&&(is_connected)) {
|
|
||||||
uint8_t * temp = NULL;
|
|
||||||
uint8_t * ntf_value_p = NULL;
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
if(!enable_heart_ntf){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s do not enable heartbeat Notify\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
if(!enable_data_ntf){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s do not enable data Notify\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
temp = (uint8_t *)malloc(sizeof(uint8_t)*event.size);
|
|
||||||
if(temp == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc.1 failed\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
//将数据通过uart串口读入缓冲区
|
|
||||||
memset(temp,0x0,event.size);
|
|
||||||
uart_read_bytes(UART_NUM_2,temp,event.size,10/portTICK_PERIOD_MS);
|
|
||||||
|
|
||||||
if(event.size <= (spp_mtu_size - 3)){ //spp_mtu_size - 3是一个分组的最大容量
|
|
||||||
//向gatt发送indicate消息
|
|
||||||
//1.接口号2.连接id 3.特征句柄 4.数据长度 5.数据指针
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[4],
|
|
||||||
event.size,
|
|
||||||
temp,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}else if(event.size > (spp_mtu_size - 3)){
|
|
||||||
if((event.size%(spp_mtu_size - 7)) == 0){
|
|
||||||
total_num = event.size/(spp_mtu_size - 7);//spp_mtu_size - 7是有效负载大小
|
|
||||||
}else{
|
|
||||||
total_num = event.size/(spp_mtu_size - 7) + 1;
|
|
||||||
}
|
|
||||||
current_num = 1;
|
|
||||||
ntf_value_p = (uint8_t *)malloc((spp_mtu_size-3)*sizeof(uint8_t));
|
|
||||||
if(ntf_value_p == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc.2 failed\n", __func__);
|
|
||||||
free(temp);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
while(current_num <= total_num){
|
|
||||||
if(current_num < total_num){
|
|
||||||
ntf_value_p[0] = '#';
|
|
||||||
ntf_value_p[1] = '#';
|
|
||||||
ntf_value_p[2] = total_num;
|
|
||||||
ntf_value_p[3] = current_num;
|
|
||||||
memcpy(ntf_value_p + 4,temp + (current_num - 1)*(spp_mtu_size-7),(spp_mtu_size-7));
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[SPP_IDX_SPP_DATA_NTY_VAL],
|
|
||||||
(spp_mtu_size-3),
|
|
||||||
ntf_value_p,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}else if(current_num == total_num){
|
|
||||||
ntf_value_p[0] = '#';
|
|
||||||
ntf_value_p[1] = '#';
|
|
||||||
ntf_value_p[2] = total_num;
|
|
||||||
ntf_value_p[3] = current_num;
|
|
||||||
memcpy(ntf_value_p + 4,temp + (current_num - 1)*(spp_mtu_size-7),(event.size - (current_num - 1)*(spp_mtu_size - 7)));
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[SPP_IDX_SPP_DATA_NTY_VAL],
|
|
||||||
(event.size - (current_num - 1)*(spp_mtu_size - 7) + 4),
|
|
||||||
ntf_value_p,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}
|
|
||||||
vTaskDelay(20 / portTICK_PERIOD_MS);
|
|
||||||
current_num++;
|
|
||||||
}
|
|
||||||
free(ntf_value_p);
|
|
||||||
}
|
|
||||||
free(temp);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void spp_uart_init(void)
|
|
||||||
{
|
|
||||||
uart_config_t uart_config = {
|
|
||||||
.baud_rate = 115200,
|
|
||||||
.data_bits = UART_DATA_8_BITS,
|
|
||||||
.parity = UART_PARITY_DISABLE,
|
|
||||||
.stop_bits = UART_STOP_BITS_1,
|
|
||||||
.flow_ctrl = UART_HW_FLOWCTRL_RTS,
|
|
||||||
.rx_flow_ctrl_thresh = 122,
|
|
||||||
.source_clk = UART_SCLK_APB,
|
|
||||||
};
|
|
||||||
|
|
||||||
//Install UART driver, and get the queue.
|
|
||||||
uart_driver_install(UART_NUM_2, 4096, 8192, 10, &spp_uart_queue,0);
|
|
||||||
//Set UART parameters
|
|
||||||
uart_param_config(UART_NUM_2, &uart_config);
|
|
||||||
//Set UART pins
|
|
||||||
uart_set_pin(UART_NUM_2, 14, 21, 47, UART_PIN_NO_CHANGE);
|
|
||||||
xTaskCreate(uart_task, "uTask", 2048, (void*)UART_NUM_2, 8, NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
void spp_heartbeat_task(void * arg)
|
|
||||||
{
|
|
||||||
uint16_t cmd_id;
|
|
||||||
|
|
||||||
for(;;) {
|
|
||||||
vTaskDelay(50 / portTICK_PERIOD_MS);
|
|
||||||
if(xQueueReceive(cmd_heartbeat_queue, &cmd_id, portMAX_DELAY)) {
|
|
||||||
while(1){
|
|
||||||
heartbeat_count_num++;
|
|
||||||
vTaskDelay(5000/ portTICK_PERIOD_MS);
|
|
||||||
if((heartbeat_count_num >3)&&(is_connected)){
|
|
||||||
esp_ble_gap_disconnect(spp_remote_bda);
|
|
||||||
}
|
|
||||||
if(is_connected && enable_heart_ntf){
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if, spp_conn_id, spp_handle_table[SPP_IDX_SPP_HEARTBEAT_VAL],sizeof(heartbeat_s), heartbeat_s, false);
|
|
||||||
}else if(!is_connected){
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
//通过接收队列获取蓝牙命令数据，进行相应的处理，然后打印到系统日志并释放相关内存
|
|
||||||
void spp_cmd_task(void * arg)
|
|
||||||
{
|
|
||||||
uint8_t * cmd_id;
|
|
||||||
|
|
||||||
for(;;){
|
|
||||||
vTaskDelay(50 / portTICK_PERIOD_MS);
|
|
||||||
if(xQueueReceive(cmd_cmd_queue, &cmd_id, 10 / portTICK_PERIOD_MS)) {
|
|
||||||
esp_log_buffer_char(GATTS_TABLE_TAG,(char *)(cmd_id),strlen((char *)cmd_id));
|
|
||||||
free(cmd_id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void spp_task_init(void)
|
|
||||||
{
|
|
||||||
spp_uart_init();
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
cmd_heartbeat_queue = xQueueCreate(10, sizeof(uint32_t));
|
|
||||||
xTaskCreate(spp_heartbeat_task, "spp_heartbeat_task", 2048, NULL, 10, NULL);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
cmd_cmd_queue = xQueueCreate(10, sizeof(uint32_t));
|
|
||||||
xTaskCreate(spp_cmd_task, "spp_cmd_task", 2048, NULL, 10, NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*gap事件回调函数*/
|
|
||||||
static void gap_event_handler(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_err_t err;
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "GAP_EVT, event %d\n", event);
|
|
||||||
|
|
||||||
switch (event) {
|
|
||||||
/*表示原始广播数据设置完成*/
|
|
||||||
case ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT:
|
|
||||||
/*启动广播，并传递蓝牙广播参数 spp_adv_params*/
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT:
|
|
||||||
//advertising start complete event to indicate advertising start successfully or failed
|
|
||||||
if((err = param->adv_start_cmpl.status) != ESP_BT_STATUS_SUCCESS) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Advertising start failed: %s\n", esp_err_to_name(err));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*处理gatt事件的回调函数,根据不同的请求执行不同的操作*/
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_ble_gatts_cb_param_t *p_data = (esp_ble_gatts_cb_param_t *) param;
|
|
||||||
uint8_t res = 0xff;
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "event = %x\n",event);
|
|
||||||
switch (event) {
|
|
||||||
|
|
||||||
//gatt服务器注册事件
|
|
||||||
case ESP_GATTS_REG_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//设置蓝牙设备名称
|
|
||||||
esp_ble_gap_set_device_name(SAMPLE_DEVICE_NAME);
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//配置蓝牙广播数据的原始数据
|
|
||||||
esp_ble_gap_config_adv_data_raw((uint8_t *)spp_adv_data, sizeof(spp_adv_data));
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//创建gatt服务的属性表
|
|
||||||
esp_ble_gatts_create_attr_tab(spp_gatt_db, gatts_if, SPP_IDX_NB, SPP_SVC_INST_ID);
|
|
||||||
break;
|
|
||||||
|
|
||||||
//收到读取数据的请求
|
|
||||||
case ESP_GATTS_READ_EVT:
|
|
||||||
//找到对应句柄,返回对应索引
|
|
||||||
res = find_char_and_desr_index(p_data->read.handle);
|
|
||||||
if(res == SPP_IDX_SPP_STATUS_VAL){
|
|
||||||
//TODO:client read the status characteristic
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
//收到写数据的请求
|
|
||||||
case ESP_GATTS_WRITE_EVT: {
|
|
||||||
res = find_char_and_desr_index(p_data->write.handle);
|
|
||||||
if(p_data->write.is_prep == false){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_WRITE_EVT : handle = %d\n", res);
|
|
||||||
if(res == SPP_IDX_SPP_COMMAND_VAL){
|
|
||||||
uint8_t * spp_cmd_buff = NULL;
|
|
||||||
spp_cmd_buff = (uint8_t *)malloc((spp_mtu_size - 3) * sizeof(uint8_t));
|
|
||||||
if(spp_cmd_buff == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc failed\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
memset(spp_cmd_buff,0x0,(spp_mtu_size - 3));
|
|
||||||
memcpy(spp_cmd_buff,p_data->write.value,p_data->write.len);
|
|
||||||
xQueueSend(cmd_cmd_queue,&spp_cmd_buff,10/portTICK_PERIOD_MS);
|
|
||||||
|
|
||||||
//SPP 数据通知配置
|
|
||||||
}else if(res == SPP_IDX_SPP_DATA_NTF_CFG){
|
|
||||||
//第一个字节为 0x01，第二个字节为 0x00。如果条件满足，则将 enable_data_ntf 设置为 true，表示启用数据通知
|
|
||||||
if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x01)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = true;
|
|
||||||
}else if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x00)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
else if(res == SPP_IDX_SPP_HEARTBEAT_CFG){
|
|
||||||
if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x01)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_heart_ntf = true;
|
|
||||||
}else if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x00)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_heart_ntf = false;
|
|
||||||
}
|
|
||||||
}else if(res == SPP_IDX_SPP_HEARTBEAT_VAL){
|
|
||||||
if((p_data->write.len == sizeof(heartbeat_s))&&(memcmp(heartbeat_s,p_data->write.value,sizeof(heartbeat_s)) == 0)){
|
|
||||||
heartbeat_count_num = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
else if(res == SPP_IDX_SPP_DATA_RECV_VAL){
|
|
||||||
#ifdef SPP_DEBUG_MODE
|
|
||||||
esp_log_buffer_char(GATTS_TABLE_TAG,(char *)(p_data->write.value),p_data->write.len);
|
|
||||||
#else
|
|
||||||
uart_write_bytes(UART_NUM_2, (char *)(p_data->write.value), p_data->write.len);
|
|
||||||
#endif
|
|
||||||
}else{
|
|
||||||
//TODO:
|
|
||||||
}
|
|
||||||
}else if((p_data->write.is_prep == true)&&(res == SPP_IDX_SPP_DATA_RECV_VAL)){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_PREP_WRITE_EVT : handle = %d\n", res);
|
|
||||||
store_wr_buffer(p_data);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
//执行写入操作
|
|
||||||
case ESP_GATTS_EXEC_WRITE_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_EXEC_WRITE_EVT\n");
|
|
||||||
if(p_data->exec_write.exec_write_flag){
|
|
||||||
print_write_buffer();
|
|
||||||
free_write_buffer();
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case ESP_GATTS_MTU_EVT:
|
|
||||||
spp_mtu_size = p_data->mtu.mtu;
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONF_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_UNREG_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DELETE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_START_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_STOP_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONNECT_EVT:
|
|
||||||
spp_conn_id = p_data->connect.conn_id;
|
|
||||||
spp_gatts_if = gatts_if;
|
|
||||||
is_connected = true;
|
|
||||||
memcpy(&spp_remote_bda,&p_data->connect.remote_bda,sizeof(esp_bd_addr_t));
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
uint16_t cmd = 0;
|
|
||||||
xQueueSend(cmd_heartbeat_queue,&cmd,10/portTICK_PERIOD_MS);
|
|
||||||
#endif
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DISCONNECT_EVT:
|
|
||||||
is_connected = false;
|
|
||||||
enable_data_ntf = false;
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
enable_heart_ntf = false;
|
|
||||||
heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CANCEL_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CLOSE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_LISTEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONGEST_EVT:
|
|
||||||
break;
|
|
||||||
//gatt创建属性表
|
|
||||||
case ESP_GATTS_CREAT_ATTR_TAB_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "The number handle =%x\n",param->add_attr_tab.num_handle);
|
|
||||||
if (param->add_attr_tab.status != ESP_GATT_OK){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table failed, error code=0x%x", param->add_attr_tab.status);
|
|
||||||
}
|
|
||||||
else if (param->add_attr_tab.num_handle != SPP_IDX_NB){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table abnormally, num_handle (%d) doesn't equal to HRS_IDX_NB(%d)", param->add_attr_tab.num_handle, SPP_IDX_NB);
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
memcpy(spp_handle_table, param->add_attr_tab.handles, sizeof(spp_handle_table));
|
|
||||||
//启动gatt服务
|
|
||||||
esp_ble_gatts_start_service(spp_handle_table[SPP_IDX_SVC]);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*gatt事件回调函数*/ //gatt属于ble的一个协议层
|
|
||||||
static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "EVT %d, gatts if %d\n", event, gatts_if);//打印接口标识符gatts_if
|
|
||||||
|
|
||||||
/* If event is register event, store the gatts_if for each profile */
|
|
||||||
//GATT 注册事件
|
|
||||||
if (event == ESP_GATTS_REG_EVT) {
|
|
||||||
if (param->reg.status == ESP_GATT_OK) {
|
|
||||||
spp_profile_tab[SPP_PROFILE_APP_IDX].gatts_if = gatts_if;
|
|
||||||
} else {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "Reg app failed, app_id %04x, status %d\n",param->reg.app_id, param->reg.status);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//循环遍历 spp_profile_tab 结构体中的配置文件，根据条件判断是否需要调用回调函数处理事件
|
|
||||||
do {
|
|
||||||
int idx;
|
|
||||||
for (idx = 0; idx < SPP_PROFILE_NUM; idx++) {
|
|
||||||
|
|
||||||
/* 表示没有指定特定的 gatts_if ,需要调用每个配置文件的回调函数*/
|
|
||||||
if (gatts_if == ESP_GATT_IF_NONE || gatts_if == spp_profile_tab[idx].gatts_if) {
|
|
||||||
if (spp_profile_tab[idx].gatts_cb) {
|
|
||||||
spp_profile_tab[idx].gatts_cb(event, gatts_if, param);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
} while (0);
|
|
||||||
}
|
|
||||||
|
|
||||||
void bt_client_init(void)
|
|
||||||
{
|
|
||||||
esp_err_t ret;
|
|
||||||
esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
||||||
|
|
||||||
/*初始化nvs*/
|
|
||||||
// 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 );
|
|
||||||
|
|
||||||
/*对 BTDM 控制器的 ROM（只读存储器）数据进行初始化操作*/
|
|
||||||
ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_CLASSIC_BT));
|
|
||||||
|
|
||||||
/*蓝牙控制器初始化*/
|
|
||||||
ret = esp_bt_controller_init(&bt_cfg);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*蓝牙控制器使能*/
|
|
||||||
ret = esp_bt_controller_enable(ESP_BT_MODE_BLE);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s init bluetooth\n", __func__);
|
|
||||||
|
|
||||||
/*初始化蓝牙协议栈r*/
|
|
||||||
ret = esp_bluedroid_init();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s init bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*使能蓝牙协议栈*/
|
|
||||||
ret = esp_bluedroid_enable();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*注册ble的gap和gatt回调函数*/
|
|
||||||
esp_ble_gatts_register_callback(gatts_event_handler);
|
|
||||||
esp_ble_gap_register_callback(gap_event_handler);
|
|
||||||
|
|
||||||
/*注册gatt服务应用*/
|
|
||||||
esp_ble_gatts_app_register(ESP_SPP_APP_ID);
|
|
||||||
|
|
||||||
/*spp任务初始化*/
|
|
||||||
spp_task_init(); //初始化uart，创建消息队列以及任务
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
@ -1,42 +0,0 @@
|
|||||||
#include <stdio.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
/*
|
|
||||||
* DEFINES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
//#define SUPPORT_HEARTBEAT
|
|
||||||
//#define SPP_DEBUG_MODE
|
|
||||||
|
|
||||||
#define spp_sprintf(s,...) sprintf((char*)(s), ##__VA_ARGS__)
|
|
||||||
#define SPP_DATA_MAX_LEN (512)
|
|
||||||
#define SPP_CMD_MAX_LEN (20)
|
|
||||||
#define SPP_STATUS_MAX_LEN (20)
|
|
||||||
#define SPP_DATA_BUFF_MAX_LEN (2*1024)
|
|
||||||
///Attributes State Machine
|
|
||||||
enum{
|
|
||||||
SPP_IDX_SVC,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_RECV_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_RECV_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_NOTIFY_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_NTY_VAL,
|
|
||||||
SPP_IDX_SPP_DATA_NTF_CFG,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_COMMAND_CHAR,
|
|
||||||
SPP_IDX_SPP_COMMAND_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_STATUS_CHAR,
|
|
||||||
SPP_IDX_SPP_STATUS_VAL,
|
|
||||||
SPP_IDX_SPP_STATUS_CFG,
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CHAR,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_VAL,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CFG,
|
|
||||||
#endif
|
|
||||||
|
|
||||||
SPP_IDX_NB,
|
|
||||||
};
|
|
||||||
192
main/communication_tcp.c
Normal file
192
main/communication_tcp.c
Normal file
@ -0,0 +1,192 @@
|
|||||||
|
#include <stdint.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "lwip/ip_addr.h"
|
||||||
|
#include "lwip/tcp.h"
|
||||||
|
#include "lwip/err.h"
|
||||||
|
#include "lwip/opt.h"
|
||||||
|
#include "lwip/sockets.h"
|
||||||
|
#include "stm32/ModbusS.h"
|
||||||
|
#include "esp_log.h"
|
||||||
|
|
||||||
|
#define LOG_TAG "[communication_tcp_sr]: "
|
||||||
|
|
||||||
|
bool tcp_is_connected = false;
|
||||||
|
extern bool data_notify_enable; /* 是否允许数据上报 */
|
||||||
|
extern void gatts_write_data_cb(uint8_t *data, uint32_t len);
|
||||||
|
|
||||||
|
static err_t ModBusSlave_recv(void *arg, struct tcp_pcb *newpcb, struct pbuf *p, err_t err) {
|
||||||
|
if (p != NULL) {
|
||||||
|
uint8_t *rxbuf;
|
||||||
|
int rxlen;
|
||||||
|
tcp_recved(newpcb, p->tot_len);
|
||||||
|
rxbuf = (uint8_t *)p->payload;
|
||||||
|
rxlen = p->len;
|
||||||
|
ESP_LOGI(LOG_TAG, "recive data %d:", rxlen);
|
||||||
|
esp_log_buffer_hex(LOG_TAG, rxbuf, rxlen);
|
||||||
|
gatts_write_data_cb(rxbuf, rxlen);
|
||||||
|
pbuf_free(p);
|
||||||
|
}
|
||||||
|
else if (err == ERR_OK)
|
||||||
|
{
|
||||||
|
ESP_LOGI(LOG_TAG, "gps1 remote end is closing the connection\n");
|
||||||
|
for (uint8_t i = 0; i < 1; i++)
|
||||||
|
{ // 清空所有客户端
|
||||||
|
gps1_acce_newpacb[i] = 0;
|
||||||
|
}
|
||||||
|
tcp_err(newpcb, NULL);
|
||||||
|
tcp_recv(newpcb, NULL);
|
||||||
|
tcp_poll(newpcb, NULL, 120);
|
||||||
|
err_t err_p = tcp_close(newpcb);
|
||||||
|
tcp_is_connected = false;
|
||||||
|
if (ERR_OK != err_p)
|
||||||
|
{
|
||||||
|
ESP_LOGI(LOG_TAG, "gps1 close error. err:%d\n", err_p);
|
||||||
|
}
|
||||||
|
return err_p;
|
||||||
|
}
|
||||||
|
return ERR_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void ModBusSlave_conn_err(void *arg, err_t err) {
|
||||||
|
// log_printf(LERROR, LOG_TAG "connection error, err:%d\n", err);
|
||||||
|
tcp_is_connected = false;
|
||||||
|
}
|
||||||
|
static err_t ModBusSlave_poll(void *arg, struct tcp_pcb *newpcb) {
|
||||||
|
// if (newpcb) {
|
||||||
|
// // log_printf(LERROR, LOG_TAG "close pcb\n");
|
||||||
|
// tcp_close(newpcb);
|
||||||
|
// newpcb = NULL;
|
||||||
|
// }
|
||||||
|
ESP_LOGI(LOG_TAG, "poll!");
|
||||||
|
return ERR_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static err_t ModBusSlave_accept(void *arg, struct tcp_pcb *pcb, err_t err) {
|
||||||
|
tcp_err(pcb, ModBusSlave_conn_err);
|
||||||
|
tcp_recv(pcb, ModBusSlave_recv);
|
||||||
|
tcp_poll(pcb, ModBusSlave_poll, 120); // 60 second timeout
|
||||||
|
/* Send out the first message */
|
||||||
|
// tcp_write(pcb, GREETING, strlen(GREETING), 1);
|
||||||
|
tcp_is_connected = true;
|
||||||
|
return ERR_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void notify_all_data(void)
|
||||||
|
{
|
||||||
|
ESP_LOGI(GATTS_TABLE_TAG, "notify_all_data");
|
||||||
|
uint8_t buf[1024];
|
||||||
|
|
||||||
|
buf[0] = 1; /* tag:深度：速度 时间 深度 桩号 */
|
||||||
|
buf[1] = 8;
|
||||||
|
buf[2] = depth_data->speed & 0xff;
|
||||||
|
buf[3] = (depth_data->speed >> 8) & 0xff;
|
||||||
|
buf[4] = depth_data->one_pile_work_time & 0xff;
|
||||||
|
buf[5] = (depth_data->one_pile_work_time >> 8) & 0xff;
|
||||||
|
buf[6] = depth_data->depth & 0xff;
|
||||||
|
buf[7] = (depth_data->depth >> 8) & 0xff;
|
||||||
|
buf[8] = gWordVar[LAST_PILE_ID_ADDR] & 0xff;
|
||||||
|
buf[9] = (gWordVar[LAST_PILE_ID_ADDR] >> 8) & 0xff;
|
||||||
|
|
||||||
|
|
||||||
|
buf[10] = 2; /* tag:1号通道流量:瞬时，每10cm，总 */
|
||||||
|
buf[11] = 6;
|
||||||
|
buf[12] = pflow[0].flow & 0xff;
|
||||||
|
buf[13] = (pflow[0].flow >> 8) & 0xff;
|
||||||
|
buf[14] = depth_data->depth_flow[0] & 0xff;
|
||||||
|
buf[15] = (depth_data->depth_flow[0] >> 8) & 0xff;
|
||||||
|
buf[16] = pflow[0].total_flow & 0xff;
|
||||||
|
buf[17] = (pflow[0].total_flow >> 8) & 0xff;
|
||||||
|
|
||||||
|
buf[18] = 3; /* tag:2号通道流量:瞬时，每10cm，总 */
|
||||||
|
buf[19] = 6;
|
||||||
|
buf[20] = pflow[1].flow & 0xff;
|
||||||
|
buf[21] = (pflow[1].flow >> 8) & 0xff;
|
||||||
|
buf[22] = depth_data->depth_flow[1] & 0xff;
|
||||||
|
buf[23] = (depth_data->depth_flow[1] >> 8) & 0xff;
|
||||||
|
buf[24] = pflow[1].total_flow & 0xff;
|
||||||
|
buf[25] = (pflow[1].total_flow >> 8) & 0xff;
|
||||||
|
|
||||||
|
buf[26] = 4; /* tag:电流:三个*/
|
||||||
|
buf[27] = 6;
|
||||||
|
buf[28] = gWordVar[AC_CURRENT_REG_ADDR + 0] & 0xff;
|
||||||
|
buf[29] = (gWordVar[AC_CURRENT_REG_ADDR + 0] >> 8) & 0xff;
|
||||||
|
buf[30] = gWordVar[AC_CURRENT_REG_ADDR + 1] & 0xff;
|
||||||
|
buf[31] = (gWordVar[AC_CURRENT_REG_ADDR + 1] >> 8) & 0xff;
|
||||||
|
buf[32] = gWordVar[AC_CURRENT_REG_ADDR + 2] & 0xff;
|
||||||
|
buf[33] = (gWordVar[AC_CURRENT_REG_ADDR + 2] >> 8) & 0xff;
|
||||||
|
|
||||||
|
|
||||||
|
int64_t x = (int64_t)(gpsMessageP->x * 1000);
|
||||||
|
int64_t y = (int64_t)(gpsMessageP->y * 1000);
|
||||||
|
uint16_t dir = (uint16_t)(gpsMessageP->dir * 100);
|
||||||
|
uint16_t pitch = (uint16_t)(gpsMessageP->pitch * 100);
|
||||||
|
uint8_t gps_status = gpsMessageP->gps_status;
|
||||||
|
uint32_t utc_time = gpsMessageP->utc;
|
||||||
|
// ESP_LOGI(GATTS_TABLE_TAG, "x:%f, %f, %lld", gpsMessageP->x, gpsMessageP->x * 1000, (long long int)(gpsMessageP->x * 1000));
|
||||||
|
// ESP_LOGI(GATTS_TABLE_TAG, "gps message x:%lld, y:%lld, dir:%ud, pitch:%ud, gps_status:%d, utc_time:%ud", (long long)x, (long long)y, (unsigned int)dir, (unsigned int)pitch, (int)gps_status, (unsigned int)utc_time);
|
||||||
|
buf[34] = 5; /* tag:CPS信息1:x, y(int64)*/
|
||||||
|
buf[35] = 16;
|
||||||
|
buf[36] = x & 0xff;
|
||||||
|
buf[37] = (x >> 8) & 0xff;
|
||||||
|
buf[38] = (x >> 16) & 0xff;
|
||||||
|
buf[39] = (x >> 24) & 0xff;
|
||||||
|
buf[40] = (x >> 32) & 0xff;
|
||||||
|
buf[41] = (x >> 40) & 0xff;
|
||||||
|
buf[42] = (x >> 48) & 0xff;
|
||||||
|
buf[43] = (x >> 56) & 0xff;
|
||||||
|
buf[44] = y & 0xff;
|
||||||
|
buf[45] = (y >> 8) & 0xff;
|
||||||
|
buf[56] = (y >> 16) & 0xff;
|
||||||
|
buf[47] = (y >> 24) & 0xff;
|
||||||
|
buf[48] = (y >> 32) & 0xff;
|
||||||
|
buf[49] = (y >> 40) & 0xff;
|
||||||
|
buf[50] = (y >> 48) & 0xff;
|
||||||
|
buf[51] = (y >> 56) & 0xff;
|
||||||
|
|
||||||
|
buf[52] = 6; /* tag:CPS信息2:方向，俯仰(uint16)， gps定位状态(uint8)， UTC时间(uint32)*/
|
||||||
|
buf[53] = 9;
|
||||||
|
buf[54] = dir & 0xff;
|
||||||
|
buf[55] = (dir >> 8) & 0xff;
|
||||||
|
buf[56] = pitch & 0xff;
|
||||||
|
buf[57] = (pitch >> 8) & 0xff;
|
||||||
|
buf[58] = utc_time & 0xff;
|
||||||
|
buf[59] = (utc_time >> 8) & 0xff;
|
||||||
|
buf[60] = (utc_time >> 16) & 0xff;
|
||||||
|
buf[61] = (utc_time >> 24) & 0xff;
|
||||||
|
buf[62] = gps_status & 0xff;
|
||||||
|
/* 需要上报什么数据在此处添加 */
|
||||||
|
|
||||||
|
// tcp_write(pcb, GREETING, strlen(GREETING), 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void notify_tcp_task(void *pvParameters)
|
||||||
|
{
|
||||||
|
ESP_LOGI(GATTS_TABLE_TAG, "notify_tcp_task");
|
||||||
|
while (1)
|
||||||
|
{
|
||||||
|
if (data_notify_enable && tcp_is_connected)
|
||||||
|
{
|
||||||
|
notify_all_data();
|
||||||
|
}
|
||||||
|
vTaskDelay(pdMS_TO_TICKS(100));
|
||||||
|
}
|
||||||
|
|
||||||
|
vTaskDelete(NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void communication_tcp_init(void) {
|
||||||
|
struct tcp_pcb *pcb;
|
||||||
|
pcb = tcp_new();
|
||||||
|
tcp_bind(pcb, IP_ADDR_ANY, 6061);
|
||||||
|
pcb = tcp_listen(pcb);
|
||||||
|
tcp_accept(pcb, ModBusSlave_accept);
|
||||||
|
|
||||||
|
xTaskCreate(notify_tcp_task, "notify_tcp_Task", 4096, NULL, 8, NULL);
|
||||||
|
}
|
||||||
|
|
||||||
@ -121,7 +121,7 @@ void app_main(void)
|
|||||||
wifi_init_softap();//ok
|
wifi_init_softap();//ok
|
||||||
// wifi_init_sta();
|
// wifi_init_sta();
|
||||||
// can_init();
|
// can_init();
|
||||||
// PWR_4G_Init();
|
// PWR_4G_Init();
|
||||||
ModBusTCPSlave_init();
|
ModBusTCPSlave_init();
|
||||||
|
|
||||||
ads1220_task_start(); /* 两路电流AD采样获取瞬时流量，计算累计流量 */
|
ads1220_task_start(); /* 两路电流AD采样获取瞬时流量，计算累计流量 */
|
||||||
@ -130,7 +130,6 @@ void app_main(void)
|
|||||||
FLOW_init(); /* 两一种计算流量的方法，计算累计流量 */
|
FLOW_init(); /* 两一种计算流量的方法，计算累计流量 */
|
||||||
|
|
||||||
uart0_modbus_slave_init();
|
uart0_modbus_slave_init();
|
||||||
|
|
||||||
// ble_server_init();
|
// ble_server_init();
|
||||||
ble_gatts_server_init();
|
ble_gatts_server_init();
|
||||||
|
|
||||||
|
|||||||
@ -9,6 +9,7 @@
|
|||||||
#include "lwip/opt.h"
|
#include "lwip/opt.h"
|
||||||
#include "lwip/sockets.h"
|
#include "lwip/sockets.h"
|
||||||
#include "stm32/ModbusS.h"
|
#include "stm32/ModbusS.h"
|
||||||
|
#include "esp_log.h"
|
||||||
// #include "log.h"
|
// #include "log.h"
|
||||||
|
|
||||||
#define LOG_TAG "[mb_tcp_sr]: "
|
#define LOG_TAG "[mb_tcp_sr]: "
|
||||||
@ -92,11 +93,12 @@ static void ModBusSlave_conn_err(void *arg, err_t err) {
|
|||||||
// log_printf(LERROR, LOG_TAG "connection error, err:%d\n", err);
|
// log_printf(LERROR, LOG_TAG "connection error, err:%d\n", err);
|
||||||
}
|
}
|
||||||
static err_t ModBusSlave_poll(void *arg, struct tcp_pcb *newpcb) {
|
static err_t ModBusSlave_poll(void *arg, struct tcp_pcb *newpcb) {
|
||||||
if (newpcb) {
|
// if (newpcb) {
|
||||||
// log_printf(LERROR, LOG_TAG "close pcb\n");
|
// // log_printf(LERROR, LOG_TAG "close pcb\n");
|
||||||
tcp_close(newpcb);
|
// tcp_close(newpcb);
|
||||||
newpcb = NULL;
|
// newpcb = NULL;
|
||||||
}
|
// }
|
||||||
|
ESP_LOGI(LOG_TAG, "HELLO!");
|
||||||
return ERR_OK;
|
return ERR_OK;
|
||||||
}
|
}
|
||||||
/**
|
/**
|
||||||
@ -112,7 +114,7 @@ static err_t ModBusSlave_accept(void *arg, struct tcp_pcb *pcb, err_t err) {
|
|||||||
/* Configure LwIP to use our call back functions. */
|
/* Configure LwIP to use our call back functions. */
|
||||||
tcp_err(pcb, ModBusSlave_conn_err);
|
tcp_err(pcb, ModBusSlave_conn_err);
|
||||||
tcp_recv(pcb, ModBusSlave_recv);
|
tcp_recv(pcb, ModBusSlave_recv);
|
||||||
tcp_poll(pcb, ModBusSlave_poll, 120); // 60 second timeout
|
tcp_poll(pcb, ModBusSlave_poll, 1); // 60 second timeout
|
||||||
/* Send out the first message */
|
/* Send out the first message */
|
||||||
// tcp_write(pcb, GREETING, strlen(GREETING), 1);
|
// tcp_write(pcb, GREETING, strlen(GREETING), 1);
|
||||||
return ERR_OK;
|
return ERR_OK;
|
||||||
|
|||||||
@ -347,9 +347,9 @@ int ModbusSlaveProcess(uint8_t *txbuf, uint8_t *rxbuf, uint16_t rxLen, int is_cr
|
|||||||
pDat+=2;
|
pDat+=2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
ESP_LOGI(TAG, "write gWordVar:");
|
// ESP_LOGI(TAG, "write gWordVar:");
|
||||||
for (i = 0; i < length; i++)
|
// for (i = 0; i < length; i++)
|
||||||
ESP_LOGI(TAG, "gWordVar[%d]=0x%04x", add + i, gWordVar[add + i]);
|
// ESP_LOGI(TAG, "gWordVar[%d]=0x%04x", add + i, gWordVar[add + i]);
|
||||||
// ESP_LOGI(TAG, "%d %d", depth_config->input_type, depth_config->port);
|
// ESP_LOGI(TAG, "%d %d", depth_config->input_type, depth_config->port);
|
||||||
|
|
||||||
ModBusWordWriteHook(add,length);
|
ModBusWordWriteHook(add,length);
|
||||||
|
|||||||
@ -20,7 +20,7 @@ void xorBit(uint16_t Add);
|
|||||||
|
|
||||||
void WriteBit(uint16_t Add,uint8_t bit_value);
|
void WriteBit(uint16_t Add,uint8_t bit_value);
|
||||||
#define gBIT_SIZE 128
|
#define gBIT_SIZE 128
|
||||||
#define gWORD_SIZE 512
|
#define gWORD_SIZE 1024
|
||||||
extern uint8_t gBitVar[(gBIT_SIZE+7)/8];
|
extern uint8_t gBitVar[(gBIT_SIZE+7)/8];
|
||||||
extern uint16_t gWordVar[gWORD_SIZE];
|
extern uint16_t gWordVar[gWORD_SIZE];
|
||||||
extern uint16_t modbus_addr;
|
extern uint16_t modbus_addr;
|
||||||
|
|||||||
@ -18,6 +18,8 @@
|
|||||||
#define TILT_SENSER_ADDR 30
|
#define TILT_SENSER_ADDR 30
|
||||||
#define RECORD_REG_ADDR 32
|
#define RECORD_REG_ADDR 32
|
||||||
|
|
||||||
|
#define TIME 264
|
||||||
|
|
||||||
#define CAL_4_20MA_ADDR 384
|
#define CAL_4_20MA_ADDR 384
|
||||||
#define FLOW_CONFIG_ADDR (CAL_4_20MA_ADDR + (sizeof(cal_4_20ma_t) + 15) / 16 * 8)
|
#define FLOW_CONFIG_ADDR (CAL_4_20MA_ADDR + (sizeof(cal_4_20ma_t) + 15) / 16 * 8)
|
||||||
#define DEPTH_CONFIG_ADDR (FLOW_CONFIG_ADDR + (sizeof(flow_config_t) + 15) / 16 * 8)
|
#define DEPTH_CONFIG_ADDR (FLOW_CONFIG_ADDR + (sizeof(flow_config_t) + 15) / 16 * 8)
|
||||||
@ -27,7 +29,58 @@
|
|||||||
#define DEPTH_RESET_ADDR 510
|
#define DEPTH_RESET_ADDR 510
|
||||||
#define REBOOT_REW_ADDR 511
|
#define REBOOT_REW_ADDR 511
|
||||||
|
|
||||||
#define TIME 264
|
#define REG_GPS_MESSAGE (512 + 48)
|
||||||
|
#define REG_GPS_WRITE_DATA (REG_GPS_MESSAGE + sizeof(gps_message_t))
|
||||||
|
|
||||||
|
// GPS数据
|
||||||
|
typedef struct gps_message
|
||||||
|
{
|
||||||
|
uint8_t gps_status; // GPS定位状态
|
||||||
|
uint8_t gps_view; // GPS可视状态
|
||||||
|
uint8_t gps_use; // GPS使用状态
|
||||||
|
uint8_t reg[1]; // 保留
|
||||||
|
uint32_t utc; // utc时间
|
||||||
|
double x; // 大地平面坐标
|
||||||
|
double y;
|
||||||
|
double dir; // 方向
|
||||||
|
double pitch; // 俯仰角
|
||||||
|
} gps_message_t;
|
||||||
|
extern gps_message_t *gpsMessageP;
|
||||||
|
|
||||||
|
|
||||||
|
#define WRITE_DOWN_MAGIC 0x55BB // 控制gps采用参数进行运算
|
||||||
|
#define WRITE_SAVE_MAGIC 0x55AA // 控制gps将参数保存成json文件，开机的时候自动加载
|
||||||
|
typedef struct gps_write_data // addr 600
|
||||||
|
{
|
||||||
|
uint16_t magic; // 600 2
|
||||||
|
uint16_t ellipsoidal_datum; // 椭圆基准 601 2
|
||||||
|
uint8_t reg[4];
|
||||||
|
|
||||||
|
// 604 8
|
||||||
|
int16_t x0; // 卫星接收器点坐标（坐标系以基站为原点建立）
|
||||||
|
int16_t y0;
|
||||||
|
int16_t x1; // 待求点坐标
|
||||||
|
int16_t y1;
|
||||||
|
|
||||||
|
// 608 16
|
||||||
|
uint64_t central_meridian; // 中央子午线
|
||||||
|
uint64_t elevation; // 投影高程
|
||||||
|
|
||||||
|
// 616 16
|
||||||
|
int64_t dx; // x轴平移
|
||||||
|
int64_t ax; // x轴旋转
|
||||||
|
// 624 16
|
||||||
|
int64_t dy; // y轴平移
|
||||||
|
int64_t ay; // y轴旋转
|
||||||
|
// 632 16
|
||||||
|
int64_t dz; // z轴平移
|
||||||
|
int64_t az; // z轴旋转
|
||||||
|
// 640 8
|
||||||
|
int64_t k; // 缩放比例
|
||||||
|
} gps_write_data_t;
|
||||||
|
extern gps_write_data_t *gpsWriteDataP;
|
||||||
|
|
||||||
|
|
||||||
typedef struct
|
typedef struct
|
||||||
{
|
{
|
||||||
uint16_t magic;
|
uint16_t magic;
|
||||||
@ -109,6 +162,25 @@ typedef struct
|
|||||||
} depth_t;
|
} depth_t;
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
int16_t max_depth;
|
||||||
|
uint16_t pile_id;
|
||||||
|
uint16_t count;
|
||||||
|
// uint16_t work_time;
|
||||||
|
struct _item
|
||||||
|
{
|
||||||
|
int16_t speed;
|
||||||
|
int16_t depth;
|
||||||
|
int16_t flow[2];
|
||||||
|
uint32_t total_flow[2];
|
||||||
|
int16_t tilt_x;
|
||||||
|
int16_t tilt_y;
|
||||||
|
uint16_t current1;
|
||||||
|
uint16_t current2;
|
||||||
|
} item[10];
|
||||||
|
} record_t;
|
||||||
|
|
||||||
extern depth_config_t *depth_config;
|
extern depth_config_t *depth_config;
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@ -19,7 +19,8 @@
|
|||||||
// #include "driver/mcpwm_prelude.h"
|
// #include "driver/mcpwm_prelude.h"
|
||||||
#include "config.h"
|
#include "config.h"
|
||||||
#include "../../../../components/bt/host/bluedroid/api/include/api/esp_gatts_api.h"
|
#include "../../../../components/bt/host/bluedroid/api/include/api/esp_gatts_api.h"
|
||||||
#include "bt_server.h"
|
// #include "bt_server.h"
|
||||||
|
#include "../ble_gatts_server.h"
|
||||||
|
|
||||||
#include "esp_system.h"
|
#include "esp_system.h"
|
||||||
#include "driver/uart.h"
|
#include "driver/uart.h"
|
||||||
@ -89,24 +90,24 @@ int32_t enc2_value;
|
|||||||
|
|
||||||
extern rotary_encoder_t *encoder;
|
extern rotary_encoder_t *encoder;
|
||||||
|
|
||||||
typedef struct
|
// typedef struct
|
||||||
{
|
// {
|
||||||
int16_t max_depth;
|
// int16_t max_depth;
|
||||||
uint16_t pile_id;
|
// uint16_t pile_id;
|
||||||
uint16_t count;
|
// uint16_t count;
|
||||||
// uint16_t work_time;
|
// // uint16_t work_time;
|
||||||
struct _item
|
// struct _item
|
||||||
{
|
// {
|
||||||
int16_t speed;
|
// int16_t speed;
|
||||||
int16_t depth;
|
// int16_t depth;
|
||||||
int16_t flow[2];
|
// int16_t flow[2];
|
||||||
uint32_t total_flow[2];
|
// uint32_t total_flow[2];
|
||||||
int16_t tilt_x;
|
// int16_t tilt_x;
|
||||||
int16_t tilt_y;
|
// int16_t tilt_y;
|
||||||
uint16_t current1;
|
// uint16_t current1;
|
||||||
uint16_t current2;
|
// uint16_t current2;
|
||||||
} item[10];
|
// } item[10];
|
||||||
} record_t;
|
// } record_t;
|
||||||
|
|
||||||
// 18字节
|
// 18字节
|
||||||
#pragma pack(1)
|
#pragma pack(1)
|
||||||
@ -332,7 +333,7 @@ int abs_sub(uint32_t enc_update_time, uint32_t _enc_update_time)
|
|||||||
send_to_bt_t1 send_to_bt1;
|
send_to_bt_t1 send_to_bt1;
|
||||||
send_to_bt_t2 send_to_bt2;
|
send_to_bt_t2 send_to_bt2;
|
||||||
extern bool is_connected;
|
extern bool is_connected;
|
||||||
extern uint16_t spp_handle_table[SPP_IDX_NB];
|
extern uint16_t spp_handle_table[IDX_NB];
|
||||||
extern uint16_t spp_conn_id;
|
extern uint16_t spp_conn_id;
|
||||||
extern esp_gatt_if_t spp_gatts_if;
|
extern esp_gatt_if_t spp_gatts_if;
|
||||||
extern flow_t *pflow;
|
extern flow_t *pflow;
|
||||||
@ -449,17 +450,17 @@ void depth_task(void *arg)
|
|||||||
|
|
||||||
while (1)
|
while (1)
|
||||||
{
|
{
|
||||||
if (add_record_time++ > 10)
|
// if (add_record_time++ > 10)
|
||||||
{
|
// {
|
||||||
add_record_time = 0;
|
// add_record_time = 0;
|
||||||
depth_data->sample_count++;
|
// depth_data->sample_count++;
|
||||||
if (depth_data->sample_count > 20)
|
// if (depth_data->sample_count > 20)
|
||||||
{
|
// {
|
||||||
record->pile_id++;
|
// record->pile_id++;
|
||||||
depth_data->sample_count = 0;
|
// depth_data->sample_count = 0;
|
||||||
}
|
// }
|
||||||
add_recod_item();
|
// add_recod_item();
|
||||||
}
|
// }
|
||||||
|
|
||||||
if (_enc1_update_time != enc1_update_time) /* 深度数据更新 */
|
if (_enc1_update_time != enc1_update_time) /* 深度数据更新 */
|
||||||
{
|
{
|
||||||
@ -469,6 +470,7 @@ void depth_task(void *arg)
|
|||||||
time_diff = abs_sub(enc_update_time, _enc1_update_time);
|
time_diff = abs_sub(enc_update_time, _enc1_update_time);
|
||||||
_enc1_update_time = enc_update_time;
|
_enc1_update_time = enc_update_time;
|
||||||
}
|
}
|
||||||
|
//ESP_LOGI(TAG, "time_diff:%d", time_diff);
|
||||||
|
|
||||||
if (time_diff != 0)
|
if (time_diff != 0)
|
||||||
{
|
{
|
||||||
@ -498,7 +500,7 @@ void depth_task(void *arg)
|
|||||||
// send_to_bt1.max_depth = depth_data->depth;
|
// send_to_bt1.max_depth = depth_data->depth;
|
||||||
}
|
}
|
||||||
|
|
||||||
ESP_LOGI(TAG, "depth_data->depth:0x%x", (unsigned int)depth_data->depth);
|
//ESP_LOGI(TAG, "depth_data->depth:0x%x", (unsigned int)depth_data->depth);
|
||||||
|
|
||||||
// 500ms计算一次速度
|
// 500ms计算一次速度
|
||||||
if (speed_calc_count++ > 50)
|
if (speed_calc_count++ > 50)
|
||||||
|
|||||||
@ -63,7 +63,7 @@ void uart0_init(void)
|
|||||||
|
|
||||||
// Install UART driver (we don't need an event queue here)
|
// Install UART driver (we don't need an event queue here)
|
||||||
// In this example we don't even use a buffer for sending data.
|
// In this example we don't even use a buffer for sending data.
|
||||||
ESP_ERROR_CHECK(uart_driver_install(uart_num, BUF_SIZE * 2, 0, 0, NULL, 0));
|
ESP_ERROR_CHECK(uart_driver_install(uart_num, BUF_SIZE * 2, BUF_SIZE, 0, NULL, 0));
|
||||||
|
|
||||||
// Configure UART parameters
|
// Configure UART parameters
|
||||||
ESP_ERROR_CHECK(uart_param_config(uart_num, &uart_config));
|
ESP_ERROR_CHECK(uart_param_config(uart_num, &uart_config));
|
||||||
|
|||||||
@ -1,714 +0,0 @@
|
|||||||
/*
|
|
||||||
* SPDX-FileCopyrightText: 2021 Espressif Systems (Shanghai) CO LTD
|
|
||||||
*
|
|
||||||
* SPDX-License-Identifier: Unlicense OR CC0-1.0
|
|
||||||
*/
|
|
||||||
|
|
||||||
/****************************************************************************
|
|
||||||
*
|
|
||||||
* This demo showcases creating a GATT database using a predefined attribute table.
|
|
||||||
* It acts as a GATT server and can send adv data, be connected by client.
|
|
||||||
* Run the gatt_client demo, the client demo will automatically connect to the gatt_server_service_table demo.
|
|
||||||
* Client demo will enable GATT server's notify after connection. The two devices will then exchange
|
|
||||||
* data.
|
|
||||||
*
|
|
||||||
****************************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
#include "freertos/FreeRTOS.h"
|
|
||||||
#include "freertos/task.h"
|
|
||||||
#include "freertos/event_groups.h"
|
|
||||||
#include "esp_system.h"
|
|
||||||
#include "esp_log.h"
|
|
||||||
#include "nvs_flash.h"
|
|
||||||
#include "esp_bt.h"
|
|
||||||
|
|
||||||
#include "esp_gap_ble_api.h"
|
|
||||||
#include "esp_gatts_api.h"
|
|
||||||
#include "esp_bt_main.h"
|
|
||||||
#include "ble_gatts_server.h"
|
|
||||||
#include "esp_gatt_common_api.h"
|
|
||||||
|
|
||||||
#include "stm32/config.h"
|
|
||||||
#include "stm32/ModbusS.h"
|
|
||||||
|
|
||||||
#define GATTS_TABLE_TAG "GATTS_TABLE_DEMO"
|
|
||||||
|
|
||||||
#define PROFILE_NUM 1
|
|
||||||
#define PROFILE_APP_IDX 0
|
|
||||||
#define ESP_APP_ID 0x55
|
|
||||||
#define SAMPLE_DEVICE_NAME "ESP_GATTS_DEMO"
|
|
||||||
#define SVC_INST_ID 0
|
|
||||||
|
|
||||||
/* The max length of characteristic value. When the GATT client performs a write or prepare write operation,
|
|
||||||
* the data length must be less than GATTS_DEMO_CHAR_VAL_LEN_MAX.
|
|
||||||
*/
|
|
||||||
#define GATTS_DEMO_CHAR_VAL_LEN_MAX 500
|
|
||||||
#define PREPARE_BUF_MAX_SIZE 1024
|
|
||||||
#define CHAR_DECLARATION_SIZE (sizeof(uint8_t))
|
|
||||||
|
|
||||||
#define ADV_CONFIG_FLAG (1 << 0)
|
|
||||||
#define SCAN_RSP_CONFIG_FLAG (1 << 1)
|
|
||||||
|
|
||||||
static uint8_t adv_config_done = 0;
|
|
||||||
|
|
||||||
uint16_t heart_rate_handle_table[HRS_IDX_NB];
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
uint8_t *prepare_buf;
|
|
||||||
int prepare_len;
|
|
||||||
} prepare_type_env_t;
|
|
||||||
|
|
||||||
static prepare_type_env_t prepare_write_env;
|
|
||||||
|
|
||||||
#define CONFIG_SET_RAW_ADV_DATA
|
|
||||||
#ifdef CONFIG_SET_RAW_ADV_DATA
|
|
||||||
static uint8_t raw_adv_data[] = {
|
|
||||||
/* flags */
|
|
||||||
0x02, 0x01, 0x06,
|
|
||||||
/* tx power*/
|
|
||||||
0x02, 0x0a, 0xeb,
|
|
||||||
/* service uuid */
|
|
||||||
0x03, 0x03, 0xFF, 0x00,
|
|
||||||
/* device name */
|
|
||||||
0x0f, 0x09, 'E', 'S', 'P', '_', 'G', 'A', 'T', 'T', 'S', '_', 'D','E', 'M', 'O'
|
|
||||||
};
|
|
||||||
static uint8_t raw_scan_rsp_data[] = {
|
|
||||||
/* flags */
|
|
||||||
0x02, 0x01, 0x06,
|
|
||||||
/* tx power */
|
|
||||||
0x02, 0x0a, 0xeb,
|
|
||||||
/* service uuid */
|
|
||||||
0x03, 0x03, 0xFF,0x00
|
|
||||||
};
|
|
||||||
|
|
||||||
#else
|
|
||||||
static uint8_t service_uuid[16] = {
|
|
||||||
/* LSB <--------------------------------------------------------------------------------> MSB */
|
|
||||||
//first uuid, 16bit, [12],[13] is the value
|
|
||||||
0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80, 0x00, 0x10, 0x00, 0x00, 0xFF, 0x00, 0x00, 0x00,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* The length of adv data must be less than 31 bytes */
|
|
||||||
static esp_ble_adv_data_t adv_data = {
|
|
||||||
.set_scan_rsp = false,
|
|
||||||
.include_name = true,
|
|
||||||
.include_txpower = true,
|
|
||||||
.min_interval = 0x0006, //slave connection min interval, Time = min_interval * 1.25 msec
|
|
||||||
.max_interval = 0x0010, //slave connection max interval, Time = max_interval * 1.25 msec
|
|
||||||
.appearance = 0x00,
|
|
||||||
.manufacturer_len = 0, //TEST_MANUFACTURER_DATA_LEN,
|
|
||||||
.p_manufacturer_data = NULL, //test_manufacturer,
|
|
||||||
.service_data_len = 0,
|
|
||||||
.p_service_data = NULL,
|
|
||||||
.service_uuid_len = sizeof(service_uuid),
|
|
||||||
.p_service_uuid = service_uuid,
|
|
||||||
.flag = (ESP_BLE_ADV_FLAG_GEN_DISC | ESP_BLE_ADV_FLAG_BREDR_NOT_SPT),
|
|
||||||
};
|
|
||||||
|
|
||||||
// scan response data
|
|
||||||
static esp_ble_adv_data_t scan_rsp_data = {
|
|
||||||
.set_scan_rsp = true,
|
|
||||||
.include_name = true,
|
|
||||||
.include_txpower = true,
|
|
||||||
.min_interval = 0x0006,
|
|
||||||
.max_interval = 0x0010,
|
|
||||||
.appearance = 0x00,
|
|
||||||
.manufacturer_len = 0, //TEST_MANUFACTURER_DATA_LEN,
|
|
||||||
.p_manufacturer_data = NULL, //&test_manufacturer[0],
|
|
||||||
.service_data_len = 0,
|
|
||||||
.p_service_data = NULL,
|
|
||||||
.service_uuid_len = sizeof(service_uuid),
|
|
||||||
.p_service_uuid = service_uuid,
|
|
||||||
.flag = (ESP_BLE_ADV_FLAG_GEN_DISC | ESP_BLE_ADV_FLAG_BREDR_NOT_SPT),
|
|
||||||
};
|
|
||||||
#endif /* CONFIG_SET_RAW_ADV_DATA */
|
|
||||||
|
|
||||||
static esp_ble_adv_params_t adv_params = {
|
|
||||||
.adv_int_min = 0x20,
|
|
||||||
.adv_int_max = 0x40,
|
|
||||||
.adv_type = ADV_TYPE_IND,
|
|
||||||
.own_addr_type = BLE_ADDR_TYPE_PUBLIC,
|
|
||||||
.channel_map = ADV_CHNL_ALL,
|
|
||||||
.adv_filter_policy = ADV_FILTER_ALLOW_SCAN_ANY_CON_ANY,
|
|
||||||
};
|
|
||||||
|
|
||||||
struct gatts_profile_inst {
|
|
||||||
esp_gatts_cb_t gatts_cb;
|
|
||||||
uint16_t gatts_if;
|
|
||||||
uint16_t app_id;
|
|
||||||
uint16_t conn_id;
|
|
||||||
uint16_t service_handle;
|
|
||||||
esp_gatt_srvc_id_t service_id;
|
|
||||||
uint16_t char_handle;
|
|
||||||
esp_bt_uuid_t char_uuid;
|
|
||||||
esp_gatt_perm_t perm;
|
|
||||||
esp_gatt_char_prop_t property;
|
|
||||||
uint16_t descr_handle;
|
|
||||||
esp_bt_uuid_t descr_uuid;
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event,
|
|
||||||
esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param);
|
|
||||||
|
|
||||||
/* One gatt-based profile one app_id and one gatts_if, this array will store the gatts_if returned by ESP_GATTS_REG_EVT */
|
|
||||||
static struct gatts_profile_inst heart_rate_profile_tab[PROFILE_NUM] = {
|
|
||||||
[PROFILE_APP_IDX] = {
|
|
||||||
.gatts_cb = gatts_profile_event_handler,
|
|
||||||
.gatts_if = ESP_GATT_IF_NONE, /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
/* Service */
|
|
||||||
static const uint16_t GATTS_SERVICE_UUID_TEST = 0x00FF;
|
|
||||||
static const uint16_t GATTS_CHAR_UUID_TEST_A = 0xFF01;
|
|
||||||
static const uint16_t ESP_GATT_UUID_SPP_DATA_NOTIFY = 0xFF02;
|
|
||||||
|
|
||||||
|
|
||||||
static const uint16_t primary_service_uuid = ESP_GATT_UUID_PRI_SERVICE;
|
|
||||||
static const uint16_t character_declaration_uuid = ESP_GATT_UUID_CHAR_DECLARE;
|
|
||||||
static const uint16_t character_client_config_uuid = ESP_GATT_UUID_CHAR_CLIENT_CONFIG;
|
|
||||||
static const uint8_t char_prop_read_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
static const uint8_t char_prop_read_write_notify = ESP_GATT_CHAR_PROP_BIT_WRITE | ESP_GATT_CHAR_PROP_BIT_READ | ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
static const uint8_t heart_measurement_ccc[2] = {0x00, 0x00};
|
|
||||||
static const uint8_t char_value[4] = {0x11, 0x22, 0x33, 0x44};
|
|
||||||
|
|
||||||
///SPP Service - data notify characteristic, notify&read
|
|
||||||
static const uint16_t spp_data_notify_uuid = ESP_GATT_UUID_SPP_DATA_NOTIFY;
|
|
||||||
static const uint8_t spp_data_notify_val[20] = {0x00};
|
|
||||||
static const uint8_t spp_data_notify_ccc[2] = {0x00, 0x00};
|
|
||||||
|
|
||||||
bool data_notify_enable = false; /* 是否允许数据上报 */
|
|
||||||
bool is_connected = false; /* 蓝牙是否连接 */
|
|
||||||
static uint16_t spp_conn_id = 0xffff;
|
|
||||||
static esp_gatt_if_t spp_gatts_if = 0xff;
|
|
||||||
|
|
||||||
/* Full Database Description - Used to add attributes into the database */
|
|
||||||
static const esp_gatts_attr_db_t gatt_db[HRS_IDX_NB] =
|
|
||||||
{
|
|
||||||
// Service Declaration
|
|
||||||
[IDX_SVC] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&primary_service_uuid, ESP_GATT_PERM_READ,
|
|
||||||
sizeof(uint16_t), sizeof(GATTS_SERVICE_UUID_TEST), (uint8_t *)&GATTS_SERVICE_UUID_TEST}},
|
|
||||||
|
|
||||||
/* Characteristic Declaration */
|
|
||||||
[IDX_CHAR_A] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE, CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write_notify}},
|
|
||||||
|
|
||||||
/* Characteristic Value */
|
|
||||||
[IDX_CHAR_VAL_A] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&GATTS_CHAR_UUID_TEST_A, ESP_GATT_PERM_READ | ESP_GATT_PERM_WRITE,
|
|
||||||
GATTS_DEMO_CHAR_VAL_LEN_MAX, sizeof(char_value), (uint8_t *)char_value}},
|
|
||||||
|
|
||||||
/* Client Characteristic Configuration Descriptor */
|
|
||||||
[IDX_CHAR_CFG_A] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ | ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t), sizeof(heart_measurement_ccc), (uint8_t *)heart_measurement_ccc}},
|
|
||||||
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_DATA_NOTIFY_CHAR] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_notify}},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Value
|
|
||||||
[SPP_IDX_SPP_DATA_NTY_VAL] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_data_notify_uuid, ESP_GATT_PERM_READ,
|
|
||||||
SPP_DATA_MAX_LEN, sizeof(spp_data_notify_val), (uint8_t *)spp_data_notify_val}},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_DATA_NTF_CFG] =
|
|
||||||
{{ESP_GATT_RSP_BY_APP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),sizeof(spp_data_notify_ccc), (uint8_t *)spp_data_notify_ccc}},
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gap_event_handler(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param)
|
|
||||||
{
|
|
||||||
switch (event) {
|
|
||||||
#ifdef CONFIG_SET_RAW_ADV_DATA
|
|
||||||
case ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT:
|
|
||||||
adv_config_done &= (~ADV_CONFIG_FLAG);
|
|
||||||
if (adv_config_done == 0){
|
|
||||||
esp_ble_gap_start_advertising(&adv_params);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_SCAN_RSP_DATA_RAW_SET_COMPLETE_EVT:
|
|
||||||
adv_config_done &= (~SCAN_RSP_CONFIG_FLAG);
|
|
||||||
if (adv_config_done == 0){
|
|
||||||
esp_ble_gap_start_advertising(&adv_params);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
#else
|
|
||||||
case ESP_GAP_BLE_ADV_DATA_SET_COMPLETE_EVT:
|
|
||||||
adv_config_done &= (~ADV_CONFIG_FLAG);
|
|
||||||
if (adv_config_done == 0){
|
|
||||||
esp_ble_gap_start_advertising(&adv_params);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_SCAN_RSP_DATA_SET_COMPLETE_EVT:
|
|
||||||
adv_config_done &= (~SCAN_RSP_CONFIG_FLAG);
|
|
||||||
if (adv_config_done == 0){
|
|
||||||
esp_ble_gap_start_advertising(&adv_params);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT:
|
|
||||||
/* advertising start complete event to indicate advertising start successfully or failed */
|
|
||||||
if (param->adv_start_cmpl.status != ESP_BT_STATUS_SUCCESS) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "advertising start failed");
|
|
||||||
}else{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "advertising start successfully");
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_ADV_STOP_COMPLETE_EVT:
|
|
||||||
if (param->adv_stop_cmpl.status != ESP_BT_STATUS_SUCCESS) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Advertising stop failed");
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "Stop adv successfully\n");
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_UPDATE_CONN_PARAMS_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "update connection params status = %d, min_int = %d, max_int = %d,conn_int = %d,latency = %d, timeout = %d",
|
|
||||||
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;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void notify_data_fun(int id, uint8_t *data, uint32_t len);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* [0]: 标识 F0--写多个modbus内存地址
|
|
||||||
* [2:1]: 起始地址
|
|
||||||
* [3]: 写的字节数 0-255
|
|
||||||
* ...： 数据内容
|
|
||||||
*/
|
|
||||||
void gatts_write_data_cb(uint8_t *data, uint32_t len, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "gatts_write_data_cb");
|
|
||||||
if (len < 4) {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "write format is fault, len less 4");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
else if (data[0] == 0xF0) /* 写gWordVar寄存器 */
|
|
||||||
{
|
|
||||||
uint16_t addr = data[1] + (data[2] << 8);
|
|
||||||
uint16_t addr_ = addr;
|
|
||||||
uint8_t cnt = data[3];
|
|
||||||
if (cnt > len - 4)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "write format is fault, cnt > len - 4");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "write addr:%d cnt:%d", addr, cnt);
|
|
||||||
uint8_t i;
|
|
||||||
for (i = 0 + 4; i < cnt + 4; i+=2) /* 发送的数据要求两字节对齐 */
|
|
||||||
{
|
|
||||||
gWordVar[addr++] = data[i] + (data[i + 1] << 8);
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "gwordvar[%d]:0x%x", addr-1, gWordVar[addr-1]);
|
|
||||||
}
|
|
||||||
/* 还应该调用 ModBusWordWriteHook 来处理这些写动作带来的影响 */
|
|
||||||
ModBusWordWriteHook(addr, cnt);
|
|
||||||
}
|
|
||||||
else if (data[0] == 0xF1) /* 读gWordVar，通过notify上报回去 */
|
|
||||||
{
|
|
||||||
uint16_t addr = data[1] + (data[2] << 8);
|
|
||||||
uint8_t cnt = data[3];
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "!read addr:%d cnt:%d", addr, cnt);
|
|
||||||
uint8_t buf[500];
|
|
||||||
buf[0] = data[0];
|
|
||||||
buf[1] = data[1];
|
|
||||||
buf[2] = data[2];
|
|
||||||
buf[3] = data[3];
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "gWordVar[0]:0x%x gWordVar[1]:0x%x", gWordVar[0], gWordVar[1]);
|
|
||||||
memcpy(buf + 4, (uint8_t *)(gWordVar + addr), cnt);
|
|
||||||
notify_data_fun(IDX_CHAR_VAL_A, buf, cnt + 4);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void example_prepare_write_event_env(esp_gatt_if_t gatts_if, prepare_type_env_t *prepare_write_env, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "prepare write, handle = %d, value len = %d", param->write.handle, param->write.len);
|
|
||||||
esp_gatt_status_t status = ESP_GATT_OK;
|
|
||||||
if (prepare_write_env->prepare_buf == NULL) {
|
|
||||||
prepare_write_env->prepare_buf = (uint8_t *)malloc(PREPARE_BUF_MAX_SIZE * sizeof(uint8_t));
|
|
||||||
prepare_write_env->prepare_len = 0;
|
|
||||||
if (prepare_write_env->prepare_buf == NULL) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s, Gatt_server prep no mem", __func__);
|
|
||||||
status = ESP_GATT_NO_RESOURCES;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
if(param->write.offset > PREPARE_BUF_MAX_SIZE) {
|
|
||||||
status = ESP_GATT_INVALID_OFFSET;
|
|
||||||
} else if ((param->write.offset + param->write.len) > PREPARE_BUF_MAX_SIZE) {
|
|
||||||
status = ESP_GATT_INVALID_ATTR_LEN;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/*send response when param->write.need_rsp is true */
|
|
||||||
// if (param->write.need_rsp){
|
|
||||||
esp_gatt_rsp_t *gatt_rsp = (esp_gatt_rsp_t *)malloc(sizeof(esp_gatt_rsp_t));
|
|
||||||
if (gatt_rsp != NULL){
|
|
||||||
gatt_rsp->attr_value.len = param->write.len;
|
|
||||||
gatt_rsp->attr_value.handle = param->write.handle;
|
|
||||||
gatt_rsp->attr_value.offset = param->write.offset;
|
|
||||||
gatt_rsp->attr_value.auth_req = ESP_GATT_AUTH_REQ_NONE;
|
|
||||||
memcpy(gatt_rsp->attr_value.value, param->write.value, param->write.len);
|
|
||||||
esp_err_t response_err = esp_ble_gatts_send_response(gatts_if, param->write.conn_id, param->write.trans_id, status, gatt_rsp);
|
|
||||||
if (response_err != ESP_OK){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Send response error");
|
|
||||||
}
|
|
||||||
free(gatt_rsp);
|
|
||||||
}else{
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s, malloc failed", __func__);
|
|
||||||
}
|
|
||||||
// }
|
|
||||||
if (status != ESP_GATT_OK){
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
memcpy(prepare_write_env->prepare_buf + param->write.offset,
|
|
||||||
param->write.value,
|
|
||||||
param->write.len);
|
|
||||||
prepare_write_env->prepare_len += param->write.len;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
void example_exec_write_event_env(prepare_type_env_t *prepare_write_env, esp_ble_gatts_cb_param_t *param){
|
|
||||||
if (param->exec_write.exec_write_flag == ESP_GATT_PREP_WRITE_EXEC && prepare_write_env->prepare_buf){
|
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, prepare_write_env->prepare_buf, prepare_write_env->prepare_len);
|
|
||||||
gatts_write_data_cb(prepare_write_env->prepare_buf, prepare_write_env->prepare_len, param); /* 此处有隐患，有可能不是data_write特征的数据 */
|
|
||||||
}else{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG,"ESP_GATT_PREP_WRITE_CANCEL");
|
|
||||||
}
|
|
||||||
if (prepare_write_env->prepare_buf) {
|
|
||||||
free(prepare_write_env->prepare_buf);
|
|
||||||
prepare_write_env->prepare_buf = NULL;
|
|
||||||
}
|
|
||||||
prepare_write_env->prepare_len = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
switch (event) {
|
|
||||||
case ESP_GATTS_REG_EVT:{
|
|
||||||
esp_err_t set_dev_name_ret = esp_ble_gap_set_device_name(SAMPLE_DEVICE_NAME);
|
|
||||||
if (set_dev_name_ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "set device name failed, error code = %x", set_dev_name_ret);
|
|
||||||
}
|
|
||||||
#ifdef CONFIG_SET_RAW_ADV_DATA
|
|
||||||
esp_err_t raw_adv_ret = esp_ble_gap_config_adv_data_raw(raw_adv_data, sizeof(raw_adv_data));
|
|
||||||
if (raw_adv_ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "config raw adv data failed, error code = %x ", raw_adv_ret);
|
|
||||||
}
|
|
||||||
adv_config_done |= ADV_CONFIG_FLAG;
|
|
||||||
esp_err_t raw_scan_ret = esp_ble_gap_config_scan_rsp_data_raw(raw_scan_rsp_data, sizeof(raw_scan_rsp_data));
|
|
||||||
if (raw_scan_ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "config raw scan rsp data failed, error code = %x", raw_scan_ret);
|
|
||||||
}
|
|
||||||
adv_config_done |= SCAN_RSP_CONFIG_FLAG;
|
|
||||||
#else
|
|
||||||
//config adv data
|
|
||||||
esp_err_t ret = esp_ble_gap_config_adv_data(&adv_data);
|
|
||||||
if (ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "config adv data failed, error code = %x", ret);
|
|
||||||
}
|
|
||||||
adv_config_done |= ADV_CONFIG_FLAG;
|
|
||||||
//config scan response data
|
|
||||||
ret = esp_ble_gap_config_adv_data(&scan_rsp_data);
|
|
||||||
if (ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "config scan response data failed, error code = %x", ret);
|
|
||||||
}
|
|
||||||
adv_config_done |= SCAN_RSP_CONFIG_FLAG;
|
|
||||||
#endif
|
|
||||||
esp_err_t create_attr_ret = esp_ble_gatts_create_attr_tab(gatt_db, gatts_if, HRS_IDX_NB, SVC_INST_ID);
|
|
||||||
if (create_attr_ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "create attr table failed, error code = %x", create_attr_ret);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_READ_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_READ_EVT");
|
|
||||||
// esp_gatt_rsp_t rsp;
|
|
||||||
// memset(&rsp, 0, sizeof(esp_gatt_rsp_t));
|
|
||||||
// rsp.attr_value.handle = param->read.handle;
|
|
||||||
// rsp.attr_value.len = 4;
|
|
||||||
// rsp.attr_value.value[0] = 0xde;
|
|
||||||
// rsp.attr_value.value[1] = 0xed;
|
|
||||||
// rsp.attr_value.value[2] = 0xbe;
|
|
||||||
// rsp.attr_value.value[3] = 0xef;
|
|
||||||
// esp_ble_gatts_send_response(gatts_if, param->read.conn_id, param->read.trans_id,
|
|
||||||
// ESP_GATT_OK, &rsp);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_WRITE_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_WRITE_EVT, need_rsp=%d", param->write.need_rsp);
|
|
||||||
|
|
||||||
if (!param->write.is_prep){
|
|
||||||
// the data length of gattc write must be less than GATTS_DEMO_CHAR_VAL_LEN_MAX.
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "GATT_WRITE_EVT, handle = %d, value len = %d, value :", param->write.handle, param->write.len);
|
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, param->write.value, param->write.len);
|
|
||||||
if (heart_rate_handle_table[IDX_CHAR_VAL_A] == param->write.handle)
|
|
||||||
gatts_write_data_cb(param->write.value, param->write.len, param);
|
|
||||||
if (heart_rate_handle_table[SPP_IDX_SPP_DATA_NTF_CFG] == param->write.handle && param->write.len == 2){
|
|
||||||
uint16_t descr_value = param->write.value[1]<<8 | param->write.value[0];
|
|
||||||
if (descr_value == 0x0001){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify enable");
|
|
||||||
data_notify_enable = true;
|
|
||||||
// uint8_t notify_data[15];
|
|
||||||
// for (int i = 0; i < sizeof(notify_data); ++i)
|
|
||||||
// {
|
|
||||||
// notify_data[i] = i % 0xff;
|
|
||||||
// }
|
|
||||||
// //the size of notify_data[] need less than MTU size
|
|
||||||
// esp_ble_gatts_send_indicate(gatts_if, param->write.conn_id, heart_rate_handle_table[IDX_CHAR_VAL_A],
|
|
||||||
// sizeof(notify_data), notify_data, false);
|
|
||||||
}//else if (descr_value == 0x0002){
|
|
||||||
// ESP_LOGI(GATTS_TABLE_TAG, "indicate enable");
|
|
||||||
// uint8_t indicate_data[15];
|
|
||||||
// for (int i = 0; i < sizeof(indicate_data); ++i)
|
|
||||||
// {
|
|
||||||
// indicate_data[i] = i % 0xff;
|
|
||||||
// }
|
|
||||||
// //the size of indicate_data[] need less than MTU size
|
|
||||||
// esp_ble_gatts_send_indicate(gatts_if, param->write.conn_id, heart_rate_handle_table[IDX_CHAR_VAL_A],
|
|
||||||
// sizeof(indicate_data), indicate_data, true);
|
|
||||||
// }
|
|
||||||
else if (descr_value == 0x0000){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify/indicate disable ");
|
|
||||||
data_notify_enable = false;
|
|
||||||
}else{
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "unknown descr value");
|
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, param->write.value, param->write.len);
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
/* send response when param->write.need_rsp is true*/
|
|
||||||
if (param->write.need_rsp){
|
|
||||||
esp_ble_gatts_send_response(gatts_if, param->write.conn_id, param->write.trans_id, ESP_GATT_OK, NULL);
|
|
||||||
}
|
|
||||||
}else{
|
|
||||||
/* handle prepare write */
|
|
||||||
example_prepare_write_event_env(gatts_if, &prepare_write_env, param);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_EXEC_WRITE_EVT:
|
|
||||||
// the length of gattc prepare write data must be less than GATTS_DEMO_CHAR_VAL_LEN_MAX.
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_EXEC_WRITE_EVT");
|
|
||||||
example_exec_write_event_env(&prepare_write_env, param);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_MTU_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_MTU_EVT, MTU %d", param->mtu.mtu);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONF_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_CONF_EVT, status = %d, attr_handle %d", param->conf.status, param->conf.handle);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_START_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "SERVICE_START_EVT, status %d, service_handle %d", param->start.status, param->start.service_handle);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONNECT_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_CONNECT_EVT, conn_id = %d", param->connect.conn_id);
|
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, param->connect.remote_bda, 6);
|
|
||||||
esp_ble_conn_update_params_t conn_params = {0};
|
|
||||||
memcpy(conn_params.bda, param->connect.remote_bda, sizeof(esp_bd_addr_t));
|
|
||||||
/* For the iOS system, please refer to Apple official documents about the BLE connection parameters restrictions. */
|
|
||||||
conn_params.latency = 0;
|
|
||||||
conn_params.max_int = 0x20; // max_int = 0x20*1.25ms = 40ms
|
|
||||||
conn_params.min_int = 0x10; // min_int = 0x10*1.25ms = 20ms
|
|
||||||
conn_params.timeout = 400; // timeout = 400*10ms = 4000ms
|
|
||||||
//start sent the update connection parameters to the peer device.
|
|
||||||
esp_ble_gap_update_conn_params(&conn_params);
|
|
||||||
is_connected = true;
|
|
||||||
spp_conn_id = param->connect.conn_id;
|
|
||||||
spp_gatts_if = gatts_if;
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DISCONNECT_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_DISCONNECT_EVT, reason = 0x%x", param->disconnect.reason);
|
|
||||||
esp_ble_gap_start_advertising(&adv_params);
|
|
||||||
is_connected = false;
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CREAT_ATTR_TAB_EVT:{
|
|
||||||
if (param->add_attr_tab.status != ESP_GATT_OK){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "create attribute table failed, error code=0x%x", param->add_attr_tab.status);
|
|
||||||
}
|
|
||||||
else if (param->add_attr_tab.num_handle != HRS_IDX_NB){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "create attribute table abnormally, num_handle (%d) \
|
|
||||||
doesn't equal to HRS_IDX_NB(%d)", param->add_attr_tab.num_handle, HRS_IDX_NB);
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "create attribute table successfully, the number handle = %d\n",param->add_attr_tab.num_handle);
|
|
||||||
memcpy(heart_rate_handle_table, param->add_attr_tab.handles, sizeof(heart_rate_handle_table));
|
|
||||||
esp_ble_gatts_start_service(heart_rate_handle_table[IDX_SVC]);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case ESP_GATTS_STOP_EVT:
|
|
||||||
case ESP_GATTS_OPEN_EVT:
|
|
||||||
case ESP_GATTS_CANCEL_OPEN_EVT:
|
|
||||||
case ESP_GATTS_CLOSE_EVT:
|
|
||||||
case ESP_GATTS_LISTEN_EVT:
|
|
||||||
case ESP_GATTS_CONGEST_EVT:
|
|
||||||
case ESP_GATTS_UNREG_EVT:
|
|
||||||
case ESP_GATTS_DELETE_EVT:
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* If event is register event, store the gatts_if for each profile */
|
|
||||||
if (event == ESP_GATTS_REG_EVT) {
|
|
||||||
if (param->reg.status == ESP_GATT_OK) {
|
|
||||||
heart_rate_profile_tab[PROFILE_APP_IDX].gatts_if = gatts_if;
|
|
||||||
} else {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "reg app failed, app_id %04x, status %d",
|
|
||||||
param->reg.app_id,
|
|
||||||
param->reg.status);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
do {
|
|
||||||
int idx;
|
|
||||||
for (idx = 0; idx < PROFILE_NUM; idx++) {
|
|
||||||
/* ESP_GATT_IF_NONE, not specify a certain gatt_if, need to call every profile cb function */
|
|
||||||
if (gatts_if == ESP_GATT_IF_NONE || gatts_if == heart_rate_profile_tab[idx].gatts_if) {
|
|
||||||
if (heart_rate_profile_tab[idx].gatts_cb) {
|
|
||||||
heart_rate_profile_tab[idx].gatts_cb(event, gatts_if, param);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
} while (0);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
|
||||||
* 上报长度过长，则分包，这里限制长度最大20，分包协议：
|
|
||||||
* [1:0] ‘#’， ‘#’，分包标识
|
|
||||||
* [2] 总包个数
|
|
||||||
* [3] 当前包号，从0开始
|
|
||||||
* ... 包数据
|
|
||||||
*/
|
|
||||||
static uint16_t spp_mtu_size = 23;
|
|
||||||
void notify_data_fun(int id, uint8_t *data, uint32_t len)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify_data_fun:");
|
|
||||||
esp_log_buffer_hex(GATTS_TABLE_TAG, data, len);
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "hihi");
|
|
||||||
if (len <= spp_mtu_size - 3) /* 包数据可以一次完整发送 */
|
|
||||||
{
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if, spp_conn_id, heart_rate_handle_table[id], len, data, false);
|
|
||||||
}
|
|
||||||
else /* 需要分包发送 */
|
|
||||||
{
|
|
||||||
int total_num = 0;
|
|
||||||
uint8_t buf[spp_mtu_size - 3];
|
|
||||||
if ((len % (spp_mtu_size - 7)) == 0)
|
|
||||||
total_num = len / (spp_mtu_size - 7);
|
|
||||||
else
|
|
||||||
total_num = len / (spp_mtu_size - 7) + 1;
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify packet has %d", total_num);
|
|
||||||
|
|
||||||
int i = 0;
|
|
||||||
buf[0] = '#';
|
|
||||||
buf[1] = '#';
|
|
||||||
buf[2] = total_num;
|
|
||||||
for (i = 0; i < total_num - 1; i++)
|
|
||||||
{
|
|
||||||
buf[3] = i;
|
|
||||||
memcpy(buf + 4, data + i * (spp_mtu_size - 7), spp_mtu_size - 7);
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if, spp_conn_id, heart_rate_handle_table[SPP_IDX_SPP_DATA_NTY_VAL],spp_mtu_size - 3, buf, false);
|
|
||||||
}
|
|
||||||
/* 最后一个包 */
|
|
||||||
buf[3] = i;
|
|
||||||
memcpy(buf + 4, data + i * (spp_mtu_size - 7), len % (spp_mtu_size - 7));
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if, spp_conn_id, heart_rate_handle_table[SPP_IDX_SPP_DATA_NTY_VAL], (len % (spp_mtu_size - 7)) + 4, buf, false);
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "notify packet send end!");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t notify_data[500] = {0x11, 0x22, 0x33, 0x44, 0x55, 0x66}; /* 外部程序可以将需要上报的数据拷贝进来 */
|
|
||||||
uint32_t notify_len = 63;
|
|
||||||
void notify_task(void *pvParameters)
|
|
||||||
{
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
if (data_notify_enable && is_connected)
|
|
||||||
{
|
|
||||||
notify_data_fun(SPP_IDX_SPP_DATA_NTY_VAL, notify_data, notify_len);
|
|
||||||
}
|
|
||||||
int i;
|
|
||||||
for (i = 0; i < notify_len; i++) notify_data[i]++;
|
|
||||||
vTaskDelay(pdMS_TO_TICKS(1000));
|
|
||||||
vTaskDelay(pdMS_TO_TICKS(1000));
|
|
||||||
}
|
|
||||||
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
void ble_gatts_server_init(void)
|
|
||||||
{
|
|
||||||
esp_err_t ret;
|
|
||||||
|
|
||||||
ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_CLASSIC_BT));
|
|
||||||
|
|
||||||
esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
||||||
ret = esp_bt_controller_init(&bt_cfg);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_bt_controller_enable(ESP_BT_MODE_BLE);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_bluedroid_init();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s init bluetooth failed: %s", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_bluedroid_enable();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable bluetooth failed: %s", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_ble_gatts_register_callback(gatts_event_handler);
|
|
||||||
if (ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "gatts register error, error code = %x", ret);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_ble_gap_register_callback(gap_event_handler);
|
|
||||||
if (ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "gap register error, error code = %x", ret);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_ble_gatts_app_register(ESP_APP_ID);
|
|
||||||
if (ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "gatts app register error, error code = %x", ret);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
esp_err_t local_mtu_ret = esp_ble_gatt_set_local_mtu(500);
|
|
||||||
if (local_mtu_ret){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "set local MTU failed, error code = %x", local_mtu_ret);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* 创建任务用于定期的数据上报notify */
|
|
||||||
xTaskCreate(notify_task, "notify_Task", 4096, NULL, 8, NULL);
|
|
||||||
}
|
|
||||||
@ -1,37 +0,0 @@
|
|||||||
#ifndef __BLE_GATTS_SERVER_H
|
|
||||||
#define __BLE_GATTS_SERVER_H
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
|
|
||||||
#define SPP_DATA_MAX_LEN (512)
|
|
||||||
|
|
||||||
|
|
||||||
/* Attributes State Machine */
|
|
||||||
enum
|
|
||||||
{
|
|
||||||
IDX_SVC,
|
|
||||||
|
|
||||||
/* gWordVar data write */
|
|
||||||
IDX_CHAR_A,
|
|
||||||
IDX_CHAR_VAL_A,
|
|
||||||
IDX_CHAR_CFG_A,
|
|
||||||
|
|
||||||
/* gWordVar data notify */
|
|
||||||
SPP_IDX_SPP_DATA_NOTIFY_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_NTY_VAL,
|
|
||||||
SPP_IDX_SPP_DATA_NTF_CFG,
|
|
||||||
|
|
||||||
|
|
||||||
HRS_IDX_NB,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* 定时上报的数据内容 */
|
|
||||||
extern uint8_t notify_data[500];
|
|
||||||
extern uint32_t notify_len;
|
|
||||||
|
|
||||||
void ble_gatts_server_init(void);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@ -1,502 +0,0 @@
|
|||||||
#include "freertos/FreeRTOS.h"
|
|
||||||
#include "freertos/task.h"
|
|
||||||
#include "freertos/event_groups.h"
|
|
||||||
#include "esp_system.h"
|
|
||||||
#include "esp_log.h"
|
|
||||||
#include "nvs_flash.h"
|
|
||||||
#include "esp_bt.h"
|
|
||||||
#include "driver/uart.h"
|
|
||||||
#include "string.h"
|
|
||||||
|
|
||||||
#include "esp_gap_ble_api.h"
|
|
||||||
#include "esp_gatts_api.h"
|
|
||||||
#include "esp_bt_defs.h"
|
|
||||||
#include "esp_bt_main.h"
|
|
||||||
#include "ble_server.h"
|
|
||||||
|
|
||||||
#include "stm32/config.h"
|
|
||||||
#include "stm32/ModbusS.h"
|
|
||||||
|
|
||||||
#define GATTS_TABLE_TAG "GATTS_SPP_DEMO"
|
|
||||||
|
|
||||||
#define SPP_PROFILE_NUM 1
|
|
||||||
#define SPP_PROFILE_APP_IDX 0
|
|
||||||
#define ESP_SPP_APP_ID 0x56
|
|
||||||
#define SAMPLE_DEVICE_NAME "ESP_SPP_SERVER" //The Device Name Characteristics in GAP
|
|
||||||
#define SPP_SVC_INST_ID 0
|
|
||||||
|
|
||||||
/// SPP Service
|
|
||||||
static const uint16_t spp_service_uuid = 0xABF0;
|
|
||||||
/// Characteristic UUID
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_RECEIVE 0xABF1
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_NOTIFY 0xABF2
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_RECEIVE 0xABF3
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_NOTIFY 0xABF4
|
|
||||||
|
|
||||||
#define ESP_GATT_UUID_PILE_DATA_RECEIVE1 0XABF5
|
|
||||||
#define ESP_GATT_UUID_PILE_DATA_RECEIVE2 0XABF6
|
|
||||||
#define ESP_GATT_UUID_PILE_DATA_RECEIVE3 0XABF7
|
|
||||||
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
#define ESP_GATT_UUID_SPP_HEARTBEAT 0xABF5
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static const uint8_t spp_adv_data[23] = {
|
|
||||||
/* Flags */
|
|
||||||
0x02,0x01,0x06,
|
|
||||||
/* Complete List of 16-bit Service Class UUIDs */
|
|
||||||
0x03,0x03,0xF0,0xAB,
|
|
||||||
/* Complete Local Name in advertising */
|
|
||||||
0x0F,0x09, 'E', 'S', 'P', '_', 'S', 'P', 'P', '_', 'S', 'E', 'R','V', 'E', 'R'
|
|
||||||
};
|
|
||||||
|
|
||||||
static uint16_t spp_mtu_size = 23;
|
|
||||||
static uint16_t spp_conn_id = 0xffff;
|
|
||||||
static esp_gatt_if_t spp_gatts_if = 0xff;
|
|
||||||
QueueHandle_t spp_uart_queue = NULL;
|
|
||||||
static QueueHandle_t cmd_cmd_queue = NULL;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static QueueHandle_t cmd_heartbeat_queue = NULL;
|
|
||||||
static uint8_t heartbeat_s[9] = {'E','s','p','r','e','s','s','i','f'};
|
|
||||||
static bool enable_heart_ntf = false;
|
|
||||||
static uint8_t heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static bool enable_data_ntf = false;
|
|
||||||
static bool is_connected = false;
|
|
||||||
static esp_bd_addr_t spp_remote_bda = {0x0,};
|
|
||||||
|
|
||||||
static uint16_t spp_handle_table[SPP_IDX_NB];
|
|
||||||
|
|
||||||
static esp_ble_adv_params_t spp_adv_params = {
|
|
||||||
.adv_int_min = 0x20,
|
|
||||||
.adv_int_max = 0x40,
|
|
||||||
.adv_type = ADV_TYPE_IND,
|
|
||||||
.own_addr_type = BLE_ADDR_TYPE_PUBLIC,
|
|
||||||
.channel_map = ADV_CHNL_ALL,
|
|
||||||
.adv_filter_policy = ADV_FILTER_ALLOW_SCAN_ANY_CON_ANY,
|
|
||||||
};
|
|
||||||
|
|
||||||
struct gatts_profile_inst {
|
|
||||||
esp_gatts_cb_t gatts_cb;
|
|
||||||
uint16_t gatts_if;
|
|
||||||
uint16_t app_id;
|
|
||||||
uint16_t conn_id;
|
|
||||||
uint16_t service_handle;
|
|
||||||
esp_gatt_srvc_id_t service_id;
|
|
||||||
uint16_t char_handle;
|
|
||||||
esp_bt_uuid_t char_uuid;
|
|
||||||
esp_gatt_perm_t perm;
|
|
||||||
esp_gatt_char_prop_t property;
|
|
||||||
uint16_t descr_handle;
|
|
||||||
esp_bt_uuid_t descr_uuid;
|
|
||||||
};
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_node{
|
|
||||||
int32_t len;
|
|
||||||
uint8_t * node_buff;
|
|
||||||
struct spp_receive_data_node * next_node;
|
|
||||||
}spp_receive_data_node_t;
|
|
||||||
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p1 = NULL;
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p2 = NULL;
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_buff{
|
|
||||||
int32_t node_num;
|
|
||||||
int32_t buff_size;
|
|
||||||
spp_receive_data_node_t * first_node;
|
|
||||||
}spp_receive_data_buff_t;
|
|
||||||
|
|
||||||
static spp_receive_data_buff_t SppRecvDataBuff = {
|
|
||||||
.node_num = 0,
|
|
||||||
.buff_size = 0,
|
|
||||||
.first_node = NULL
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param);
|
|
||||||
|
|
||||||
/* One gatt-based profile one app_id and one gatts_if, this array will store the gatts_if returned by ESP_GATTS_REG_EVT */
|
|
||||||
static struct gatts_profile_inst spp_profile_tab[SPP_PROFILE_NUM] = {
|
|
||||||
[SPP_PROFILE_APP_IDX] = {
|
|
||||||
.gatts_cb = gatts_profile_event_handler,
|
|
||||||
.gatts_if = ESP_GATT_IF_NONE, /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* SPP PROFILE ATTRIBUTES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
|
|
||||||
#define CHAR_DECLARATION_SIZE (sizeof(uint8_t))
|
|
||||||
static const uint16_t primary_service_uuid = ESP_GATT_UUID_PRI_SERVICE;
|
|
||||||
static const uint16_t character_declaration_uuid = ESP_GATT_UUID_CHAR_DECLARE;
|
|
||||||
static const uint16_t character_client_config_uuid = ESP_GATT_UUID_CHAR_CLIENT_CONFIG;
|
|
||||||
|
|
||||||
static const uint8_t char_prop_read_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
static const uint8_t char_prop_read_write = ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_READ;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static const uint8_t char_prop_read_write_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
///SPP Service - data receive characteristic, read&write without response
|
|
||||||
static const uint16_t spp_data_receive_uuid = ESP_GATT_UUID_SPP_DATA_RECEIVE;
|
|
||||||
static const uint8_t spp_data_receive_val[20] = {0x02, 0x03};
|
|
||||||
|
|
||||||
///SPP Service - data notify characteristic, notify&read
|
|
||||||
static const uint16_t spp_data_notify_uuid = ESP_GATT_UUID_SPP_DATA_NOTIFY;
|
|
||||||
static const uint8_t spp_data_notify_val[20] = {0x00};
|
|
||||||
static const uint8_t spp_data_notify_ccc[2] = {0x00, 0x00};
|
|
||||||
|
|
||||||
///SPP Service - command characteristic, read&write without response
|
|
||||||
static const uint16_t spp_command_uuid = ESP_GATT_UUID_SPP_COMMAND_RECEIVE;
|
|
||||||
static const uint8_t spp_command_val[10] = {0x00};
|
|
||||||
|
|
||||||
///SPP Service - status characteristic, notify&read
|
|
||||||
static const uint16_t spp_status_uuid = ESP_GATT_UUID_SPP_COMMAND_NOTIFY;
|
|
||||||
static const uint8_t spp_status_val[10] = {0x00};
|
|
||||||
static const uint8_t spp_status_ccc[2] = {0x00, 0x00};
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
///SPP Server - Heart beat characteristic, notify&write&read
|
|
||||||
static const uint16_t spp_heart_beat_uuid = ESP_GATT_UUID_SPP_HEARTBEAT;
|
|
||||||
static const uint8_t spp_heart_beat_val[2] = {0x00, 0x00};
|
|
||||||
static const uint8_t spp_heart_beat_ccc[2] = {0x00, 0x00};
|
|
||||||
#endif
|
|
||||||
|
|
||||||
extern cal_4_20ma_t *cal_4_20ma;//电流数据结构体
|
|
||||||
extern flow_config_t *flow_config;//流量数据结构体
|
|
||||||
extern depth_config_t *depth_config;//深度数据结构体
|
|
||||||
|
|
||||||
static const uint16_t pile_data_receive1_uuid = ESP_GATT_UUID_PILE_DATA_RECEIVE1;
|
|
||||||
static const uint16_t pile_data_receive2_uuid = ESP_GATT_UUID_PILE_DATA_RECEIVE2;
|
|
||||||
static const uint16_t pile_data_receive3_uuid = ESP_GATT_UUID_PILE_DATA_RECEIVE3;
|
|
||||||
|
|
||||||
///Full HRS Database Description - Used to add attributes into the database
|
|
||||||
esp_gatts_attr_db_t spp_gatt_db[SPP_IDX_NB] =
|
|
||||||
{
|
|
||||||
//SPP - Service Declaration
|
|
||||||
[SPP_IDX_SVC] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&primary_service_uuid, ESP_GATT_PERM_READ,
|
|
||||||
sizeof(spp_service_uuid), sizeof(spp_service_uuid), (uint8_t *)&spp_service_uuid}},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write}},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Value
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_data_receive_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,sizeof(spp_data_receive_val), (uint8_t *)spp_data_receive_val}},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_DATA_NOTIFY_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_notify}},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Value
|
|
||||||
[SPP_IDX_SPP_DATA_NTY_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_data_notify_uuid, ESP_GATT_PERM_READ,
|
|
||||||
SPP_DATA_MAX_LEN, sizeof(spp_data_notify_val), (uint8_t *)spp_data_notify_val}},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_DATA_NTF_CFG] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),sizeof(spp_data_notify_ccc), (uint8_t *)spp_data_notify_ccc}},
|
|
||||||
|
|
||||||
//SPP - command characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_COMMAND_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write}},
|
|
||||||
|
|
||||||
//SPP - command characteristic Value
|
|
||||||
[SPP_IDX_SPP_COMMAND_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_command_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_CMD_MAX_LEN,sizeof(spp_command_val), (uint8_t *)spp_command_val}},
|
|
||||||
|
|
||||||
//SPP - status characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_STATUS_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_notify}},
|
|
||||||
|
|
||||||
//SPP - status characteristic Value
|
|
||||||
[SPP_IDX_SPP_STATUS_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_status_uuid, ESP_GATT_PERM_READ,
|
|
||||||
SPP_STATUS_MAX_LEN,sizeof(spp_status_val), (uint8_t *)spp_status_val}},
|
|
||||||
|
|
||||||
//SPP - status characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_STATUS_CFG] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),sizeof(spp_status_ccc), (uint8_t *)spp_status_ccc}},
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
[PILE_IDX_DATA_RECV1_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write}},
|
|
||||||
[PILE_IDX_DATA_RECV1_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&pile_data_receive1_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,sizeof(cal_4_20ma_t), (uint8_t *)&gWordVar[CAL_4_20MA_ADDR]}},
|
|
||||||
|
|
||||||
[PILE_IDX_DATA_RECV2_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write}},
|
|
||||||
[PILE_IDX_DATA_RECV2_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&pile_data_receive2_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,sizeof(flow_config_t), (uint8_t *)&gWordVar[FLOW_CONFIG_ADDR]}},
|
|
||||||
|
|
||||||
[PILE_IDX_DATA_RECV3_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write}},
|
|
||||||
[PILE_IDX_DATA_RECV3_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&pile_data_receive3_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,sizeof(depth_config_t), (uint8_t *)&gWordVar[DEPTH_CONFIG_ADDR]}},
|
|
||||||
};
|
|
||||||
|
|
||||||
static uint8_t find_char_and_desr_index(uint16_t handle)
|
|
||||||
{
|
|
||||||
uint8_t error = 0xff;
|
|
||||||
|
|
||||||
for(int i = 0; i < SPP_IDX_NB ; i++){
|
|
||||||
if(handle == spp_handle_table[i]){
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return error;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gap_event_handler(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_err_t err;
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "GAP_EVT, event %d\n", event);
|
|
||||||
|
|
||||||
switch (event) {
|
|
||||||
case ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT:
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT:
|
|
||||||
//advertising start complete event to indicate advertising start successfully or failed
|
|
||||||
if((err = param->adv_start_cmpl.status) != ESP_BT_STATUS_SUCCESS) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Advertising start failed: %s\n", esp_err_to_name(err));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_ble_gatts_cb_param_t *p_data = (esp_ble_gatts_cb_param_t *) param;
|
|
||||||
uint8_t res = 0xff;
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "event = %d\n",event);
|
|
||||||
switch (event) {
|
|
||||||
case ESP_GATTS_REG_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_REG_EVT");
|
|
||||||
|
|
||||||
esp_ble_gap_set_device_name(SAMPLE_DEVICE_NAME);
|
|
||||||
|
|
||||||
esp_ble_gap_config_adv_data_raw((uint8_t *)spp_adv_data, sizeof(spp_adv_data));
|
|
||||||
|
|
||||||
esp_ble_gatts_create_attr_tab(spp_gatt_db, gatts_if, SPP_IDX_NB, SPP_SVC_INST_ID);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_READ_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_READ_EVT");
|
|
||||||
gWordVar[CAL_4_20MA_ADDR] = 1;
|
|
||||||
// res = find_char_and_desr_index(p_data->read.handle);
|
|
||||||
// if(res == SPP_IDX_SPP_STATUS_VAL){
|
|
||||||
// //TODO:client read the status characteristic
|
|
||||||
// }
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_WRITE_EVT: {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_WRITE_EVT");
|
|
||||||
res = find_char_and_desr_index(p_data->write.handle);
|
|
||||||
if(p_data->write.is_prep == false){
|
|
||||||
// ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_WRITE_EVT : handle = %d\n", res);
|
|
||||||
if(res == SPP_IDX_SPP_COMMAND_VAL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "SPP_IDX_SPP_COMMAND_VAL");
|
|
||||||
// uint8_t * spp_cmd_buff = NULL;
|
|
||||||
// spp_cmd_buff = (uint8_t *)malloc((spp_mtu_size - 3) * sizeof(uint8_t));
|
|
||||||
// if(spp_cmd_buff == NULL){
|
|
||||||
// ESP_LOGE(GATTS_TABLE_TAG, "%s malloc failed\n", __func__);
|
|
||||||
// break;
|
|
||||||
// }
|
|
||||||
// memset(spp_cmd_buff,0x0,(spp_mtu_size - 3));
|
|
||||||
// memcpy(spp_cmd_buff,p_data->write.value,p_data->write.len);
|
|
||||||
// xQueueSend(cmd_cmd_queue,&spp_cmd_buff,10/portTICK_PERIOD_MS);
|
|
||||||
}else if(res == SPP_IDX_SPP_DATA_NTF_CFG){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "SPP_IDX_SPP_DATA_NTF_CFG");
|
|
||||||
if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x01)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = true;
|
|
||||||
}else if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x00)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else if(res == SPP_IDX_SPP_DATA_RECV_VAL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "SPP_IDX_SPP_DATA_RECV_VAL");
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "0x%x 0x%x", spp_data_receive_val[0], spp_data_receive_val[1]);
|
|
||||||
// uart_write_bytes(UART_NUM_2, (char *)(p_data->write.value), p_data->write.len);
|
|
||||||
}
|
|
||||||
else if (res == PILE_IDX_DATA_RECV1_VAL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "PILE_IDX_DATA_RECV1_VAL %d:0x%x 0x%x 0x%x 0x%x", p_data->write.len, p_data->write.value[0], p_data->write.value[1], p_data->write.value[2], p_data->write.value[3]);
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "0x%x 0x%x", gWordVar[CAL_4_20MA_ADDR], gWordVar[CAL_4_20MA_ADDR + 1]);
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "cal_4_20ma->magic=%d", cal_4_20ma->magic);
|
|
||||||
}
|
|
||||||
else if (res == PILE_IDX_DATA_RECV2_VAL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "PILE_IDX_DATA_RECV2_VAL");
|
|
||||||
}
|
|
||||||
else if (res == PILE_IDX_DATA_RECV3_VAL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "PILE_IDX_DATA_RECV3_VAL");
|
|
||||||
}
|
|
||||||
else{
|
|
||||||
//TODO:
|
|
||||||
}
|
|
||||||
}else if((p_data->write.is_prep == true)&&(res == SPP_IDX_SPP_DATA_RECV_VAL)){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_PREP_WRITE_EVT : handle = %d\n", res);
|
|
||||||
// store_wr_buffer(p_data);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case ESP_GATTS_EXEC_WRITE_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_EXEC_WRITE_EVT\n");
|
|
||||||
if(p_data->exec_write.exec_write_flag){
|
|
||||||
// print_write_buffer();
|
|
||||||
// free_write_buffer();
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case ESP_GATTS_MTU_EVT:
|
|
||||||
spp_mtu_size = p_data->mtu.mtu;
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONF_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_UNREG_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DELETE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_START_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_STOP_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONNECT_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_CONNECT_EVT");
|
|
||||||
spp_conn_id = p_data->connect.conn_id;
|
|
||||||
spp_gatts_if = gatts_if;
|
|
||||||
is_connected = true;
|
|
||||||
memcpy(&spp_remote_bda,&p_data->connect.remote_bda,sizeof(esp_bd_addr_t));
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
uint16_t cmd = 0;
|
|
||||||
xQueueSend(cmd_heartbeat_queue,&cmd,10/portTICK_PERIOD_MS);
|
|
||||||
#endif
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DISCONNECT_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_DISCONNECT_EVT");
|
|
||||||
is_connected = false;
|
|
||||||
enable_data_ntf = false;
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
enable_heart_ntf = false;
|
|
||||||
heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CANCEL_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CLOSE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_LISTEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONGEST_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CREAT_ATTR_TAB_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "The number handle =%x\n",param->add_attr_tab.num_handle);
|
|
||||||
if (param->add_attr_tab.status != ESP_GATT_OK){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table failed, error code=0x%x", param->add_attr_tab.status);
|
|
||||||
}
|
|
||||||
else if (param->add_attr_tab.num_handle != SPP_IDX_NB){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table abnormally, num_handle (%d) doesn't equal to HRS_IDX_NB(%d)", param->add_attr_tab.num_handle, SPP_IDX_NB);
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
memcpy(spp_handle_table, param->add_attr_tab.handles, sizeof(spp_handle_table));
|
|
||||||
esp_ble_gatts_start_service(spp_handle_table[SPP_IDX_SVC]);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "EVT %d, gatts if %d\n", event, gatts_if);
|
|
||||||
|
|
||||||
/* If event is register event, store the gatts_if for each profile */
|
|
||||||
if (event == ESP_GATTS_REG_EVT) {
|
|
||||||
if (param->reg.status == ESP_GATT_OK) {
|
|
||||||
spp_profile_tab[SPP_PROFILE_APP_IDX].gatts_if = gatts_if;
|
|
||||||
} else {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "Reg app failed, app_id %04x, status %d\n",param->reg.app_id, param->reg.status);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
do {
|
|
||||||
int idx;
|
|
||||||
for (idx = 0; idx < SPP_PROFILE_NUM; idx++) {
|
|
||||||
if (gatts_if == ESP_GATT_IF_NONE || /* ESP_GATT_IF_NONE, not specify a certain gatt_if, need to call every profile cb function */
|
|
||||||
gatts_if == spp_profile_tab[idx].gatts_if) {
|
|
||||||
if (spp_profile_tab[idx].gatts_cb) {
|
|
||||||
spp_profile_tab[idx].gatts_cb(event, gatts_if, param);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
} while (0);
|
|
||||||
}
|
|
||||||
|
|
||||||
void ble_server_init(void)
|
|
||||||
{
|
|
||||||
esp_err_t ret;
|
|
||||||
esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
||||||
|
|
||||||
ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_CLASSIC_BT));
|
|
||||||
|
|
||||||
ret = esp_bt_controller_init(&bt_cfg);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = esp_bt_controller_enable(ESP_BT_MODE_BLE);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s init bluetooth\n", __func__);
|
|
||||||
ret = esp_bluedroid_init();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s init bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
ret = esp_bluedroid_enable();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
esp_ble_gatts_register_callback(gatts_event_handler);
|
|
||||||
esp_ble_gap_register_callback(gap_event_handler);
|
|
||||||
esp_ble_gatts_app_register(ESP_SPP_APP_ID);
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
@ -1,59 +0,0 @@
|
|||||||
#ifndef __BLE_SERCER_H
|
|
||||||
#define __BLE_SERCER_H
|
|
||||||
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
/*
|
|
||||||
* DEFINES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
//#define SUPPORT_HEARTBEAT
|
|
||||||
//#define SPP_DEBUG_MODE
|
|
||||||
|
|
||||||
#define spp_sprintf(s,...) sprintf((char*)(s), ##__VA_ARGS__)
|
|
||||||
#define SPP_DATA_MAX_LEN (512)
|
|
||||||
#define SPP_CMD_MAX_LEN (20)
|
|
||||||
#define SPP_STATUS_MAX_LEN (20)
|
|
||||||
#define SPP_DATA_BUFF_MAX_LEN (2*1024)
|
|
||||||
///Attributes State Machine
|
|
||||||
enum{
|
|
||||||
SPP_IDX_SVC,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_RECV_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_RECV_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_NOTIFY_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_NTY_VAL,
|
|
||||||
SPP_IDX_SPP_DATA_NTF_CFG,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_COMMAND_CHAR,
|
|
||||||
SPP_IDX_SPP_COMMAND_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_STATUS_CHAR,
|
|
||||||
SPP_IDX_SPP_STATUS_VAL,
|
|
||||||
SPP_IDX_SPP_STATUS_CFG,
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CHAR,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_VAL,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CFG,
|
|
||||||
#endif
|
|
||||||
|
|
||||||
PILE_IDX_DATA_RECV1_CHAR,
|
|
||||||
PILE_IDX_DATA_RECV1_VAL,
|
|
||||||
|
|
||||||
PILE_IDX_DATA_RECV2_CHAR,
|
|
||||||
PILE_IDX_DATA_RECV2_VAL,
|
|
||||||
|
|
||||||
PILE_IDX_DATA_RECV3_CHAR,
|
|
||||||
PILE_IDX_DATA_RECV3_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_NB,
|
|
||||||
};
|
|
||||||
|
|
||||||
void ble_server_init(void);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@ -1,859 +0,0 @@
|
|||||||
/*
|
|
||||||
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.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "freertos/FreeRTOS.h"
|
|
||||||
#include "freertos/task.h"
|
|
||||||
#include "freertos/event_groups.h"
|
|
||||||
#include "esp_system.h"
|
|
||||||
#include "esp_log.h"
|
|
||||||
#include "nvs_flash.h"
|
|
||||||
#include "esp_bt.h"
|
|
||||||
#include "driver/uart.h"
|
|
||||||
#include "string.h"
|
|
||||||
|
|
||||||
#include "esp_gap_ble_api.h"
|
|
||||||
#include "esp_gatts_api.h"
|
|
||||||
#include "esp_bt_defs.h"
|
|
||||||
#include "esp_bt_main.h"
|
|
||||||
#include "bt_server.h"
|
|
||||||
|
|
||||||
#define SPP_DEBUG_MODE 1
|
|
||||||
|
|
||||||
#define GATTS_TABLE_TAG "GATTS_SPP_DEMO"
|
|
||||||
|
|
||||||
#define SPP_PROFILE_NUM 1
|
|
||||||
#define SPP_PROFILE_APP_IDX 0
|
|
||||||
#define ESP_SPP_APP_ID 0x56
|
|
||||||
#define SAMPLE_DEVICE_NAME "ESP_SPP_SERVER" //The Device Name Characteristics in GAP
|
|
||||||
#define SPP_SVC_INST_ID 0
|
|
||||||
|
|
||||||
/// SPP Service
|
|
||||||
static const uint16_t spp_service_uuid = 0xABF0;
|
|
||||||
/// Characteristic UUID
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_RECEIVE 0xABF1
|
|
||||||
#define ESP_GATT_UUID_SPP_DATA_NOTIFY 0xABF2
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_RECEIVE 0xABF3
|
|
||||||
#define ESP_GATT_UUID_SPP_COMMAND_NOTIFY 0xABF4
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
#define ESP_GATT_UUID_SPP_HEARTBEAT 0xABF5
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*蓝牙的广播数据*/
|
|
||||||
static const uint8_t spp_adv_data[23] = {
|
|
||||||
/* Flags */
|
|
||||||
0x02,0x01,0x06, //表示设备支持LE General Discoverable Mode（可被发现模式）和BR/EDR Not Supported（不支持传统蓝牙）
|
|
||||||
/* Complete List of 16-bit Service Class UUIDs */
|
|
||||||
0x03,0x03,0xF0,0xAB,//广播数据中的16位服务UUID字段，表示设备提供了一个特定的服务，这里是自定义的16位UUID
|
|
||||||
/* Complete Local Name in advertising */
|
|
||||||
0x0F,0x09, 'E', 'S', 'P', '_', 'S', 'P', 'P', '_', 'S', 'E', 'R','V', 'E', 'R'
|
|
||||||
//广播数据中的16位服务UUID字段，表示设备提供了一个特定的服务，这里是自定义的16位UUID
|
|
||||||
};
|
|
||||||
|
|
||||||
static uint16_t spp_mtu_size = 23;
|
|
||||||
uint16_t spp_conn_id = 0xffff;
|
|
||||||
esp_gatt_if_t spp_gatts_if = 0xff;
|
|
||||||
QueueHandle_t spp_uart_queue = NULL;
|
|
||||||
static QueueHandle_t cmd_cmd_queue = NULL;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static QueueHandle_t cmd_heartbeat_queue = NULL;
|
|
||||||
static uint8_t heartbeat_s[9] = {'E','s','p','r','e','s','s','i','f'};
|
|
||||||
static bool enable_heart_ntf = false;
|
|
||||||
static uint8_t heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static bool enable_data_ntf = false;
|
|
||||||
bool is_connected = false;
|
|
||||||
static esp_bd_addr_t spp_remote_bda = {0x0,};
|
|
||||||
|
|
||||||
uint16_t spp_handle_table[SPP_IDX_NB];
|
|
||||||
|
|
||||||
static esp_ble_adv_params_t spp_adv_params = {
|
|
||||||
.adv_int_min = 0x20,
|
|
||||||
.adv_int_max = 0x40,
|
|
||||||
.adv_type = ADV_TYPE_IND,
|
|
||||||
.own_addr_type = BLE_ADDR_TYPE_PUBLIC,
|
|
||||||
.channel_map = ADV_CHNL_ALL,
|
|
||||||
.adv_filter_policy = ADV_FILTER_ALLOW_SCAN_ANY_CON_ANY,
|
|
||||||
};
|
|
||||||
|
|
||||||
struct gatts_profile_inst {
|
|
||||||
esp_gatts_cb_t gatts_cb;
|
|
||||||
uint16_t gatts_if;
|
|
||||||
uint16_t app_id;
|
|
||||||
uint16_t conn_id;
|
|
||||||
uint16_t service_handle;
|
|
||||||
esp_gatt_srvc_id_t service_id;
|
|
||||||
uint16_t char_handle;
|
|
||||||
esp_bt_uuid_t char_uuid;
|
|
||||||
esp_gatt_perm_t perm;
|
|
||||||
esp_gatt_char_prop_t property;
|
|
||||||
uint16_t descr_handle;
|
|
||||||
esp_bt_uuid_t descr_uuid;
|
|
||||||
};
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_node{
|
|
||||||
int32_t len;
|
|
||||||
uint8_t * node_buff;
|
|
||||||
struct spp_receive_data_node * next_node;
|
|
||||||
}spp_receive_data_node_t;
|
|
||||||
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p1 = NULL;
|
|
||||||
static spp_receive_data_node_t * temp_spp_recv_data_node_p2 = NULL;
|
|
||||||
|
|
||||||
typedef struct spp_receive_data_buff{
|
|
||||||
int32_t node_num;
|
|
||||||
int32_t buff_size;
|
|
||||||
spp_receive_data_node_t * first_node;
|
|
||||||
}spp_receive_data_buff_t;
|
|
||||||
|
|
||||||
static spp_receive_data_buff_t SppRecvDataBuff = {
|
|
||||||
.node_num = 0,
|
|
||||||
.buff_size = 0,
|
|
||||||
.first_node = NULL
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param);
|
|
||||||
|
|
||||||
/* One gatt-based profile one app_id and one gatts_if, this array will store the gatts_if returned by ESP_GATTS_REG_EVT */
|
|
||||||
static struct gatts_profile_inst spp_profile_tab[SPP_PROFILE_NUM] = {
|
|
||||||
[SPP_PROFILE_APP_IDX] = {
|
|
||||||
.gatts_cb = gatts_profile_event_handler,
|
|
||||||
.gatts_if = ESP_GATT_IF_NONE, /* Not get the gatt_if, so initial is ESP_GATT_IF_NONE */
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* SPP PROFILE ATTRIBUTES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
|
|
||||||
#define CHAR_DECLARATION_SIZE (sizeof(uint8_t))
|
|
||||||
static const uint16_t primary_service_uuid = ESP_GATT_UUID_PRI_SERVICE; //0x2800
|
|
||||||
static const uint16_t character_declaration_uuid = ESP_GATT_UUID_CHAR_DECLARE; //0x2803
|
|
||||||
static const uint16_t character_client_config_uuid = ESP_GATT_UUID_CHAR_CLIENT_CONFIG; //0x2902
|
|
||||||
|
|
||||||
static const uint8_t char_prop_read_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
static const uint8_t char_prop_read_write = ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_READ;
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
static const uint8_t char_prop_read_write_notify = ESP_GATT_CHAR_PROP_BIT_READ|ESP_GATT_CHAR_PROP_BIT_WRITE_NR|ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
///SPP Service - data receive characteristic, read&write without response
|
|
||||||
static const uint16_t spp_data_receive_uuid = ESP_GATT_UUID_SPP_DATA_RECEIVE; //0xABF1
|
|
||||||
static const uint8_t spp_data_receive_val[20] = {0x00};
|
|
||||||
|
|
||||||
///SPP Service - data notify characteristic, notify&read
|
|
||||||
static const uint16_t spp_data_notify_uuid = ESP_GATT_UUID_SPP_DATA_NOTIFY; //0xABF2
|
|
||||||
static const uint8_t spp_data_notify_val[20] = {0x00};
|
|
||||||
static const uint8_t spp_data_notify_ccc[2] = {0x00, 0x00};
|
|
||||||
|
|
||||||
///SPP Service - command characteristic, read&write without response
|
|
||||||
static const uint16_t spp_command_uuid = ESP_GATT_UUID_SPP_COMMAND_RECEIVE; //0xABF3
|
|
||||||
static const uint8_t spp_command_val[10] = {0x00};
|
|
||||||
|
|
||||||
///SPP Service - status characteristic, notify&read
|
|
||||||
static const uint16_t spp_status_uuid = ESP_GATT_UUID_SPP_COMMAND_NOTIFY; //0xABF4
|
|
||||||
static const uint8_t spp_status_val[10] = {0x00};
|
|
||||||
static const uint8_t spp_status_ccc[2] = {0x00, 0x00};//状态特征值。这个值允许其他设备配置是否接收状态特征通知,这里是禁用
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
///SPP Server - Heart beat characteristic, notify&write&read
|
|
||||||
static const uint16_t spp_heart_beat_uuid = ESP_GATT_UUID_SPP_HEARTBEAT;
|
|
||||||
static const uint8_t spp_heart_beat_val[2] = {0x00, 0x00};
|
|
||||||
static const uint8_t spp_heart_beat_ccc[2] = {0x00, 0x00};
|
|
||||||
#endif
|
|
||||||
|
|
||||||
///Full HRS Database Description - Used to add attributes into the database
|
|
||||||
static const esp_gatts_attr_db_t spp_gatt_db[SPP_IDX_NB] =
|
|
||||||
{
|
|
||||||
//SPP - Service Declaration 服务声明
|
|
||||||
[SPP_IDX_SVC] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&primary_service_uuid, //0x2800
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
sizeof(spp_service_uuid), //0xABF0
|
|
||||||
sizeof(spp_service_uuid),
|
|
||||||
(uint8_t *)&spp_service_uuid
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Declaration 声明服务中数据接受特征
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_write
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data receive characteristic Value spp服务中数据接收特征值
|
|
||||||
[SPP_IDX_SPP_DATA_RECV_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_data_receive_uuid, //0xABF1
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_DATA_MAX_LEN,
|
|
||||||
sizeof(spp_data_receive_val),
|
|
||||||
(uint8_t *)spp_data_receive_val //0x00
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Declaration spp协议中数据通知特征
|
|
||||||
[SPP_IDX_SPP_DATA_NOTIFY_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_notify
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic Value 数据通知特征的值
|
|
||||||
[SPP_IDX_SPP_DATA_NTY_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_data_notify_uuid, //0xABF2
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
SPP_DATA_MAX_LEN,
|
|
||||||
sizeof(spp_data_notify_val),
|
|
||||||
(uint8_t *)spp_data_notify_val //0x00
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - data notify characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
//数据通知特征的客户端特性配置描述符,用于配置特征的行为和交互方式,客户端特性配置描述符用于配置该特征是否可以发送通知给连接的设备
|
|
||||||
[SPP_IDX_SPP_DATA_NTF_CFG] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_client_config_uuid, //0x2902
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),
|
|
||||||
sizeof(spp_data_notify_ccc),
|
|
||||||
(uint8_t *)spp_data_notify_ccc //{0x00, 0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - command characteristic Declaration 命令特征声明
|
|
||||||
[SPP_IDX_SPP_COMMAND_CHAR]= {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_write
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - command characteristic Value 命令特征值
|
|
||||||
[SPP_IDX_SPP_COMMAND_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_command_uuid, //0xABF3
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
SPP_CMD_MAX_LEN,
|
|
||||||
sizeof(spp_command_val),
|
|
||||||
(uint8_t *)spp_command_val //{0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_STATUS_CHAR] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_declaration_uuid, //0x2803
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
CHAR_DECLARATION_SIZE,
|
|
||||||
(uint8_t *)&char_prop_read_notify
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic Value
|
|
||||||
[SPP_IDX_SPP_STATUS_VAL] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&spp_status_uuid, //0xABF4
|
|
||||||
ESP_GATT_PERM_READ,
|
|
||||||
SPP_STATUS_MAX_LEN,
|
|
||||||
sizeof(spp_status_val),
|
|
||||||
(uint8_t *)spp_status_val //{0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
//SPP - status characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_STATUS_CFG] = {
|
|
||||||
{ESP_GATT_AUTO_RSP},
|
|
||||||
{
|
|
||||||
ESP_UUID_LEN_16,
|
|
||||||
(uint8_t *)&character_client_config_uuid, //0x2902
|
|
||||||
ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),
|
|
||||||
sizeof(spp_status_ccc),
|
|
||||||
(uint8_t *)spp_status_ccc //{0x00, 0x00}
|
|
||||||
}
|
|
||||||
},
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
//SPP - Heart beat characteristic Declaration
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_CHAR] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_declaration_uuid, ESP_GATT_PERM_READ,
|
|
||||||
CHAR_DECLARATION_SIZE,CHAR_DECLARATION_SIZE, (uint8_t *)&char_prop_read_write_notify}},
|
|
||||||
|
|
||||||
//SPP - Heart beat characteristic Value
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_VAL] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&spp_heart_beat_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(spp_heart_beat_val), sizeof(spp_heart_beat_val), (uint8_t *)spp_heart_beat_val}},
|
|
||||||
|
|
||||||
//SPP - Heart beat characteristic - Client Characteristic Configuration Descriptor
|
|
||||||
[SPP_IDX_SPP_HEARTBEAT_CFG] =
|
|
||||||
{{ESP_GATT_AUTO_RSP}, {ESP_UUID_LEN_16, (uint8_t *)&character_client_config_uuid, ESP_GATT_PERM_READ|ESP_GATT_PERM_WRITE,
|
|
||||||
sizeof(uint16_t),sizeof(spp_data_notify_ccc), (uint8_t *)spp_heart_beat_ccc}},
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
/*在 spp_handle_table 数组中查找与给定句柄匹配的特性或描述符，返回其索引值。如果没有找到匹配的值，则返回 0xff*/
|
|
||||||
static uint8_t find_char_and_desr_index(uint16_t handle)
|
|
||||||
{
|
|
||||||
uint8_t error = 0xff;
|
|
||||||
|
|
||||||
for(int i = 0; i < SPP_IDX_NB ; i++){
|
|
||||||
if(handle == spp_handle_table[i]){
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return error;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*存储写入缓冲区的数据*/
|
|
||||||
static bool store_wr_buffer(esp_ble_gatts_cb_param_t *p_data)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = (spp_receive_data_node_t *)malloc(sizeof(spp_receive_data_node_t));
|
|
||||||
|
|
||||||
if(temp_spp_recv_data_node_p1 == NULL){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "malloc error %s %d\n", __func__, __LINE__);
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
if(temp_spp_recv_data_node_p2 != NULL){
|
|
||||||
temp_spp_recv_data_node_p2->next_node = temp_spp_recv_data_node_p1;
|
|
||||||
}
|
|
||||||
temp_spp_recv_data_node_p1->len = p_data->write.len;
|
|
||||||
SppRecvDataBuff.buff_size += p_data->write.len;
|
|
||||||
temp_spp_recv_data_node_p1->next_node = NULL;
|
|
||||||
temp_spp_recv_data_node_p1->node_buff = (uint8_t *)malloc(p_data->write.len);
|
|
||||||
temp_spp_recv_data_node_p2 = temp_spp_recv_data_node_p1;
|
|
||||||
memcpy(temp_spp_recv_data_node_p1->node_buff,p_data->write.value,p_data->write.len);
|
|
||||||
if(SppRecvDataBuff.node_num == 0){
|
|
||||||
SppRecvDataBuff.first_node = temp_spp_recv_data_node_p1;
|
|
||||||
SppRecvDataBuff.node_num++;
|
|
||||||
}else{
|
|
||||||
SppRecvDataBuff.node_num++;
|
|
||||||
}
|
|
||||||
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
//释放缓冲区内存
|
|
||||||
static void free_write_buffer(void)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = SppRecvDataBuff.first_node;
|
|
||||||
|
|
||||||
while(temp_spp_recv_data_node_p1 != NULL){
|
|
||||||
temp_spp_recv_data_node_p2 = temp_spp_recv_data_node_p1->next_node;
|
|
||||||
free(temp_spp_recv_data_node_p1->node_buff);
|
|
||||||
free(temp_spp_recv_data_node_p1);
|
|
||||||
temp_spp_recv_data_node_p1 = temp_spp_recv_data_node_p2;
|
|
||||||
}
|
|
||||||
|
|
||||||
SppRecvDataBuff.node_num = 0;
|
|
||||||
SppRecvDataBuff.buff_size = 0;
|
|
||||||
SppRecvDataBuff.first_node = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*将缓冲区数据写入uart*/
|
|
||||||
static void print_write_buffer(void)
|
|
||||||
{
|
|
||||||
temp_spp_recv_data_node_p1 = SppRecvDataBuff.first_node;
|
|
||||||
|
|
||||||
while(temp_spp_recv_data_node_p1 != NULL){
|
|
||||||
uart_write_bytes(UART_NUM_2, (char *)(temp_spp_recv_data_node_p1->node_buff), temp_spp_recv_data_node_p1->len);
|
|
||||||
temp_spp_recv_data_node_p1 = temp_spp_recv_data_node_p1->next_node;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//蓝牙设备接收到消息后将分组数据通过蓝牙的 GATT Indicate 方式发送给蓝牙连接的设备（也就是蓝牙客户端）
|
|
||||||
void uart_task(void *pvParameters)
|
|
||||||
{
|
|
||||||
uart_event_t event;
|
|
||||||
uint8_t total_num = 0;
|
|
||||||
uint8_t current_num = 0;
|
|
||||||
|
|
||||||
for (;;) {
|
|
||||||
//Waiting for UART event.
|
|
||||||
if (xQueueReceive(spp_uart_queue, (void * )&event, 10/portTICK_PERIOD_MS)) {
|
|
||||||
switch (event.type) {
|
|
||||||
//Event of UART receving data
|
|
||||||
case UART_DATA:
|
|
||||||
if ((event.size)&&(is_connected)) {
|
|
||||||
uint8_t * temp = NULL;
|
|
||||||
uint8_t * ntf_value_p = NULL;
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
if(!enable_heart_ntf){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s do not enable heartbeat Notify\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
if(!enable_data_ntf){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s do not enable data Notify\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
temp = (uint8_t *)malloc(sizeof(uint8_t)*event.size);
|
|
||||||
if(temp == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc.1 failed\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
//将数据通过uart串口读入缓冲区
|
|
||||||
memset(temp,0x0,event.size);
|
|
||||||
uart_read_bytes(UART_NUM_2,temp,event.size,10/portTICK_PERIOD_MS);
|
|
||||||
|
|
||||||
if(event.size <= (spp_mtu_size - 3)){ //spp_mtu_size - 3是一个分组的最大容量
|
|
||||||
//向gatt发送indicate消息
|
|
||||||
//1.接口号2.连接id 3.特征句柄 4.数据长度 5.数据指针
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[4],
|
|
||||||
event.size,
|
|
||||||
temp,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}else if(event.size > (spp_mtu_size - 3)){
|
|
||||||
if((event.size%(spp_mtu_size - 7)) == 0){
|
|
||||||
total_num = event.size/(spp_mtu_size - 7);//spp_mtu_size - 7是有效负载大小
|
|
||||||
}else{
|
|
||||||
total_num = event.size/(spp_mtu_size - 7) + 1;
|
|
||||||
}
|
|
||||||
current_num = 1;
|
|
||||||
ntf_value_p = (uint8_t *)malloc((spp_mtu_size-3)*sizeof(uint8_t));
|
|
||||||
if(ntf_value_p == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc.2 failed\n", __func__);
|
|
||||||
free(temp);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
while(current_num <= total_num){
|
|
||||||
if(current_num < total_num){
|
|
||||||
ntf_value_p[0] = '#';
|
|
||||||
ntf_value_p[1] = '#';
|
|
||||||
ntf_value_p[2] = total_num;
|
|
||||||
ntf_value_p[3] = current_num;
|
|
||||||
memcpy(ntf_value_p + 4,temp + (current_num - 1)*(spp_mtu_size-7),(spp_mtu_size-7));
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[SPP_IDX_SPP_DATA_NTY_VAL],
|
|
||||||
(spp_mtu_size-3),
|
|
||||||
ntf_value_p,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}else if(current_num == total_num){
|
|
||||||
ntf_value_p[0] = '#';
|
|
||||||
ntf_value_p[1] = '#';
|
|
||||||
ntf_value_p[2] = total_num;
|
|
||||||
ntf_value_p[3] = current_num;
|
|
||||||
memcpy(ntf_value_p + 4,temp + (current_num - 1)*(spp_mtu_size-7),(event.size - (current_num - 1)*(spp_mtu_size - 7)));
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if,
|
|
||||||
spp_conn_id,
|
|
||||||
spp_handle_table[SPP_IDX_SPP_DATA_NTY_VAL],
|
|
||||||
(event.size - (current_num - 1)*(spp_mtu_size - 7) + 4),
|
|
||||||
ntf_value_p,
|
|
||||||
false
|
|
||||||
);
|
|
||||||
}
|
|
||||||
vTaskDelay(20 / portTICK_PERIOD_MS);
|
|
||||||
current_num++;
|
|
||||||
}
|
|
||||||
free(ntf_value_p);
|
|
||||||
}
|
|
||||||
free(temp);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void spp_uart_init(void)
|
|
||||||
{
|
|
||||||
uart_config_t uart_config = {
|
|
||||||
.baud_rate = 115200,
|
|
||||||
.data_bits = UART_DATA_8_BITS,
|
|
||||||
.parity = UART_PARITY_DISABLE,
|
|
||||||
.stop_bits = UART_STOP_BITS_1,
|
|
||||||
.flow_ctrl = UART_HW_FLOWCTRL_RTS,
|
|
||||||
.rx_flow_ctrl_thresh = 122,
|
|
||||||
.source_clk = UART_SCLK_APB,
|
|
||||||
};
|
|
||||||
|
|
||||||
//Install UART driver, and get the queue.
|
|
||||||
uart_driver_install(UART_NUM_2, 4096, 8192, 10, &spp_uart_queue,0);
|
|
||||||
//Set UART parameters
|
|
||||||
uart_param_config(UART_NUM_2, &uart_config);
|
|
||||||
//Set UART pins
|
|
||||||
uart_set_pin(UART_NUM_2, 14, 21, 47, UART_PIN_NO_CHANGE);
|
|
||||||
xTaskCreate(uart_task, "uTask", 2048, (void*)UART_NUM_2, 8, NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
void spp_heartbeat_task(void * arg)
|
|
||||||
{
|
|
||||||
uint16_t cmd_id;
|
|
||||||
|
|
||||||
for(;;) {
|
|
||||||
vTaskDelay(50 / portTICK_PERIOD_MS);
|
|
||||||
if(xQueueReceive(cmd_heartbeat_queue, &cmd_id, portMAX_DELAY)) {
|
|
||||||
while(1){
|
|
||||||
heartbeat_count_num++;
|
|
||||||
vTaskDelay(5000/ portTICK_PERIOD_MS);
|
|
||||||
if((heartbeat_count_num >3)&&(is_connected)){
|
|
||||||
esp_ble_gap_disconnect(spp_remote_bda);
|
|
||||||
}
|
|
||||||
if(is_connected && enable_heart_ntf){
|
|
||||||
esp_ble_gatts_send_indicate(spp_gatts_if, spp_conn_id, spp_handle_table[SPP_IDX_SPP_HEARTBEAT_VAL],sizeof(heartbeat_s), heartbeat_s, false);
|
|
||||||
}else if(!is_connected){
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
//通过接收队列获取蓝牙命令数据，进行相应的处理，然后打印到系统日志并释放相关内存
|
|
||||||
void spp_cmd_task(void * arg)
|
|
||||||
{
|
|
||||||
uint8_t * cmd_id;
|
|
||||||
|
|
||||||
for(;;){
|
|
||||||
vTaskDelay(50 / portTICK_PERIOD_MS);
|
|
||||||
if(xQueueReceive(cmd_cmd_queue, &cmd_id, 10 / portTICK_PERIOD_MS)) {
|
|
||||||
esp_log_buffer_char(GATTS_TABLE_TAG,(char *)(cmd_id),strlen((char *)cmd_id));
|
|
||||||
free(cmd_id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
vTaskDelete(NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void spp_task_init(void)
|
|
||||||
{
|
|
||||||
spp_uart_init();
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
cmd_heartbeat_queue = xQueueCreate(10, sizeof(uint32_t));
|
|
||||||
xTaskCreate(spp_heartbeat_task, "spp_heartbeat_task", 2048, NULL, 10, NULL);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
cmd_cmd_queue = xQueueCreate(10, sizeof(uint32_t));
|
|
||||||
xTaskCreate(spp_cmd_task, "spp_cmd_task", 2048, NULL, 10, NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*gap事件回调函数*/
|
|
||||||
static void gap_event_handler(esp_gap_ble_cb_event_t event, esp_ble_gap_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_err_t err;
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "GAP_EVT, event %d\n", event);
|
|
||||||
|
|
||||||
switch (event) {
|
|
||||||
/*表示原始广播数据设置完成*/
|
|
||||||
case ESP_GAP_BLE_ADV_DATA_RAW_SET_COMPLETE_EVT:
|
|
||||||
/*启动广播，并传递蓝牙广播参数 spp_adv_params*/
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GAP_BLE_ADV_START_COMPLETE_EVT:
|
|
||||||
//advertising start complete event to indicate advertising start successfully or failed
|
|
||||||
if((err = param->adv_start_cmpl.status) != ESP_BT_STATUS_SUCCESS) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Advertising start failed: %s\n", esp_err_to_name(err));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*处理gatt事件的回调函数,根据不同的请求执行不同的操作*/
|
|
||||||
static void gatts_profile_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
esp_ble_gatts_cb_param_t *p_data = (esp_ble_gatts_cb_param_t *) param;
|
|
||||||
uint8_t res = 0xff;
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "event = %x\n",event);
|
|
||||||
switch (event) {
|
|
||||||
|
|
||||||
//gatt服务器注册事件
|
|
||||||
case ESP_GATTS_REG_EVT:
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//设置蓝牙设备名称
|
|
||||||
esp_ble_gap_set_device_name(SAMPLE_DEVICE_NAME);
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//配置蓝牙广播数据的原始数据
|
|
||||||
esp_ble_gap_config_adv_data_raw((uint8_t *)spp_adv_data, sizeof(spp_adv_data));
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s %d\n", __func__, __LINE__);
|
|
||||||
|
|
||||||
//创建gatt服务的属性表
|
|
||||||
esp_ble_gatts_create_attr_tab(spp_gatt_db, gatts_if, SPP_IDX_NB, SPP_SVC_INST_ID);
|
|
||||||
break;
|
|
||||||
|
|
||||||
//收到读取数据的请求
|
|
||||||
case ESP_GATTS_READ_EVT:
|
|
||||||
//找到对应句柄,返回对应索引
|
|
||||||
res = find_char_and_desr_index(p_data->read.handle);
|
|
||||||
if(res == SPP_IDX_SPP_STATUS_VAL){
|
|
||||||
//TODO:client read the status characteristic
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
//收到写数据的请求
|
|
||||||
case ESP_GATTS_WRITE_EVT: {
|
|
||||||
res = find_char_and_desr_index(p_data->write.handle);
|
|
||||||
if(p_data->write.is_prep == false){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_WRITE_EVT : handle = %d\n", res);
|
|
||||||
if(res == SPP_IDX_SPP_COMMAND_VAL){
|
|
||||||
uint8_t * spp_cmd_buff = NULL;
|
|
||||||
spp_cmd_buff = (uint8_t *)malloc((spp_mtu_size - 3) * sizeof(uint8_t));
|
|
||||||
if(spp_cmd_buff == NULL){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s malloc failed\n", __func__);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
memset(spp_cmd_buff,0x0,(spp_mtu_size - 3));
|
|
||||||
memcpy(spp_cmd_buff,p_data->write.value,p_data->write.len);
|
|
||||||
xQueueSend(cmd_cmd_queue,&spp_cmd_buff,10/portTICK_PERIOD_MS);
|
|
||||||
|
|
||||||
//SPP 数据通知配置
|
|
||||||
}else if(res == SPP_IDX_SPP_DATA_NTF_CFG){
|
|
||||||
//第一个字节为 0x01，第二个字节为 0x00。如果条件满足，则将 enable_data_ntf 设置为 true，表示启用数据通知
|
|
||||||
if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x01)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = true;
|
|
||||||
}else if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x00)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_data_ntf = false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
else if(res == SPP_IDX_SPP_HEARTBEAT_CFG){
|
|
||||||
if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x01)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_heart_ntf = true;
|
|
||||||
}else if((p_data->write.len == 2)&&(p_data->write.value[0] == 0x00)&&(p_data->write.value[1] == 0x00)){
|
|
||||||
enable_heart_ntf = false;
|
|
||||||
}
|
|
||||||
}else if(res == SPP_IDX_SPP_HEARTBEAT_VAL){
|
|
||||||
if((p_data->write.len == sizeof(heartbeat_s))&&(memcmp(heartbeat_s,p_data->write.value,sizeof(heartbeat_s)) == 0)){
|
|
||||||
heartbeat_count_num = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
else if(res == SPP_IDX_SPP_DATA_RECV_VAL){
|
|
||||||
#ifdef SPP_DEBUG_MODE
|
|
||||||
esp_log_buffer_char(GATTS_TABLE_TAG,(char *)(p_data->write.value),p_data->write.len);
|
|
||||||
#else
|
|
||||||
uart_write_bytes(UART_NUM_2, (char *)(p_data->write.value), p_data->write.len);
|
|
||||||
#endif
|
|
||||||
}else{
|
|
||||||
//TODO:
|
|
||||||
}
|
|
||||||
}else if((p_data->write.is_prep == true)&&(res == SPP_IDX_SPP_DATA_RECV_VAL)){
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_PREP_WRITE_EVT : handle = %d\n", res);
|
|
||||||
store_wr_buffer(p_data);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
//执行写入操作
|
|
||||||
case ESP_GATTS_EXEC_WRITE_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "ESP_GATTS_EXEC_WRITE_EVT\n");
|
|
||||||
if(p_data->exec_write.exec_write_flag){
|
|
||||||
print_write_buffer();
|
|
||||||
free_write_buffer();
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case ESP_GATTS_MTU_EVT:
|
|
||||||
spp_mtu_size = p_data->mtu.mtu;
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONF_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_UNREG_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DELETE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_START_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_STOP_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONNECT_EVT:
|
|
||||||
spp_conn_id = p_data->connect.conn_id;
|
|
||||||
spp_gatts_if = gatts_if;
|
|
||||||
is_connected = true;
|
|
||||||
memcpy(&spp_remote_bda,&p_data->connect.remote_bda,sizeof(esp_bd_addr_t));
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
uint16_t cmd = 0;
|
|
||||||
xQueueSend(cmd_heartbeat_queue,&cmd,10/portTICK_PERIOD_MS);
|
|
||||||
#endif
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_DISCONNECT_EVT:
|
|
||||||
is_connected = false;
|
|
||||||
enable_data_ntf = false;
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
enable_heart_ntf = false;
|
|
||||||
heartbeat_count_num = 0;
|
|
||||||
#endif
|
|
||||||
esp_ble_gap_start_advertising(&spp_adv_params);
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CANCEL_OPEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CLOSE_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_LISTEN_EVT:
|
|
||||||
break;
|
|
||||||
case ESP_GATTS_CONGEST_EVT:
|
|
||||||
break;
|
|
||||||
//gatt创建属性表
|
|
||||||
case ESP_GATTS_CREAT_ATTR_TAB_EVT:{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "The number handle =%x\n",param->add_attr_tab.num_handle);
|
|
||||||
if (param->add_attr_tab.status != ESP_GATT_OK){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table failed, error code=0x%x", param->add_attr_tab.status);
|
|
||||||
}
|
|
||||||
else if (param->add_attr_tab.num_handle != SPP_IDX_NB){
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "Create attribute table abnormally, num_handle (%d) doesn't equal to HRS_IDX_NB(%d)", param->add_attr_tab.num_handle, SPP_IDX_NB);
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
memcpy(spp_handle_table, param->add_attr_tab.handles, sizeof(spp_handle_table));
|
|
||||||
//启动gatt服务
|
|
||||||
esp_ble_gatts_start_service(spp_handle_table[SPP_IDX_SVC]);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*gatt事件回调函数*/ //gatt属于ble的一个协议层
|
|
||||||
static void gatts_event_handler(esp_gatts_cb_event_t event, esp_gatt_if_t gatts_if, esp_ble_gatts_cb_param_t *param)
|
|
||||||
{
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "EVT %d, gatts if %d\n", event, gatts_if);//打印接口标识符gatts_if
|
|
||||||
|
|
||||||
/* If event is register event, store the gatts_if for each profile */
|
|
||||||
//GATT 注册事件
|
|
||||||
if (event == ESP_GATTS_REG_EVT) {
|
|
||||||
if (param->reg.status == ESP_GATT_OK) {
|
|
||||||
spp_profile_tab[SPP_PROFILE_APP_IDX].gatts_if = gatts_if;
|
|
||||||
} else {
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "Reg app failed, app_id %04x, status %d\n",param->reg.app_id, param->reg.status);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
//循环遍历 spp_profile_tab 结构体中的配置文件，根据条件判断是否需要调用回调函数处理事件
|
|
||||||
do {
|
|
||||||
int idx;
|
|
||||||
for (idx = 0; idx < SPP_PROFILE_NUM; idx++) {
|
|
||||||
|
|
||||||
/* 表示没有指定特定的 gatts_if ,需要调用每个配置文件的回调函数*/
|
|
||||||
if (gatts_if == ESP_GATT_IF_NONE || gatts_if == spp_profile_tab[idx].gatts_if) {
|
|
||||||
if (spp_profile_tab[idx].gatts_cb) {
|
|
||||||
spp_profile_tab[idx].gatts_cb(event, gatts_if, param);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
} while (0);
|
|
||||||
}
|
|
||||||
|
|
||||||
void bt_client_init(void)
|
|
||||||
{
|
|
||||||
esp_err_t ret;
|
|
||||||
esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT();
|
|
||||||
|
|
||||||
/*初始化nvs*/
|
|
||||||
// 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 );
|
|
||||||
|
|
||||||
/*对 BTDM 控制器的 ROM（只读存储器）数据进行初始化操作*/
|
|
||||||
ESP_ERROR_CHECK(esp_bt_controller_mem_release(ESP_BT_MODE_CLASSIC_BT));
|
|
||||||
|
|
||||||
/*蓝牙控制器初始化*/
|
|
||||||
ret = esp_bt_controller_init(&bt_cfg);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*蓝牙控制器使能*/
|
|
||||||
ret = esp_bt_controller_enable(ESP_BT_MODE_BLE);
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable controller failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
ESP_LOGI(GATTS_TABLE_TAG, "%s init bluetooth\n", __func__);
|
|
||||||
|
|
||||||
/*初始化蓝牙协议栈r*/
|
|
||||||
ret = esp_bluedroid_init();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s init bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*使能蓝牙协议栈*/
|
|
||||||
ret = esp_bluedroid_enable();
|
|
||||||
if (ret) {
|
|
||||||
ESP_LOGE(GATTS_TABLE_TAG, "%s enable bluetooth failed: %s\n", __func__, esp_err_to_name(ret));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*注册ble的gap和gatt回调函数*/
|
|
||||||
esp_ble_gatts_register_callback(gatts_event_handler);
|
|
||||||
esp_ble_gap_register_callback(gap_event_handler);
|
|
||||||
|
|
||||||
/*注册gatt服务应用*/
|
|
||||||
esp_ble_gatts_app_register(ESP_SPP_APP_ID);
|
|
||||||
|
|
||||||
/*spp任务初始化*/
|
|
||||||
spp_task_init(); //初始化uart，创建消息队列以及任务
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
@ -1,42 +0,0 @@
|
|||||||
#include <stdio.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
/*
|
|
||||||
* DEFINES
|
|
||||||
****************************************************************************************
|
|
||||||
*/
|
|
||||||
//#define SUPPORT_HEARTBEAT
|
|
||||||
//#define SPP_DEBUG_MODE
|
|
||||||
|
|
||||||
#define spp_sprintf(s,...) sprintf((char*)(s), ##__VA_ARGS__)
|
|
||||||
#define SPP_DATA_MAX_LEN (512)
|
|
||||||
#define SPP_CMD_MAX_LEN (20)
|
|
||||||
#define SPP_STATUS_MAX_LEN (20)
|
|
||||||
#define SPP_DATA_BUFF_MAX_LEN (2*1024)
|
|
||||||
///Attributes State Machine
|
|
||||||
enum{
|
|
||||||
SPP_IDX_SVC,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_RECV_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_RECV_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_DATA_NOTIFY_CHAR,
|
|
||||||
SPP_IDX_SPP_DATA_NTY_VAL,
|
|
||||||
SPP_IDX_SPP_DATA_NTF_CFG,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_COMMAND_CHAR,
|
|
||||||
SPP_IDX_SPP_COMMAND_VAL,
|
|
||||||
|
|
||||||
SPP_IDX_SPP_STATUS_CHAR,
|
|
||||||
SPP_IDX_SPP_STATUS_VAL,
|
|
||||||
SPP_IDX_SPP_STATUS_CFG,
|
|
||||||
|
|
||||||
#ifdef SUPPORT_HEARTBEAT
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CHAR,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_VAL,
|
|
||||||
SPP_IDX_SPP_HEARTBEAT_CFG,
|
|
||||||
#endif
|
|
||||||
|
|
||||||
SPP_IDX_NB,
|
|
||||||
};
|
|
||||||
Loading…
Reference in New Issue
Block a user