366 lines
12 KiB
C
366 lines
12 KiB
C
/********************************** (C) COPYRIGHT *******************************
|
|
* File Name : ble_usb_service.c
|
|
* Author : WCH
|
|
* Version : V1.1
|
|
* Date : 2022/01/19
|
|
* Description :
|
|
*********************************************************************************
|
|
* Copyright (c) 2021 Nanjing Qinheng Microelectronics Co., Ltd.
|
|
* Attention: This software (modified or not) and binary are used for
|
|
* microcontroller manufactured by Nanjing Qinheng Microelectronics.
|
|
*******************************************************************************/
|
|
|
|
/*********************************************************************
|
|
* INCLUDES
|
|
*/
|
|
|
|
#include "CONFIG.h"
|
|
#include "gattprofile.h"
|
|
#include "stdint.h"
|
|
#include "ble_usb_service.h"
|
|
|
|
|
|
/*********************************************************************
|
|
* MACROS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* CONSTANTS
|
|
*/
|
|
|
|
#define SERVAPP_NUM_ATTR_SUPPORTED 7
|
|
|
|
#define RAWPASS_TX_VALUE_HANDLE 2
|
|
#define RAWPASS_RX_VALUE_HANDLE 5
|
|
/*********************************************************************
|
|
* TYPEDEFS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* GLOBAL VARIABLES
|
|
*/
|
|
|
|
// ble_usb GATT Profile Service UUID
|
|
const uint8_t ble_usb_ServiceUUID[ATT_BT_UUID_SIZE] =
|
|
{0xf0, 0xff};
|
|
|
|
// Characteristic rx uuid
|
|
const uint8_t ble_usb_RxCharUUID[ATT_BT_UUID_SIZE] =
|
|
{0xf2, 0xff};
|
|
|
|
// Characteristic tx uuid
|
|
const uint8_t ble_usb_TxCharUUID[ATT_BT_UUID_SIZE] =
|
|
{0xf1, 0xff};
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL VARIABLES
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* LOCAL VARIABLES
|
|
*/
|
|
|
|
static ble_usb_ProfileChangeCB_t ble_usb_AppCBs = NULL;
|
|
|
|
/*********************************************************************
|
|
* Profile Attributes - variables
|
|
*/
|
|
|
|
// Profile Service attribute
|
|
static const gattAttrType_t ble_usb_Service = {ATT_BT_UUID_SIZE, ble_usb_ServiceUUID};
|
|
|
|
// Profile Characteristic 1 Properties
|
|
//static uint8_t ble_usb_RxCharProps = GATT_PROP_WRITE_NO_RSP| GATT_PROP_WRITE;
|
|
static uint8_t ble_usb_RxCharProps = GATT_PROP_WRITE_NO_RSP | GATT_PROP_WRITE;
|
|
|
|
// Characteristic 1 Value
|
|
static uint8_t ble_usb_RxCharValue[BLE_USB_RX_BUFF_SIZE];
|
|
//static uint8_t ble_usb_RxCharValue[1];
|
|
|
|
// Profile Characteristic 2 Properties
|
|
//static uint8_t ble_usb_TxCharProps = GATT_PROP_NOTIFY| GATT_PROP_INDICATE;
|
|
static uint8_t ble_usb_TxCharProps = GATT_PROP_NOTIFY;
|
|
|
|
// Characteristic 2 Value
|
|
static uint8_t ble_usb_TxCharValue = 0;
|
|
|
|
// Simple Profile Characteristic 2 User Description
|
|
static gattCharCfg_t ble_usb_TxCCCD[4];
|
|
|
|
/*********************************************************************
|
|
* Profile Attributes - Table
|
|
*/
|
|
|
|
static gattAttribute_t ble_usb_ProfileAttrTbl[] = {
|
|
// Simple Profile Service
|
|
{
|
|
{ATT_BT_UUID_SIZE, primaryServiceUUID}, /* type */
|
|
GATT_PERMIT_READ, /* permissions */
|
|
0, /* handle */
|
|
(uint8_t *)&ble_usb_Service /* pValue */
|
|
},
|
|
|
|
// Characteristic 2 Declaration
|
|
{
|
|
{ATT_BT_UUID_SIZE, characterUUID},
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
&ble_usb_TxCharProps},
|
|
|
|
// Characteristic Value 2
|
|
{
|
|
{ATT_BT_UUID_SIZE, ble_usb_TxCharUUID},
|
|
0,
|
|
0,
|
|
(uint8_t *)&ble_usb_TxCharValue},
|
|
|
|
// Characteristic 2 User Description
|
|
{
|
|
{ATT_BT_UUID_SIZE, clientCharCfgUUID},
|
|
GATT_PERMIT_READ | GATT_PERMIT_WRITE,
|
|
0,
|
|
(uint8_t *)ble_usb_TxCCCD},
|
|
|
|
// Characteristic 1 Declaration
|
|
{
|
|
{ATT_BT_UUID_SIZE, characterUUID},
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
&ble_usb_RxCharProps},
|
|
|
|
// Characteristic Value 1
|
|
{
|
|
{ATT_BT_UUID_SIZE, ble_usb_RxCharUUID},
|
|
GATT_PERMIT_WRITE,
|
|
0,
|
|
&ble_usb_RxCharValue[0]},
|
|
|
|
};
|
|
|
|
/*********************************************************************
|
|
* LOCAL FUNCTIONS
|
|
*/
|
|
static bStatus_t ble_usb_ReadAttrCB(uint16_t connHandle, gattAttribute_t *pAttr,
|
|
uint8_t *pValue, uint16_t *pLen, uint16_t offset, uint16_t maxLen, uint8_t method);
|
|
static bStatus_t ble_usb_WriteAttrCB(uint16_t connHandle, gattAttribute_t *pAttr,
|
|
uint8_t *pValue, uint16_t len, uint16_t offset, uint8_t method);
|
|
|
|
static void ble_usb_HandleConnStatusCB(uint16_t connHandle, uint8_t changeType);
|
|
|
|
/*********************************************************************
|
|
* PROFILE CALLBACKS
|
|
*/
|
|
// Simple Profile Service Callbacks
|
|
gattServiceCBs_t ble_usb_ProfileCBs = {
|
|
ble_usb_ReadAttrCB, // Read callback function pointer
|
|
ble_usb_WriteAttrCB, // Write callback function pointer
|
|
NULL // Authorization callback function pointer
|
|
};
|
|
|
|
/*********************************************************************
|
|
* PUBLIC FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* @fn ble_usb_AddService
|
|
*
|
|
* @brief Initializes the Simple Profile service by registering
|
|
* GATT attributes with the GATT server.
|
|
*
|
|
* @param services - services to add. This is a bit map and can
|
|
* contain more than one service.
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
bStatus_t ble_usb_add_service(ble_usb_ProfileChangeCB_t cb)
|
|
{
|
|
uint8_t status = SUCCESS;
|
|
|
|
GATTServApp_InitCharCfg(INVALID_CONNHANDLE, ble_usb_TxCCCD);
|
|
// Register with Link DB to receive link status change callback
|
|
linkDB_Register(ble_usb_HandleConnStatusCB);
|
|
|
|
// ble_usb_TxCCCD.connHandle = INVALID_CONNHANDLE;
|
|
// ble_usb_TxCCCD.value = 0;
|
|
// Register GATT attribute list and CBs with GATT Server App
|
|
status = GATTServApp_RegisterService(ble_usb_ProfileAttrTbl,
|
|
GATT_NUM_ATTRS(ble_usb_ProfileAttrTbl),
|
|
GATT_MAX_ENCRYPT_KEY_SIZE,
|
|
&ble_usb_ProfileCBs);
|
|
if(status != SUCCESS)
|
|
PRINT("Add ble usb service failed!\n");
|
|
ble_usb_AppCBs = cb;
|
|
|
|
return (status);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn ble_usb_ReadAttrCB
|
|
*
|
|
* @brief Read an attribute.
|
|
*
|
|
* @param connHandle - connection message was received on
|
|
* @param pAttr - pointer to attribute
|
|
* @param pValue - pointer to data to be read
|
|
* @param pLen - length of data to be read
|
|
* @param offset - offset of the first octet to be read
|
|
* @param maxLen - maximum length of data to be read
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
static bStatus_t ble_usb_ReadAttrCB(uint16_t connHandle, gattAttribute_t *pAttr,
|
|
uint8_t *pValue, uint16_t *pLen, uint16_t offset, uint16_t maxLen, uint8_t method)
|
|
{
|
|
bStatus_t status = SUCCESS;
|
|
PRINT("ReadAttrCB\n");
|
|
// Make sure it's not a blob operation (no attributes in the profile are long)
|
|
if(pAttr->type.len == ATT_BT_UUID_SIZE)
|
|
{
|
|
// 16-bit UUID
|
|
uint16_t uuid = BUILD_UINT16(pAttr->type.uuid[0], pAttr->type.uuid[1]);
|
|
if(uuid == GATT_CLIENT_CHAR_CFG_UUID)
|
|
{
|
|
*pLen = 2;
|
|
tmos_memcpy(pValue, pAttr->pValue, 2);
|
|
}
|
|
}
|
|
return (status);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn simpleProfile_WriteAttrCB
|
|
*
|
|
* @brief Validate attribute data prior to a write operation
|
|
*
|
|
* @param connHandle - connection message was received on
|
|
* @param pAttr - pointer to attribute
|
|
* @param pValue - pointer to data to be written
|
|
* @param len - length of data
|
|
* @param offset - offset of the first octet to be written
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
|
|
static bStatus_t ble_usb_WriteAttrCB(uint16_t connHandle, gattAttribute_t *pAttr,
|
|
uint8_t *pValue, uint16_t len, uint16_t offset, uint8_t method)
|
|
{
|
|
bStatus_t status = SUCCESS;
|
|
//uint8_t notifyApp = 0xFF;
|
|
// If attribute permissions require authorization to write, return error
|
|
if(gattPermitAuthorWrite(pAttr->permissions))
|
|
{
|
|
// Insufficient authorization
|
|
return (ATT_ERR_INSUFFICIENT_AUTHOR);
|
|
}
|
|
|
|
if(pAttr->type.len == ATT_BT_UUID_SIZE)
|
|
{
|
|
// 16-bit UUID
|
|
uint16_t uuid = BUILD_UINT16(pAttr->type.uuid[0], pAttr->type.uuid[1]);
|
|
if(uuid == GATT_CLIENT_CHAR_CFG_UUID)
|
|
{
|
|
status = GATTServApp_ProcessCCCWriteReq(connHandle, pAttr, pValue, len,
|
|
offset, GATT_CLIENT_CFG_NOTIFY);
|
|
if(status == SUCCESS && ble_usb_AppCBs)
|
|
{
|
|
uint16_t charCfg = BUILD_UINT16(pValue[0], pValue[1]);
|
|
ble_usb_evt_t evt;
|
|
|
|
evt.type = (charCfg == GATT_CFG_NO_OPERATION) ? BLE_USB_EVT_TX_NOTI_DISABLED : BLE_USB_EVT_TX_NOTI_ENABLED;
|
|
ble_usb_AppCBs(connHandle, &evt);
|
|
}
|
|
}
|
|
|
|
// UUID
|
|
if(pAttr->handle == ble_usb_ProfileAttrTbl[RAWPASS_RX_VALUE_HANDLE].handle)
|
|
{
|
|
if(ble_usb_AppCBs)
|
|
{
|
|
ble_usb_evt_t evt;
|
|
evt.type = BLE_USB_EVT_BLE_DATA_RECIEVED;
|
|
evt.data.length = (uint16_t)len;
|
|
evt.data.p_data = pValue;
|
|
ble_usb_AppCBs(connHandle, &evt);
|
|
}
|
|
}
|
|
}
|
|
// else
|
|
// {
|
|
// // 128-bit UUID
|
|
// if(pAttr->handle == ble_usb_ProfileAttrTbl[RAWPASS_RX_VALUE_HANDLE].handle)
|
|
// {
|
|
// if(ble_usb_AppCBs) {
|
|
// ble_usb_evt_t evt;
|
|
// evt.type = BLE_usb_EVT_BLE_DATA_RECIEVED;
|
|
// evt.data.length = (uint16_t)len;
|
|
// evt.data.p_data = pValue;
|
|
// ble_usb_AppCBs(connHandle,&evt);
|
|
// }
|
|
// }
|
|
// }
|
|
return (status);
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn ble_usb_HandleConnStatusCB
|
|
*
|
|
* @brief ble_usb link status change handler function.
|
|
*
|
|
* @param connHandle - connection handle
|
|
* @param changeType - type of change
|
|
*
|
|
* @return none
|
|
*/
|
|
static void ble_usb_HandleConnStatusCB(uint16_t connHandle, uint8_t changeType)
|
|
{
|
|
// Make sure this is not loopback connection
|
|
if(connHandle != LOOPBACK_CONNHANDLE)
|
|
{
|
|
// Reset Client Char Config if connection has dropped
|
|
if((changeType == LINKDB_STATUS_UPDATE_REMOVED) ||
|
|
((changeType == LINKDB_STATUS_UPDATE_STATEFLAGS) &&
|
|
(!linkDB_Up(connHandle))))
|
|
{
|
|
//ble_usb_TxCCCD[0].value = 0;
|
|
GATTServApp_InitCharCfg(connHandle, ble_usb_TxCCCD);
|
|
}
|
|
}
|
|
}
|
|
|
|
uint8_t ble_usb_notify_is_ready(uint16_t connHandle)
|
|
{
|
|
return (GATT_CLIENT_CFG_NOTIFY == GATTServApp_ReadCharCfg(connHandle, ble_usb_TxCCCD));
|
|
}
|
|
/*********************************************************************
|
|
* @fn ble_usb_notify
|
|
*
|
|
* @brief
|
|
*
|
|
* @param connHandle - connection handle
|
|
* @param pNoti - pointer to notification structure
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
bStatus_t ble_usb_notify(uint16_t connHandle, attHandleValueNoti_t *pNoti, uint8_t taskId)
|
|
{
|
|
//uint16_t value = ble_usb_TxCCCD[0].value;
|
|
uint16_t value = GATTServApp_ReadCharCfg(connHandle, ble_usb_TxCCCD);
|
|
// If notifications enabled
|
|
if(value & GATT_CLIENT_CFG_NOTIFY)
|
|
{
|
|
// Set the handle
|
|
pNoti->handle = ble_usb_ProfileAttrTbl[RAWPASS_TX_VALUE_HANDLE].handle;
|
|
|
|
// Send the Indication
|
|
return GATT_Notification(connHandle, pNoti, FALSE);
|
|
}
|
|
return bleIncorrectMode;
|
|
}
|
|
|
|
/*********************************************************************
|
|
*********************************************************************/
|