341 lines
9.3 KiB
C
341 lines
9.3 KiB
C
#include "app_config.h"
|
|
#include "btstack/btstack_task.h"
|
|
#include "btstack/bluetooth.h"
|
|
#include "btcontroller_modules.h"
|
|
#include "bt_common.h"
|
|
#include "le_common.h"
|
|
#include "system/timer.h"
|
|
#include "os/os_api.h"
|
|
|
|
#if (TCFG_BLE_DEMO_SELECT == DEF_BLE_DEMO_NONCONN_24G)
|
|
|
|
#if 1
|
|
extern void printf_buf(u8 *buf, u32 len);
|
|
#define log_info(x, ...) printf("[BLE_24G]" x " ", ## __VA_ARGS__)
|
|
#define log_info_hexdump printf_buf
|
|
#else
|
|
#define log_info(...)
|
|
#define log_info_hexdump(...)
|
|
#endif
|
|
|
|
|
|
/* #define PHONE_DISCOVER_HIDE_SWITCH_TEST //手机可发现与不可发现切换test */
|
|
//------------------------------------------------------
|
|
#define CFG_RF_24G_CODE_ID 0x13 // 24g 识别码(24bit),发送接收都要匹配
|
|
|
|
//配置收发角色
|
|
#define CONFIG_TX_MODE_ENABLE 1 //发射器
|
|
#define CONFIG_RX_MODE_ENABLE 1 //接收器
|
|
|
|
//------------------------------------------------------
|
|
//TX发送配置
|
|
#define TX_DATA_COUNT 3 //发送次数,决定os_time_dly 多久
|
|
#define TX_DATA_INTERVAL 20 //发送间隔>=20ms
|
|
|
|
#define ADV_INTERVAL_VAL ADV_SCAN_MS(TX_DATA_INTERVAL)//unit: 0.625ms
|
|
#define RSP_TX_HEAD 0xff
|
|
|
|
static u8 adv_data_len = 0;
|
|
static u8 adv_data[ADV_RSP_PACKET_MAX];//max is 31
|
|
static u8 scan_rsp_data_len = 0;
|
|
static u8 scan_rsp_data[ADV_RSP_PACKET_MAX];//max is 31
|
|
|
|
static char gap_device_name[BT_NAME_LEN_MAX] = "jl_ble_test";
|
|
static u8 gap_device_name_len = 0; //名字长度，不包含结束符
|
|
static u8 adv_ctrl_en = 0; //adv控制
|
|
static u8 scan_ctrl_en = 0; //scan控制
|
|
|
|
//------------------------------------------------------
|
|
//RX接收配置
|
|
//搜索类型
|
|
#define SET_SCAN_TYPE SCAN_ACTIVE
|
|
//搜索 周期大小
|
|
#define SET_SCAN_INTERVAL ADV_SCAN_MS(200)//unit: 0.625ms
|
|
//搜索 窗口大小
|
|
#define SET_SCAN_WINDOW ADV_SCAN_MS(200)//unit: 0.625ms
|
|
|
|
//------------------------------------------------------
|
|
//广播参数设置
|
|
extern const char *bt_get_local_name();
|
|
|
|
//------------------------------------------------------
|
|
static void tx_setup_init(void)
|
|
{
|
|
uint8_t adv_type;
|
|
uint8_t adv_channel = ADV_CHANNEL_ALL;
|
|
int ret = 0;
|
|
|
|
if (scan_rsp_data_len) {
|
|
adv_type = ADV_SCAN_IND;
|
|
} else {
|
|
adv_type = ADV_NONCONN_IND;
|
|
}
|
|
|
|
#ifdef PHONE_DISCOVER_HIDE_SWITCH_TEST
|
|
adv_type = ADV_IND;
|
|
|
|
u8 offset = 0;
|
|
u8 *buf = adv_data;
|
|
u8 name_len = gap_device_name_len;
|
|
|
|
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, 0xAF00, 2);
|
|
offset += make_eir_packet_data(&buf[offset], offset, HCI_EIR_DATATYPE_COMPLETE_LOCAL_NAME, (void *)gap_device_name, name_len);
|
|
adv_data_len = offset;
|
|
|
|
offset = 0;
|
|
buf = scan_rsp_data;
|
|
|
|
offset = make_eir_packet_data(&buf[offset], offset, HCI_EIR_DATATYPE_COMPLETE_LOCAL_NAME, (void *)gap_device_name, name_len);
|
|
scan_rsp_data_len = offset;
|
|
#endif
|
|
|
|
ble_op_set_adv_param(ADV_INTERVAL_VAL, adv_type, adv_channel);
|
|
|
|
ble_op_set_adv_data(adv_data_len, adv_data);
|
|
put_buf(adv_data, adv_data_len);
|
|
|
|
ble_op_set_rsp_data(scan_rsp_data_len, scan_rsp_data);
|
|
put_buf(scan_rsp_data, scan_rsp_data_len);
|
|
}
|
|
|
|
//发送使能
|
|
static void ble_tx_enable(u8 enable)
|
|
{
|
|
#if CONFIG_TX_MODE_ENABLE
|
|
if (adv_ctrl_en != enable) {
|
|
adv_ctrl_en = enable;
|
|
log_info("tx_en:%d\n", enable);
|
|
if (enable) {
|
|
tx_setup_init();
|
|
}
|
|
ble_op_adv_enable(enable);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
//发送数据, len support max is 60
|
|
int ble_tx_send_data(const u8 *data, u8 len)
|
|
{
|
|
if (0 == len || len > (ADV_RSP_PACKET_MAX - 1) * 2) {
|
|
log_info("len is overflow:%d\n", len);
|
|
return -1;
|
|
}
|
|
|
|
u8 tmp_len;
|
|
adv_data_len = 0;
|
|
scan_rsp_data_len = 0;
|
|
|
|
if (len > ADV_RSP_PACKET_MAX - 1) {
|
|
adv_data_len = ADV_RSP_PACKET_MAX - 1;
|
|
} else {
|
|
adv_data_len = len;
|
|
}
|
|
|
|
adv_data[0] = len;//packet len
|
|
memcpy(&adv_data[1], data, adv_data_len);
|
|
data += adv_data_len;
|
|
len -= adv_data_len;
|
|
adv_data_len++; //add head
|
|
|
|
if (len) {
|
|
scan_rsp_data[0] = RSP_TX_HEAD;
|
|
scan_rsp_data_len = len + 1; //add head
|
|
memcpy(&scan_rsp_data[1], data, len);
|
|
}
|
|
ble_tx_enable(1);
|
|
//延时确定发送成功
|
|
#ifndef PHONE_DISCOVER_HIDE_SWITCH_TEST
|
|
os_time_dly(TX_DATA_COUNT * TX_DATA_INTERVAL / 10 + 1);
|
|
ble_tx_enable(0);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static void ble_tx_timer_test(void *p)
|
|
{
|
|
static u8 test_buffer[64];
|
|
static u8 tag_value = 0;
|
|
u8 test_len = 60;
|
|
if (tag_value == 0) {
|
|
for (int i = 0; i < 64; i++) {
|
|
test_buffer[i] = i;
|
|
}
|
|
tag_value++;
|
|
}
|
|
|
|
ble_tx_send_data(test_buffer, test_len);
|
|
r_printf("tx_data: %02x", test_buffer[0]);
|
|
/* put_buf(&test_buffer, test_len); */
|
|
test_buffer[0]++;
|
|
}
|
|
|
|
static u8 rx_buffer[ADV_RSP_PACKET_MAX * 2];
|
|
static u8 rx_len = 0;
|
|
// *****************************************************************************
|
|
//扫描接收到的数据
|
|
static void ble_rx_data_handle(const u8 *data, u16 len)
|
|
{
|
|
log_info("rx_data: %d", len);
|
|
put_buf(data, len);
|
|
}
|
|
|
|
static void ble_rx_report_handle(adv_report_t *report_pt, u16 len)
|
|
{
|
|
/* log_info("event_type,addr_type:%x,%x\n", report_pt->event_type, report_pt->address_type); */
|
|
/* log_info_hexdump(report_pt->address, 6); */
|
|
static u32 scan_packet_num = 0;//for test
|
|
|
|
/* r_printf("rx data:%d",report_pt->length); */
|
|
/* put_buf(report_pt->data,report_pt->length); */
|
|
|
|
u8 data_len = report_pt->length - 1;
|
|
|
|
if (!data_len) {
|
|
return;
|
|
}
|
|
|
|
if (report_pt->data[0] == RSP_TX_HEAD) {
|
|
memcpy(&rx_buffer[ADV_RSP_PACKET_MAX - 1], &report_pt->data[1], data_len);
|
|
log_info("long_packet =%d\n", rx_len);
|
|
} else {
|
|
memcpy(rx_buffer, &report_pt->data[1], data_len);
|
|
rx_len = report_pt->data[0];
|
|
if (rx_len > ADV_RSP_PACKET_MAX - 1) {
|
|
log_info("first_packet =%d,wait next packet\n", data_len);
|
|
return;
|
|
} else {
|
|
log_info("short_packet =%d\n", rx_len);
|
|
}
|
|
}
|
|
|
|
//for debug
|
|
log_info("rssi:%d,packet_num:%u\n", report_pt->rssi, ++scan_packet_num);
|
|
ble_rx_data_handle(rx_buffer, rx_len);
|
|
rx_len = 0;
|
|
}
|
|
|
|
static void ble_rx_event_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)
|
|
{
|
|
switch (packet_type) {
|
|
case HCI_EVENT_PACKET:
|
|
switch (hci_event_packet_get_type(packet)) {
|
|
case GAP_EVENT_ADVERTISING_REPORT:
|
|
ble_rx_report_handle((void *)&packet[2], packet[1]);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void rx_setup_init(void)
|
|
{
|
|
ble_op_set_scan_param(SET_SCAN_TYPE, SET_SCAN_INTERVAL, SET_SCAN_WINDOW);
|
|
}
|
|
|
|
//收数使能
|
|
static void ble_rx_enable(u8 enable)
|
|
{
|
|
#if CONFIG_RX_MODE_ENABLE
|
|
if (scan_ctrl_en != enable) {
|
|
scan_ctrl_en = enable;
|
|
log_info("rx_en:%d\n", enable);
|
|
if (enable) {
|
|
rx_setup_init();
|
|
}
|
|
ble_op_scan_enable2(enable, 0);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
//------------------------------------------------------------
|
|
//协议栈内部调用
|
|
void ble_profile_init(void)
|
|
{
|
|
log_info("ble profile init\n");
|
|
// register for HCI events
|
|
hci_event_callback_set(&ble_rx_event_handler);
|
|
/* le_l2cap_register_packet_handler(&ble_rx_packet_handler); */
|
|
}
|
|
|
|
static void ble_module_enable(u8 en)
|
|
{
|
|
log_info("mode_en:%d\n", en);
|
|
if (en) {
|
|
} else {
|
|
ble_rx_enable(0);
|
|
ble_tx_enable(0);
|
|
}
|
|
}
|
|
|
|
#ifdef PHONE_DISCOVER_HIDE_SWITCH_TEST
|
|
static void phone_discover_hide_switch_test(void)
|
|
{
|
|
static u8 flag = 0;
|
|
/* printf("--------%s-------%d flag = %d\n", __func__, __LINE__, flag); */
|
|
ble_module_enable(0);
|
|
os_time_dly(100);
|
|
if (!flag) {
|
|
flag = 1;
|
|
rf_set_24g_hackable_coded(CFG_RF_24G_CODE_ID);
|
|
ble_rf_vendor_fixed_channel(36, 3); //不可被手机发现
|
|
} else {
|
|
flag = 0;
|
|
rf_set_24g_hackable_coded(0);
|
|
ble_rf_vendor_fixed_channel(0xff, 3); //可被手机发现
|
|
}
|
|
os_time_dly(100);
|
|
ble_module_enable(1);
|
|
ble_tx_timer_test();
|
|
}
|
|
#endif
|
|
|
|
void bt_ble_init(void)
|
|
{
|
|
log_info("***** ble_init******\n");
|
|
|
|
const char *name_p;
|
|
const char ble_ext_name[] = "(BLE)";
|
|
u8 ext_name_len = sizeof(ble_ext_name) - 1;
|
|
|
|
rf_set_24g_hackable_coded(CFG_RF_24G_CODE_ID);
|
|
ble_rf_vendor_fixed_channel(36, 3); //通信信道，发送接收都要一致
|
|
|
|
name_p = bt_get_local_name();
|
|
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;
|
|
|
|
log_info("ble name(%d): %s \n", gap_device_name_len, gap_device_name);
|
|
|
|
#if CONFIG_TX_MODE_ENABLE
|
|
//for test
|
|
#ifndef PHONE_DISCOVER_HIDE_SWITCH_TEST
|
|
sys_timer_add(NULL, ble_tx_timer_test, 3000);
|
|
#else
|
|
sys_timer_add(NULL, phone_discover_hide_switch_test, 10000);
|
|
ble_tx_timer_test();
|
|
#endif
|
|
#endif
|
|
|
|
#if CONFIG_RX_MODE_ENABLE && (!defined PHONE_DISCOVER_HIDE_SWITCH_TEST)
|
|
ble_rx_enable(1);
|
|
#endif
|
|
}
|
|
|
|
void bt_ble_exit(void)
|
|
{
|
|
log_info("***** ble_exit******\n");
|
|
ble_module_enable(0);
|
|
}
|
|
|
|
#endif
|