312 lines
11 KiB
C++
312 lines
11 KiB
C++
|
#include "app_ibrt_ble_adv.h"
|
||
|
|
#include "hal_trace.h"
|
||
|
|
#include "me_api.h"
|
||
|
|
#include "cmsis_os.h"
|
||
|
|
#include "factory_section.h"
|
||
|
|
#include "co_bt_defines.h"
|
||
|
|
#include "app_tws_ibrt.h"
|
||
|
|
|
||
|
|
SLAVE_BLE_MODE_T slaveBleMode;
|
||
|
|
static app_ble_adv_para_data_t app_ble_adv_para_data_cfg;
|
||
|
|
#define APP_IBRT_BLE_ADV_DATA_MAX_LEN (31)
|
||
|
|
#define APP_IBRT_BLE_SCAN_RSP_DATA_MAX_LEN (31)
|
||
|
|
|
||
|
|
const char *g_slave_ble_state_str[] =
|
||
|
|
{
|
||
|
|
"BLE_STATE_IDLE",
|
||
|
|
"BLE_ADVERTISING",
|
||
|
|
"BLE_STARTING_ADV",
|
||
|
|
"BLE_STOPPING_ADV",
|
||
|
|
};
|
||
|
|
|
||
|
|
const char *g_slave_ble_op_str[] =
|
||
|
|
{
|
||
|
|
"BLE_OP_IDLE",
|
||
|
|
"BLE_START_ADV",
|
||
|
|
"BLE_STOP_ADV",
|
||
|
|
"BLE_STOPPING_ADV",
|
||
|
|
};
|
||
|
|
|
||
|
|
#define SET_SLAVE_BLE_STATE(newState) \
|
||
|
|
do \
|
||
|
|
{ \
|
||
|
|
TRACE(3,"[BLE][STATE]%s->%s at line %d", g_slave_ble_state_str[slaveBleMode.state], g_slave_ble_state_str[newState], __LINE__); \
|
||
|
|
slaveBleMode.state = (newState); \
|
||
|
|
} while (0);
|
||
|
|
|
||
|
|
#define SET_SLAVE_BLE_OP(newOp) \
|
||
|
|
do \
|
||
|
|
{ \
|
||
|
|
TRACE(3,"[BLE][OP]%s->%s at line %d", g_slave_ble_op_str[slaveBleMode.op], g_slave_ble_op_str[newOp], __LINE__); \
|
||
|
|
slaveBleMode.op = (newOp); \
|
||
|
|
} while (0);
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_slave_ble_cmd_complete_callback
|
||
|
|
Description : stop ble adv
|
||
|
|
Input : const void *para
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_slave_ble_cmd_complete_callback(const void *para)
|
||
|
|
{
|
||
|
|
slave_ble_cmd_comp_t *p_cmd_complete = (slave_ble_cmd_comp_t *)para;
|
||
|
|
|
||
|
|
switch (p_cmd_complete->cmd_opcode)
|
||
|
|
{
|
||
|
|
case HCI_BLE_ADV_CMD_OPCODE:
|
||
|
|
if(!p_cmd_complete->param[0])
|
||
|
|
app_ibrt_ble_switch_activities();
|
||
|
|
else
|
||
|
|
{
|
||
|
|
TRACE(2,"%s error p_cmd_complete->param[0] %d", __func__, p_cmd_complete->param[0]);
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_STATE_IDLE);
|
||
|
|
SET_SLAVE_BLE_OP(BLE_OP_IDLE);
|
||
|
|
}
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_adv_para_data_init
|
||
|
|
Description : initialize ble adv parameter and adv data
|
||
|
|
Input : None
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_adv_para_data_init(void)
|
||
|
|
{
|
||
|
|
app_ble_adv_para_data_t *adv_para_cfg = &app_ble_adv_para_data_cfg;
|
||
|
|
|
||
|
|
adv_para_cfg->adv_type = ADV_CONN_UNDIR;
|
||
|
|
adv_para_cfg->advInterval_Ms = APP_IBRT_BLE_ADV_INTERVAL;
|
||
|
|
adv_para_cfg->own_addr_type = ADDR_PUBLIC;
|
||
|
|
adv_para_cfg->peer_addr_type = ADDR_PUBLIC;
|
||
|
|
adv_para_cfg->adv_chanmap = ADV_ALL_CHNLS_EN;
|
||
|
|
adv_para_cfg->adv_filter_policy = ADV_ALLOW_SCAN_ANY_CON_ANY;
|
||
|
|
memset(adv_para_cfg->bd_addr.address, 0, BTIF_BD_ADDR_SIZE);
|
||
|
|
|
||
|
|
const char* ble_name_in_nv = (const char*)factory_section_get_ble_name();
|
||
|
|
uint32_t nameLen = strlen(ble_name_in_nv);
|
||
|
|
|
||
|
|
ASSERT(APP_IBRT_BLE_ADV_DATA_MAX_LEN >= nameLen, "ble adv data exceed");
|
||
|
|
|
||
|
|
adv_para_cfg->adv_data_len = 0;
|
||
|
|
adv_para_cfg->adv_data[adv_para_cfg->adv_data_len++] = nameLen+1;
|
||
|
|
adv_para_cfg->adv_data[adv_para_cfg->adv_data_len++] = 0x08;
|
||
|
|
memcpy(&adv_para_cfg->adv_data[adv_para_cfg->adv_data_len], ble_name_in_nv, nameLen);
|
||
|
|
adv_para_cfg->adv_data_len += nameLen;
|
||
|
|
|
||
|
|
adv_para_cfg->scan_rsp_data_len = 0;
|
||
|
|
memset(adv_para_cfg->scan_rsp_data,0,sizeof(adv_para_cfg->scan_rsp_data));
|
||
|
|
|
||
|
|
memset(&slaveBleMode, 0, sizeof(slaveBleMode));
|
||
|
|
btif_me_register_cmd_complete_callback(HCI_CMD_COMPLETE_USER_BLE, app_ibrt_slave_ble_cmd_complete_callback);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_set_adv_para_handler
|
||
|
|
Description : config ble adv parameter
|
||
|
|
Input : app_ble_adv_para_data_t *adv_para_cfg
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_set_adv_para_handler(app_ble_adv_para_data_t *adv_para_cfg)
|
||
|
|
{
|
||
|
|
btif_adv_para_struct_t adv_para;
|
||
|
|
adv_para.adv_type = adv_para_cfg->adv_type;
|
||
|
|
adv_para.interval_max = adv_para_cfg->advInterval_Ms * 8 / 5;
|
||
|
|
adv_para.interval_min = adv_para_cfg->advInterval_Ms * 8 / 5;
|
||
|
|
adv_para.own_addr_type = adv_para_cfg->own_addr_type;
|
||
|
|
adv_para.peer_addr_type = adv_para_cfg->peer_addr_type;
|
||
|
|
adv_para.adv_chanmap = adv_para_cfg->adv_chanmap;
|
||
|
|
adv_para.adv_filter_policy = adv_para_cfg->adv_filter_policy;
|
||
|
|
memcpy(adv_para.bd_addr.address, adv_para_cfg->bd_addr.address, BTIF_BD_ADDR_SIZE);
|
||
|
|
|
||
|
|
btif_me_ble_set_adv_parameters(&adv_para);
|
||
|
|
}
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_set_adv_data_handler
|
||
|
|
Description : config ble adv data and scan response data
|
||
|
|
Input : app_ble_adv_para_data_t *adv_data_cfg
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_set_adv_data_handler(app_ble_adv_para_data_t *adv_data_cfg)
|
||
|
|
{
|
||
|
|
btif_me_ble_set_adv_data(adv_data_cfg->adv_data_len, adv_data_cfg->adv_data);
|
||
|
|
btif_me_ble_set_scan_rsp_data(adv_data_cfg->scan_rsp_data_len, adv_data_cfg->scan_rsp_data);
|
||
|
|
}
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_adv_start
|
||
|
|
Description : enable ble adv
|
||
|
|
Input : uint8_t adv_type, uint16_t advInterval
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_adv_start(uint8_t adv_type, uint16_t advInterval)
|
||
|
|
{
|
||
|
|
TRACE(2,"ble adv start with adv_type %d advIntervalms %dms", adv_type, advInterval);
|
||
|
|
app_ble_adv_para_data_cfg.adv_type = adv_type;
|
||
|
|
app_ble_adv_para_data_cfg.advInterval_Ms = advInterval;
|
||
|
|
|
||
|
|
switch(slaveBleMode.state)
|
||
|
|
{
|
||
|
|
case BLE_ADVERTISING:
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_STOPPING_ADV);
|
||
|
|
SET_SLAVE_BLE_OP(BLE_START_ADV);
|
||
|
|
btif_me_ble_set_adv_en(false);
|
||
|
|
break;
|
||
|
|
case BLE_STARTING_ADV:
|
||
|
|
case BLE_STOPPING_ADV:
|
||
|
|
SET_SLAVE_BLE_OP(BLE_START_ADV);
|
||
|
|
break;
|
||
|
|
case BLE_STATE_IDLE:
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_STARTING_ADV);
|
||
|
|
app_ibrt_ble_set_adv_para_handler(&app_ble_adv_para_data_cfg);
|
||
|
|
app_ibrt_ble_set_adv_data_handler(&app_ble_adv_para_data_cfg);
|
||
|
|
btif_me_ble_set_adv_en(true);
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_adv_stop
|
||
|
|
Description : disable ble adv
|
||
|
|
Input : None
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_adv_stop(void)
|
||
|
|
{
|
||
|
|
TRACE(1,"%s",__func__);
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_STOPPING_ADV);
|
||
|
|
SET_SLAVE_BLE_OP(BLE_STOP_ADV);
|
||
|
|
btif_me_ble_set_adv_en(false);
|
||
|
|
}
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_switch_activities
|
||
|
|
Description : ble adv state machine switch
|
||
|
|
Input : None
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_switch_activities(void)
|
||
|
|
{
|
||
|
|
switch(slaveBleMode.state)
|
||
|
|
{
|
||
|
|
case BLE_STARTING_ADV:
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_ADVERTISING);
|
||
|
|
if(slaveBleMode.op == BLE_START_ADV)
|
||
|
|
{
|
||
|
|
SET_SLAVE_BLE_OP(BLE_OP_IDLE);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case BLE_STOPPING_ADV:
|
||
|
|
SET_SLAVE_BLE_STATE(BLE_STATE_IDLE);
|
||
|
|
if(slaveBleMode.op == BLE_STOP_ADV)
|
||
|
|
{
|
||
|
|
SET_SLAVE_BLE_OP(BLE_OP_IDLE);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
switch(slaveBleMode.op)
|
||
|
|
{
|
||
|
|
case BLE_START_ADV:
|
||
|
|
app_ibrt_ble_adv_start(ADV_CONN_UNDIR, app_ble_adv_para_data_cfg.advInterval_Ms);
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/*****************************************************************************
|
||
|
|
Prototype : app_ibrt_ble_adv_data_config
|
||
|
|
Description : config ble adv data and scan response data by customer
|
||
|
|
Input : uint8_t *advData, uint8_t advDataLen
|
||
|
|
: uint8_t *scanRspData, uint8_t scanRspDataLen
|
||
|
|
Output : None
|
||
|
|
Return Value :
|
||
|
|
Calls :
|
||
|
|
Called By :
|
||
|
|
|
||
|
|
History :
|
||
|
|
Date : 2019/12/28
|
||
|
|
Author : bestechnic
|
||
|
|
Modification : Created function
|
||
|
|
|
||
|
|
*****************************************************************************/
|
||
|
|
void app_ibrt_ble_adv_data_config(uint8_t *advData, uint8_t advDataLen,
|
||
|
|
uint8_t *scanRspData, uint8_t scanRspDataLen)
|
||
|
|
{
|
||
|
|
ASSERT(APP_IBRT_BLE_ADV_DATA_MAX_LEN >= advDataLen, "ble adv data len exceed");
|
||
|
|
ASSERT(APP_IBRT_BLE_SCAN_RSP_DATA_MAX_LEN >= scanRspDataLen, "scan response data len exceed")
|
||
|
|
memcpy(app_ble_adv_para_data_cfg.adv_data, advData, advDataLen);
|
||
|
|
memcpy(app_ble_adv_para_data_cfg.scan_rsp_data, scanRspData, scanRspDataLen);
|
||
|
|
app_ble_adv_para_data_cfg.adv_data_len = advDataLen;
|
||
|
|
app_ble_adv_para_data_cfg.scan_rsp_data_len = scanRspDataLen;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|