146 lines
2.9 KiB
C
146 lines
2.9 KiB
C
|
/**
|
||
|
|
****************************************************************************************
|
||
|
|
*
|
||
|
|
* @file proc.c
|
||
|
|
*
|
||
|
|
* @brief user procedure.
|
||
|
|
*
|
||
|
|
****************************************************************************************
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "b6x.h"
|
||
|
|
#include "bledef.h"
|
||
|
|
#include "drvs.h"
|
||
|
|
|
||
|
|
#include "app.h"
|
||
|
|
#include "prf_sess.h"
|
||
|
|
#include "uartRb.h"
|
||
|
|
|
||
|
|
#if (DBG_PROC)
|
||
|
|
#include "dbg.h"
|
||
|
|
#define DEBUG(format, ...) debug("<%s,%d>" format "\r\n", __MODULE__, __LINE__, ##__VA_ARGS__)
|
||
|
|
#else
|
||
|
|
#define DEBUG(format, ...)
|
||
|
|
#define debugHex(dat, len)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* DEFINES
|
||
|
|
****************************************************************************************
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define BLE_MAX_LEN (BLE_MTU - 3)
|
||
|
|
#define NULL_CNT 20
|
||
|
|
|
||
|
|
static uint8_t buff[BLE_MAX_LEN];
|
||
|
|
static uint16_t buff_len = 0;
|
||
|
|
|
||
|
|
bool speed_test = 0;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* FUNCTIONS
|
||
|
|
****************************************************************************************
|
||
|
|
*/
|
||
|
|
|
||
|
|
#if !(DBG_SESS)
|
||
|
|
/// Override - Callback on received data from peer device
|
||
|
|
void sess_cb_rxd(uint8_t conidx, uint16_t len, const uint8_t *data)
|
||
|
|
{
|
||
|
|
uart_send(UART1_PORT, len, data);
|
||
|
|
}
|
||
|
|
#endif //!(DBG_SESS)
|
||
|
|
|
||
|
|
/// Uart Data procedure
|
||
|
|
static void data_proc(void)
|
||
|
|
{
|
||
|
|
// Todo Loop-Proc
|
||
|
|
static uint8_t null_cnt = 0;
|
||
|
|
uint16_t len;
|
||
|
|
|
||
|
|
len = uart1Rb_Read(&buff[buff_len], BLE_MAX_LEN - buff_len);
|
||
|
|
if (len > 0)
|
||
|
|
{
|
||
|
|
buff_len += len;
|
||
|
|
if (buff_len < BLE_MAX_LEN)
|
||
|
|
{
|
||
|
|
return; // wait full
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
if ((buff_len > 0) && (null_cnt++ > NULL_CNT))
|
||
|
|
{
|
||
|
|
//finish = true;
|
||
|
|
null_cnt = 0;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
return; // wait again
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (app_state_get() == APP_CONNECTED)
|
||
|
|
{
|
||
|
|
if (buff[0] == 0xAA)
|
||
|
|
{
|
||
|
|
speed_test = false;
|
||
|
|
DEBUG("GAP Disc!\r\n");
|
||
|
|
gapc_disconnect(app_env.curidx);
|
||
|
|
buff_len = 0;
|
||
|
|
}
|
||
|
|
else if (buff[0] == 'S')
|
||
|
|
{
|
||
|
|
speed_test = true;
|
||
|
|
buff_len = 0;
|
||
|
|
}
|
||
|
|
else if (sess_txd_send(app_env.curidx, buff_len, buff) == LE_SUCCESS)
|
||
|
|
{
|
||
|
|
debugHex(buff, buff_len);
|
||
|
|
buff_len = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
// goto reset
|
||
|
|
if (buff[0] == 0xAA)
|
||
|
|
{
|
||
|
|
DEBUG("GAP Reset!\r\n");
|
||
|
|
gapm_reset();
|
||
|
|
}
|
||
|
|
|
||
|
|
buff_len = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#if (CFG_SLEEP)
|
||
|
|
static void sleep_proc(void)
|
||
|
|
{
|
||
|
|
uint8_t lpsta = ble_sleep(BLE_SLP_TWOSC, BLE_SLP_DURMAX);
|
||
|
|
|
||
|
|
if (lpsta == BLE_IN_SLEEP)
|
||
|
|
{
|
||
|
|
uint16_t lpret = core_sleep(CFG_WKUP_BLE_EN);
|
||
|
|
//DEBUG("ble sta:%d, wksrc:%X", lpsta, lpret);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
//DEBUG("ble sta:%d", lpsta);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
#endif //(CFG_SLEEP)
|
||
|
|
|
||
|
|
void user_procedure(void)
|
||
|
|
{
|
||
|
|
#if (CFG_SLEEP)
|
||
|
|
sleep_proc();
|
||
|
|
#endif //(CFG_SLEEP)
|
||
|
|
|
||
|
|
data_proc();
|
||
|
|
|
||
|
|
if ((app_state_get() == APP_CONNECTED) && (speed_test))
|
||
|
|
{
|
||
|
|
sess_txd_send(app_env.curidx, BLE_MAX_LEN, buff);
|
||
|
|
}
|
||
|
|
}
|