1355 lines
39 KiB
C
1355 lines
39 KiB
C
/*********************************************************************************************
|
||
* Filename : le_server_module.c
|
||
|
||
* Description :
|
||
|
||
* Author :
|
||
|
||
* Email : zh-jieli.com
|
||
|
||
* Last modifiled : 2017-01-17 11:14
|
||
|
||
* Copyright:(c)JIELI 2011-2016 @ , All Rights Reserved.
|
||
*********************************************************************************************/
|
||
|
||
// *****************************************************************************
|
||
/* EXAMPLE_START(le_counter): LE Peripheral - Heartbeat Counter over GATT
|
||
*
|
||
* @text All newer operating systems provide GATT Client functionality.
|
||
* The LE Counter examples demonstrates how to specify a minimal GATT Database
|
||
* with a custom GATT Service and a custom Characteristic that sends periodic
|
||
* notifications.
|
||
*/
|
||
// *****************************************************************************
|
||
#include "system/app_core.h"
|
||
#include "system/includes.h"
|
||
|
||
#include "app_config.h"
|
||
|
||
#include "btstack/btstack_task.h"
|
||
#include "btstack/bluetooth.h"
|
||
#include "btcontroller_modules.h"
|
||
#include "bt_common.h"
|
||
|
||
#include "le_trans_data.h"
|
||
#include "le_common.h"
|
||
/* #include "3th_profile_api.h" */
|
||
|
||
#include "third_party/common/ble_user.h"
|
||
/* #include "rcsp_bluetooth.h" */
|
||
#include "JL_rcsp_api.h"
|
||
|
||
#if (TCFG_BLE_DEMO_SELECT == DEF_BLE_DEMO_TRANS_DATA)
|
||
|
||
/******** test send/recieve rate******/
|
||
#define TEST_RECEIVE_DATA_RATE 0 /*测试记录接收数据速度*/
|
||
#define TEST_TRANS_TIMER_MS 500
|
||
|
||
static u32 trans_recieve_test_count;
|
||
/***********************************/
|
||
|
||
#define TEST_SEND_DATA_RATE 0 //测试上行发送数据
|
||
#define TEST_SEND_HANDLE_VAL ATT_CHARACTERISTIC_ae02_01_VALUE_HANDLE
|
||
/* #define TEST_SEND_HANDLE_VAL ATT_CHARACTERISTIC_ae05_01_VALUE_HANDLE */
|
||
#define EXT_ADV_MODE_EN 0
|
||
|
||
#define TEST_AUDIO_DATA_UPLOAD 0 //测试文件上传
|
||
|
||
|
||
#if 1
|
||
extern void printf_buf(u8 *buf, u32 len);
|
||
#define log_info printf
|
||
#define log_info_hexdump printf_buf
|
||
#else
|
||
#define log_info(...)
|
||
#define log_info_hexdump(...)
|
||
#endif
|
||
|
||
|
||
/* #define LOG_TAG_CONST BT_BLE */
|
||
/* #define LOG_TAG "[LE_S_DEMO]" */
|
||
/* #define LOG_ERROR_ENABLE */
|
||
/* #define LOG_DEBUG_ENABLE */
|
||
/* #define LOG_INFO_ENABLE */
|
||
/* #define LOG_DUMP_ENABLE */
|
||
/* #define LOG_CLI_ENABLE */
|
||
/* #include "debug.h" */
|
||
|
||
//------
|
||
//ATT发送的包长, note: 20 <=need >= MTU
|
||
#define ATT_LOCAL_MTU_SIZE (200) //
|
||
//ATT缓存的buffer大小, note: need >= 20,可修改
|
||
#define ATT_SEND_CBUF_SIZE (512) //
|
||
|
||
//共配置的RAM
|
||
#define ATT_RAM_BUFSIZE (ATT_CTRL_BLOCK_SIZE + ATT_LOCAL_MTU_SIZE + ATT_SEND_CBUF_SIZE) //note:
|
||
static u8 att_ram_buffer[ATT_RAM_BUFSIZE] __attribute__((aligned(4)));
|
||
//---------------
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
static u32 test_data_count;
|
||
static u32 server_timer_handle = 0;
|
||
static u8 test_data_start;
|
||
#endif
|
||
|
||
/*
|
||
打开流控使能后,确定使能接口 att_server_flow_enable 被调用
|
||
然后使用过程 通过接口 att_server_flow_hold 来控制流控开关
|
||
注意:流控只能控制对方使用带响应READ/WRITE等命令方式
|
||
例如:ATT_WRITE_REQUEST = 0x12
|
||
*/
|
||
#define ATT_DATA_RECIEVT_FLOW 0//流控功能使能
|
||
|
||
//---------------
|
||
// 广播周期 (unit:0.625ms)
|
||
#define ADV_INTERVAL_MIN (160*5)
|
||
|
||
#define HOLD_LATENCY_CNT_MIN (3) //(0~0xffff)
|
||
#define HOLD_LATENCY_CNT_MAX (15) //(0~0xffff)
|
||
#define HOLD_LATENCY_CNT_ALL (0xffff)
|
||
|
||
static volatile hci_con_handle_t con_handle;
|
||
|
||
//加密设置
|
||
/* static const uint8_t sm_min_key_size = 7; */
|
||
|
||
//连接参数更新请求设置
|
||
//是否使能参数请求更新,0--disable, 1--enable
|
||
static const uint8_t connection_update_enable = 1; ///0--disable, 1--enable
|
||
//当前请求的参数表index
|
||
static uint8_t connection_update_cnt = 0; //
|
||
|
||
//参数表
|
||
static const struct conn_update_param_t connection_param_table[] = {
|
||
{16, 24, 10, 600},//11
|
||
{12, 28, 10, 600},//3.7
|
||
{8, 20, 10, 600},
|
||
/* {12, 28, 4, 600},//3.7 */
|
||
/* {12, 24, 30, 600},//3.05 */
|
||
};
|
||
|
||
//共可用的参数组数
|
||
#define CONN_PARAM_TABLE_CNT (sizeof(connection_param_table)/sizeof(struct conn_update_param_t))
|
||
|
||
#if (ATT_RAM_BUFSIZE < 64)
|
||
#error "adv_data & rsp_data buffer error!!!!!!!!!!!!"
|
||
#endif
|
||
|
||
//用户可配对的，这是样机跟客户开发的app配对的秘钥
|
||
/* const u8 link_key_data[16] = {0x06, 0x77, 0x5f, 0x87, 0x91, 0x8d, 0xd4, 0x23, 0x00, 0x5d, 0xf1, 0xd8, 0xcf, 0x0c, 0x14, 0x2b}; */
|
||
/* #define EIR_TAG_STRING 0xd6, 0x05, 0x08, 0x00, 'J', 'L', 'A', 'I', 'S', 'D','K' */
|
||
/* static const char user_tag_string[] = {EIR_TAG_STRING}; */
|
||
|
||
static u8 adv_data_len;
|
||
static u8 adv_data[ADV_RSP_PACKET_MAX];//max is 31
|
||
static u8 scan_rsp_data_len;
|
||
static u8 scan_rsp_data[ADV_RSP_PACKET_MAX];//max is 31
|
||
|
||
/* #define adv_data &att_ram_buffer[0] */
|
||
/* #define scan_rsp_data &att_ram_buffer[32] */
|
||
|
||
static char gap_device_name[BT_NAME_LEN_MAX] = "wl80_ble_test";
|
||
static u8 gap_device_name_len = 0; //名字长度，不包含结束符
|
||
static u8 ble_work_state = 0; //ble 状态变化
|
||
static u8 adv_ctrl_en; //广播控制
|
||
static u8 test_read_write_buf[4];
|
||
static OS_MUTEX mutex;
|
||
static void (*app_recieve_callback)(void *priv, void *buf, u16 len) = NULL;
|
||
static void (*app_ble_state_callback)(void *priv, ble_state_e state) = NULL;
|
||
static void (*ble_resume_send_wakeup)(void) = NULL;
|
||
static u32 channel_priv;
|
||
|
||
static int app_send_user_data_check(u16 len);
|
||
static int app_send_user_data_do(void *priv, u8 *data, u16 len);
|
||
static int app_send_user_data(u16 handle, const u8 *data, u16 len, u8 handle_type);
|
||
static void reset_passkey_cb(u32 *key);
|
||
|
||
// Complete Local Name 默认的蓝牙名字
|
||
|
||
//------------------------------------------------------
|
||
//广播参数设置
|
||
static void advertisements_setup_init();
|
||
extern const char *bt_get_local_name();
|
||
static int get_buffer_vaild_len(void *priv);
|
||
//------------------------------------------------------
|
||
#if TEST_AUDIO_DATA_UPLOAD
|
||
static const u8 test_audio_data_file[1024] = {
|
||
1, 2, 3, 4, 5, 6, 7, 8, 9
|
||
};
|
||
|
||
#define AUDIO_ONE_PACKET_LEN 128
|
||
static void test_send_audio_data(int init_flag)
|
||
{
|
||
static u32 send_pt = 0;
|
||
static u32 start_flag = 0;
|
||
|
||
if (!con_handle) {
|
||
return;
|
||
}
|
||
|
||
if (init_flag) {
|
||
log_info("audio send init\n");
|
||
send_pt = 0;
|
||
start_flag = 1;
|
||
}
|
||
|
||
if (!start_flag) {
|
||
return;
|
||
}
|
||
|
||
u32 file_size = sizeof(test_audio_data_file);
|
||
const u8 *file_ptr = test_audio_data_file;
|
||
|
||
if (send_pt >= file_size) {
|
||
log_info("audio send Complete\n");
|
||
start_flag = 0;
|
||
return;
|
||
}
|
||
|
||
u32 send_len = file_size - send_pt;
|
||
if (send_len > AUDIO_ONE_PACKET_LEN) {
|
||
send_len = AUDIO_ONE_PACKET_LEN;
|
||
}
|
||
|
||
while (1) {
|
||
if (app_send_user_data_check(send_len)) {
|
||
log_info("audio send %08x\n", send_pt);
|
||
if (app_send_user_data(ATT_CHARACTERISTIC_ae3c_01_VALUE_HANDLE, &file_ptr[send_pt], send_len, ATT_OP_AUTO_READ_CCC)) {
|
||
log_info("audio send fail!\n");
|
||
break;
|
||
} else {
|
||
send_pt += send_len;
|
||
}
|
||
} else {
|
||
break;
|
||
}
|
||
}
|
||
}
|
||
|
||
#endif
|
||
|
||
static void send_request_connect_parameter(u8 table_index)
|
||
{
|
||
struct conn_update_param_t *param = (void *)&connection_param_table[table_index];//static ram
|
||
|
||
log_info("update_request:-%d-%d-%d-%d-\n", param->interval_min, param->interval_max, param->latency, param->timeout);
|
||
if (con_handle) {
|
||
ble_op_conn_param_request(con_handle, param);
|
||
}
|
||
}
|
||
|
||
static void check_connetion_updata_deal(void)
|
||
{
|
||
if (connection_update_enable) {
|
||
if (connection_update_cnt < CONN_PARAM_TABLE_CNT) {
|
||
send_request_connect_parameter(connection_update_cnt);
|
||
}
|
||
}
|
||
}
|
||
|
||
static void connection_update_complete_success(u8 *packet)
|
||
{
|
||
int con_handle, conn_interval, conn_latency, conn_timeout;
|
||
|
||
con_handle = hci_subevent_le_connection_update_complete_get_connection_handle(packet);
|
||
conn_interval = hci_subevent_le_connection_update_complete_get_conn_interval(packet);
|
||
conn_latency = hci_subevent_le_connection_update_complete_get_conn_latency(packet);
|
||
conn_timeout = hci_subevent_le_connection_update_complete_get_supervision_timeout(packet);
|
||
|
||
log_info("conn_interval = %d\n", conn_interval);
|
||
log_info("conn_latency = %d\n", conn_latency);
|
||
log_info("conn_timeout = %d\n", conn_timeout);
|
||
}
|
||
|
||
static void set_ble_work_state(ble_state_e state)
|
||
{
|
||
if (state != ble_work_state) {
|
||
log_info("ble_work_st:%x->%x\n", ble_work_state, state);
|
||
ble_work_state = state;
|
||
if (app_ble_state_callback) {
|
||
app_ble_state_callback((void *)channel_priv, state);
|
||
}
|
||
}
|
||
}
|
||
|
||
static ble_state_e get_ble_work_state(void)
|
||
{
|
||
return ble_work_state;
|
||
}
|
||
|
||
static void cbk_sm_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)
|
||
{
|
||
sm_just_event_t *event = (void *)packet;
|
||
u32 tmp32;
|
||
|
||
switch (packet_type) {
|
||
case HCI_EVENT_PACKET:
|
||
switch (hci_event_packet_get_type(packet)) {
|
||
case SM_EVENT_JUST_WORKS_REQUEST:
|
||
sm_just_works_confirm(sm_event_just_works_request_get_handle(packet));
|
||
log_info("Just Works Confirmed.\n");
|
||
break;
|
||
|
||
case SM_EVENT_PASSKEY_DISPLAY_NUMBER:
|
||
log_info_hexdump(packet, size);
|
||
memcpy(&tmp32, event->data, 4);
|
||
log_info("Passkey display: %06u.\n", tmp32);
|
||
break;
|
||
|
||
case SM_EVENT_PASSKEY_INPUT_NUMBER:
|
||
/*IO_CAPABILITY_KEYBOARD_ONLY 方式*/
|
||
reset_passkey_cb(&tmp32);
|
||
log_info("%04x->Passkey input: %06u.\n", event->con_handle, tmp32);
|
||
sm_passkey_input(event->con_handle, tmp32); /*update passkey*/
|
||
break;
|
||
|
||
case SM_EVENT_PAIR_PROCESS:
|
||
log_info("======PAIR_PROCESS: %02x\n", event->data[0]);
|
||
put_buf(event->data, 4);
|
||
break;
|
||
|
||
}
|
||
break;
|
||
}
|
||
}
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
static void server_timer_handler(void *priv)
|
||
{
|
||
if (!con_handle) {
|
||
test_data_count = 0;
|
||
test_data_start = 0;
|
||
return;
|
||
}
|
||
|
||
log_info("peer_rssi = %d\n", ble_vendor_get_peer_rssi(con_handle));
|
||
|
||
if (test_data_count) {
|
||
log_info("\n%d bytes send: %d.%02d KB/s \n", test_data_count, test_data_count / 1000, test_data_count % 1000);
|
||
test_data_count = 0;
|
||
}
|
||
}
|
||
|
||
static void server_timer_start(void)
|
||
{
|
||
if (server_timer_handle) {
|
||
return;
|
||
}
|
||
|
||
server_timer_handle = sys_timer_add(NULL, server_timer_handler, 1000);
|
||
}
|
||
|
||
static void server_timer_stop(void)
|
||
{
|
||
if (server_timer_handle) {
|
||
sys_timeout_del(server_timer_handle);
|
||
server_timer_handle = 0;
|
||
}
|
||
}
|
||
|
||
void test_data_send_packet(void)
|
||
{
|
||
u32 vaild_len = get_buffer_vaild_len(0);//获取发送buffer可写入的数据
|
||
if (!test_data_start) {
|
||
return;
|
||
}
|
||
|
||
if (vaild_len) {
|
||
if (!app_send_user_data(TEST_SEND_HANDLE_VAL, (void *)&test_data_count, vaild_len, ATT_OP_AUTO_READ_CCC)) {
|
||
test_data_count += vaild_len;
|
||
}
|
||
}
|
||
}
|
||
#endif
|
||
|
||
static void can_send_now_wakeup(void)
|
||
{
|
||
/* putchar('E'); */
|
||
if (ble_resume_send_wakeup) {
|
||
ble_resume_send_wakeup();
|
||
}
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
test_data_send_packet();
|
||
#endif
|
||
|
||
#if TEST_AUDIO_DATA_UPLOAD
|
||
test_send_audio_data(0);
|
||
#endif
|
||
|
||
}
|
||
|
||
extern void sys_power_auto_shutdown_pause();
|
||
extern void sys_power_auto_shutdown_resume();
|
||
extern u8 get_total_connect_dev(void);
|
||
|
||
static void ble_auto_shut_down_enable(u8 enable)
|
||
{
|
||
#if TCFG_AUTO_SHUT_DOWN_TIME
|
||
if (enable) {
|
||
if (get_total_connect_dev() == 0) { //已经没有设备连接
|
||
sys_power_auto_shutdown_resume();
|
||
}
|
||
} else {
|
||
sys_power_auto_shutdown_pause();
|
||
}
|
||
#endif
|
||
}
|
||
|
||
static const char *const phy_result[] = {
|
||
"None",
|
||
"1M",
|
||
"2M",
|
||
"Coded",
|
||
};
|
||
|
||
static void set_connection_data_length(u16 tx_octets, u16 tx_time)
|
||
{
|
||
if (con_handle) {
|
||
ble_op_set_data_length(con_handle, tx_octets, tx_time);
|
||
}
|
||
}
|
||
|
||
static void set_connection_data_phy(u8 tx_phy, u8 rx_phy)
|
||
{
|
||
if (0 == con_handle) {
|
||
return;
|
||
}
|
||
|
||
u8 all_phys = 0;
|
||
u16 phy_options = CONN_SET_PHY_OPTIONS_S8;
|
||
|
||
ble_op_set_ext_phy(con_handle, all_phys, tx_phy, rx_phy, phy_options);
|
||
}
|
||
|
||
static void server_profile_start(u16 con_handle)
|
||
{
|
||
#if BT_FOR_APP_EN
|
||
set_app_connect_type(TYPE_BLE);
|
||
#endif
|
||
ble_op_att_send_init(con_handle, att_ram_buffer, ATT_RAM_BUFSIZE, ATT_LOCAL_MTU_SIZE);
|
||
set_ble_work_state(BLE_ST_CONNECT);
|
||
ble_auto_shut_down_enable(0);
|
||
|
||
/* set_connection_data_phy(CONN_SET_CODED_PHY, CONN_SET_CODED_PHY); */
|
||
}
|
||
|
||
_WEAK_
|
||
u8 ble_update_get_ready_jump_flag(void)
|
||
{
|
||
return 0;
|
||
}
|
||
/*
|
||
* @section Packet Handler
|
||
*
|
||
* @text The packet handler is used to:
|
||
* - stop the counter after a disconnect
|
||
* - send a notification when the requested ATT_EVENT_CAN_SEND_NOW is received
|
||
*/
|
||
|
||
/* LISTING_START(packetHandler): Packet Handler */
|
||
static void cbk_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)
|
||
{
|
||
int mtu;
|
||
u32 tmp;
|
||
u8 status;
|
||
|
||
switch (packet_type) {
|
||
case HCI_EVENT_PACKET:
|
||
switch (hci_event_packet_get_type(packet)) {
|
||
|
||
/* case DAEMON_EVENT_HCI_PACKET_SENT: */
|
||
/* break; */
|
||
case ATT_EVENT_HANDLE_VALUE_INDICATION_COMPLETE:
|
||
log_info("ATT_EVENT_HANDLE_VALUE_INDICATION_COMPLETE\n");
|
||
case ATT_EVENT_CAN_SEND_NOW:
|
||
can_send_now_wakeup();
|
||
break;
|
||
|
||
case HCI_EVENT_LE_META:
|
||
switch (hci_event_le_meta_get_subevent_code(packet)) {
|
||
case HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE:
|
||
status = hci_subevent_le_enhanced_connection_complete_get_status(packet);
|
||
if (status) {
|
||
log_info("LE_SLAVE CONNECTION FAIL!!! %0x\n", status);
|
||
set_ble_work_state(BLE_ST_DISCONN);
|
||
break;
|
||
}
|
||
con_handle = hci_subevent_le_enhanced_connection_complete_get_connection_handle(packet);
|
||
log_info("HCI_SUBEVENT_LE_ENHANCED_CONNECTION_COMPLETE : %0x\n", con_handle);
|
||
log_info("conn_interval = %d\n", hci_subevent_le_enhanced_connection_complete_get_conn_interval(packet));
|
||
log_info("conn_latency = %d\n", hci_subevent_le_enhanced_connection_complete_get_conn_latency(packet));
|
||
log_info("conn_timeout = %d\n", hci_subevent_le_enhanced_connection_complete_get_supervision_timeout(packet));
|
||
server_profile_start(con_handle);
|
||
break;
|
||
|
||
case HCI_SUBEVENT_LE_CONNECTION_COMPLETE:
|
||
con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet);
|
||
log_info("HCI_SUBEVENT_LE_CONNECTION_COMPLETE: %0x\n", con_handle);
|
||
connection_update_complete_success(packet + 8);
|
||
server_profile_start(con_handle);
|
||
#if RCSP_BTMATE_EN
|
||
#if (defined(BT_CONNECTION_VERIFY) && (0 == BT_CONNECTION_VERIFY))
|
||
JL_rcsp_auth_reset();
|
||
#endif
|
||
//rcsp_dev_select(RCSP_BLE);
|
||
rcsp_init();
|
||
#endif
|
||
break;
|
||
|
||
case HCI_SUBEVENT_LE_CONNECTION_UPDATE_COMPLETE:
|
||
connection_update_complete_success(packet);
|
||
break;
|
||
|
||
case HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE:
|
||
log_info("APP HCI_SUBEVENT_LE_DATA_LENGTH_CHANGE\n");
|
||
/* set_connection_data_phy(CONN_SET_CODED_PHY, CONN_SET_CODED_PHY); */
|
||
break;
|
||
|
||
case HCI_SUBEVENT_LE_PHY_UPDATE_COMPLETE:
|
||
log_info("APP HCI_SUBEVENT_LE_PHY_UPDATE %s\n", hci_event_le_meta_get_phy_update_complete_status(packet) ? "Fail" : "Succ");
|
||
log_info("Tx PHY: %s\n", phy_result[hci_event_le_meta_get_phy_update_complete_tx_phy(packet)]);
|
||
log_info("Rx PHY: %s\n", phy_result[hci_event_le_meta_get_phy_update_complete_rx_phy(packet)]);
|
||
break;
|
||
}
|
||
break;
|
||
|
||
case HCI_EVENT_DISCONNECTION_COMPLETE:
|
||
log_info("HCI_EVENT_DISCONNECTION_COMPLETE: %0x\n", packet[5]);
|
||
#if RCSP_BTMATE_EN
|
||
rcsp_exit();
|
||
#endif
|
||
con_handle = 0;
|
||
ble_op_att_send_init(con_handle, 0, 0, 0);
|
||
set_ble_work_state(BLE_ST_DISCONN);
|
||
|
||
if (!ble_update_get_ready_jump_flag()) {
|
||
os_mutex_pend(&mutex, 0);
|
||
bt_ble_adv_enable(1);
|
||
os_mutex_post(&mutex);
|
||
}
|
||
connection_update_cnt = 0;
|
||
#if BT_FOR_APP_EN
|
||
set_app_connect_type(TYPE_NULL);
|
||
#endif
|
||
ble_auto_shut_down_enable(1);
|
||
break;
|
||
|
||
case ATT_EVENT_MTU_EXCHANGE_COMPLETE:
|
||
mtu = att_event_mtu_exchange_complete_get_MTU(packet) - 3;
|
||
log_info("ATT MTU = %u\n", mtu);
|
||
ble_op_att_set_send_mtu(mtu);
|
||
/* set_connection_data_length(251, 2120); */
|
||
break;
|
||
|
||
case HCI_EVENT_VENDOR_REMOTE_TEST:
|
||
log_info("--- HCI_EVENT_VENDOR_REMOTE_TEST\n");
|
||
break;
|
||
|
||
case L2CAP_EVENT_CONNECTION_PARAMETER_UPDATE_RESPONSE:
|
||
tmp = little_endian_read_16(packet, 4);
|
||
log_info("-update_rsp: %02x\n", tmp);
|
||
if (tmp) {
|
||
connection_update_cnt++;
|
||
log_info("remoter reject!!!\n");
|
||
check_connetion_updata_deal();
|
||
} else {
|
||
connection_update_cnt = CONN_PARAM_TABLE_CNT;
|
||
}
|
||
break;
|
||
|
||
case HCI_EVENT_ENCRYPTION_CHANGE:
|
||
log_info("HCI_EVENT_ENCRYPTION_CHANGE= %d\n", packet[2]);
|
||
break;
|
||
}
|
||
break;
|
||
}
|
||
}
|
||
|
||
/* LISTING_END */
|
||
|
||
/*
|
||
* @section ATT Read
|
||
*
|
||
* @text The ATT Server handles all reads to constant data. For dynamic data like the custom characteristic, the registered
|
||
* att_read_callback is called. To handle long characteristics and long reads, the att_read_callback is first called
|
||
* with buffer == NULL, to request the total value length. Then it will be called again requesting a chunk of the value.
|
||
* See Listing attRead.
|
||
*/
|
||
|
||
/* LISTING_START(attRead): ATT Read */
|
||
|
||
// ATT Client Read Callback for Dynamic Data
|
||
// - if buffer == NULL, don't copy data, just return size of value
|
||
// - if buffer != NULL, copy data and return number bytes copied
|
||
// @param offset defines start of attribute value
|
||
static uint16_t att_read_callback(hci_con_handle_t connection_handle, uint16_t att_handle, uint16_t offset, uint8_t *buffer, uint16_t buffer_size)
|
||
{
|
||
uint16_t att_value_len = 0;
|
||
uint16_t handle = att_handle;
|
||
|
||
log_info("read_callback, handle= 0x%04x,buffer= %08x\n", handle, (u32)buffer);
|
||
|
||
switch (handle) {
|
||
case ATT_CHARACTERISTIC_2a00_01_VALUE_HANDLE:
|
||
att_value_len = gap_device_name_len;
|
||
|
||
if ((offset >= att_value_len) || (offset + buffer_size) > att_value_len) {
|
||
break;
|
||
}
|
||
|
||
if (buffer) {
|
||
memcpy(buffer, &gap_device_name[offset], buffer_size);
|
||
att_value_len = buffer_size;
|
||
log_info("\n------read gap_name: %s \n", gap_device_name);
|
||
}
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae10_01_VALUE_HANDLE:
|
||
att_value_len = sizeof(test_read_write_buf);
|
||
if ((offset >= att_value_len) || (offset + buffer_size) > att_value_len) {
|
||
break;
|
||
}
|
||
|
||
if (buffer) {
|
||
memcpy(buffer, &test_read_write_buf[offset], buffer_size);
|
||
att_value_len = buffer_size;
|
||
}
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae04_01_CLIENT_CONFIGURATION_HANDLE:
|
||
case ATT_CHARACTERISTIC_ae02_01_CLIENT_CONFIGURATION_HANDLE:
|
||
case ATT_CHARACTERISTIC_ae05_01_CLIENT_CONFIGURATION_HANDLE:
|
||
case ATT_CHARACTERISTIC_ae3c_01_CLIENT_CONFIGURATION_HANDLE:
|
||
if (buffer) {
|
||
buffer[0] = att_get_ccc_config(handle);
|
||
buffer[1] = 0;
|
||
}
|
||
att_value_len = 2;
|
||
break;
|
||
|
||
default:
|
||
break;
|
||
}
|
||
|
||
log_info("att_value_len= %d\n", att_value_len);
|
||
|
||
return att_value_len;
|
||
}
|
||
|
||
|
||
/* LISTING_END */
|
||
/*
|
||
* @section ATT Write
|
||
*
|
||
* @text The only valid ATT write in this example is to the Client Characteristic Configuration, which configures notification
|
||
* and indication. If the ATT handle matches the client configuration handle, the new configuration value is stored and used
|
||
* in the heartbeat handler to decide if a new value should be sent. See Listing attWrite.
|
||
*/
|
||
|
||
/* LISTING_START(attWrite): ATT Write */
|
||
static int att_write_callback(hci_con_handle_t connection_handle, uint16_t att_handle, uint16_t transaction_mode, uint16_t offset, uint8_t *buffer, uint16_t buffer_size)
|
||
{
|
||
int result = 0;
|
||
u16 tmp16;
|
||
|
||
u16 handle = att_handle;
|
||
|
||
#if !TEST_RECEIVE_DATA_RATE
|
||
log_info("write_callback, handle= 0x%04x,size = %d\n", handle, buffer_size);
|
||
#endif
|
||
|
||
switch (handle) {
|
||
|
||
case ATT_CHARACTERISTIC_2a00_01_VALUE_HANDLE:
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae02_01_CLIENT_CONFIGURATION_HANDLE:
|
||
#if TEST_SEND_DATA_RATE
|
||
if (buffer[0]) {
|
||
server_timer_start();
|
||
} else {
|
||
server_timer_stop();
|
||
test_data_start = 0;
|
||
}
|
||
#endif
|
||
case ATT_CHARACTERISTIC_ae04_01_CLIENT_CONFIGURATION_HANDLE:
|
||
case ATT_CHARACTERISTIC_ae05_01_CLIENT_CONFIGURATION_HANDLE:
|
||
case ATT_CHARACTERISTIC_ae3c_01_CLIENT_CONFIGURATION_HANDLE:
|
||
set_ble_work_state(BLE_ST_NOTIFY_IDICATE);
|
||
check_connetion_updata_deal();
|
||
log_info("\n------write ccc:%04x,%02x\n", handle, buffer[0]);
|
||
att_set_ccc_config(handle, buffer[0]);
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
test_data_start = 1;//start
|
||
if (buffer[0]) {
|
||
test_data_send_packet();
|
||
}
|
||
#endif
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae10_01_VALUE_HANDLE:
|
||
tmp16 = sizeof(test_read_write_buf);
|
||
if ((offset >= tmp16) || (offset + buffer_size) > tmp16) {
|
||
break;
|
||
}
|
||
memcpy(&test_read_write_buf[offset], buffer, buffer_size);
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae01_01_VALUE_HANDLE:
|
||
|
||
#if TEST_RECEIVE_DATA_RATE
|
||
trans_recieve_test_count += buffer_size;
|
||
break;
|
||
#endif
|
||
|
||
printf("\n-ae01_rx(%d):", buffer_size);
|
||
printf_buf(buffer, buffer_size);
|
||
|
||
//收发测试，自动发送收到的数据;for test
|
||
if (app_send_user_data_check(buffer_size)) {
|
||
app_send_user_data(ATT_CHARACTERISTIC_ae02_01_VALUE_HANDLE, buffer, buffer_size, ATT_OP_AUTO_READ_CCC);
|
||
}
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
if ((buffer[0] == 'A') && (buffer[1] == 'F')) {
|
||
test_data_start = 1;//start
|
||
} else if ((buffer[0] == 'A') && (buffer[1] == 'A')) {
|
||
test_data_start = 0;//stop
|
||
}
|
||
#endif
|
||
break;
|
||
|
||
case ATT_CHARACTERISTIC_ae03_01_VALUE_HANDLE:
|
||
printf("\n-ae03_rx(%d):", buffer_size);
|
||
printf_buf(buffer, buffer_size);
|
||
|
||
//收发测试，自动发送收到的数据;for test
|
||
if (app_send_user_data_check(buffer_size)) {
|
||
app_send_user_data(ATT_CHARACTERISTIC_ae05_01_VALUE_HANDLE, buffer, buffer_size, ATT_OP_AUTO_READ_CCC);
|
||
}
|
||
break;
|
||
|
||
#if RCSP_BTMATE_EN
|
||
case ATT_CHARACTERISTIC_ae02_02_CLIENT_CONFIGURATION_HANDLE:
|
||
ble_op_latency_skip(con_handle, HOLD_LATENCY_CNT_ALL); //
|
||
set_ble_work_state(BLE_ST_NOTIFY_IDICATE);
|
||
#endif
|
||
/* if ((cur_conn_latency == 0) */
|
||
/* && (connection_update_cnt == CONN_PARAM_TABLE_CNT) */
|
||
/* && (Peripheral_Preferred_Connection_Parameters[0].latency != 0)) { */
|
||
/* connection_update_cnt = 0; */
|
||
/* } */
|
||
check_connetion_updata_deal();
|
||
log_info("\n------write ccc:%04x,%02x\n", handle, buffer[0]);
|
||
att_set_ccc_config(handle, buffer[0]);
|
||
break;
|
||
#if RCSP_BTMATE_EN
|
||
case ATT_CHARACTERISTIC_ae01_02_VALUE_HANDLE:
|
||
printf("rcsp_read:%x\n", buffer_size);
|
||
if (app_recieve_callback) {
|
||
app_recieve_callback(0, buffer, buffer_size);
|
||
}
|
||
break;
|
||
#endif
|
||
|
||
case ATT_CHARACTERISTIC_ae3b_01_VALUE_HANDLE:
|
||
printf("\n-ae3b_rx(%d):", buffer_size);
|
||
printf_buf(buffer, buffer_size);
|
||
|
||
#if TEST_AUDIO_DATA_UPLOAD
|
||
if (0 == memcmp(buffer, "start", 5)) {
|
||
test_send_audio_data(1);
|
||
}
|
||
#endif
|
||
break;
|
||
|
||
default:
|
||
break;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static int app_send_user_data(u16 handle, const u8 *data, u16 len, u8 handle_type)
|
||
{
|
||
u32 ret = APP_BLE_NO_ERROR;
|
||
|
||
if (!con_handle) {
|
||
return APP_BLE_OPERATION_ERROR;
|
||
}
|
||
|
||
if (!att_get_ccc_config(handle + 1)) {
|
||
log_info("fail,no write ccc!!!,%04x\n", handle + 1);
|
||
return APP_BLE_NO_WRITE_CCC;
|
||
}
|
||
|
||
ret = ble_op_att_send_data(handle, data, len, handle_type);
|
||
if (ret == BLE_BUFFER_FULL) {
|
||
ret = APP_BLE_BUFF_FULL;
|
||
}
|
||
|
||
if (ret) {
|
||
log_info("app_send_fail:%d !!!!!!\n", ret);
|
||
}
|
||
return ret;
|
||
}
|
||
|
||
//------------------------------------------------------
|
||
static int make_set_adv_data(void)
|
||
{
|
||
u8 offset = 0;
|
||
u8 *buf = adv_data;
|
||
|
||
/* offset += make_eir_packet_val(&buf[offset], offset, HCI_EIR_DATATYPE_FLAGS, 0x18, 1); */
|
||
/* offset += make_eir_packet_val(&buf[offset], offset, HCI_EIR_DATATYPE_FLAGS, 0x1A, 1); */
|
||
offset += make_eir_packet_val(&buf[offset], offset, HCI_EIR_DATATYPE_FLAGS, 0x06, 1);
|
||
offset += make_eir_packet_val(&buf[offset], offset, HCI_EIR_DATATYPE_COMPLETE_16BIT_SERVICE_UUIDS, 0xAF30, 2);
|
||
|
||
if (offset > ADV_RSP_PACKET_MAX) {
|
||
puts("***adv_data overflow!!!!!!\n");
|
||
return -1;
|
||
}
|
||
log_info("adv_data(%d):", offset);
|
||
log_info_hexdump(buf, offset);
|
||
adv_data_len = offset;
|
||
ble_op_set_adv_data(offset, buf);
|
||
return 0;
|
||
}
|
||
|
||
static int make_set_rsp_data(void)
|
||
{
|
||
u8 offset = 0;
|
||
u8 *buf = scan_rsp_data;
|
||
|
||
#if RCSP_BTMATE_EN
|
||
u8 tag_len = sizeof(user_tag_string);
|
||
offset += make_eir_packet_data(&buf[offset], offset, HCI_EIR_DATATYPE_MANUFACTURER_SPECIFIC_DATA, (void *)user_tag_string, tag_len);
|
||
#endif
|
||
|
||
u8 name_len = gap_device_name_len;
|
||
u8 vaild_len = ADV_RSP_PACKET_MAX - (offset + 2);
|
||
if (name_len > vaild_len) {
|
||
name_len = vaild_len;
|
||
}
|
||
offset += make_eir_packet_data(&buf[offset], offset, HCI_EIR_DATATYPE_COMPLETE_LOCAL_NAME, (void *)gap_device_name, name_len);
|
||
|
||
if (offset > ADV_RSP_PACKET_MAX) {
|
||
puts("***rsp_data overflow!!!!!!\n");
|
||
return -1;
|
||
}
|
||
|
||
log_info("rsp_data(%d):", offset);
|
||
log_info_hexdump(buf, offset);
|
||
scan_rsp_data_len = offset;
|
||
ble_op_set_rsp_data(offset, buf);
|
||
return 0;
|
||
}
|
||
|
||
//广播参数设置
|
||
static void advertisements_setup_init()
|
||
{
|
||
uint8_t adv_type = ADV_IND;
|
||
uint8_t adv_channel = ADV_CHANNEL_ALL;
|
||
int ret = 0;
|
||
|
||
ble_op_set_adv_param(ADV_INTERVAL_MIN, adv_type, adv_channel);
|
||
|
||
ret |= make_set_adv_data();
|
||
ret |= make_set_rsp_data();
|
||
|
||
if (ret) {
|
||
puts("advertisements_setup_init fail !!!!!!\n");
|
||
}
|
||
}
|
||
|
||
#define PASSKEY_ENTER_ENABLE 0 //输入passkey使能，可修改passkey
|
||
//重设passkey回调函数，在这里可以重新设置passkey
|
||
//passkey为6个数字组成，十万位、万位。。。。个位 各表示一个数字 高位不够为0
|
||
static void reset_passkey_cb(u32 *key)
|
||
{
|
||
#if 1
|
||
u32 newkey = rand32();//获取随机数
|
||
|
||
newkey &= 0xfffff;
|
||
if (newkey > 999999) {
|
||
newkey = newkey - 999999; //不能大于999999
|
||
}
|
||
*key = newkey; //小于或等于六位数
|
||
printf("set new_key= %06u\n", *key);
|
||
#else
|
||
*key = 123456; //for debug
|
||
#endif
|
||
}
|
||
|
||
void ble_sm_setup_init(io_capability_t io_type, u8 auth_req, uint8_t min_key_size, u8 security_en)
|
||
{
|
||
//setup SM: Display only
|
||
sm_init();
|
||
sm_set_io_capabilities(io_type);
|
||
sm_set_authentication_requirements(auth_req);
|
||
sm_set_encryption_key_size_range(min_key_size, 16);
|
||
sm_set_request_security(security_en);
|
||
sm_event_callback_set(&cbk_sm_packet_handler);
|
||
|
||
if (io_type == IO_CAPABILITY_DISPLAY_ONLY) {
|
||
reset_PK_cb_register(reset_passkey_cb);
|
||
}
|
||
}
|
||
|
||
void ble_profile_init(void)
|
||
{
|
||
printf("ble profile init\n");
|
||
le_device_db_init();
|
||
|
||
#if PASSKEY_ENTER_ENABLE
|
||
ble_sm_setup_init(IO_CAPABILITY_DISPLAY_ONLY, SM_AUTHREQ_BONDING | SM_AUTHREQ_MITM_PROTECTION, 7, TCFG_BLE_SECURITY_EN);
|
||
#else
|
||
ble_sm_setup_init(IO_CAPABILITY_NO_INPUT_NO_OUTPUT, SM_AUTHREQ_BONDING | SM_AUTHREQ_MITM_PROTECTION, 7, TCFG_BLE_SECURITY_EN);
|
||
#endif
|
||
|
||
/* setup ATT server */
|
||
att_server_init(profile_data, att_read_callback, att_write_callback);
|
||
att_server_register_packet_handler(cbk_packet_handler);
|
||
/* gatt_client_register_packet_handler(packet_cbk); */
|
||
|
||
// register for HCI events
|
||
hci_event_callback_set(&cbk_packet_handler);
|
||
/* ble_l2cap_register_packet_handler(packet_cbk); */
|
||
/* sm_event_packet_handler_register(packet_cbk); */
|
||
le_l2cap_register_packet_handler(&cbk_packet_handler);
|
||
|
||
ble_vendor_set_default_att_mtu(ATT_LOCAL_MTU_SIZE);
|
||
}
|
||
|
||
#if EXT_ADV_MODE_EN
|
||
|
||
|
||
#define EXT_ADV_NAME 'J', 'L', '_', 'E', 'X', 'T', '_', 'A', 'D', 'V'
|
||
/* #define EXT_ADV_NAME "JL_EXT_ADV" */
|
||
#define BYTE_LEN(x...) sizeof((u8 []) {x})
|
||
#define EXT_ADV_DATA \
|
||
0x02, 0x01, 0x06, \
|
||
0x03, 0x02, 0xF0, 0xFF, \
|
||
BYTE_LEN(EXT_ADV_NAME) + 1, BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME, EXT_ADV_NAME
|
||
|
||
struct ext_advertising_param {
|
||
u8 Advertising_Handle;
|
||
u16 Advertising_Event_Properties;
|
||
u8 Primary_Advertising_Interval_Min[3];
|
||
u8 Primary_Advertising_Interval_Max[3];
|
||
u8 Primary_Advertising_Channel_Map;
|
||
u8 Own_Address_Type;
|
||
u8 Peer_Address_Type;
|
||
u8 Peer_Address[6];
|
||
u8 Advertising_Filter_Policy;
|
||
u8 Advertising_Tx_Power;
|
||
u8 Primary_Advertising_PHY;
|
||
u8 Secondary_Advertising_Max_Skip;
|
||
u8 Secondary_Advertising_PHY;
|
||
u8 Advertising_SID;
|
||
u8 Scan_Request_Notification_Enable;
|
||
} _GNU_PACKED_;
|
||
|
||
struct ext_advertising_data {
|
||
u8 Advertising_Handle;
|
||
u8 Operation;
|
||
u8 Fragment_Preference;
|
||
u8 Advertising_Data_Length;
|
||
u8 Advertising_Data[BYTE_LEN(EXT_ADV_DATA)];
|
||
} _GNU_PACKED_;
|
||
|
||
struct ext_advertising_enable {
|
||
u8 Enable;
|
||
u8 Number_of_Sets;
|
||
u8 Advertising_Handle;
|
||
u16 Duration;
|
||
u8 Max_Extended_Advertising_Events;
|
||
} _GNU_PACKED_;
|
||
|
||
static const struct ext_advertising_param ext_adv_param = {
|
||
.Advertising_Handle = 0,
|
||
.Advertising_Event_Properties = 1,
|
||
.Primary_Advertising_Interval_Min = {30, 0, 0},
|
||
.Primary_Advertising_Interval_Max = {30, 0, 0},
|
||
.Primary_Advertising_Channel_Map = 7,
|
||
.Primary_Advertising_PHY = ADV_SET_1M_PHY,
|
||
.Secondary_Advertising_PHY = ADV_SET_1M_PHY,
|
||
};
|
||
|
||
static const struct ext_advertising_data ext_adv_data = {
|
||
.Advertising_Handle = 0,
|
||
.Operation = 3,
|
||
.Fragment_Preference = 0,
|
||
.Advertising_Data_Length = BYTE_LEN(EXT_ADV_DATA),
|
||
.Advertising_Data = EXT_ADV_DATA,
|
||
};
|
||
|
||
static const struct ext_advertising_enable ext_adv_enable = {
|
||
.Enable = 1,
|
||
.Number_of_Sets = 1,
|
||
.Advertising_Handle = 0,
|
||
.Duration = 0,
|
||
.Max_Extended_Advertising_Events = 0,
|
||
};
|
||
|
||
static const struct ext_advertising_enable ext_adv_disable = {
|
||
.Enable = 0,
|
||
.Number_of_Sets = 1,
|
||
.Advertising_Handle = 0,
|
||
.Duration = 0,
|
||
.Max_Extended_Advertising_Events = 0,
|
||
};
|
||
|
||
#endif /* EXT_ADV_MODE_EN */
|
||
|
||
static int set_adv_enable(void *priv, u32 en)
|
||
{
|
||
ble_state_e next_state, cur_state;
|
||
|
||
if (!adv_ctrl_en && en) {
|
||
return APP_BLE_OPERATION_ERROR;
|
||
}
|
||
|
||
if (con_handle) {
|
||
return APP_BLE_OPERATION_ERROR;
|
||
}
|
||
|
||
if (en) {
|
||
next_state = BLE_ST_ADV;
|
||
} else {
|
||
next_state = BLE_ST_IDLE;
|
||
}
|
||
|
||
cur_state = get_ble_work_state();
|
||
|
||
switch (cur_state) {
|
||
case BLE_ST_ADV:
|
||
case BLE_ST_IDLE:
|
||
case BLE_ST_INIT_OK:
|
||
case BLE_ST_NULL:
|
||
case BLE_ST_DISCONN:
|
||
break;
|
||
default:
|
||
return APP_BLE_OPERATION_ERROR;
|
||
break;
|
||
}
|
||
|
||
if (cur_state == next_state) {
|
||
return APP_BLE_NO_ERROR;
|
||
}
|
||
log_info("adv_en:%d\n", en);
|
||
set_ble_work_state(next_state);
|
||
|
||
#if EXT_ADV_MODE_EN
|
||
if (en) {
|
||
ble_op_set_ext_adv_param(&ext_adv_param, sizeof(ext_adv_param));
|
||
|
||
log_info_hexdump((u8 *)&ext_adv_data, sizeof(ext_adv_data));
|
||
ble_op_set_ext_adv_data(&ext_adv_data, sizeof(ext_adv_data));
|
||
|
||
ble_op_set_ext_adv_enable(&ext_adv_enable, sizeof(ext_adv_enable));
|
||
} else {
|
||
ble_op_set_ext_adv_enable(&ext_adv_disable, sizeof(ext_adv_disable));
|
||
}
|
||
#else
|
||
if (en) {
|
||
advertisements_setup_init();
|
||
}
|
||
ble_op_adv_enable(en);
|
||
#endif /* EXT_ADV_MODE_EN */
|
||
|
||
return APP_BLE_NO_ERROR;
|
||
}
|
||
|
||
static int ble_disconnect(void *priv)
|
||
{
|
||
if (con_handle) {
|
||
if (BLE_ST_SEND_DISCONN != get_ble_work_state()) {
|
||
log_info(">>>ble send disconnect\n");
|
||
set_ble_work_state(BLE_ST_SEND_DISCONN);
|
||
ble_op_disconnect(con_handle);
|
||
} else {
|
||
log_info(">>>ble wait disconnect...\n");
|
||
}
|
||
return APP_BLE_NO_ERROR;
|
||
} else {
|
||
return APP_BLE_OPERATION_ERROR;
|
||
}
|
||
}
|
||
|
||
static int get_buffer_vaild_len(void *priv)
|
||
{
|
||
u32 vaild_len = 0;
|
||
ble_op_att_get_remain(&vaild_len);
|
||
return vaild_len;
|
||
}
|
||
|
||
static int app_send_user_data_do(void *priv, u8 *data, u16 len)
|
||
{
|
||
#if PRINT_DMA_DATA_EN
|
||
if (len < 128) {
|
||
log_info("-le_tx(%d):");
|
||
log_info_hexdump(data, len);
|
||
} else {
|
||
putchar('L');
|
||
}
|
||
#endif
|
||
return app_send_user_data(ATT_CHARACTERISTIC_ae02_01_VALUE_HANDLE, data, len, ATT_OP_AUTO_READ_CCC);
|
||
}
|
||
|
||
static int app_send_user_data_check(u16 len)
|
||
{
|
||
u32 buf_space = get_buffer_vaild_len(0);
|
||
if (len <= buf_space) {
|
||
return 1;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static int regiest_wakeup_send(void *priv, void *cbk)
|
||
{
|
||
ble_resume_send_wakeup = cbk;
|
||
return APP_BLE_NO_ERROR;
|
||
}
|
||
|
||
static int regiest_recieve_cbk(void *priv, void *cbk)
|
||
{
|
||
channel_priv = (u32)priv;
|
||
app_recieve_callback = cbk;
|
||
return APP_BLE_NO_ERROR;
|
||
}
|
||
|
||
static int regiest_state_cbk(void *priv, void *cbk)
|
||
{
|
||
channel_priv = (u32)priv;
|
||
app_ble_state_callback = cbk;
|
||
return APP_BLE_NO_ERROR;
|
||
}
|
||
|
||
//------------------------------------------------------------------------------
|
||
//------------------------------------------------------------------------------
|
||
//------------------------------------------------------------------------------
|
||
//------------------------------------------------------------------------------
|
||
|
||
|
||
u8 *ble_get_scan_rsp_ptr(u16 *len)
|
||
{
|
||
if (len) {
|
||
*len = scan_rsp_data_len;
|
||
}
|
||
return scan_rsp_data;
|
||
}
|
||
|
||
u8 *ble_get_adv_data_ptr(u16 *len)
|
||
{
|
||
if (len) {
|
||
*len = adv_data_len;
|
||
}
|
||
return adv_data;
|
||
}
|
||
|
||
u8 *ble_get_gatt_profile_data(u16 *len)
|
||
{
|
||
*len = sizeof(profile_data);
|
||
return (u8 *)profile_data;
|
||
}
|
||
|
||
|
||
void bt_ble_adv_enable(u8 enable)
|
||
{
|
||
set_adv_enable(0, enable);
|
||
}
|
||
|
||
u16 bt_ble_is_connected(void)
|
||
{
|
||
return con_handle;
|
||
}
|
||
|
||
static void ble_module_enable(u8 en)
|
||
{
|
||
os_mutex_pend(&mutex, 0);
|
||
log_info("mode_en:%d\n", en);
|
||
if (en) {
|
||
extern u8 get_ble_gatt_role(void);
|
||
if (1 == get_ble_gatt_role()) {
|
||
ble_stack_gatt_role(0);
|
||
// register for HCI events
|
||
hci_event_callback_set(&cbk_packet_handler);
|
||
le_l2cap_register_packet_handler(&cbk_packet_handler);
|
||
}
|
||
adv_ctrl_en = 1;
|
||
bt_ble_adv_enable(1);
|
||
} else {
|
||
if (con_handle) {
|
||
adv_ctrl_en = 0;
|
||
ble_disconnect(NULL);
|
||
} else {
|
||
bt_ble_adv_enable(0);
|
||
adv_ctrl_en = 0;
|
||
}
|
||
}
|
||
os_mutex_post(&mutex);
|
||
}
|
||
|
||
|
||
//流控使能 EN: 1-停止收数 or 0-继续收数
|
||
int ble_trans_flow_enable(u8 en)
|
||
{
|
||
int ret = -1;
|
||
#if ATT_DATA_RECIEVT_FLOW
|
||
if (con_handle) {
|
||
att_server_flow_hold(con_handle, en);
|
||
ret = 0;
|
||
}
|
||
#endif
|
||
log_info("ble_trans_flow_enable:%d,%d\n", en, ret);
|
||
return ret;
|
||
}
|
||
|
||
//for test
|
||
static void timer_trans_flow_test(void)
|
||
{
|
||
static u8 sw = 0;
|
||
if (con_handle) {
|
||
sw = !sw;
|
||
ble_trans_flow_enable(sw);
|
||
}
|
||
}
|
||
|
||
static void trans_test_recv_data(void)
|
||
{
|
||
#if TEST_RECEIVE_DATA_RATE
|
||
static u32 count = 0;
|
||
static u32 recv_index;
|
||
|
||
int i, ret = 0;
|
||
u32 time_index_max = 1000 / TEST_TRANS_TIMER_MS;
|
||
|
||
if (!con_handle) {
|
||
return;
|
||
}
|
||
|
||
recv_index++;
|
||
|
||
if (recv_index >= time_index_max) {
|
||
recv_index = 0;
|
||
|
||
if (trans_recieve_test_count) {
|
||
log_info("<<<<<<< recieve_rate= %d byte/s\n", trans_recieve_test_count);
|
||
trans_recieve_test_count = 0;
|
||
}
|
||
}
|
||
#endif
|
||
}
|
||
|
||
static const char ble_ext_name[] = "(BLE)";
|
||
|
||
void bt_ble_init(void)
|
||
{
|
||
log_info("***** ble_init******\n");
|
||
const char *name_p = bt_get_local_name();
|
||
u8 ext_name_len = sizeof(ble_ext_name) - 1;
|
||
|
||
if (!os_mutex_valid(&mutex)) {
|
||
os_mutex_create(&mutex);
|
||
}
|
||
|
||
gap_device_name_len = strlen(name_p);
|
||
if (gap_device_name_len > BT_NAME_LEN_MAX - ext_name_len) {
|
||
gap_device_name_len = BT_NAME_LEN_MAX - ext_name_len;
|
||
}
|
||
|
||
//增加后缀，区分名字
|
||
memcpy(gap_device_name, name_p, gap_device_name_len);
|
||
memcpy(&gap_device_name[gap_device_name_len], "(BLE)", ext_name_len);
|
||
gap_device_name_len += ext_name_len;
|
||
|
||
gap_device_name[gap_device_name_len] = 0;//结束符
|
||
log_info("ble name(%d): %s \n", gap_device_name_len, gap_device_name);
|
||
|
||
#if ATT_DATA_RECIEVT_FLOW
|
||
log_info("att_server_flow_enable\n");
|
||
att_server_flow_enable(1);
|
||
/* sys_timer_add(0, timer_trans_flow_test, 3000); */
|
||
#endif
|
||
|
||
set_ble_work_state(BLE_ST_INIT_OK);
|
||
ble_module_enable(1);
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
server_timer_start();
|
||
#endif
|
||
|
||
#if TEST_RECEIVE_DATA_RATE
|
||
if (TEST_TRANS_TIMER_MS < 10) {
|
||
sys_hi_timer_add(0, trans_test_recv_data, TEST_TRANS_TIMER_MS);
|
||
} else {
|
||
sys_timer_add(0, trans_test_recv_data, TEST_TRANS_TIMER_MS);
|
||
}
|
||
#endif
|
||
}
|
||
|
||
void bt_ble_exit(void)
|
||
{
|
||
log_info("***** ble_exit******\n");
|
||
|
||
ble_module_enable(0);
|
||
|
||
#if TEST_SEND_DATA_RATE
|
||
server_timer_stop();
|
||
#endif
|
||
}
|
||
|
||
void ble_app_disconnect(void)
|
||
{
|
||
ble_disconnect(NULL);
|
||
}
|
||
|
||
#if RCSP_BTMATE_EN
|
||
static int rcsp_send_user_data_do(void *priv, u8 *data, u16 len)
|
||
{
|
||
log_info("rcsp_tx:%x\n", len);
|
||
#if PRINT_DMA_DATA_EN
|
||
if (len < 128) {
|
||
log_info("-dma_tx(%d):");
|
||
log_info_hexdump(data, len);
|
||
} else {
|
||
putchar('L');
|
||
}
|
||
#endif
|
||
return app_send_user_data(ATT_CHARACTERISTIC_ae02_02_VALUE_HANDLE, data, len, ATT_OP_AUTO_READ_CCC);
|
||
}
|
||
#endif
|
||
|
||
#if RCSP_BTMATE_EN
|
||
static const struct ble_server_operation_t mi_ble_operation = {
|
||
.adv_enable = set_adv_enable,
|
||
.disconnect = ble_disconnect,
|
||
.get_buffer_vaild = get_buffer_vaild_len,
|
||
.send_data = (void *)rcsp_send_user_data_do,
|
||
.regist_wakeup_send = regiest_wakeup_send,
|
||
.regist_recieve_cbk = regiest_recieve_cbk,
|
||
.regist_state_cbk = regiest_state_cbk,
|
||
};
|
||
#else
|
||
static const struct ble_server_operation_t mi_ble_operation = {
|
||
.adv_enable = set_adv_enable,
|
||
.disconnect = ble_disconnect,
|
||
.get_buffer_vaild = get_buffer_vaild_len,
|
||
.send_data = (void *)app_send_user_data_do,
|
||
.regist_wakeup_send = regiest_wakeup_send,
|
||
.regist_recieve_cbk = regiest_recieve_cbk,
|
||
.regist_state_cbk = regiest_state_cbk,
|
||
};
|
||
#endif
|
||
|
||
void ble_get_server_operation_table(struct ble_server_operation_t **interface_pt)
|
||
{
|
||
*interface_pt = (void *)&mi_ble_operation;
|
||
}
|
||
|
||
#endif
|
||
|