.
This commit is contained in:
Ben V. Brown
@@ -13,8 +13,9 @@ NOTES
|
||||
#include <stdbool.h>
|
||||
#include <stdlib.h>
|
||||
#include <FreeRTOS.h>
|
||||
#include "bflb_platform.h"
|
||||
#include <task.h>
|
||||
|
||||
#include "BSP.h"
|
||||
#include "bluetooth.h"
|
||||
#include "conn.h"
|
||||
#include "gatt.h"
|
||||
@@ -23,291 +24,7 @@ NOTES
|
||||
#include "ble_peripheral_tp_server.h"
|
||||
#include "log.h"
|
||||
#include "bl702_glb.h"
|
||||
static void ble_tp_connected(struct bt_conn *conn, u8_t err);
|
||||
static void ble_tp_disconnected(struct bt_conn *conn, u8_t reason);
|
||||
|
||||
static struct bt_conn *ble_tp_conn;
|
||||
#if !defined(CONFIG_BT_OAD_SERVER)
|
||||
static struct bt_gatt_exchange_params exchg_mtu;
|
||||
#endif
|
||||
static TaskHandle_t ble_tp_task_h;
|
||||
|
||||
static struct k_sem notify_poll_sem;
|
||||
|
||||
static int tx_mtu_size = 20;
|
||||
static u8_t created_tp_task = 0;
|
||||
static u8_t isRegister = 0;
|
||||
|
||||
static struct bt_conn_cb ble_tp_conn_callbacks = {
|
||||
.connected = ble_tp_connected,
|
||||
.disconnected = ble_tp_disconnected,
|
||||
};
|
||||
|
||||
#if !defined(CONFIG_BT_OAD_SERVER)
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_tx_mtu_size
|
||||
*/
|
||||
static void ble_tp_tx_mtu_size(struct bt_conn *conn, u8_t err,
|
||||
struct bt_gatt_exchange_params *params)
|
||||
{
|
||||
if (!err) {
|
||||
tx_mtu_size = bt_gatt_get_mtu(ble_tp_conn);
|
||||
BT_WARN("ble tp echange mtu size success, mtu size: %d", tx_mtu_size);
|
||||
} else {
|
||||
BT_WARN("ble tp echange mtu size failure, err: %d", err);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_connected
|
||||
*/
|
||||
static void ble_tp_connected(struct bt_conn *conn, u8_t err)
|
||||
{
|
||||
#if !defined(CONFIG_BT_OAD_SERVER)
|
||||
int tx_octets = 0x00fb;
|
||||
int tx_time = 0x0848;
|
||||
int ret = -1;
|
||||
#endif
|
||||
|
||||
if (err) {
|
||||
return;
|
||||
}
|
||||
|
||||
BT_WARN("Tp connected");
|
||||
ble_tp_conn = conn;
|
||||
|
||||
#if !defined(CONFIG_BT_OAD_SERVER)
|
||||
//set data length after connected.
|
||||
ret = bt_le_set_data_len(ble_tp_conn, tx_octets, tx_time);
|
||||
|
||||
if (!ret) {
|
||||
BT_WARN("ble tp set data length success");
|
||||
} else {
|
||||
BT_WARN("ble tp set data length failure, err: %d", ret);
|
||||
}
|
||||
|
||||
//exchange mtu size after connected.
|
||||
exchg_mtu.func = ble_tp_tx_mtu_size;
|
||||
ret = bt_gatt_exchange_mtu(ble_tp_conn, &exchg_mtu);
|
||||
|
||||
if (!ret) {
|
||||
BT_WARN("ble tp exchange mtu size pending");
|
||||
} else {
|
||||
BT_WARN("ble tp exchange mtu size failure, err: %d", ret);
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_disconnected
|
||||
*/
|
||||
static void ble_tp_disconnected(struct bt_conn *conn, u8_t reason)
|
||||
{
|
||||
BT_WARN("Tp disconnected");
|
||||
|
||||
if (created_tp_task) {
|
||||
BT_WARN("Delete throughput tx task");
|
||||
vTaskDelete(ble_tp_task_h);
|
||||
created_tp_task = 0;
|
||||
}
|
||||
|
||||
ble_tp_conn = NULL;
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_recv_rd
|
||||
*/
|
||||
static int ble_tp_recv_rd(struct bt_conn *conn, const struct bt_gatt_attr *attr,
|
||||
void *buf, u16_t len, u16_t offset)
|
||||
{
|
||||
int size = 9;
|
||||
char data[9] = { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09 };
|
||||
|
||||
memcpy(buf, data, size);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_recv_wr(receive data from client)
|
||||
*/
|
||||
static int ble_tp_recv_wr(struct bt_conn *conn, const struct bt_gatt_attr *attr,
|
||||
const void *buf, u16_t len, u16_t offset, u8_t flags)
|
||||
{
|
||||
BT_WARN("recv data len=%d, offset=%d, flag=%d", len, offset, flags);
|
||||
BT_WARN("recv data:%s", bt_hex(buf, len));
|
||||
|
||||
if (flags & BT_GATT_WRITE_FLAG_PREPARE) {
|
||||
//Don't use prepare write data, execute write will upload data again.
|
||||
BT_WARN("recv prepare write request");
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (flags & BT_GATT_WRITE_FLAG_CMD) {
|
||||
//Use write command data.
|
||||
BT_WARN("recv write command");
|
||||
} else {
|
||||
//Use write request / execute write data.
|
||||
BT_WARN("recv write request / exce write");
|
||||
}
|
||||
|
||||
k_sem_give(¬ify_poll_sem);
|
||||
return len;
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
indicate_rsp /bl_tp_send_indicate
|
||||
*/
|
||||
|
||||
static void indicate_rsp(struct bt_conn *conn, const struct bt_gatt_attr *attr, u8_t err)
|
||||
{
|
||||
BT_WARN("receive comfirmation, err:%d", err);
|
||||
}
|
||||
|
||||
static int bl_tp_send_indicate(struct bt_conn *conn, const struct bt_gatt_attr *attr,
|
||||
const void *data, u16_t len)
|
||||
{
|
||||
static struct bt_gatt_indicate_params ind_params;
|
||||
|
||||
ind_params.attr = attr;
|
||||
ind_params.data = data;
|
||||
ind_params.len = len;
|
||||
ind_params.func = indicate_rsp;
|
||||
ind_params.uuid = NULL;
|
||||
|
||||
return bt_gatt_indicate(conn, &ind_params);
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_ind_ccc_changed
|
||||
*/
|
||||
static void ble_tp_ind_ccc_changed(const struct bt_gatt_attr *attr, u16_t value)
|
||||
{
|
||||
int err = -1;
|
||||
char data[9] = { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09 };
|
||||
|
||||
if (value == BT_GATT_CCC_INDICATE) {
|
||||
err = bl_tp_send_indicate(ble_tp_conn, get_attr(BT_CHAR_BLE_TP_IND_ATTR_VAL_INDEX), data, 9);
|
||||
BT_WARN("ble tp send indatcate: %d", err);
|
||||
}
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_notify(send data to client)
|
||||
*/
|
||||
static void ble_tp_notify_task(void *pvParameters)
|
||||
{
|
||||
int err = -1;
|
||||
u8_t data[244] = { 0x01 };
|
||||
k_sem_give(¬ify_poll_sem);
|
||||
|
||||
while (1) {
|
||||
k_sem_take(¬ify_poll_sem, K_FOREVER);
|
||||
//send data to client
|
||||
err = bt_gatt_notify(ble_tp_conn, get_attr(BT_CHAR_BLE_TP_NOT_ATTR_VAL_INDEX), data, (tx_mtu_size - 3));
|
||||
data[0] = data[0] + 1;
|
||||
BT_WARN("ble tp send notify : %d", err);
|
||||
}
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_not_ccc_changed
|
||||
*/
|
||||
static void ble_tp_notify_ccc_changed(const struct bt_gatt_attr *attr, u16_t value)
|
||||
{
|
||||
BT_WARN("ccc:value=[%d]", value);
|
||||
|
||||
if (value == BT_GATT_CCC_NOTIFY) {
|
||||
|
||||
if (xTaskCreate(ble_tp_notify_task, (char *)"bletp", 512, NULL, 15, &ble_tp_task_h) == pdPASS) {
|
||||
created_tp_task = 1;
|
||||
BT_WARN("Create throughput tx task success");
|
||||
} else {
|
||||
created_tp_task = 0;
|
||||
BT_WARN("Create throughput tx taskfail");
|
||||
}
|
||||
} else {
|
||||
if (created_tp_task) {
|
||||
BT_WARN("Delete throughput tx task");
|
||||
vTaskDelete(ble_tp_task_h);
|
||||
created_tp_task = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*************************************************************************
|
||||
* DEFINE : attrs
|
||||
*/
|
||||
static struct bt_gatt_attr attrs[] = {
|
||||
BT_GATT_PRIMARY_SERVICE(BT_UUID_SVC_BLE_TP),
|
||||
|
||||
BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_TP_RD,
|
||||
BT_GATT_CHRC_READ,
|
||||
BT_GATT_PERM_READ,
|
||||
ble_tp_recv_rd,
|
||||
NULL,
|
||||
NULL),
|
||||
|
||||
BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_TP_WR,
|
||||
BT_GATT_CHRC_WRITE | BT_GATT_CHRC_WRITE_WITHOUT_RESP,
|
||||
BT_GATT_PERM_WRITE | BT_GATT_PERM_PREPARE_WRITE,
|
||||
NULL,
|
||||
ble_tp_recv_wr,
|
||||
NULL),
|
||||
|
||||
BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_TP_IND,
|
||||
BT_GATT_CHRC_INDICATE,
|
||||
0,
|
||||
NULL,
|
||||
NULL,
|
||||
NULL),
|
||||
|
||||
BT_GATT_CCC(ble_tp_ind_ccc_changed, BT_GATT_PERM_READ | BT_GATT_PERM_WRITE),
|
||||
|
||||
BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_TP_NOT,
|
||||
BT_GATT_CHRC_NOTIFY,
|
||||
0,
|
||||
NULL,
|
||||
NULL,
|
||||
NULL),
|
||||
|
||||
BT_GATT_CCC(ble_tp_notify_ccc_changed, BT_GATT_PERM_READ | BT_GATT_PERM_WRITE)
|
||||
|
||||
};
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
get_attr
|
||||
*/
|
||||
struct bt_gatt_attr *get_attr(u8_t index)
|
||||
{
|
||||
return &attrs[index];
|
||||
}
|
||||
|
||||
static struct bt_gatt_service ble_tp_server = BT_GATT_SERVICE(attrs);
|
||||
|
||||
/*************************************************************************
|
||||
NAME
|
||||
ble_tp_init
|
||||
*/
|
||||
void ble_tp_init()
|
||||
{
|
||||
if (!isRegister) {
|
||||
isRegister = 1;
|
||||
bt_conn_cb_register(&ble_tp_conn_callbacks);
|
||||
bt_gatt_service_register(&ble_tp_server);
|
||||
k_sem_init(¬ify_poll_sem, 0, 1);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -351,3 +68,39 @@ void ble_stack_start(void)
|
||||
MSG("[OS] bt_enable...\r\n");
|
||||
bt_enable(bt_enable_cb);
|
||||
}
|
||||
|
||||
|
||||
|
||||
/* configSUPPORT_STATIC_ALLOCATION and configUSE_TIMERS are both set to 1, so the
|
||||
application must provide an implementation of vApplicationGetTimerTaskMemory()
|
||||
to provide the memory that is used by the Timer service task. */
|
||||
void vApplicationGetTimerTaskMemory(StaticTask_t **ppxTimerTaskTCBBuffer, StackType_t **ppxTimerTaskStackBuffer, uint32_t *pulTimerTaskStackSize)
|
||||
{
|
||||
/* If the buffers to be provided to the Timer task are declared inside this
|
||||
function then they must be declared static - otherwise they will be allocated on
|
||||
the stack and so not exists after this function exits. */
|
||||
static StaticTask_t xTimerTaskTCB;
|
||||
static StackType_t uxTimerTaskStack[configTIMER_TASK_STACK_DEPTH];
|
||||
|
||||
/* Pass out a pointer to the StaticTask_t structure in which the Timer
|
||||
task's state will be stored. */
|
||||
*ppxTimerTaskTCBBuffer = &xTimerTaskTCB;
|
||||
|
||||
/* Pass out the array that will be used as the Timer task's stack. */
|
||||
*ppxTimerTaskStackBuffer = uxTimerTaskStack;
|
||||
|
||||
/* Pass out the size of the array pointed to by *ppxTimerTaskStackBuffer.
|
||||
Note that, as the array is necessarily of type StackType_t,
|
||||
configTIMER_TASK_STACK_DEPTH is specified in words, not bytes. */
|
||||
*pulTimerTaskStackSize = configTIMER_TASK_STACK_DEPTH;
|
||||
}
|
||||
|
||||
|
||||
|
||||
void vApplicationMallocFailedHook(void)
|
||||
{
|
||||
MSG("vApplicationMallocFailedHook\r\n");
|
||||
|
||||
while (1)
|
||||
;
|
||||
}
|
||||
Reference in New Issue
Block a user