1051 lines
33 KiB
Plaintext
Executable File
1051 lines
33 KiB
Plaintext
Executable File
// Copyright 2020-2021 Beken
|
|
//
|
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
|
// you may not use this file except in compliance with the License.
|
|
// You may obtain a copy of the License at
|
|
//
|
|
// http://www.apache.org/licenses/LICENSE-2.0
|
|
//
|
|
// Unless required by applicable law or agreed to in writing, software
|
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
// See the License for the specific language governing permissions and
|
|
// limitations under the License.
|
|
|
|
|
|
#include <common/bk_include.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
#include <components/log.h>
|
|
#include <os/mem.h>
|
|
#include <os/str.h>
|
|
#include <os/os.h>
|
|
|
|
#if CONFIG_BLE//(CONFIG_BLE_5_X || CONFIG_BTDM_5_2)
|
|
#if CONFIG_AT
|
|
#include "bk_at_ble.h"
|
|
#elif defined(CONFIG_AT_CMD)
|
|
#include "at_ble_common.h"
|
|
#endif
|
|
|
|
#include "ble_api_5_x.h"
|
|
|
|
#include "bk_wifi.h"
|
|
#include "bluetooth_legacy_include.h"
|
|
#include "ble_client.h"
|
|
#if CONFIG_MBEDTLS
|
|
#include "mbedtls/aes.h"
|
|
#endif
|
|
|
|
#define LOGI(...) BK_LOGI(TAG, ##__VA_ARGS__)
|
|
#define LOGW(...) BK_LOGW(TAG, ##__VA_ARGS__)
|
|
#define LOGE(...) BK_LOGE(TAG, ##__VA_ARGS__)
|
|
#define LOGD(...) BK_LOGD(TAG, ##__VA_ARGS__)
|
|
|
|
#define TAG "ble_client"
|
|
|
|
#define AT_SYNC_CMD_TIMEOUT_MS 4000
|
|
|
|
static beken_semaphore_t ble_boarding_sema = NULL;
|
|
static ble_err_t s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
static uint8_t s_conn_ind = ~0;
|
|
|
|
enum boarding_mode
|
|
{
|
|
BOARDING_MODE_UNKNOW,
|
|
BOARDING_MODE_AT,
|
|
};
|
|
|
|
static ble_boarding_info_t *ble_boarding_info = NULL;
|
|
|
|
extern void at_set_data_handle(uint8_t *out, char *buff, uint16_t len);
|
|
#if CONFIG_AT
|
|
static int ble_boarding_legacy_handle(int sync,int argc, char **argv);
|
|
#elif defined(CONFIG_AT_CMD)
|
|
int ble_boarding_legacy_handle(char *pcWriteBuffer, int xWriteBufferLen, int argc, char **argv);
|
|
|
|
#endif
|
|
#define BOARDING_SERVICE_UUID (0xFA00)
|
|
|
|
#define BOARDING_CHARA_PROPERTIES_UUID (0xEA01)
|
|
#define BOARDING_CHARA_OPERATION_UUID (0xEA02)
|
|
|
|
#define BOARDING_CHARA_SSID_UUID (0xEA05)
|
|
#define BOARDING_CHARA_PASSWORD_UUID (0xEA06)
|
|
|
|
|
|
enum {
|
|
BOARDING_IDX_SVC,
|
|
BOARDING_IDX_CHAR_DECL,
|
|
BOARDING_IDX_CHAR_VALUE,
|
|
BOARDING_IDX_CHAR_DESC,
|
|
|
|
BOARDING_IDX_CHAR_OPERATION_DECL,
|
|
BOARDING_IDX_CHAR_OPERATION_VALUE,
|
|
|
|
BOARDING_IDX_CHAR_SSID_DECL,
|
|
BOARDING_IDX_CHAR_SSID_VALUE,
|
|
|
|
BOARDING_IDX_CHAR_PASSWORD_DECL,
|
|
BOARDING_IDX_CHAR_PASSWORD_VALUE,
|
|
|
|
BOARDING_IDX_NB,
|
|
};
|
|
|
|
#define DECL_PRIMARY_SERVICE_128 {0x00,0x28,0,0,0,0,0,0,0,0,0,0,0,0,0,0}
|
|
#define DECL_CHARACTERISTIC_128 {0x03,0x28,0,0,0,0,0,0,0,0,0,0,0,0,0,0}
|
|
#define DESC_CLIENT_CHAR_CFG_128 {0x02,0x29,0,0,0,0,0,0,0,0,0,0,0,0,0,0}
|
|
|
|
ble_attm_desc_t boarding_service_db[BOARDING_IDX_NB] = {
|
|
// Service Declaration
|
|
[BOARDING_IDX_SVC] = {{BOARDING_SERVICE_UUID & 0xFF, BOARDING_SERVICE_UUID >> 8}, BK_BLE_PERM_SET(RD, ENABLE), 0, 0},
|
|
|
|
[BOARDING_IDX_CHAR_DECL] = {DECL_CHARACTERISTIC_128, BK_BLE_PERM_SET(RD, ENABLE), 0, 0},
|
|
// Characteristic Value
|
|
[BOARDING_IDX_CHAR_VALUE] = {{BOARDING_CHARA_PROPERTIES_UUID & 0xFF, BOARDING_CHARA_PROPERTIES_UUID >> 8}, BK_BLE_PERM_SET(NTF, ENABLE), BK_BLE_PERM_SET(RI, ENABLE) | BK_BLE_PERM_SET(UUID_LEN, UUID_16), 128},
|
|
//Client Characteristic Configuration Descriptor
|
|
[BOARDING_IDX_CHAR_DESC] = {DESC_CLIENT_CHAR_CFG_128, BK_BLE_PERM_SET(RD, ENABLE) | BK_BLE_PERM_SET(WRITE_REQ, ENABLE), 0, 0},
|
|
|
|
//opreation
|
|
[BOARDING_IDX_CHAR_OPERATION_DECL] = {DECL_CHARACTERISTIC_128, BK_BLE_PERM_SET(RD, ENABLE), 0, 0},
|
|
[BOARDING_IDX_CHAR_OPERATION_VALUE] = {{BOARDING_CHARA_OPERATION_UUID & 0xFF, BOARDING_CHARA_OPERATION_UUID >> 8, 0}, BK_BLE_PERM_SET(WRITE_REQ, ENABLE), BK_BLE_PERM_SET(RI, ENABLE) | BK_BLE_PERM_SET(UUID_LEN, UUID_16), 128},
|
|
|
|
//ssid
|
|
[BOARDING_IDX_CHAR_SSID_DECL] = {DECL_CHARACTERISTIC_128, BK_BLE_PERM_SET(RD, ENABLE), 0, 0},
|
|
[BOARDING_IDX_CHAR_SSID_VALUE] = {{BOARDING_CHARA_SSID_UUID & 0xFF, BOARDING_CHARA_SSID_UUID >> 8, 0}, BK_BLE_PERM_SET(WRITE_REQ, ENABLE) | BK_BLE_PERM_SET(RD, ENABLE), BK_BLE_PERM_SET(RI, ENABLE) | BK_BLE_PERM_SET(UUID_LEN, UUID_16), 128},
|
|
|
|
//password
|
|
[BOARDING_IDX_CHAR_PASSWORD_DECL] = {DECL_CHARACTERISTIC_128, BK_BLE_PERM_SET(RD, ENABLE), 0, 0},
|
|
[BOARDING_IDX_CHAR_PASSWORD_VALUE] = {{BOARDING_CHARA_PASSWORD_UUID & 0xFF, BOARDING_CHARA_PASSWORD_UUID >> 8, 0}, BK_BLE_PERM_SET(WRITE_REQ, ENABLE) | BK_BLE_PERM_SET(RD, ENABLE), BK_BLE_PERM_SET(RI, ENABLE) | BK_BLE_PERM_SET(UUID_LEN, UUID_16), 128},
|
|
};
|
|
|
|
static void ble_at_cmd_cb(ble_cmd_t cmd, ble_cmd_param_t *param)
|
|
{
|
|
s_at_cmd_status = param->status;
|
|
switch (cmd)
|
|
{
|
|
case BLE_CREATE_ADV:
|
|
case BLE_SET_ADV_DATA:
|
|
case BLE_SET_RSP_DATA:
|
|
case BLE_START_ADV:
|
|
case BLE_STOP_ADV:
|
|
case BLE_CREATE_SCAN:
|
|
case BLE_START_SCAN:
|
|
case BLE_STOP_SCAN:
|
|
case BLE_INIT_CREATE:
|
|
case BLE_INIT_START_CONN:
|
|
case BLE_INIT_STOP_CONN:
|
|
case BLE_CONN_DIS_CONN:
|
|
case BLE_CONN_UPDATE_PARAM:
|
|
case BLE_DELETE_ADV:
|
|
case BLE_DELETE_SCAN:
|
|
case BLE_CONN_READ_PHY:
|
|
case BLE_CONN_SET_PHY:
|
|
case BLE_CONN_UPDATE_MTU:
|
|
if (ble_boarding_sema != NULL)
|
|
rtos_set_semaphore( &ble_boarding_sema );
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
}
|
|
|
|
static void ble_boarding_operation_handle(uint16_t opcode, uint16_t length, uint8_t *data)
|
|
{
|
|
LOGE("%s, opcode: %04X, length: %04X\n", __func__, opcode, length);
|
|
|
|
switch (opcode)
|
|
{
|
|
case BOARDING_OP_STATION_START:
|
|
{
|
|
#if CONFIG_WIFI_ENABLE
|
|
demo_sta_app_init((char *)ble_boarding_info->ssid_value, (char *)ble_boarding_info->password_value);
|
|
#endif
|
|
}
|
|
break;
|
|
|
|
}
|
|
}
|
|
static bk_ble_key_t s_ble_enc_key;
|
|
|
|
static uint8_t ble_check_random_bda_is_resolvable(uint8_t *addr, uint8_t addr_type)
|
|
{
|
|
uint8_t ret = 0;
|
|
#if CONFIG_MBEDTLS
|
|
uint8_t key[16];
|
|
uint8_t plain_text[16];
|
|
uint8_t encrypt_data[16];
|
|
mbedtls_aes_context aes;
|
|
|
|
if ((0 == addr_type) || (0x40 != (addr[5] & 0xc0))) //most significant bit, bit7, bit6 is 01 to be resolvable random
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
mbedtls_aes_init(&aes);
|
|
for (uint8_t i = 0; i < 16; i++)
|
|
{
|
|
key[15 -i] = s_ble_enc_key.pirk.irk[i];
|
|
}
|
|
mbedtls_aes_setkey_enc(&aes, key, 128);
|
|
|
|
os_memset(plain_text, 0, sizeof(plain_text));
|
|
plain_text[13] = addr[5];
|
|
plain_text[14] = addr[4];
|
|
plain_text[15] = addr[3];
|
|
|
|
mbedtls_aes_crypt_ecb(&aes, MBEDTLS_AES_ENCRYPT, plain_text, encrypt_data);
|
|
|
|
if ((encrypt_data[13] == addr[2]) && (encrypt_data[14] == addr[1]) && (encrypt_data[15] == addr[0]))
|
|
{
|
|
ret = 1;
|
|
LOGI("the random bda is resolvable!\r\n");
|
|
}
|
|
|
|
mbedtls_aes_free(&aes);
|
|
#endif
|
|
return ret;
|
|
}
|
|
|
|
static void ble_at_legacy_notice_cb(ble_notice_t notice, void *param)
|
|
{
|
|
switch (notice) {
|
|
case BLE_5_STACK_OK:
|
|
os_printf("ble stack ok");
|
|
break;
|
|
case BLE_5_WRITE_EVENT: {
|
|
ble_write_req_t *w_req = (ble_write_req_t *)param;
|
|
os_printf("write_cb:conn_idx:%d, prf_id:%d, att_idx:%d, len:%d, data[0]:0x%02x\r\n",
|
|
w_req->conn_idx, w_req->prf_id, w_req->att_idx, w_req->len, w_req->value[0]);
|
|
//#if (CONFIG_BTDM_5_2)
|
|
|
|
if (bk_ble_get_controller_stack_type() == BK_BLE_CONTROLLER_STACK_TYPE_BTDM_5_2
|
|
&& w_req->prf_id == PRF_TASK_ID_BOARDING) {
|
|
switch(w_req->att_idx)
|
|
{
|
|
case BOARDING_IDX_CHAR_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_VALUE:
|
|
break;
|
|
case BOARDING_IDX_CHAR_DESC: {
|
|
//uint8_t con_idx = *(uint8_t *)param;
|
|
//uint8_t value[3] = {0};
|
|
//value[0] = 0x12;
|
|
//value[1] = 0x34;
|
|
//value[2] = 0x56;
|
|
//bk_ble_send_noti_value(con_idx, 3, value, PRF_TASK_ID_BOARDING, BOARDING_IDX_CHAR_VALUE);
|
|
os_memcpy(&ble_boarding_info->boarding_notify[0], &w_req->value[0], sizeof(ble_boarding_info->boarding_notify));
|
|
LOGI("write notify: %02X %02X, length: %d\n", w_req->value[0], w_req->value[1], w_req->len);
|
|
break;
|
|
}
|
|
|
|
case BOARDING_IDX_CHAR_OPERATION_DECL:
|
|
break;
|
|
|
|
case BOARDING_IDX_CHAR_OPERATION_VALUE:
|
|
{
|
|
uint16_t opcode = 0, length = 0;
|
|
uint8_t *data = NULL;
|
|
|
|
if (w_req->len < 2)
|
|
{
|
|
LOGE("error input: operation code length: " + w_req->len);
|
|
break;
|
|
}
|
|
|
|
opcode = w_req->value[0] | w_req->value[1] << 8;
|
|
|
|
if (w_req->len >= 4)
|
|
{
|
|
length = w_req->value[2] | w_req->value[3] << 8;
|
|
}
|
|
|
|
if (w_req->len > 4)
|
|
{
|
|
data = &w_req->value[4];
|
|
}
|
|
|
|
if (ble_boarding_info->cb)
|
|
{
|
|
ble_boarding_info->cb(opcode, length, data);
|
|
}
|
|
else
|
|
{
|
|
ble_boarding_operation_handle(opcode, length, data);
|
|
}
|
|
}
|
|
break;
|
|
|
|
case BOARDING_IDX_CHAR_SSID_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_SSID_VALUE:
|
|
{
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
LOGE("ble_boarding_info should not be NULL\n");
|
|
break;
|
|
}
|
|
|
|
if (ble_boarding_info->ssid_value != NULL)
|
|
{
|
|
os_free(ble_boarding_info->ssid_value);
|
|
ble_boarding_info->ssid_value = NULL;
|
|
}
|
|
|
|
ble_boarding_info->ssid_length = w_req->len;
|
|
ble_boarding_info->ssid_value = os_malloc(ble_boarding_info->ssid_length + 1);
|
|
|
|
|
|
os_memset((uint8_t *)ble_boarding_info->ssid_value, 0, ble_boarding_info->ssid_length + 1);
|
|
os_memcpy((uint8_t *)ble_boarding_info->ssid_value, w_req->value, ble_boarding_info->ssid_length);
|
|
|
|
LOGI("write ssid: %s, length: %d\n", ble_boarding_info->ssid_value, ble_boarding_info->ssid_length);
|
|
}
|
|
break;
|
|
|
|
case BOARDING_IDX_CHAR_PASSWORD_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_PASSWORD_VALUE:
|
|
{
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
LOGE("ble_boarding_info should not be NULL\n");
|
|
break;
|
|
}
|
|
|
|
if (ble_boarding_info->password_value != NULL)
|
|
{
|
|
os_free(ble_boarding_info->password_value);
|
|
ble_boarding_info->password_value = NULL;
|
|
}
|
|
|
|
ble_boarding_info->password_length = w_req->len;
|
|
ble_boarding_info->password_value = os_malloc(ble_boarding_info->password_length + 1);
|
|
|
|
os_memset((uint8_t *)ble_boarding_info->password_value, 0, ble_boarding_info->password_length + 1);
|
|
os_memcpy((uint8_t *)ble_boarding_info->password_value, w_req->value, ble_boarding_info->password_length);
|
|
|
|
LOGI("write password: %s, length: %d\n", ble_boarding_info->password_value, ble_boarding_info->password_length);
|
|
}
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
//#endif
|
|
break;
|
|
}
|
|
case BLE_5_READ_EVENT: {
|
|
ble_read_req_t *r_req = (ble_read_req_t *)param;
|
|
os_printf("read_cb:conn_idx:%d, prf_id:%d, att_idx:%d\r\n",
|
|
r_req->conn_idx, r_req->prf_id, r_req->att_idx);
|
|
|
|
if (r_req->prf_id == PRF_TASK_ID_BOARDING) {
|
|
switch(r_req->att_idx)
|
|
{
|
|
case BOARDING_IDX_CHAR_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_VALUE:
|
|
break;
|
|
case BOARDING_IDX_CHAR_DESC:
|
|
bk_ble_read_response_value(r_req->conn_idx, sizeof(ble_boarding_info->boarding_notify), &ble_boarding_info->boarding_notify[0], r_req->prf_id, r_req->att_idx);
|
|
break;
|
|
|
|
case BOARDING_IDX_CHAR_SSID_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_SSID_VALUE:
|
|
bk_ble_read_response_value(r_req->conn_idx, ble_boarding_info->ssid_length, (uint8_t*)ble_boarding_info->ssid_value, r_req->prf_id, r_req->att_idx);
|
|
//os_printf("len:%d, data[0]:0x%02x, data[1]:0x%02x, data[2]:0x%02x\r\n", s_boarding_ssid_len, s_boarding_ssid[0], s_boarding_ssid[1], s_boarding_ssid[2]);
|
|
LOGI("read ssid: %s, length: %d\n", ble_boarding_info->ssid_value, ble_boarding_info->ssid_length);
|
|
break;
|
|
|
|
case BOARDING_IDX_CHAR_PASSWORD_DECL:
|
|
break;
|
|
case BOARDING_IDX_CHAR_PASSWORD_VALUE:
|
|
bk_ble_read_response_value(r_req->conn_idx, ble_boarding_info->password_length, (uint8_t*)ble_boarding_info->password_value, r_req->prf_id, r_req->att_idx);
|
|
//os_printf("len:%d, data[0]:0x%02x, data[1]:0x%02x, data[2]:0x%02x\r\n", s_boarding_password_len, s_boarding_password[0], s_boarding_password[1], s_boarding_password[2]);
|
|
LOGI("read password: %s, length: %d\n", ble_boarding_info->password_value, ble_boarding_info->password_length);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
case BLE_5_REPORT_ADV: {
|
|
ble_recv_adv_t *r_ind = (ble_recv_adv_t *)param;
|
|
uint8_t adv_type = r_ind->evt_type & REPORT_INFO_REPORT_TYPE_MASK;
|
|
os_printf("r_ind:actv_idx:%d,", r_ind->actv_idx);
|
|
switch (adv_type)
|
|
{
|
|
case REPORT_TYPE_ADV_EXT:
|
|
os_printf("evt_type:EXT_ADV,");
|
|
break;
|
|
case REPORT_TYPE_ADV_LEG:
|
|
{
|
|
switch (r_ind->evt_type)
|
|
{
|
|
case (REPORT_INFO_SCAN_ADV_BIT | REPORT_INFO_CONN_ADV_BIT | REPORT_INFO_COMPLETE_BIT | REPORT_TYPE_ADV_LEG):
|
|
os_printf("evt_type:ADV_IND,");
|
|
break;
|
|
case (REPORT_INFO_DIR_ADV_BIT | REPORT_INFO_CONN_ADV_BIT | REPORT_INFO_COMPLETE_BIT | REPORT_TYPE_ADV_LEG):
|
|
os_printf("evt_type:ADV_DIRECT_IND,");
|
|
break;
|
|
case (REPORT_INFO_SCAN_ADV_BIT | REPORT_INFO_COMPLETE_BIT | REPORT_TYPE_ADV_LEG):
|
|
os_printf("evt_type:ADV_SCAN_IND,");
|
|
break;
|
|
case (REPORT_INFO_COMPLETE_BIT | REPORT_TYPE_ADV_LEG):
|
|
os_printf("evt_type:ADV_NONCONN_IND,");
|
|
break;
|
|
default:
|
|
os_printf("evt_type:ERR_LEG_ADV,");
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
case REPORT_TYPE_SCAN_RSP_LEG:
|
|
os_printf("evt_type:SCAN_RSP,");
|
|
break;
|
|
case REPORT_TYPE_SCAN_RSP_EXT:
|
|
os_printf("evt_type:AUX_SCAN_RSP,");
|
|
break;
|
|
case REPORT_TYPE_PER_ADV:
|
|
os_printf("evt_type:PER_ADV,");
|
|
break;
|
|
default:
|
|
os_printf("evt_type:ERR_ADV,");
|
|
break;
|
|
}
|
|
os_printf(" adv_addr_type:%d, adv_addr:%02x:%02x:%02x:%02x:%02x:%02x\r\n",
|
|
r_ind->adv_addr_type, r_ind->adv_addr[0], r_ind->adv_addr[1], r_ind->adv_addr[2],
|
|
r_ind->adv_addr[3], r_ind->adv_addr[4], r_ind->adv_addr[5]);
|
|
break;
|
|
}
|
|
case BLE_5_MTU_CHANGE: {
|
|
ble_mtu_change_t *m_ind = (ble_mtu_change_t *)param;
|
|
os_printf("%s m_ind:conn_idx:%d, mtu_size:%d\r\n", __func__, m_ind->conn_idx, m_ind->mtu_size);
|
|
break;
|
|
}
|
|
case BLE_5_CONNECT_EVENT: {
|
|
ble_conn_ind_t *c_ind = (ble_conn_ind_t *)param;
|
|
os_printf("c_ind:conn_idx:%d, addr_type:%d, peer_addr:%02x:%02x:%02x:%02x:%02x:%02x\r\n",
|
|
c_ind->conn_idx, c_ind->peer_addr_type, c_ind->peer_addr[0], c_ind->peer_addr[1],
|
|
c_ind->peer_addr[2], c_ind->peer_addr[3], c_ind->peer_addr[4], c_ind->peer_addr[5]);
|
|
s_conn_ind = c_ind->conn_idx;
|
|
break;
|
|
}
|
|
case BLE_5_DISCONNECT_EVENT: {
|
|
ble_discon_ind_t *d_ind = (ble_discon_ind_t *)param;
|
|
os_printf("d_ind:conn_idx:%d,reason:%d\r\n", d_ind->conn_idx, d_ind->reason);
|
|
s_conn_ind = ~0;
|
|
break;
|
|
}
|
|
case BLE_5_ATT_INFO_REQ: {
|
|
ble_att_info_req_t *a_ind = (ble_att_info_req_t *)param;
|
|
os_printf("a_ind:conn_idx:%d\r\n", a_ind->conn_idx);
|
|
a_ind->length = 128;
|
|
a_ind->status = BK_ERR_BLE_SUCCESS;
|
|
break;
|
|
}
|
|
case BLE_5_CREATE_DB: {
|
|
ble_create_db_t *cd_ind = (ble_create_db_t *)param;
|
|
|
|
os_printf("cd_ind:prf_id:%d, status:%d\r\n", cd_ind->prf_id, cd_ind->status);
|
|
s_at_cmd_status = cd_ind->status;
|
|
if (ble_boarding_sema != NULL)
|
|
rtos_set_semaphore( &ble_boarding_sema );
|
|
break;
|
|
}
|
|
case BLE_5_INIT_CONNECT_EVENT: {
|
|
ble_conn_ind_t *c_ind = (ble_conn_ind_t *)param;
|
|
os_printf("BLE_5_INIT_CONNECT_EVENT:conn_idx:%d, addr_type:%d, peer_addr:%02x:%02x:%02x:%02x:%02x:%02x\r\n",
|
|
c_ind->conn_idx, c_ind->peer_addr_type, c_ind->peer_addr[0], c_ind->peer_addr[1],
|
|
c_ind->peer_addr[2], c_ind->peer_addr[3], c_ind->peer_addr[4], c_ind->peer_addr[5]);
|
|
break;
|
|
}
|
|
case BLE_5_INIT_DISCONNECT_EVENT: {
|
|
ble_discon_ind_t *d_ind = (ble_discon_ind_t *)param;
|
|
os_printf("BLE_5_INIT_DISCONNECT_EVENT:conn_idx:%d,reason:%d\r\n", d_ind->conn_idx, d_ind->reason);
|
|
break;
|
|
}
|
|
case BLE_5_SDP_REGISTER_FAILED:
|
|
os_printf("BLE_5_SDP_REGISTER_FAILED\r\n");
|
|
break;
|
|
case BLE_5_READ_PHY_EVENT: {
|
|
ble_read_phy_t *phy_param = (ble_read_phy_t *)param;
|
|
os_printf("BLE_5_READ_PHY_EVENT:tx_phy:0x%02x, rx_phy:0x%02x\r\n",phy_param->tx_phy, phy_param->rx_phy);
|
|
break;
|
|
}
|
|
case BLE_5_TX_DONE:
|
|
break;
|
|
case BLE_5_CONN_UPDATA_EVENT: {
|
|
ble_conn_param_t *updata_param = (ble_conn_param_t *)param;
|
|
os_printf("BLE_5_CONN_UPDATA_EVENT:conn_interval:0x%04x, con_latency:0x%04x, sup_to:0x%04x\r\n", updata_param->intv_max,
|
|
updata_param->con_latency, updata_param->sup_to);
|
|
break;
|
|
}
|
|
case BLE_5_PAIRING_REQ:
|
|
bk_printf("BLE_5_PAIRING_REQ\r\n");
|
|
ble_smp_ind_t *s_ind = (ble_smp_ind_t *)param;
|
|
bk_ble_sec_send_auth_mode(s_ind->conn_idx, GAP_AUTH_REQ_NO_MITM_BOND, BK_BLE_GAP_IO_CAP_NO_INPUT_NO_OUTPUT,
|
|
GAP_SEC1_NOAUTH_PAIR_ENC, GAP_OOB_AUTH_DATA_NOT_PRESENT);
|
|
break;
|
|
|
|
case BLE_5_PARING_PASSKEY_REQ:
|
|
bk_printf("BLE_5_PARING_PASSKEY_REQ\r\n");
|
|
break;
|
|
|
|
case BLE_5_ENCRYPT_EVENT:
|
|
bk_printf("BLE_5_ENCRYPT_EVENT\r\n");
|
|
break;
|
|
|
|
case BLE_5_PAIRING_SUCCEED:
|
|
bk_printf("BLE_5_PAIRING_SUCCEED\r\n");
|
|
break;
|
|
case BLE_5_KEY_EVENT:
|
|
{
|
|
bk_printf("BLE_5_KEY_EVENT\r\n");
|
|
s_ble_enc_key = *((bk_ble_key_t*)param);
|
|
break;
|
|
}
|
|
|
|
case BLE_5_BOND_INFO_REQ_EVENT:
|
|
{
|
|
bk_printf("BLE_5_BOND_INFO_REQ_EVENT\r\n");
|
|
bk_ble_bond_info_req_t *bond_info_req = (bk_ble_bond_info_req_t*)param;
|
|
if (((bond_info_req->key.peer_addr_type == s_ble_enc_key.peer_addr_type)
|
|
&& (!os_memcmp(bond_info_req->key.peer_addr, s_ble_enc_key.peer_addr, 6)))
|
|
|| (ble_check_random_bda_is_resolvable(bond_info_req->key.peer_addr, bond_info_req->key.peer_addr_type)))
|
|
{
|
|
bond_info_req->key_found = 1;
|
|
bond_info_req->key = s_ble_enc_key;
|
|
}
|
|
break;
|
|
}
|
|
case BLE_5_PAIRING_FAILED:
|
|
{
|
|
bk_printf("BLE_5_PAIRING_FAILED\r\n");
|
|
os_memset(&s_ble_enc_key, 0 ,sizeof(s_ble_enc_key));
|
|
break;
|
|
}
|
|
case BLE_5_GAP_CMD_CMP_EVENT:
|
|
{
|
|
ble_cmd_cmp_evt_t *event = (ble_cmd_cmp_evt_t *)param;
|
|
|
|
switch(event->cmd) {
|
|
case BLE_CONN_ENCRYPT:
|
|
{
|
|
bk_printf("BLE_5_GAP_CMD_CMP_EVENT(BLE_CONN_ENCRYPT) , status %x\r\n",event->status);
|
|
if (event->status)
|
|
{
|
|
os_memset(&s_ble_enc_key, 0 ,sizeof(s_ble_enc_key));
|
|
bk_ble_disconnect(event->conn_idx);
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
#if CONFIG_AT
|
|
int ble_boarding_handle(int sync,int argc, char **argv)
|
|
{
|
|
if(bk_ble_get_host_stack_type() != BK_BLE_HOST_STACK_TYPE_ETHERMIND)
|
|
{
|
|
return ble_boarding_legacy_handle(sync,argc, argv);
|
|
}else
|
|
{
|
|
return dm_ble_boarding_handle(sync, argc, argv);
|
|
}
|
|
}
|
|
#elif defined(CONFIG_AT_CMD)
|
|
int ble_boarding_handle(char *pcWriteBuffer, int xWriteBufferLen, int argc,char **argv)
|
|
{
|
|
if(bk_ble_get_host_stack_type() != BK_BLE_HOST_STACK_TYPE_ETHERMIND)
|
|
{
|
|
return ble_boarding_legacy_handle(pcWriteBuffer,xWriteBufferLen,argc, argv);
|
|
}else
|
|
{
|
|
return dm_ble_boarding_handle(pcWriteBuffer,xWriteBufferLen, argc, argv);
|
|
}
|
|
}
|
|
|
|
#endif
|
|
int ble_boarding_notify(uint8_t *data, uint16_t length)
|
|
{
|
|
if(s_conn_ind == 0xFF)
|
|
{
|
|
os_printf("BLE is disconnected, can not send data !!!\r\n");
|
|
return BK_FAIL;
|
|
}else
|
|
{
|
|
bk_ble_send_noti_value(s_conn_ind, length, data, PRF_TASK_ID_BOARDING, BOARDING_IDX_CHAR_VALUE);
|
|
return BK_OK;
|
|
}
|
|
}
|
|
|
|
int ble_boarding_init(ble_boarding_info_t *info)
|
|
{
|
|
bt_err_t ret = BK_FAIL;
|
|
struct bk_ble_db_cfg ble_db_cfg;
|
|
|
|
ble_boarding_info = info;
|
|
|
|
ret = rtos_init_semaphore(&ble_boarding_sema, 1);
|
|
if(ret != BK_OK){
|
|
goto error;
|
|
}
|
|
|
|
ble_db_cfg.att_db = (ble_attm_desc_t *)boarding_service_db;
|
|
ble_db_cfg.att_db_nb = BOARDING_IDX_NB;
|
|
ble_db_cfg.prf_task_id = PRF_TASK_ID_BOARDING;
|
|
ble_db_cfg.start_hdl = 0;
|
|
ble_db_cfg.svc_perm = BK_BLE_PERM_SET(SVC_UUID_LEN, UUID_16);
|
|
ble_db_cfg.uuid[0] = BOARDING_SERVICE_UUID & 0xFF;
|
|
ble_db_cfg.uuid[1] = BOARDING_SERVICE_UUID >> 8;
|
|
|
|
bk_ble_set_notice_cb(ble_at_legacy_notice_cb);
|
|
|
|
ret = bk_ble_create_db(&ble_db_cfg);
|
|
|
|
if (ret != BK_ERR_BLE_SUCCESS)
|
|
{
|
|
LOGE("create gatt db failed %d\n", ret);
|
|
goto error;
|
|
}
|
|
|
|
ret = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
|
|
if (ret != BK_OK)
|
|
{
|
|
LOGE("wait semaphore failed at %d, %d\n", ret, __LINE__);
|
|
goto error;
|
|
}
|
|
else
|
|
{
|
|
LOGI("create gatt db success\n");
|
|
}
|
|
|
|
return ret;
|
|
|
|
error:
|
|
|
|
return BK_FAIL;
|
|
}
|
|
#if CONFIG_AT
|
|
#include "at_server.h"
|
|
#endif
|
|
int ble_boarding_adv_start(uint8_t *adv_data, uint16_t adv_len)
|
|
{
|
|
ble_adv_param_t adv_param;
|
|
int actv_idx = 0;
|
|
bt_err_t ret = BK_FAIL;
|
|
|
|
/* set adv paramters */
|
|
os_memset(&adv_param, 0, sizeof(ble_adv_param_t));
|
|
adv_param.chnl_map = 7;
|
|
adv_param.adv_intv_min = 120;
|
|
adv_param.adv_intv_max = 160;
|
|
adv_param.own_addr_type = OWN_ADDR_TYPE_PUBLIC_ADDR;
|
|
adv_param.adv_type = 0;
|
|
adv_param.adv_prop = 3;
|
|
adv_param.prim_phy = 1;
|
|
adv_param.second_phy = 1;
|
|
|
|
ret = bk_ble_create_advertising(actv_idx, &adv_param, ble_at_cmd_cb);
|
|
|
|
if (ret != BK_ERR_BLE_SUCCESS)
|
|
{
|
|
LOGE("config adv paramters failed %d\n", ret);
|
|
goto error;
|
|
}
|
|
|
|
ret = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
|
|
if (ret != BK_OK)
|
|
{
|
|
LOGE("wait semaphore failed at %d, %d\n", ret, __LINE__);
|
|
goto error;
|
|
}
|
|
else
|
|
{
|
|
LOGI("set adv paramters success\n");
|
|
}
|
|
|
|
/* set adv paramters */
|
|
ret = bk_ble_set_adv_data(actv_idx, adv_data, adv_len, ble_at_cmd_cb);
|
|
|
|
if (ret != BK_ERR_BLE_SUCCESS)
|
|
{
|
|
LOGE("set adv data failed %d\n", ret);
|
|
goto error;
|
|
}
|
|
|
|
ret = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
|
|
if (ret != BK_OK)
|
|
{
|
|
LOGE("wait semaphore failed at %d, %d\n", ret, __LINE__);
|
|
goto error;
|
|
}
|
|
else
|
|
{
|
|
LOGI("set adv data success\n");
|
|
}
|
|
|
|
/* sart adv */
|
|
ret = bk_ble_start_advertising(actv_idx, 0, ble_at_cmd_cb);
|
|
|
|
if (ret != BK_ERR_BLE_SUCCESS)
|
|
{
|
|
LOGE("start adv failed %d\n", ret);
|
|
goto error;
|
|
}
|
|
|
|
ret = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
|
|
if (ret != BK_OK)
|
|
{
|
|
LOGE("wait semaphore failed at %d, %d\n", ret, __LINE__);
|
|
goto error;
|
|
}
|
|
else
|
|
{
|
|
LOGI("sart adv success\n");
|
|
}
|
|
|
|
return ret;
|
|
|
|
error:
|
|
|
|
return BK_FAIL;
|
|
}
|
|
|
|
#if CONFIG_AT
|
|
int ble_boarding_legacy_handle(int sync,int argc, char **argv)
|
|
{
|
|
int err = kNoErr;
|
|
uint16 service_uuid = 0xFFFF;
|
|
uint16 char_uuid = 0x1234;
|
|
struct bk_ble_db_cfg ble_db_cfg;
|
|
|
|
int actv_idx = 0;
|
|
uint8_t adv_data[31];
|
|
uint8_t adv_len = 0;
|
|
|
|
ble_adv_param_t adv_param;
|
|
|
|
if (argc != 2) {
|
|
os_printf("\nThe number of param is wrong!\n");
|
|
err = kParamErr;
|
|
goto error;
|
|
}
|
|
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
ble_boarding_info = os_malloc(sizeof(ble_boarding_info_t));
|
|
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
LOGE("ble_boarding_info malloc failed\n");
|
|
|
|
goto error;
|
|
}
|
|
|
|
os_memset(ble_boarding_info, 0, sizeof(ble_boarding_info_t));
|
|
}
|
|
|
|
err = rtos_init_semaphore(&ble_boarding_sema, 1);
|
|
if(err != kNoErr){
|
|
goto error;
|
|
}
|
|
|
|
os_memcpy(&(boarding_service_db[BOARDING_IDX_CHAR_VALUE].uuid[0]), &char_uuid, 2);
|
|
os_memset(&ble_db_cfg, 0, sizeof(ble_db_cfg));
|
|
|
|
ble_db_cfg.att_db = (ble_attm_desc_t *)boarding_service_db;
|
|
ble_db_cfg.att_db_nb = BOARDING_IDX_NB;
|
|
ble_db_cfg.prf_task_id = PRF_TASK_ID_BOARDING;
|
|
ble_db_cfg.start_hdl = 0;
|
|
ble_db_cfg.svc_perm = BK_BLE_PERM_SET(SVC_UUID_LEN, UUID_16);
|
|
os_memcpy(&(ble_db_cfg.uuid[0]), &service_uuid, 2);
|
|
|
|
bk_ble_set_notice_cb(ble_at_legacy_notice_cb);
|
|
// register_app_sdp_charac_callback(ble_sdp_charac_callback);
|
|
err = bk_ble_create_db(&ble_db_cfg);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
atsvr_cmd_rsp_ok();
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("creat boarding service successfully!\r\n");
|
|
|
|
os_memset(&adv_param, 0, sizeof(ble_adv_param_t));
|
|
adv_param.chnl_map = 7;
|
|
adv_param.adv_intv_min = 120;
|
|
adv_param.adv_intv_max = 160;
|
|
adv_param.own_addr_type = OWN_ADDR_TYPE_PUBLIC_ADDR;
|
|
adv_param.adv_type = 0;
|
|
adv_param.adv_prop = 3;
|
|
adv_param.prim_phy = 1;
|
|
adv_param.second_phy = 1;
|
|
|
|
err = bk_ble_create_advertising(actv_idx, &adv_param, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
atsvr_cmd_rsp_ok();
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("set adv param and creat adv successfully!\r\n");
|
|
|
|
adv_len = os_strtoul(argv[1], NULL, 16) & 0xFF;
|
|
if (adv_len > 31 || adv_len != os_strlen(argv[0]) / 2)
|
|
{
|
|
os_printf("input adv len over limited\n");
|
|
err = kParamErr;
|
|
goto error;
|
|
}
|
|
at_set_data_handle(adv_data, argv[0], os_strlen(argv[0]));
|
|
|
|
err = bk_ble_set_adv_data(actv_idx, adv_data, adv_len, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
atsvr_cmd_rsp_ok();
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("set adv data successfully!\r\n");
|
|
|
|
err = bk_ble_start_advertising(actv_idx, 0, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS)
|
|
{
|
|
atsvr_cmd_rsp_ok();
|
|
rtos_deinit_semaphore(&ble_boarding_sema);
|
|
os_printf("start adv successfully!\r\n");
|
|
return err;
|
|
}
|
|
else
|
|
{
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
|
|
error:
|
|
atsvr_cmd_rsp_error();
|
|
if (ble_boarding_sema != NULL)
|
|
rtos_deinit_semaphore(&ble_boarding_sema);
|
|
return err;
|
|
}
|
|
#elif defined(CONFIG_AT_CMD)
|
|
int ble_boarding_legacy_handle(char *pcWriteBuffer, int xWriteBufferLen, int argc, char **argv)
|
|
{
|
|
int err = kNoErr;
|
|
char *msg = NULL;
|
|
uint16 service_uuid = 0xFFFF;
|
|
uint16 char_uuid = 0x1234;
|
|
struct bk_ble_db_cfg ble_db_cfg;
|
|
|
|
int actv_idx = 0;
|
|
uint8_t adv_data[31];
|
|
uint8_t adv_len = 0;
|
|
|
|
ble_adv_param_t adv_param;
|
|
|
|
if (argc != 2) {
|
|
os_printf("\nThe number of param is wrong!\n");
|
|
err = kParamErr;
|
|
goto error;
|
|
}
|
|
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
ble_boarding_info = os_malloc(sizeof(ble_boarding_info_t));
|
|
|
|
if (ble_boarding_info == NULL)
|
|
{
|
|
LOGE("ble_boarding_info malloc failed\n");
|
|
|
|
goto error;
|
|
}
|
|
|
|
os_memset(ble_boarding_info, 0, sizeof(ble_boarding_info_t));
|
|
}
|
|
|
|
err = rtos_init_semaphore(&ble_boarding_sema, 1);
|
|
if(err != kNoErr){
|
|
goto error;
|
|
}
|
|
|
|
os_memcpy(&(boarding_service_db[BOARDING_IDX_CHAR_VALUE].uuid[0]), &char_uuid, 2);
|
|
os_memset(&ble_db_cfg, 0, sizeof(ble_db_cfg));
|
|
|
|
ble_db_cfg.att_db = (ble_attm_desc_t *)boarding_service_db;
|
|
ble_db_cfg.att_db_nb = BOARDING_IDX_NB;
|
|
ble_db_cfg.prf_task_id = PRF_TASK_ID_BOARDING;
|
|
ble_db_cfg.start_hdl = 0;
|
|
ble_db_cfg.svc_perm = BK_BLE_PERM_SET(SVC_UUID_LEN, UUID_16);
|
|
os_memcpy(&(ble_db_cfg.uuid[0]), &service_uuid, 2);
|
|
|
|
bk_ble_set_notice_cb(ble_at_legacy_notice_cb);
|
|
// register_app_sdp_charac_callback(ble_sdp_charac_callback);
|
|
err = bk_ble_create_db(&ble_db_cfg);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
msg = AT_CMD_RSP_SUCCEED;
|
|
os_memcpy(pcWriteBuffer, msg, os_strlen(msg));
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("creat boarding service successfully!\r\n");
|
|
|
|
os_memset(&adv_param, 0, sizeof(ble_adv_param_t));
|
|
adv_param.chnl_map = 7;
|
|
adv_param.adv_intv_min = 120;
|
|
adv_param.adv_intv_max = 160;
|
|
adv_param.own_addr_type = OWN_ADDR_TYPE_PUBLIC_ADDR;
|
|
adv_param.adv_type = 0;
|
|
adv_param.adv_prop = 3;
|
|
adv_param.prim_phy = 1;
|
|
adv_param.second_phy = 1;
|
|
|
|
err = bk_ble_create_advertising(actv_idx, &adv_param, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
msg = AT_CMD_RSP_SUCCEED;
|
|
os_memcpy(pcWriteBuffer, msg, os_strlen(msg));
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("set adv param and creat adv successfully!\r\n");
|
|
|
|
adv_len = os_strtoul(argv[1], NULL, 16) & 0xFF;
|
|
if (adv_len > 31 || adv_len != os_strlen(argv[0]) / 2)
|
|
{
|
|
os_printf("input adv len over limited\n");
|
|
err = kParamErr;
|
|
goto error;
|
|
}
|
|
at_set_data_handle(adv_data, argv[0], os_strlen(argv[0]));
|
|
|
|
err = bk_ble_set_adv_data(actv_idx, adv_data, adv_len, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
err = rtos_get_semaphore(&ble_boarding_sema, AT_SYNC_CMD_TIMEOUT_MS);
|
|
if (err != kNoErr){
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS) {
|
|
msg = AT_CMD_RSP_SUCCEED;
|
|
os_memcpy(pcWriteBuffer, msg, os_strlen(msg));
|
|
} else {
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
os_printf("set adv data successfully!\r\n");
|
|
|
|
err = bk_ble_start_advertising(actv_idx, 0, ble_at_cmd_cb);
|
|
if (err != BK_ERR_BLE_SUCCESS) {
|
|
goto error;
|
|
} else {
|
|
if (s_at_cmd_status == BK_ERR_BLE_SUCCESS)
|
|
{
|
|
msg = AT_CMD_RSP_SUCCEED;
|
|
os_memcpy(pcWriteBuffer, msg, os_strlen(msg));
|
|
rtos_deinit_semaphore(&ble_boarding_sema);
|
|
os_printf("start adv successfully!\r\n");
|
|
return err;
|
|
}
|
|
else
|
|
{
|
|
err = s_at_cmd_status;
|
|
s_at_cmd_status = BK_ERR_BLE_SUCCESS;
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
|
|
error:
|
|
msg = AT_CMD_RSP_ERROR;
|
|
os_memcpy(pcWriteBuffer, msg, os_strlen(msg));
|
|
if (ble_boarding_sema != NULL)
|
|
rtos_deinit_semaphore(&ble_boarding_sema);
|
|
return err;
|
|
}
|
|
|
|
#endif
|
|
#endif
|
|
|