fix:修改UDP通讯中,取电变化上报机制
1、问题点:当RCU网络状态异常的情况下,网络还处于协商状态下,还未进入正常通讯环节时,取电变化不会进行判断。这会导致取电变化上报与实际产生取电状态时间点对不上。 2、将BLV_C1F_Module代码上传至Gitea,之前代码修改记录请查看 .\BasicCode\Readme.txt
This commit is contained in:
688
BasicCode/Drive/BLE/peripheral.c
Normal file
688
BasicCode/Drive/BLE/peripheral.c
Normal file
@@ -0,0 +1,688 @@
|
||||
/********************************** (C) COPYRIGHT *******************************
|
||||
* File Name : peripheral.C
|
||||
* Author : WCH
|
||||
* Version : V1.0
|
||||
* Date : 2018/12/10
|
||||
* Description : <20><><EFBFBD><EFBFBD><EFBFBD>ӻ<EFBFBD><D3BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӧ<EFBFBD>ó<EFBFBD><C3B3><EFBFBD>ʼ<EFBFBD><CABC><EFBFBD>㲥<EFBFBD><E3B2A5><EFBFBD>Ӳ<EFBFBD><D3B2><EFBFBD><EFBFBD><EFBFBD>Ȼ<EFBFBD><C8BB><EFBFBD>㲥<EFBFBD><E3B2A5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
* <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӳ<EFBFBD><D3B2><EFBFBD><EFBFBD><EFBFBD>ͨ<EFBFBD><CDA8><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
|
||||
/*********************************************************************
|
||||
* INCLUDES
|
||||
*/
|
||||
#include "CONFIG.h"
|
||||
#include "CH57x_common.h"
|
||||
#include "devinfoservice.h"
|
||||
#include "gattprofile.h"
|
||||
#include "peripheral.h"
|
||||
|
||||
/*********************************************************************
|
||||
* MACROS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* CONSTANTS
|
||||
*/
|
||||
|
||||
// How often to perform periodic event
|
||||
#define SBP_PERIODIC_EVT_PERIOD 1600
|
||||
|
||||
// How often to perform read rssi event
|
||||
#define SBP_READ_RSSI_EVT_PERIOD /*3200*/4800
|
||||
|
||||
// Parameter update delay
|
||||
#define SBP_PARAM_UPDATE_DELAY 6400
|
||||
|
||||
// What is the advertising interval when device is discoverable (units of 625us, 80=50ms)
|
||||
#define DEFAULT_ADVERTISING_INTERVAL 80
|
||||
|
||||
// Limited discoverable mode advertises for 30.72s, and then stops
|
||||
// General discoverable mode advertises indefinitely
|
||||
#define DEFAULT_DISCOVERABLE_MODE GAP_ADTYPE_FLAGS_GENERAL
|
||||
|
||||
// Minimum connection interval (units of 1.25ms, 20=25ms)
|
||||
#define DEFAULT_DESIRED_MIN_CONN_INTERVAL 20
|
||||
|
||||
// Maximum connection interval (units of 1.25ms, 100=125ms)
|
||||
#define DEFAULT_DESIRED_MAX_CONN_INTERVAL 100
|
||||
|
||||
|
||||
|
||||
// Slave latency to use parameter update
|
||||
#define DEFAULT_DESIRED_SLAVE_LATENCY 0
|
||||
|
||||
// Supervision timeout value (units of 10ms, 100=1s)
|
||||
#define DEFAULT_DESIRED_CONN_TIMEOUT 50
|
||||
|
||||
// Company Identifier: WCH
|
||||
#define WCH_COMPANY_ID 0x07D7
|
||||
|
||||
/*********************************************************************
|
||||
* TYPEDEFS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* GLOBAL VARIABLES
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* EXTERNAL VARIABLES
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* EXTERNAL FUNCTIONS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* LOCAL VARIABLES
|
||||
*/
|
||||
static uint8 Peripheral_TaskID = INVALID_TASK_ID; // Task ID for internal task/event processing
|
||||
|
||||
|
||||
static uint8 advertData[] =
|
||||
{
|
||||
// Flags; this sets the device to use limited discoverable
|
||||
// mode (advertises for 30 seconds at a time) instead of general
|
||||
// discoverable mode (advertises indefinitely)
|
||||
0x02, // length of this data
|
||||
GAP_ADTYPE_FLAGS,
|
||||
DEFAULT_DISCOVERABLE_MODE | GAP_ADTYPE_FLAGS_BREDR_NOT_SUPPORTED,
|
||||
|
||||
// service UUID, to notify central devices what services are included
|
||||
// in this peripheral
|
||||
0x03, // length of this data
|
||||
GAP_ADTYPE_16BIT_MORE, // some of the UUID's, but not all
|
||||
LO_UINT16( SIMPLEPROFILE_SERV_UUID ),
|
||||
HI_UINT16( SIMPLEPROFILE_SERV_UUID )
|
||||
};
|
||||
|
||||
// GAP - SCAN RSP data (max size = 31 bytes)
|
||||
static uint8 scanRspData[31] =
|
||||
{
|
||||
// complete name
|
||||
0x10, // length of this data
|
||||
GAP_ADTYPE_LOCAL_NAME_COMPLETE,
|
||||
'B',
|
||||
'L',
|
||||
'V',
|
||||
'-',
|
||||
'C',
|
||||
'1',
|
||||
' ',
|
||||
'R',
|
||||
'C',
|
||||
'U',
|
||||
':',
|
||||
'8',
|
||||
'8',
|
||||
'8',
|
||||
'8',
|
||||
// connection interval range
|
||||
0x05, // length of this data
|
||||
GAP_ADTYPE_SLAVE_CONN_INTERVAL_RANGE,
|
||||
LO_UINT16( DEFAULT_DESIRED_MIN_CONN_INTERVAL ), // 100ms
|
||||
HI_UINT16( DEFAULT_DESIRED_MIN_CONN_INTERVAL ),
|
||||
LO_UINT16( DEFAULT_DESIRED_MAX_CONN_INTERVAL ), // 1s
|
||||
HI_UINT16( DEFAULT_DESIRED_MAX_CONN_INTERVAL ),
|
||||
|
||||
// Tx power level
|
||||
// 0x02, // length of this data
|
||||
// GAP_ADTYPE_POWER_LEVEL,
|
||||
// 0 // 0dBm
|
||||
};
|
||||
|
||||
|
||||
/************
|
||||
**<2A><> <20><><EFBFBD><EFBFBD>Set_BleDevice_Name
|
||||
**<2A><> <20>ã<EFBFBD><C3A3><EFBFBD><DEB8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
**<2A><> <20><><EFBFBD><EFBFBD>rspData: <20><><EFBFBD><EFBFBD>ɨ<EFBFBD><C9A8><EFBFBD><EFBFBD>Ϣ<EFBFBD><CFA2>buff name<6D><65>Ҫ<EFBFBD>ĵ<DEB8><C4B5><EFBFBD><EFBFBD>֣<EFBFBD> len<65><6E><EFBFBD><EFBFBD><EFBFBD>ֵij<D6B5><C4B3><EFBFBD>
|
||||
**<2A><><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD>ɹ<EFBFBD>
|
||||
*************/
|
||||
//uint8 Set_BleDevice_Name(uint8* name, u8 len)
|
||||
//{
|
||||
// if(name == NULL || len == 0) return 1; //<2F><><EFBFBD>ֲ<EFBFBD><D6B2><EFBFBD><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA>
|
||||
// if(dataFlash_save_t.bleName_len == len && memcmp(name, &dataFlash_save_t.scanRspData[2], len) == 0) //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>δ<EFBFBD>ı<EFBFBD>
|
||||
// {
|
||||
// return 2; //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͬ
|
||||
// }
|
||||
// memset(dataFlash_save_t.scanRspData, 0, 31);
|
||||
// //memset(attDeviceName, 0, BLE_DEVICE_NAME_LEN);
|
||||
// if(len < BLE_DEVICE_NAME_LEN)
|
||||
// {
|
||||
// memcpy(&dataFlash_save_t.scanRspData[2], name, len);
|
||||
// //memcpy(attDeviceName, name, len);
|
||||
// dataFlash_save_t.scanRspData[0] = len +1;
|
||||
// dataFlash_save_t.bleName_len = len;
|
||||
// }
|
||||
// else
|
||||
// {
|
||||
// memcpy(&dataFlash_save_t.scanRspData[2], name, BLE_DEVICE_NAME_LEN);
|
||||
// //memcpy(attDeviceName, name, BLE_DEVICE_NAME_LEN);
|
||||
// dataFlash_save_t.scanRspData[0] = BLE_DEVICE_NAME_LEN + 1;
|
||||
// dataFlash_save_t.bleName_len = BLE_DEVICE_NAME_LEN;
|
||||
// }
|
||||
// dataFlash_save_t.scanRspData[1] = GAP_ADTYPE_LOCAL_NAME_COMPLETE;
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+1] = 0x05; // length of this data
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+2] = GAP_ADTYPE_SLAVE_CONN_INTERVAL_RANGE;
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+3] = LO_UINT16( DEFAULT_DESIRED_MIN_CONN_INTERVAL );
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+4] = HI_UINT16( DEFAULT_DESIRED_MIN_CONN_INTERVAL );
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+5] = LO_UINT16( DEFAULT_DESIRED_MAX_CONN_INTERVAL );
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+6] = HI_UINT16( DEFAULT_DESIRED_MAX_CONN_INTERVAL );
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+7] = 0x02; // length of this data
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+8] = GAP_ADTYPE_POWER_LEVEL;
|
||||
// dataFlash_save_t.scanRspData[dataFlash_save_t.scanRspData[0]+9] = 0; // 0dBm
|
||||
// // Set the GAP Characteristics д GAP <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
// GGS_SetParameter( GGS_DEVICE_NAME_ATT, BLE_DEVICE_NAME_LEN, &dataFlash_save_t.scanRspData[2] );
|
||||
// GAPRole_SetParameter( GAPROLE_SCAN_RSP_DATA, sizeof ( dataFlash_save_t.scanRspData ), dataFlash_save_t.scanRspData );
|
||||
//
|
||||
// dataFlash_save_t.flash_save_flg = 1; //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>
|
||||
// return 0;
|
||||
//}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
// Connection item list
|
||||
/*static*/ peripheralConnItem_t peripheralConnList;
|
||||
|
||||
/*********************************************************************
|
||||
* LOCAL FUNCTIONS
|
||||
*/
|
||||
static void Peripheral_ProcessTMOSMsg( tmos_event_hdr_t *pMsg );
|
||||
static void peripheralStateNotificationCB( gapRole_States_t newState ,gapRoleEvent_t * pEvent);
|
||||
static void performPeriodicTask( void );
|
||||
static void simpleProfileChangeCB( uint8 paramID );
|
||||
static void peripheralParamUpdateCB( uint16 connHandle, uint16 connInterval,
|
||||
uint16 connSlaveLatency, uint16 connTimeout );
|
||||
static void peripheralInitConnItem( peripheralConnItem_t* peripheralConnList );
|
||||
static void peripheralRssiCB( uint16 connHandle, int8 rssi );
|
||||
//static void peripheralChar4Notify( uint8 *pValue, uint16 len );
|
||||
|
||||
/*********************************************************************
|
||||
* PROFILE CALLBACKS
|
||||
*/
|
||||
|
||||
// GAP Role Callbacks
|
||||
static gapRolesCBs_t Peripheral_PeripheralCBs =
|
||||
{
|
||||
peripheralStateNotificationCB, // Profile State Change Callbacks
|
||||
peripheralRssiCB, // When a valid RSSI is read from controller (not used by application)
|
||||
peripheralParamUpdateCB //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɻص<C9BB>
|
||||
};
|
||||
|
||||
// GAP Bond Manager Callbacks
|
||||
static gapBondCBs_t Peripheral_BondMgrCBs =
|
||||
{
|
||||
NULL, // Passcode callback (not used by application)
|
||||
NULL // Pairing / Bonding state Callback (not used by application)
|
||||
};
|
||||
|
||||
// Simple GATT Profile Callbacks
|
||||
static simpleProfileCBs_t Peripheral_SimpleProfileCBs =
|
||||
{
|
||||
simpleProfileChangeCB // Charactersitic value change callback
|
||||
};
|
||||
/*********************************************************************
|
||||
* PUBLIC FUNCTIONS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* @fn Peripheral_Init
|
||||
*
|
||||
* @brief Initialization function for the Peripheral App Task.
|
||||
* This is called during initialization and should contain
|
||||
* any application specific initialization (ie. hardware
|
||||
* initialization/setup, table initialization, power up
|
||||
* notificaiton ... ).
|
||||
*
|
||||
* @param task_id - the ID assigned by TMOS. This ID should be
|
||||
* used to send messages and set timers.
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
void Peripheral_Init( )
|
||||
{
|
||||
Peripheral_TaskID = TMOS_ProcessEventRegister( Peripheral_ProcessEvent );
|
||||
|
||||
// Setup the GAP Peripheral Role Profile <20><><EFBFBD><EFBFBD>GAP<41><50>Χ<EFBFBD><CEA7>ɫ<EFBFBD><C9AB><EFBFBD><EFBFBD><EFBFBD>ļ<EFBFBD>
|
||||
{
|
||||
uint8 initial_advertising_enable = TRUE;
|
||||
uint16 desired_min_interval = DEFAULT_DESIRED_MIN_CONN_INTERVAL; //<2F><>С<EFBFBD><D0A1><EFBFBD>Ӽ<EFBFBD><D3BC><EFBFBD>1<EFBFBD><31><EFBFBD><EFBFBD>λΪ1.25ms<EFBFBD><EFBFBD>20=25ms<6D><73>
|
||||
uint16 desired_max_interval = DEFAULT_DESIRED_MAX_CONN_INTERVAL; //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӽ<EFBFBD><D3BC><EFBFBD>5<EFBFBD><35><EFBFBD><EFBFBD>λΪ1.25ms<EFBFBD><EFBFBD>100=25ms<6D><73>
|
||||
|
||||
// GAP - Advertisement data (max size = 31 bytes, though this is
|
||||
// best kept short to conserve power while advertisting)
|
||||
|
||||
|
||||
// Set the GAP Role Parameters д GAP Role <20><><EFBFBD><EFBFBD>
|
||||
GAPRole_SetParameter( GAPROLE_ADVERT_ENABLED, sizeof( uint8 ), &initial_advertising_enable );
|
||||
|
||||
// GAPRole_SetParameter( GAPROLE_SCAN_RSP_DATA, sizeof ( dataFlash_save_t.scanRspData ), dataFlash_save_t.scanRspData );
|
||||
GAPRole_SetParameter( GAPROLE_SCAN_RSP_DATA, sizeof ( scanRspData ), scanRspData );
|
||||
GAPRole_SetParameter( GAPROLE_ADVERT_DATA, sizeof( advertData ), advertData );
|
||||
GAPRole_SetParameter( GAPROLE_MIN_CONN_INTERVAL, sizeof( uint16 ), &desired_min_interval );
|
||||
GAPRole_SetParameter( GAPROLE_MAX_CONN_INTERVAL, sizeof( uint16 ), &desired_max_interval );
|
||||
}
|
||||
|
||||
// Set the GAP Characteristics д GAP <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
// GGS_SetParameter( GGS_DEVICE_NAME_ATT, dataFlash_save_t.bleName_len, &dataFlash_save_t.scanRspData[2] );
|
||||
GGS_SetParameter( GGS_DEVICE_NAME_ATT, GAP_DEVICE_NAME_LEN, attDeviceName );
|
||||
|
||||
// Set advertising interval
|
||||
{
|
||||
uint16 advInt = DEFAULT_ADVERTISING_INTERVAL; //<2F>㲥<EFBFBD><E3B2A5><EFBFBD><EFBFBD>
|
||||
//д GAP <20><><EFBFBD><EFBFBD>
|
||||
GAP_SetParamValue( TGAP_DISC_ADV_INT_MIN, advInt );
|
||||
GAP_SetParamValue( TGAP_DISC_ADV_INT_MAX, advInt );
|
||||
}
|
||||
|
||||
// Setup the GAP Bond Manager
|
||||
{
|
||||
uint32 passkey = 0; // passkey "000000"
|
||||
uint8 pairMode = GAPBOND_PAIRING_MODE_WAIT_FOR_REQ; //<2F>ȴ<EFBFBD><C8B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȫ<EFBFBD><C8AB><EFBFBD><EFBFBD>
|
||||
uint8 mitm = TRUE;
|
||||
uint8 bonding = TRUE;
|
||||
uint8 ioCap = GAPBOND_IO_CAP_DISPLAY_ONLY; ////<2F><><EFBFBD><EFBFBD>ʾ<EFBFBD>豸
|
||||
//д<><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>
|
||||
GAPBondMgr_SetParameter( GAPBOND_PERI_DEFAULT_PASSCODE, sizeof ( uint32 ), &passkey ); //MITM<54><4D><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ĭ<EFBFBD><C4AC><EFBFBD><EFBFBD><EFBFBD>롣<EFBFBD><EBA1A3><EFBFBD><EFBFBD>Ϊuint32<33><32><EFBFBD><EFBFBD>Χ<EFBFBD><CEA7>0-999999<39><39>Ĭ<EFBFBD><C4AC>ֵΪ0<CEAA><30>
|
||||
GAPBondMgr_SetParameter( GAPBOND_PERI_PAIRING_MODE, sizeof ( uint8 ), &pairMode ); //<2F><><EFBFBD><EFBFBD>ģʽ<C4A3><CABD>@ref GAPBOND_Pairing_Mode_defined<65><64><EFBFBD><EFBFBD>/д<><D0B4><EFBFBD><EFBFBD>С<EFBFBD><D0A1>uint8<74><38>Ĭ<EFBFBD><C4AC>ΪGAPBOND_PAIRING_MODE_WAIT_REQ<45>ȴ<EFBFBD><C8B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
GAPBondMgr_SetParameter( GAPBOND_PERI_MITM_PROTECTION, sizeof ( uint8 ), &mitm ); //<2F><>Կ<EFBFBD><D4BF><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>/д<><D0B4><EFBFBD><EFBFBD>С<EFBFBD><D0A1>uint8<74><38>Ĭ<EFBFBD><C4AC>ֵΪ0<CEAA><30><EFBFBD><EFBFBD><EFBFBD>ã<EFBFBD><C3A3><EFBFBD><EFBFBD>˴<EFBFBD><CBB4><EFBFBD><EFBFBD><EFBFBD>
|
||||
GAPBondMgr_SetParameter( GAPBOND_PERI_IO_CAPABILITIES, sizeof ( uint8 ), &ioCap ); //I/O<><4F><EFBFBD>ܡ<EFBFBD><DCA1><EFBFBD>/д<><D0B4><EFBFBD><EFBFBD>С<EFBFBD><D0A1>uint8<74><38>Ĭ<EFBFBD><C4AC>ֵΪ<D6B5><CEAA><EFBFBD><EFBFBD>ʾ<EFBFBD>豸
|
||||
GAPBondMgr_SetParameter( GAPBOND_PERI_BONDING_ENABLED, sizeof ( uint8 ), &bonding ); //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ã<EFBFBD><C3A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Թ<EFBFBD><D4B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><F3B6A8A1><EFBFBD>/д<><D0B4><EFBFBD>ߴ<EFBFBD><DFB4><EFBFBD>uint8<74><38>Ĭ<EFBFBD><C4AC>ֵΪ0<CEAA><30><EFBFBD><EFBFBD><EFBFBD>ã<EFBFBD><C3A3><EFBFBD><EFBFBD>˴<EFBFBD><CBB4><EFBFBD><EFBFBD><EFBFBD>
|
||||
}
|
||||
|
||||
// Initialize GATT attributes
|
||||
GGS_AddService( GATT_ALL_SERVICES ); // GAP
|
||||
GATTServApp_AddService( GATT_ALL_SERVICES ); // GATT attributes
|
||||
DevInfo_AddService(); // Device Information Service
|
||||
SimpleProfile_AddService( GATT_ALL_SERVICES ); // Simple GATT Profile
|
||||
|
||||
// Setup the SimpleProfile Characteristic Values
|
||||
{
|
||||
// uint8 charValue1[SIMPLEPROFILE_CHAR1_LEN] = { 1 };
|
||||
// uint8 charValue2[SIMPLEPROFILE_CHAR2_LEN] = {192,168,1,94};
|
||||
//uint8 charValue3[SIMPLEPROFILE_CHAR3_LEN] = { 3 };
|
||||
// uint8 charValue4[SIMPLEPROFILE_CHAR4_LEN] = { 4 };
|
||||
// uint8 charValue5[SIMPLEPROFILE_CHAR5_LEN] = { 1, 2, 3, 4, 5 };
|
||||
|
||||
// SimpleProfile_SetParameter( SIMPLEPROFILE_CHAR1, SIMPLEPROFILE_CHAR1_LEN, charValue1 );
|
||||
// SimpleProfile_SetParameter( SIMPLEPROFILE_CHAR2, SIMPLEPROFILE_CHAR2_LEN, charValue2 );
|
||||
//SimpleProfile_SetParameter( SIMPLEPROFILE_CHAR3, SIMPLEPROFILE_CHAR3_LEN, charValue3 );
|
||||
// SimpleProfile_SetParameter( SIMPLEPROFILE_CHAR4, SIMPLEPROFILE_CHAR4_LEN, charValue4 );
|
||||
// SimpleProfile_SetParameter( SIMPLEPROFILE_CHAR5, SIMPLEPROFILE_CHAR5_LEN, charValue5 );
|
||||
}
|
||||
|
||||
// Init Connection Item
|
||||
peripheralInitConnItem( &peripheralConnList );
|
||||
|
||||
// Register callback with SimpleGATTprofile //ע<><D7A2><EFBFBD>ص<EFBFBD>
|
||||
SimpleProfile_RegisterAppCBs( &Peripheral_SimpleProfileCBs );
|
||||
|
||||
// Setup a delayed profile startup //<2F><><EFBFBD><EFBFBD><EFBFBD>ӳٵ<D3B3><D9B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD>
|
||||
tmos_set_event( Peripheral_TaskID, SBP_START_DEVICE_EVT );
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn peripheralInitConnItem
|
||||
*
|
||||
* @brief Init Connection Item
|
||||
*
|
||||
* @param peripheralConnList -
|
||||
*
|
||||
* @return NULL
|
||||
*/
|
||||
static void peripheralInitConnItem( peripheralConnItem_t* peripheralConnList )
|
||||
{
|
||||
peripheralConnList->connHandle = GAP_CONNHANDLE_INIT;
|
||||
peripheralConnList->connInterval = 0;
|
||||
peripheralConnList->connSlaveLatency = 0;
|
||||
peripheralConnList->connTimeout = 0;
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn Peripheral_ProcessEvent
|
||||
*
|
||||
* @brief Peripheral Application Task event processor. This function
|
||||
* is called to process all events for the task. Events
|
||||
* include timers, messages and any other user defined events.
|
||||
*
|
||||
* @param task_id - The TMOS assigned task ID.
|
||||
* @param events - events to process. This is a bit map and can
|
||||
* contain more than one event.
|
||||
*
|
||||
* @return events not processed
|
||||
*/
|
||||
uint16 Peripheral_ProcessEvent( uint8 task_id, uint16 events )
|
||||
{
|
||||
|
||||
// VOID task_id; // TMOS required parameter that isn't used in this function
|
||||
|
||||
if ( events & SYS_EVENT_MSG ){
|
||||
uint8 *pMsg;
|
||||
|
||||
if ( (pMsg = tmos_msg_receive( Peripheral_TaskID )) != NULL ){
|
||||
Peripheral_ProcessTMOSMsg( (tmos_event_hdr_t *)pMsg );
|
||||
// Release the TMOS message
|
||||
tmos_msg_deallocate( pMsg );
|
||||
}
|
||||
// return unprocessed events
|
||||
return (events ^ SYS_EVENT_MSG);
|
||||
}
|
||||
|
||||
if ( events & SBP_START_DEVICE_EVT ){
|
||||
// Start the Device
|
||||
GAPRole_PeripheralStartDevice( Peripheral_TaskID, &Peripheral_BondMgrCBs, &Peripheral_PeripheralCBs );
|
||||
return ( events ^ SBP_START_DEVICE_EVT );
|
||||
}
|
||||
|
||||
if ( events & SBP_PERIODIC_EVT )
|
||||
{
|
||||
// Restart timer
|
||||
// if ( SBP_PERIODIC_EVT_PERIOD ){
|
||||
// tmos_start_task( Peripheral_TaskID, SBP_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD );
|
||||
// }
|
||||
// Perform periodic application task ִ<>ж<EFBFBD><D0B6><EFBFBD>Ӧ<EFBFBD><D3A6><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
//performPeriodicTask(); //<2F><><EFBFBD>ڷ<EFBFBD><DAB7><EFBFBD>֪ͨ
|
||||
return (events ^ SBP_PERIODIC_EVT);
|
||||
}
|
||||
|
||||
if ( events & SBP_PARAM_UPDATE_EVT ) //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
{
|
||||
// Send connect param update request //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӳ<EFBFBD><D3B2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
GAPRole_PeripheralConnParamUpdateReq( peripheralConnList.connHandle,
|
||||
DEFAULT_DESIRED_MIN_CONN_INTERVAL,
|
||||
DEFAULT_DESIRED_MAX_CONN_INTERVAL,
|
||||
DEFAULT_DESIRED_SLAVE_LATENCY,
|
||||
DEFAULT_DESIRED_CONN_TIMEOUT,
|
||||
Peripheral_TaskID);
|
||||
|
||||
return (events ^ SBP_PARAM_UPDATE_EVT);
|
||||
}
|
||||
|
||||
if ( events & SBP_READ_RSSI_EVT )
|
||||
{
|
||||
GAPRole_ReadRssiCmd(peripheralConnList.connHandle);
|
||||
tmos_start_task( Peripheral_TaskID, SBP_READ_RSSI_EVT, SBP_READ_RSSI_EVT_PERIOD );
|
||||
return (events ^ SBP_READ_RSSI_EVT);
|
||||
}
|
||||
|
||||
// Discard unknown events
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn Peripheral_ProcessTMOSMsg
|
||||
*
|
||||
* @brief Process an incoming task message.
|
||||
*
|
||||
* @param pMsg - message to process
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void Peripheral_ProcessTMOSMsg( tmos_event_hdr_t *pMsg )
|
||||
{
|
||||
switch ( pMsg->event ){
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn Peripheral_LinkEstablished
|
||||
*
|
||||
* @brief Process link established.
|
||||
*
|
||||
* @param pEvent - event to process
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void Peripheral_LinkEstablished( gapRoleEvent_t * pEvent )
|
||||
{
|
||||
gapEstLinkReqEvent_t *event = (gapEstLinkReqEvent_t *) pEvent;
|
||||
|
||||
// See if already connected
|
||||
if( peripheralConnList.connHandle != GAP_CONNHANDLE_INIT )
|
||||
{
|
||||
GAPRole_TerminateLink( pEvent->linkCmpl.connectionHandle );
|
||||
PRINT( "Connection max...\n" );
|
||||
}
|
||||
else
|
||||
{
|
||||
peripheralConnList.connHandle = event->connectionHandle;
|
||||
peripheralConnList.connInterval = event->connInterval;
|
||||
peripheralConnList.connSlaveLatency = event->connLatency;
|
||||
peripheralConnList.connTimeout = event->connTimeout;
|
||||
|
||||
// Set timer for periodic event
|
||||
tmos_start_task( Peripheral_TaskID, SBP_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD );
|
||||
|
||||
// Set timer for param update event
|
||||
tmos_start_task( Peripheral_TaskID, SBP_PARAM_UPDATE_EVT, SBP_PARAM_UPDATE_DELAY );
|
||||
|
||||
// Start read rssi
|
||||
tmos_start_task( Peripheral_TaskID, SBP_READ_RSSI_EVT, SBP_READ_RSSI_EVT_PERIOD );
|
||||
|
||||
printf("Conn %x - Int %x \n", event->connectionHandle, event->connInterval);
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn Peripheral_LinkTerminated
|
||||
*
|
||||
* @brief Process link terminated.
|
||||
*
|
||||
* @param pEvent - event to process
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void Peripheral_LinkTerminated( gapRoleEvent_t * pEvent )
|
||||
{
|
||||
gapTerminateLinkEvent_t *event = (gapTerminateLinkEvent_t *) pEvent;
|
||||
|
||||
if( event->connectionHandle == peripheralConnList.connHandle )
|
||||
{
|
||||
peripheralConnList.connHandle = GAP_CONNHANDLE_INIT;
|
||||
peripheralConnList.connInterval = 0;
|
||||
peripheralConnList.connSlaveLatency = 0;
|
||||
peripheralConnList.connTimeout = 0;
|
||||
tmos_stop_task( Peripheral_TaskID, SBP_PERIODIC_EVT );
|
||||
tmos_stop_task( Peripheral_TaskID, SBP_READ_RSSI_EVT );
|
||||
|
||||
// Restart advertising
|
||||
{
|
||||
uint8 advertising_enable = TRUE;
|
||||
GAPRole_SetParameter( GAPROLE_ADVERT_ENABLED, sizeof( uint8 ), &advertising_enable );
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
PRINT("ERR..\n");
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn peripheralRssiCB
|
||||
*
|
||||
* @brief RSSI callback.
|
||||
*
|
||||
* @param connHandle - connection handle
|
||||
* @param rssi - RSSI
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void peripheralRssiCB( uint16 connHandle, int8 rssi )
|
||||
{
|
||||
PRINT( "RSSI -%d dB Conn %x \n", -rssi, connHandle);
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn peripheralParamUpdateCB
|
||||
*
|
||||
* @brief Parameter update complete callback
|
||||
*
|
||||
* @param connHandle - connect handle
|
||||
* connInterval - connect interval
|
||||
* connSlaveLatency - connect slave latency
|
||||
* connTimeout - connect timeout
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void peripheralParamUpdateCB( uint16 connHandle, uint16 connInterval,
|
||||
uint16 connSlaveLatency, uint16 connTimeout )
|
||||
{
|
||||
if( connHandle == peripheralConnList.connHandle )
|
||||
{
|
||||
peripheralConnList.connInterval = connInterval;
|
||||
peripheralConnList.connSlaveLatency = connSlaveLatency;
|
||||
peripheralConnList.connTimeout = connTimeout;
|
||||
|
||||
printf("Update %x - Int %x \n", connHandle, connInterval);
|
||||
}
|
||||
else
|
||||
{
|
||||
PRINT("ERR..\n");
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn peripheralStateNotificationCB
|
||||
*
|
||||
* @brief Notification from the profile of a state change.
|
||||
*
|
||||
* @param newState - new state
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void peripheralStateNotificationCB( gapRole_States_t newState, gapRoleEvent_t * pEvent )
|
||||
{
|
||||
switch ( newState )
|
||||
{
|
||||
case GAPROLE_STARTED:
|
||||
PRINT( "Initialized..\n" );
|
||||
break;
|
||||
|
||||
case GAPROLE_ADVERTISING:
|
||||
if( pEvent->gap.opcode == GAP_LINK_TERMINATED_EVENT ) //gap<61><70><EFBFBD>ӽ<EFBFBD><D3BD><EFBFBD>
|
||||
{
|
||||
Peripheral_LinkTerminated( pEvent );
|
||||
PRINT( "Disconnected..Reason:%x\n", pEvent->linkTerminate.reason );
|
||||
}
|
||||
PRINT( "Advertising..\n" );
|
||||
break;
|
||||
|
||||
case GAPROLE_CONNECTED:
|
||||
if( pEvent->gap.opcode == GAP_LINK_ESTABLISHED_EVENT ) //GAP<41><50><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
{
|
||||
Peripheral_LinkEstablished( pEvent );
|
||||
}
|
||||
PRINT( "Connected..\n" );
|
||||
break;
|
||||
|
||||
case GAPROLE_CONNECTED_ADV: //
|
||||
PRINT( "Connected Advertising..\n" );
|
||||
break;
|
||||
|
||||
case GAPROLE_WAITING:
|
||||
if( pEvent->gap.opcode == GAP_END_DISCOVERABLE_DONE_EVENT )
|
||||
{
|
||||
PRINT( "Waiting for advertising..\n" );
|
||||
}
|
||||
else if( pEvent->gap.opcode == GAP_LINK_TERMINATED_EVENT )
|
||||
{
|
||||
Peripheral_LinkTerminated( pEvent );
|
||||
PRINT( "Disconnected..Reason:%x\n", pEvent->linkTerminate.reason );
|
||||
}
|
||||
break;
|
||||
|
||||
case GAPROLE_ERROR:
|
||||
PRINT( "Error..\n" );
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn performPeriodicTask
|
||||
*
|
||||
* @brief Perform a periodic application task. This function gets
|
||||
* called every five seconds as a result of the SBP_PERIODIC_EVT
|
||||
* TMOS event. In this example, the value of the third
|
||||
* characteristic in the SimpleGATTProfile service is retrieved
|
||||
* from the profile, and then copied into the value of the
|
||||
* the fourth characteristic.
|
||||
* <09><>ʱ֪ͨ<CDA8><D6AA><EFBFBD><EFBFBD>
|
||||
* @param none
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void performPeriodicTask( void )
|
||||
{
|
||||
static uint8 count = 0;
|
||||
uint8 notiData[SIMPLEPROFILE_CHAR4_LEN] = "Notify:";
|
||||
sprintf((char*)¬iData[7], "%d", ++count);
|
||||
peripheralChar4Notify( notiData, strlen((char*)notiData) );
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn peripheralChar4Notify
|
||||
*
|
||||
* @brief Prepare and send simpleProfileChar4 notification
|
||||
*
|
||||
* @param pValue - data to notify
|
||||
* len - length of data
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
/*static*/ void peripheralChar4Notify( uint8 *pValue, uint16 len )
|
||||
{
|
||||
attHandleValueNoti_t noti;
|
||||
noti.len = len;
|
||||
noti.pValue = GATT_bm_alloc( peripheralConnList.connHandle, ATT_HANDLE_VALUE_NOTI, noti.len, NULL, 0 );
|
||||
tmos_memcpy( noti.pValue, pValue, noti.len );
|
||||
if( simpleProfile_Notify( peripheralConnList.connHandle, ¬i ) != SUCCESS )
|
||||
{
|
||||
GATT_bm_free( (gattMsg_t *)¬i, ATT_HANDLE_VALUE_NOTI );
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn simpleProfileChangeCB
|
||||
*
|
||||
* @brief Callback from SimpleBLEProfile indicating a value change
|
||||
*
|
||||
* @param paramID - parameter ID of the value that was changed.
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
static void simpleProfileChangeCB( uint8 paramID )
|
||||
{
|
||||
|
||||
switch( paramID )
|
||||
{
|
||||
case SIMPLEPROFILE_CHAR1:
|
||||
{
|
||||
uint8 newValue[SIMPLEPROFILE_CHAR1_LEN];
|
||||
SimpleProfile_GetParameter( SIMPLEPROFILE_CHAR1, newValue );
|
||||
PRINT("profile ChangeCB CHAR1.. \n");
|
||||
break;
|
||||
}
|
||||
|
||||
case SIMPLEPROFILE_CHAR3:
|
||||
{
|
||||
uint8 newValue[GAP_DEVICE_NAME_LEN];
|
||||
SimpleProfile_GetParameter( SIMPLEPROFILE_CHAR3, newValue );
|
||||
PRINT("profile ChangeCB CHAR3..\n");
|
||||
break;
|
||||
}
|
||||
|
||||
default:
|
||||
// should not reach here!
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
*********************************************************************/
|
||||
Reference in New Issue
Block a user