Warning[w28]: Parts of segment <XDATA_ROM_C> 1 are initialized (as in module
?FILLER_BYTES), parts not (as in module simpleBLECentral)
This thread has been locked.
If you have a related question, please click the "Ask a related question" button in the top right corner. The newly created question will be automatically linked to this question.
/**************************************************************************************************
Filename: simpleBLECentral.c
Revised: $Date: 2011-06-20 11:57:59 -0700 (Mon, 20 Jun 2011) $
Revision: $Revision: 28 $
Description: This file contains the Simple BLE Central sample application
for use with the CC2540 Bluetooth Low Energy Protocol Stack.
Copyright 2010 Texas Instruments Incorporated. All rights reserved.
IMPORTANT: Your use of this Software is limited to those specific rights
granted under the terms of a software license agreement between the user
who downloaded the software, his/her employer (which must be your employer)
and Texas Instruments Incorporated (the "License"). You may not use this
Software unless you agree to abide by the terms of the License. The License
limits your use, and you acknowledge, that the Software may not be modified,
copied or distributed unless embedded on a Texas Instruments microcontroller
or used solely and exclusively in conjunction with a Texas Instruments radio
frequency transceiver, which is integrated into your product. Other than for
the foregoing purpose, you may not use, reproduce, copy, prepare derivative
works of, modify, distribute, perform, display or sell this Software and/or
its documentation for any purpose.
YOU FURTHER ACKNOWLEDGE AND AGREE THAT THE SOFTWARE AND DOCUMENTATION ARE
PROVIDED �AS IS?WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESS OR IMPLIED,
INCLUDING WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY, TITLE,
NON-INFRINGEMENT AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL
TEXAS INSTRUMENTS OR ITS LICENSORS BE LIABLE OR OBLIGATED UNDER CONTRACT,
NEGLIGENCE, STRICT LIABILITY, CONTRIBUTION, BREACH OF WARRANTY, OR OTHER
LEGAL EQUITABLE THEORY ANY DIRECT OR INDIRECT DAMAGES OR EXPENSES
INCLUDING BUT NOT LIMITED TO ANY INCIDENTAL, SPECIAL, INDIRECT, PUNITIVE
OR CONSEQUENTIAL DAMAGES, LOST PROFITS OR LOST DATA, COST OF PROCUREMENT
OF SUBSTITUTE GOODS, TECHNOLOGY, SERVICES, OR ANY CLAIMS BY THIRD PARTIES
(INCLUDING BUT NOT LIMITED TO ANY DEFENSE THEREOF), OR OTHER SIMILAR COSTS.
Should you have any questions regarding your right to use this Software,
contact Texas Instruments Incorporated at www.TI.com.
**************************************************************************************************/
/*********************************************************************
* INCLUDES
*/
#include "bcomdef.h"
#include "OSAL.h"
#include "OSAL_PwrMgr.h"
#include "OnBoard.h"
#include "hal_led.h"
#include "hal_key.h"
#include "hal_lcd.h"
#include "gatt.h"
#include "ll.h"
#include "hci.h"
#include "gapgattserver.h"
#include "gattservapp.h"
#include "central.h"
#include "gapbondmgr.h"
#include "simpleGATTprofile.h"
#include "simpleBLECentral.h"
#include "npi.h"
#include "simpleble.h"
#include "stdio.h"
#include "simpleBLEPeripheral.h"
#include "observer.h"
/*********************************************************************
* MACROS
*/
// Length of bd addr as a string
#define B_ADDR_STR_LEN 15
/*********************************************************************
* CONSTANTS
*/
// Maximum number of scan responses
#define DEFAULT_MAX_SCAN_RES 16
// Scan duration in ms
#define DEFAULT_SCAN_DURATION 500//4000 Ĭ��ɨ��ʱ�� ms
// Discovey mode (limited, general, all)
#define DEFAULT_DISCOVERY_MODE DEVDISC_MODE_ALL
// TRUE to use active scan
#define DEFAULT_DISCOVERY_ACTIVE_SCAN TRUE
// TRUE to use white list during discovery
#define DEFAULT_DISCOVERY_WHITE_LIST FALSE
// TRUE to use high scan duty cycle when creating link
#define DEFAULT_LINK_HIGH_DUTY_CYCLE FALSE
// TRUE to use white list when creating link
#define DEFAULT_LINK_WHITE_LIST FALSE
// Default RSSI polling period in ms
#define DEFAULT_RSSI_PERIOD 200
// Whether to enable automatic parameter update request when a connection is formed
#define DEFAULT_ENABLE_UPDATE_REQUEST FALSE
// Minimum connection interval (units of 1.25ms) if automatic parameter update request is enabled
#define DEFAULT_UPDATE_MIN_CONN_INTERVAL 8//400 ���Ӽ�������ݷ������йأ� ���Ӽ��Խ�̣� ��λʱ���ھ��ܷ���Խ�������
// Maximum connection interval (units of 1.25ms) if automatic parameter update request is enabled
#define DEFAULT_UPDATE_MAX_CONN_INTERVAL 8//800 ���Ӽ�������ݷ������йأ� ���Ӽ��Խ�̣� ��λʱ���ھ��ܷ���Խ�������
// Slave latency to use if automatic parameter update request is enabled
#define DEFAULT_UPDATE_SLAVE_LATENCY 0
// Supervision timeout value (units of 10ms) if automatic parameter update request is enabled
#define DEFAULT_UPDATE_CONN_TIMEOUT 100//600
// Default passcode
#define DEFAULT_PASSCODE 12345
// Default GAP pairing mode
#define DEFAULT_PAIRING_MODE GAPBOND_PAIRING_MODE_WAIT_FOR_REQ
// Default MITM mode (TRUE to require passcode or OOB when pairing)
#define DEFAULT_MITM_MODE FALSE
// Default bonding mode, TRUE to bond
#define DEFAULT_BONDING_MODE TRUE
// Default GAP bonding I/O capabilities
#define DEFAULT_IO_CAPABILITIES GAPBOND_IO_CAP_DISPLAY_ONLY
// Default service discovery timer delay in ms
#define DEFAULT_SVC_DISCOVERY_DELAY 1000
// TRUE to filter discovery results on desired service UUID
#define DEFAULT_DEV_DISC_BY_SVC_UUID TRUE
// Discovery states
enum
{
BLE_DISC_STATE_IDLE, // Idle
BLE_DISC_STATE_SVC, // Service discovery
BLE_DISC_STATE_CHAR // Characteristic discovery
};
/*********************************************************************
* TYPEDEFS
*/
/*********************************************************************
* GLOBAL VARIABLES
*/
/*********************************************************************
* EXTERNAL VARIABLES
*/
/*********************************************************************
* EXTERNAL FUNCTIONS
*/
/*********************************************************************
* LOCAL VARIABLES
*/
// Task ID for internal task/event processing
uint8 simpleBLETaskId;
// GAP GATT Attributes
static const uint8 simpleBLEDeviceName[GAP_DEVICE_NAME_LEN] = "Simple BLE Central";
// Number of scan results and scan result index
uint8 simpleBLEScanRes; //ɨ����
//static uint8 simpleBLEScanIdx;
// Scan result list
static gapDevRec_t simpleBLEDevList[DEFAULT_MAX_SCAN_RES];
//debug
//uint8 gapDevRec_tp[12][40];
//int8 gapDevRec_rssi[12];
Central_ibeType tagCibe={0};
// Scanning state
uint8 simpleBLEScanning = FALSE;
// RSSI polling state
uint8 simpleBLERssi = FALSE;
// Connection handle of current connection
static uint16 simpleBLEConnHandle = GAP_CONNHANDLE_INIT;
// Application state
uint8 simpleBLEState = BLE_STATE_IDLE;
// Discovery state
static uint8 simpleBLEDiscState = BLE_DISC_STATE_IDLE;
// Discovered service start and end handle
static uint16 simpleBLESvcStartHdl = 0;
static uint16 simpleBLESvcEndHdl = 0;
// Discovered characteristic handle
uint16 simpleBLECharHdl = 0;
uint16 simpleBLECharHd6 = 0;
bool simpleBLEChar6DoWrite = TRUE;
bool simpleBLECentralCanSend = FALSE; // �����ɷ�������
//uint8 strTp[400];
// Value to write
//static uint8 simpleBLECharVal = 0;
// Value read/write toggle
//static bool simpleBLEDoWrite = FALSE;
// GATT read/write procedure state
//static bool simpleBLEProcedureInProgress = FALSE;
/*********************************************************************
* LOCAL FUNCTIONS
*/
static void simpleBLECentralProcessGATTMsg( gattMsgEvent_t *pMsg );
static void simpleBLECentralRssiCB( uint16 connHandle, int8 rssi );
static uint8 simpleBLECentralEventCB( gapCentralRoleEvent_t *pEvent );
//static void simpleBLECentralPasscodeCB( uint8 *deviceAddr, uint16 connectionHandle,
// uint8 uiInputs, uint8 uiOutputs );
//static void simpleBLECentralPairStateCB( uint16 connHandle, uint8 state, uint8 status );
static void simpleBLECentral_HandleKeys( uint8 shift, uint8 keys );
static void simpleBLECentral_ProcessOSALMsg( osal_event_hdr_t *pMsg );
static void simpleBLEGATTDiscoveryEvent( gattMsgEvent_t *pMsg );
static void simpleBLECentralStartDiscovery( void );
//static bool simpleBLEFindSvcUuid( uint16 uuid, uint8 *pData, uint8 dataLen );
//static void simpleBLEAddDeviceInfo( uint8 *pAddr, uint8 addrType );
void simpleBLECentralDisp(void);
static void simpleBLEAddDeviceInfo_1(uint8 *pAddr, uint8 addrType,uint8 *pd, uint8 len,int8 rssi);
/*********************************************************************
* PROFILE CALLBACKS
*/
// GAP Role Callbacks
static const gapCentralRoleCB_t simpleBLERoleCB =
{
simpleBLECentralRssiCB, // RSSI callback
simpleBLECentralEventCB // Event callback
};
// Bond Manager Callbacks
/*static const gapBondCBs_t simpleBLEBondCB =
{
simpleBLECentralPasscodeCB,
simpleBLECentralPairStateCB
};*/
/*********************************************************************
* PUBLIC FUNCTIONS
*/
/*********************************************************************
* @fn SimpleBLECentral_Init
*
* @brief Initialization function for the Simple BLE Central App Task.
* This is called during initialization and should contain
* any application specific initialization (ie. hardware
* initialization/setup, table initialization, power up
* notification).
*
* @param task_id - the ID assigned by OSAL. This ID should be
* used to send messages and set timers.
*
* @return none
*/
void SimpleBLECentral_Init( uint8 task_id )
{
simpleBLETaskId = task_id;
// Setup Central Profile
{
uint8 scanRes = DEFAULT_MAX_SCAN_RES;
GAPCentralRole_SetParameter ( GAPCENTRALROLE_MAX_SCAN_RES, sizeof( uint8 ), &scanRes );
GAPObserverRole_SetParameter ( GAPOBSERVERROLE_MAX_SCAN_RES, sizeof( uint8 ), &scanRes );
}
// Setup GAP
GAP_SetParamValue( TGAP_GEN_DISC_SCAN, DEFAULT_SCAN_DURATION );
GAP_SetParamValue( TGAP_LIM_DISC_SCAN, DEFAULT_SCAN_DURATION );
GGS_SetParameter( GGS_DEVICE_NAME_ATT, GAP_DEVICE_NAME_LEN, (uint8 *) simpleBLEDeviceName );
// Setup the GAP Bond Manager
#if 0
{
uint32 passkey = DEFAULT_PASSCODE;
uint8 pairMode = DEFAULT_PAIRING_MODE;
uint8 mitm = DEFAULT_MITM_MODE;
uint8 ioCap = DEFAULT_IO_CAPABILITIES;
uint8 bonding = DEFAULT_BONDING_MODE;
GAPBondMgr_SetParameter( GAPBOND_DEFAULT_PASSCODE, sizeof( uint32 ), &passkey );
GAPBondMgr_SetParameter( GAPBOND_PAIRING_MODE, sizeof( uint8 ), &pairMode );
GAPBondMgr_SetParameter( GAPBOND_MITM_PROTECTION, sizeof( uint8 ), &mitm );
GAPBondMgr_SetParameter( GAPBOND_IO_CAPABILITIES, sizeof( uint8 ), &ioCap );
GAPBondMgr_SetParameter( GAPBOND_BONDING_ENABLED, sizeof( uint8 ), &bonding );
}
#endif
// Initialize GATT Client
VOID GATT_InitClient();
// Register to receive incoming ATT Indications/Notifications
GATT_RegisterForInd( simpleBLETaskId );
// Initialize GATT attributes
GGS_AddService( GATT_ALL_SERVICES ); // GAP
GATTServApp_AddService( GATT_ALL_SERVICES ); // GATT attributes
// Register for all key events - This app will handle all key events
RegisterForKeys( simpleBLETaskId );
// makes sure LEDs are off
//HalLedSet( (HAL_LED_1 | HAL_LED_2), HAL_LED_MODE_OFF );
// Setup a delayed profile startup
osal_set_event( simpleBLETaskId, START_DEVICE_EVT );
}
void simpleBLEStartScan()
{
LCD_WRITE_STRING( "--simpleBLEStartScan", HAL_LCD_LINE_2 );
//Serial_Delay(10);
simpleBLECentralCanSend = FALSE;
//����������Ͻ��У��Զ���ʼ����
if ( (!simpleBLEScanning ) && (tagCen.disi_start == 1) && (sys_config.workMode == 1) /*&& (tagCen.start == 1)*/)
{
simpleBLEScanning = TRUE;
simpleBLEScanRes = 0;
tagCen.disi_start = 0;
/* GAPCentralRole_StartDiscovery( DEFAULT_DISCOVERY_MODE,
DEFAULT_DISCOVERY_ACTIVE_SCAN,
DEFAULT_DISCOVERY_WHITE_LIST );
LCD_WRITE_STRING( "Scanning...", HAL_LCD_LINE_1 );
*/
GAPObserverRole_StartDiscovery( DEFAULT_DISCOVERY_MODE,
DEFAULT_DISCOVERY_ACTIVE_SCAN,
DEFAULT_DISCOVERY_WHITE_LIST );
NPI_WriteTransport("Scanning...\r\n",13);
//GAPCentralRole_StartRssi( simpleBLEConnHandle, DEFAULT_RSSI_PERIOD );
}
else
{
LCD_WRITE_STRING( "No Scan", HAL_LCD_LINE_1 );
//NPI_WriteTransport("No Scan\r\n",9);
}
}
/*********************************************************************
* @fn SimpleBLECentral_ProcessEvent
*
* @brief Simple BLE Central 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 OSAL 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 SimpleBLECentral_ProcessEvent( uint8 task_id, uint16 events )
{
VOID task_id; // OSAL required parameter that isn't used in this function
if ( events & SYS_EVENT_MSG )
{
uint8 *pMsg;
if ( (pMsg = osal_msg_receive( simpleBLETaskId )) != NULL )
{
simpleBLECentral_ProcessOSALMsg( (osal_event_hdr_t *)pMsg );
// Release the OSAL message
VOID osal_msg_deallocate( pMsg );
}
// return unprocessed events
return (events ^ SYS_EVENT_MSG);
}
if ( events & START_DEVICE_EVT )
{
// Start the Device
// VOID GAPCentralRole_StartDevice( (gapCentralRoleCB_t *) &simpleBLERoleCB );
// Register with bond manager after starting device
// GAPBondMgr_Register( (gapBondCBs_t *) &simpleBLEBondCB );
//simpleBLEStartScan();
// Start the Device
VOID GAPObserverRole_StartDevice( (gapObserverRoleCB_t *) &simpleBLERoleCB );
osal_start_timerEx( simpleBLETaskId, Cen_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD );
// CheckKeyForSetAllParaDefault(); //��������3�룬 �ظ���������
return ( events ^ START_DEVICE_EVT );
}
if ( events & Cen_PERIODIC_EVT )
{
// Restart timer
if ( SBP_PERIODIC_EVT_PERIOD )
{
osal_start_timerEx( simpleBLETaskId, Cen_PERIODIC_EVT, SBP_PERIODIC_EVT_PERIOD );
}
// Perform periodic application task
// performPeriodicTask();
if ( simpleBLEState == BLE_STATE_CONNECTED )
{
if ( !simpleBLERssi )
{
simpleBLERssi = TRUE;
GAPCentralRole_StartRssi( simpleBLEConnHandle, DEFAULT_RSSI_PERIOD );
LCD_WRITE_STRING( "RSSI Start...", HAL_LCD_LINE_1 );
NPI_WriteTransport("RSSI Start...\r\n",15);
}
}
else
{
if(simpleBLERssi)
{
simpleBLERssi = FALSE;
GAPCentralRole_CancelRssi( simpleBLEConnHandle );
LCD_WRITE_STRING( "RSSI Cancelled", HAL_LCD_LINE_1 );
NPI_WriteTransport("RSSI Cancelled\r\n",16);
}
else
{
simpleBLEStartScan();
}
}
return (events ^ Cen_PERIODIC_EVT);
}
if ( events & START_DISCOVERY_EVT )
{
simpleBLECentralStartDiscovery( );
return ( events ^ START_DISCOVERY_EVT );
}
if(events & Centrl_SCANIB_EVT )
{
simpleBLECentralDisp();
return ( events ^ Centrl_SCANIB_EVT );
}
//�����λ
if ( events & SBP_RESET_EVT )
{
//delay
uint32 i=0;
for(i=100000;i>0;i--){
asm("nop");
}
SystemReset();
// return (events ^ SBP_RESET_EVT);
}
// Discard unknown events
return 0;
}
/*********************************************************************
* @fn simpleBLECentral_ProcessOSALMsg
*
* @brief Process an incoming task message.
*
* @param pMsg - message to process
*
* @return none
*/
static void simpleBLECentral_ProcessOSALMsg( osal_event_hdr_t *pMsg )
{
switch ( pMsg->event )
{
case KEY_CHANGE:
simpleBLECentral_HandleKeys( ((keyChange_t *)pMsg)->state, ((keyChange_t *)pMsg)->keys );
break;
case GATT_MSG_EVENT:
simpleBLECentralProcessGATTMsg( (gattMsgEvent_t *) pMsg );
break;
}
}
/*********************************************************************
* @fn simpleBLECentral_HandleKeys
*
* @brief Handles all key events for this device.
*
* @param shift - true if in shift/alt.
* @param keys - bit field for key events. Valid entries:
* HAL_KEY_SW_2
* HAL_KEY_SW_1
*
* @return none
*/
uint8 gStatus;
static void simpleBLECentral_HandleKeys( uint8 shift, uint8 keys )
{
(void)shift; // Intentionally unreferenced parameter
#if 0
if ( keys & HAL_KEY_UP )
{
LCD_WRITE_STRING( "HAL_KEY_UP", HAL_LCD_LINE_7 );
// Start or stop discovery
if ( simpleBLEState != BLE_STATE_CONNECTED )
{
if ( !simpleBLEScanning )
{
simpleBLEScanning = TRUE;
simpleBLEScanRes = 0;
LCD_WRITE_STRING( "Discovering...", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( "", HAL_LCD_LINE_2 );
GAPCentralRole_StartDiscovery( DEFAULT_DISCOVERY_MODE,
DEFAULT_DISCOVERY_ACTIVE_SCAN,
DEFAULT_DISCOVERY_WHITE_LIST );
}
else
{
GAPCentralRole_CancelDiscovery();
}
}
else if ( simpleBLEState == BLE_STATE_CONNECTED &&
simpleBLECharHdl != 0 &&
simpleBLEProcedureInProgress == FALSE )
{
uint8 status;
// Do a read or write as long as no other read or write is in progress
if ( simpleBLEDoWrite )
{
// Do a write
attWriteReq_t req;
req.pValue = GATT_bm_alloc( simpleBLEConnHandle, ATT_WRITE_REQ, 1, NULL );
req.handle = simpleBLECharHdl;
req.len = 1;
req.pValue[0] = simpleBLECharVal;
req.sig = 0;
req.cmd = 0;
status = GATT_WriteCharValue( simpleBLEConnHandle, &req, simpleBLETaskId );
if ( status != SUCCESS )
{
GATT_bm_free( (gattMsg_t *)&req, ATT_WRITE_REQ );
}
}
else
{
// Do a read
attReadReq_t req;
req.handle = simpleBLECharHdl;
status = GATT_ReadCharValue( simpleBLEConnHandle, &req, simpleBLETaskId );
}
if ( status == SUCCESS )
{
simpleBLEProcedureInProgress = TRUE;
simpleBLEDoWrite = !simpleBLEDoWrite;
}
}
}
if ( keys & HAL_KEY_LEFT )
{
LCD_WRITE_STRING( "HAL_KEY_LEFT", HAL_LCD_LINE_7 );
// Display discovery results
if ( !simpleBLEScanning && simpleBLEScanRes > 0 )
{
// Increment index of current result (with wraparound)
simpleBLEScanIdx++;
if ( simpleBLEScanIdx >= simpleBLEScanRes )
{
simpleBLEScanIdx = 0;
}
LCD_WRITE_STRING_VALUE( "Device", simpleBLEScanIdx + 1,
10, HAL_LCD_LINE_1 );
LCD_WRITE_STRING( bdAddr2Str( simpleBLEDevList[simpleBLEScanIdx].addr ),
HAL_LCD_LINE_2 );
}
}
if ( keys & HAL_KEY_RIGHT )
{
LCD_WRITE_STRING( "HAL_KEY_RIGHT", HAL_LCD_LINE_7 );
// Connection update
if ( simpleBLEState == BLE_STATE_CONNECTED )
{
GAPCentralRole_UpdateLink( simpleBLEConnHandle,
DEFAULT_UPDATE_MIN_CONN_INTERVAL,
DEFAULT_UPDATE_MAX_CONN_INTERVAL,
DEFAULT_UPDATE_SLAVE_LATENCY,
DEFAULT_UPDATE_CONN_TIMEOUT );
}
}
if ( keys & HAL_KEY_CENTER )
{
uint8 addrType;
uint8 *peerAddr;
LCD_WRITE_STRING( "HAL_KEY_CENTER", HAL_LCD_LINE_7 );
// Connect or disconnect
if ( simpleBLEState == BLE_STATE_IDLE )
{
// if there is a scan result
if ( simpleBLEScanRes > 0 )
{
// connect to current device in scan result
peerAddr = simpleBLEDevList[simpleBLEScanIdx].addr;
addrType = simpleBLEDevList[simpleBLEScanIdx].addrType;
simpleBLEState = BLE_STATE_CONNECTING;
GAPCentralRole_EstablishLink( DEFAULT_LINK_HIGH_DUTY_CYCLE,
DEFAULT_LINK_WHITE_LIST,
addrType, peerAddr );
LCD_WRITE_STRING( "Connecting", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( bdAddr2Str( peerAddr ), HAL_LCD_LINE_2 );
}
}
else if ( simpleBLEState == BLE_STATE_CONNECTING ||
simpleBLEState == BLE_STATE_CONNECTED )
{
// disconnect
simpleBLEState = BLE_STATE_DISCONNECTING;
gStatus = GAPCentralRole_TerminateLink( simpleBLEConnHandle );
LCD_WRITE_STRING( "Disconnecting", HAL_LCD_LINE_1 );
}
}
if ( keys & HAL_KEY_DOWN )
{
LCD_WRITE_STRING( "HAL_KEY_DOWN", HAL_LCD_LINE_7 );
// Start or cancel RSSI polling
if ( simpleBLEState == BLE_STATE_CONNECTED )
{
if ( !simpleBLERssi )
{
simpleBLERssi = TRUE;
GAPCentralRole_StartRssi( simpleBLEConnHandle, DEFAULT_RSSI_PERIOD );
}
else
{
simpleBLERssi = FALSE;
GAPCentralRole_CancelRssi( simpleBLEConnHandle );
LCD_WRITE_STRING( "RSSI Cancelled", HAL_LCD_LINE_1 );
}
}
}
#endif
}
/*********************************************************************
* @fn simpleBLECentralProcessGATTMsg
*
* @brief Process GATT messages
*
* @return none
*/
static void simpleBLECentralProcessGATTMsg( gattMsgEvent_t *pMsg )
{
if ( simpleBLEState != BLE_STATE_CONNECTED )
{
// In case a GATT message came after a connection has dropped,
// ignore the message
return;
}
if ( ( pMsg->method == ATT_READ_RSP ) ||
( ( pMsg->method == ATT_ERROR_RSP ) &&
( pMsg->msg.errorRsp.reqOpcode == ATT_READ_REQ ) ) )
{
if ( pMsg->method == ATT_ERROR_RSP )
{
// uint8 status = pMsg->msg.errorRsp.errCode;
// LCD_WRITE_STRING_VALUE( "Read Error", status, 10, HAL_LCD_LINE_1 );
}
else
{
// After a successful read, display the read value
// uint8 valueRead = pMsg->msg.readRsp.pValue[0];
// LCD_WRITE_STRING_VALUE( "Read rsp:", valueRead, 10, HAL_LCD_LINE_1 );
}
//simpleBLEProcedureInProgress = FALSE;
}
else if ( ( pMsg->method == ATT_WRITE_RSP ) ||
( ( pMsg->method == ATT_ERROR_RSP ) &&
( pMsg->msg.errorRsp.reqOpcode == ATT_WRITE_REQ ) ) )
{
if ( pMsg->method == ATT_ERROR_RSP == ATT_ERROR_RSP )
{
// uint8 status = pMsg->msg.errorRsp.errCode;
// LCD_WRITE_STRING_VALUE( "Write Error", status, 10, HAL_LCD_LINE_1 );
}
else
{
// After a succesful write, display the value that was written and increment value
//LCD_WRITE_STRING_VALUE( "Write sent:", simpleBLECharVal++, 10, HAL_LCD_LINE_1 );
// ����������ڱ�����һ��д���ݵ��ӻ��Ѿ��ɹ��� �������ж�д����ʱ���жϣ� ��ȷ�����ݵ�������
simpleBLEChar6DoWrite = TRUE;
}
//simpleBLEProcedureInProgress = FALSE;
}
else if ( simpleBLEDiscState != BLE_DISC_STATE_IDLE )
{
simpleBLEGATTDiscoveryEvent( pMsg );
}
else if ( ( pMsg->method == ATT_HANDLE_VALUE_NOTI ) ) //֪ͨ
{
if( pMsg->msg.handleValueNoti.handle == 0x0035) //CHAR6��֪ͨ ���ڴ�ӡ
{
NPI_WriteTransport(pMsg->msg.handleValueNoti.pValue, pMsg->msg.handleValueNoti.len );
}
}
}
/*********************************************************************
* @fn simpleBLECentralRssiCB
*
* @brief RSSI callback.
*
* @param connHandle - connection handle
* @param rssi - RSSI
*
* @return none
*/
static void simpleBLECentralRssiCB( uint16 connHandle, int8 rssi )
{
char strTp[64];
LCD_WRITE_STRING_VALUE( "RSSI -dB:", (uint8) (-rssi), 10, HAL_LCD_LINE_1 );
simpleBle_SetRssi(rssi);
sprintf(strTp, "RSSI -dB:%d\r\n", (uint8)(-sys_config.rssi));
NPI_WriteTransport((uint8*)strTp, osal_strlen(strTp));
}
/*********************************************************************
* @fn simpleBLECentralEventCB
*
* @brief Central event callback function.
*
* @param pEvent - pointer to event structure
*
* @return none
*/
static uint8 simpleBLECentralEventCB( gapCentralRoleEvent_t *pEvent )
{
// gapCentralRoleEvent_t *pTp;
switch ( pEvent->gap.opcode )
{
case GAP_DEVICE_INIT_DONE_EVENT:
{
LCD_WRITE_STRING( "BLE Central", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( bdAddr2Str( pEvent->initDone.devAddr ), HAL_LCD_LINE_2 );
NPI_WriteTransport("BLE Central\r\n",13);
}
break;
case GAP_DEVICE_INFO_EVENT:
{
// if filtering device discovery results based on service UUID
if ( DEFAULT_DEV_DISC_BY_SVC_UUID == TRUE )
{
/* if ( simpleBLEFindSvcUuid( SIMPLEPROFILE_SERV_UUID,
pEvent->deviceInfo.pEvtData,
pEvent->deviceInfo.dataLen ) )*/
{
// pTp = pEvent;
// simpleBLEAddDeviceInfo( pEvent->deviceInfo.addr, pEvent->deviceInfo.addrType );
}
}
simpleBLEAddDeviceInfo_1(pEvent->deviceInfo.addr, pEvent->deviceInfo.addrType,pEvent->deviceInfo.pEvtData,pEvent->deviceInfo.dataLen,pEvent->deviceInfo.rssi);
}
break;
case GAP_DEVICE_DISCOVERY_EVENT:
{
// discovery complete
simpleBLEScanning = FALSE;
// if not filtering device discovery results based on service UUID
if ( DEFAULT_DEV_DISC_BY_SVC_UUID == FALSE )
{
// Copy results
simpleBLEScanRes = pEvent->discCmpl.numDevs;
osal_memcpy( simpleBLEDevList, pEvent->discCmpl.pDevList,
(sizeof( gapDevRec_t ) * pEvent->discCmpl.numDevs) );
}
LCD_WRITE_STRING_VALUE( "Devices Found", simpleBLEScanRes,
10, HAL_LCD_LINE_1 );
if ( simpleBLEScanRes > 0 )
{
LCD_WRITE_STRING( "<- To Select", HAL_LCD_LINE_2 );
//������Ծ������ӵ�������������һ���ӻ��� ������Խ��дӻ���ַ����жϣ� ���磬 �������ӵ����һ�����ӳɹ���mac��ַ�Ĵӻ�
//HalLedSet(HAL_LED_3, HAL_LED_MODE_ON ); //��LED3
if ( (simpleBLEState == BLE_STATE_IDLE) ||(simpleBLEState == BLE_STATE_DISCONNECTING) )
{
// uint8 addrType;
// uint8 *peerAddr;
uint8 i;
//uint8 Addr[MAC_ADDR_CHAR_LEN];
uint8 strTp[81];
char strUUID1[17];
char strUUID2[17];
char strmaj[11];
char strVendor[9];
//bool ret = FALSE;;
//bool ifDoConnect = FALSE;
for(i = 0; i < simpleBLEScanRes; i++)
{
LCD_WRITE_STRING_VALUE( "--->peerAddr ", i, 10, HAL_LCD_LINE_2 );
//Serial_Delay(1);
LCD_WRITE_STRING( bdAddr2Str( simpleBLEDevList[i].addr ), HAL_LCD_LINE_2 );
//Serial_Delay(1);
/* sprintf((char *)&strTp, "OK+DISC:%.8s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[5],4));
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
//Serial_Delay(10);
//sprintf((char *)&strTp[16], ":%.32s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[9],16));
sprintf((char *)strTp, ":%.16s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[9],8));
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
sprintf((char *)strTp, "%.16s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[17],8));
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
//Serial_Delay(10);
//sprintf((char *)&strTp[49], ":%.10s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[25],5));
sprintf((char *)strTp, ":%.10s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[25],5));
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
//Serial_Delay(10);
//sprintf((char *)&strTp[60], ":%.12s:-%0.3d\r\n", bdAddr2Str( simpleBLEDevList[i].addr ),tagCibe.gapDevRec_rssi[i]);
sprintf((char *)strTp, ":%.12s:-%0.3d\r\n", bdAddr2Str( simpleBLEDevList[i].addr ),tagCibe.gapDevRec_rssi[i]);
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
*/
sprintf((char *)strVendor, "%.9s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[5],4));
sprintf((char *)strUUID1, "%.17s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[9],8));
sprintf((char *)strUUID2, "%.17s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[17],8));
sprintf((char *)strmaj, "%.11s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[25],5));
if(osal_memcmp(&tagCibe.gapDevRec_tp[i].data[5], "\x4C\x00\x02\x15" , 4 ) == 0)
{
osal_memset(strUUID1,'0',17);
osal_memset(strUUID2,'0',17);
osal_memset(strmaj,'0',11);
osal_memset(strVendor,'0',9);
}
sprintf((char *)strTp, "OK+DISC:%.8s:%.16s%.16s:%.10s:%.12s:-%0.3d\r\n",strVendor,strUUID1,strUUID2,strmaj, bdAddr2Str( simpleBLEDevList[i].addr ),tagCibe.gapDevRec_rssi[i]);
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
}
Serial_Delay(2);
//debug
// osal_set_event(simpleBLETaskId, Centrl_SCANIB_EVT);
/* NPI_WriteTransport((uint8 *)strTp, 96);
NPI_WriteTransport((uint8 *)&strTp[96], 96);
NPI_WriteTransport((uint8 *)&strTp[192], 96);
NPI_WriteTransport((uint8 *)&strTp[288], 96);*/
NPI_WriteTransport("OK+DISCE", osal_strlen("OK+DISCE"));
// GAPCentralRole_CancelRssi( simpleBLEConnHandle );
//Serial_Delay(10);
//Serial_Delay(1);
#if 0//�Զ����ӷ��ֵĵ�һ�����豸
ret = simpleBLE_GetPeripheralMacAddr(Addr);
//LCD_WRITE_STRING_VALUE( "--->ret ", ret, 10, HAL_LCD_LINE_2 );
//Serial_Delay(1);
//simpleBLEScanIdx = 0;
for(i = 0; i < simpleBLEScanRes; i++)
{
LCD_WRITE_STRING_VALUE( "peerAddr ", i, 10, HAL_LCD_LINE_2 );
LCD_WRITE_STRING( bdAddr2Str( simpleBLEDevList[i].addr ), HAL_LCD_LINE_2 );
// connect to current device in scan result
peerAddr = simpleBLEDevList[i].addr;
addrType = simpleBLEDevList[i].addrType;
if(ret == FALSE) //���û�м�¼��ַ�� ���¼��ַ�� �����ӵ�һ�����豸
{
simpleBLE_SetPeripheralMacAddr((uint8*)bdAddr2Str( simpleBLEDevList[i].addr )+2);
simpleBLE_SaveAllDataToFlash();
//simpleBLEScanIdx = i;
ifDoConnect = TRUE;
break;
}
else
{
//ָ������ij�豸, ����ô�ɨ��û��֮ǰ���ӹ��ĵ�ַ�� ��������
if(osal_memcmp(Addr, bdAddr2Str( simpleBLEDevList[i].addr )+2, MAC_ADDR_CHAR_LEN))
{
//simpleBLEScanIdx = i;
ifDoConnect = TRUE;
break;
}
}
}
#endif
#if 0// ����ָ��MAC��ַ�Ĵ��豸
if(simpleBLE_GetToConnectFlag(Addr))
{
// ����ָ����mac ��ַ�Ĵӻ��豸
simpleBLEScanIdx = 0;
for(i = 0; i < simpleBLEScanRes; i++)
{
LCD_WRITE_STRING_VALUE( "peerAddr ", i, 10, HAL_LCD_LINE_2 );
LCD_WRITE_STRING( bdAddr2Str( simpleBLEDevList[i].addr ), HAL_LCD_LINE_2 );
// connect to current device in scan result
peerAddr = simpleBLEDevList[i].addr;
addrType = simpleBLEDevList[i].addrType;
if(osal_memcmp(Addr, bdAddr2Str( simpleBLEDevList[i].addr )+2, MAC_ADDR_CHAR_LEN))
{
simpleBLEScanIdx = i;
ifDoConnect = TRUE;
break;
}
}
}
#endif
/* if(ifDoConnect)
{
simpleBLEState = BLE_STATE_CONNECTING;
LCD_WRITE_STRING( "Connecting", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( bdAddr2Str( pEvent->linkCmpl.devAddr ), HAL_LCD_LINE_2 );
GAPCentralRole_EstablishLink( DEFAULT_LINK_HIGH_DUTY_CYCLE,
DEFAULT_LINK_WHITE_LIST,
addrType, peerAddr );
//sprintf(strTp, "establishlink:%s\r\n", bdAddr2Str( peerAddr ));
//NPI_WriteTransport((uint8*)strTp, osal_strlen(strTp));
}
else */
{
//LCD_WRITE_STRING( "Continue scanning", HAL_LCD_LINE_1 );
//NPI_WriteTransport("Scanning...", 11);
// ����ɨ��
simpleBLEScanning = FALSE;
// simpleBLEScanRes = 0;
// simpleBLERssi = 0;
// simpleBLEStartScan();
}
}
//HalLedSet(HAL_LED_3, HAL_LED_MODE_OFF );
// initialize scan index to last device
//simpleBLEScanIdx = simpleBLEScanRes;
}
else
{
simpleBLERssi = 0;
simpleBLEStartScan();
}
}
break;
case GAP_LINK_ESTABLISHED_EVENT:
{
if ( pEvent->gap.hdr.status == SUCCESS )
{
simpleBLEState = BLE_STATE_CONNECTED;
simpleBLEConnHandle = pEvent->linkCmpl.connectionHandle;
//simpleBLEProcedureInProgress = TRUE;
// If service discovery not performed initiate service discovery
if ( simpleBLECharHdl == 0 )
{
osal_start_timerEx( simpleBLETaskId, START_DISCOVERY_EVT, DEFAULT_SVC_DISCOVERY_DELAY );
}
LCD_WRITE_STRING( "Connected", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( bdAddr2Str( pEvent->linkCmpl.devAddr ), HAL_LCD_LINE_2 );
// HalLedSet(HAL_LED_3, HAL_LED_MODE_OFF );
}
else
{
simpleBLEState = BLE_STATE_IDLE;
simpleBLEConnHandle = GAP_CONNHANDLE_INIT;
//simpleBLERssi = FALSE;
simpleBLEDiscState = BLE_DISC_STATE_IDLE;
simpleBLECentralCanSend = FALSE;
LCD_WRITE_STRING( "Connect Failed", HAL_LCD_LINE_1 );
LCD_WRITE_STRING_VALUE( "Reason:", pEvent->gap.hdr.status, 10, HAL_LCD_LINE_2 );
//HalLedSet(HAL_LED_3, HAL_LED_MODE_OFF ); //��LED3
}
}
break;
case GAP_LINK_TERMINATED_EVENT:
{
simpleBLEState = BLE_STATE_IDLE;
simpleBLEConnHandle = GAP_CONNHANDLE_INIT;
//simpleBLERssi = FALSE;
simpleBLEDiscState = BLE_DISC_STATE_IDLE;
simpleBLECharHdl = 0;
//simpleBLEProcedureInProgress = FALSE;
simpleBLECentralCanSend = FALSE;
LCD_WRITE_STRING( "Disconnected", HAL_LCD_LINE_1 );
LCD_WRITE_STRING_VALUE( "Reason:", pEvent->linkTerminate.reason,
10, HAL_LCD_LINE_2 );
//HalLedSet(HAL_LED_3, HAL_LED_MODE_OFF ); //��LED3
//��������ʧ�ܺ� ���Գ���ִ�����������ɨ��ӻ�
simpleBLEScanRes = 0;
LCD_WRITE_STRING_VALUE( "simpleBLEScanning=", simpleBLEScanning, 10, HAL_LCD_LINE_1 );
LCD_WRITE_STRING_VALUE( "simpleBLEScanRes=", simpleBLEScanRes, 10, HAL_LCD_LINE_1 );
simpleBLEScanning = 0;
simpleBLEScanRes = 0;
simpleBLEStartScan();
}
break;
case GAP_LINK_PARAM_UPDATE_EVENT:
{
attWriteReq_t AttReq;
uint8 ValueBuf[2];
LCD_WRITE_STRING( "Param Update", HAL_LCD_LINE_1);
AttReq.handle = 0x0036;
AttReq.len = 2;
AttReq.sig = 0;
AttReq.cmd = 0;
ValueBuf[0] = 0x01;
ValueBuf[1] = 0x00;
osal_memcpy(AttReq.pValue,ValueBuf,2);
GATT_WriteCharValue( 0, &AttReq, simpleBLETaskId );
LCD_WRITE_STRING( "Enable Notice\n", HAL_LCD_LINE_1);
simpleBLECentralCanSend = TRUE;
NPI_WriteTransport("Connected\r\n", 11);
}
break;
default:
break;
}
return ( TRUE );
}
/*********************************************************************
* @fn pairStateCB
*
* @brief Pairing state callback.
*
* @return none
*/
/*static void simpleBLECentralPairStateCB( uint16 connHandle, uint8 state, uint8 status )
{
if ( state == GAPBOND_PAIRING_STATE_STARTED )
{
LCD_WRITE_STRING( "Pairing started", HAL_LCD_LINE_1 );
}
else if ( state == GAPBOND_PAIRING_STATE_COMPLETE )
{
if ( status == SUCCESS )
{
LCD_WRITE_STRING( "Pairing success", HAL_LCD_LINE_1 );
}
else
{
LCD_WRITE_STRING_VALUE( "Pairing fail", status, 10, HAL_LCD_LINE_1 );
}
}
else if ( state == GAPBOND_PAIRING_STATE_BONDED )
{
if ( status == SUCCESS )
{
LCD_WRITE_STRING( "Bonding success", HAL_LCD_LINE_1 );
}
}
}
*/
/*********************************************************************
* @fn simpleBLECentralPasscodeCB
*
* @brief Passcode callback.
*
* @return none
*/
/*static void simpleBLECentralPasscodeCB( uint8 *deviceAddr, uint16 connectionHandle,
uint8 uiInputs, uint8 uiOutputs )
{
#if (HAL_LCD == TRUE)
uint32 passcode;
uint8 str[7];
// Create random passcode
LL_Rand( ((uint8 *) &passcode), sizeof( uint32 ));
passcode %= 1000000;
// Display passcode to user
if ( uiOutputs != 0 )
{
LCD_WRITE_STRING( "Passcode:", HAL_LCD_LINE_1 );
LCD_WRITE_STRING( (char *) _ltoa(passcode, str, 10), HAL_LCD_LINE_2 );
}
// Send passcode response
GAPBondMgr_PasscodeRsp( connectionHandle, SUCCESS, passcode );
#endif
}
*/
/*********************************************************************
* @fn simpleBLECentralStartDiscovery
*
* @brief Start service discovery.
*
* @return none
*/
static void simpleBLECentralStartDiscovery( void )
{
uint8 uuid[ATT_BT_UUID_SIZE] = { LO_UINT16(SIMPLEPROFILE_SERV_UUID),
HI_UINT16(SIMPLEPROFILE_SERV_UUID) };
// Initialize cached handles
simpleBLESvcStartHdl = simpleBLESvcEndHdl = simpleBLECharHdl = 0;
simpleBLEDiscState = BLE_DISC_STATE_SVC;
// Discovery simple BLE service
GATT_DiscPrimaryServiceByUUID( simpleBLEConnHandle,
uuid,
ATT_BT_UUID_SIZE,
simpleBLETaskId );
}
/*********************************************************************
* @fn simpleBLEGATTDiscoveryEvent
*
* @brief Process GATT discovery event
*
* @return none
*/
static void simpleBLEGATTDiscoveryEvent( gattMsgEvent_t *pMsg )
{
attReadByTypeReq_t req;
if ( simpleBLEDiscState == BLE_DISC_STATE_SVC )
{
// Service found, store handles
if ( pMsg->method == ATT_FIND_BY_TYPE_VALUE_RSP &&
pMsg->msg.findByTypeValueRsp.numInfo > 0 )
{
simpleBLESvcStartHdl = ATT_ATTR_HANDLE(pMsg->msg.findByTypeValueRsp.pHandlesInfo, 0);
simpleBLESvcEndHdl = ATT_GRP_END_HANDLE(pMsg->msg.findByTypeValueRsp.pHandlesInfo, 0);
}
// If procedure complete
if ( ( pMsg->method == ATT_FIND_BY_TYPE_VALUE_RSP &&
pMsg->hdr.status == bleProcedureComplete ) ||
( pMsg->method == ATT_ERROR_RSP ) )
{
if ( simpleBLESvcStartHdl != 0 )
{
// Discover characteristic
simpleBLEDiscState = BLE_DISC_STATE_CHAR;
req.startHandle = simpleBLESvcStartHdl;
req.endHandle = simpleBLESvcEndHdl;
req.type.len = ATT_BT_UUID_SIZE;
req.type.uuid[0] = LO_UINT16(SIMPLEPROFILE_CHAR4_UUID);
req.type.uuid[1] = HI_UINT16(SIMPLEPROFILE_CHAR4_UUID);
GATT_ReadUsingCharUUID( simpleBLEConnHandle, &req, simpleBLETaskId );
}
}
}
else if ( simpleBLEDiscState == BLE_DISC_STATE_CHAR )
{
// Characteristic found, store handle
if ( pMsg->method == ATT_READ_BY_TYPE_RSP &&
pMsg->msg.readByTypeRsp.numPairs > 0 )
{
simpleBLECharHd6 = BUILD_UINT16( pMsg->msg.readByTypeRsp.pDataList[0],
pMsg->msg.readByTypeRsp.pDataList[1] );
LCD_WRITE_STRING( "Simple Svc Found", HAL_LCD_LINE_1 );
//simpleBLEProcedureInProgress = FALSE;
}
simpleBLEDiscState = BLE_DISC_STATE_IDLE;
}
}
/*********************************************************************
* @fn simpleBLEFindSvcUuid
*
* @brief Find a given UUID in an advertiser's service UUID list.
*
* @return TRUE if service UUID found
*/
/*static bool simpleBLEFindSvcUuid( uint16 uuid, uint8 *pData, uint8 dataLen )
{
uint8 adLen;
uint8 adType;
uint8 *pEnd;
pEnd = pData + dataLen - 1;
// While end of data not reached
while ( pData < pEnd )
{
// Get length of next AD item
adLen = *pData++;
if ( adLen > 0 )
{
adType = *pData;
// If AD type is for 16-bit service UUID
if ( adType == GAP_ADTYPE_16BIT_MORE || adType == GAP_ADTYPE_16BIT_COMPLETE )
{
pData++;
adLen--;
// For each UUID in list
while ( adLen >= 2 && pData < pEnd )
{
// Check for match
if ( pData[0] == LO_UINT16(uuid) && pData[1] == HI_UINT16(uuid) )
{
// Match found
return TRUE;
}
// Go to next
pData += 2;
adLen -= 2;
}
// Handle possible erroneous extra byte in UUID list
if ( adLen == 1 )
{
pData++;
}
}
else
{
// Go to next item
pData += adLen;
}
}
}
// Match not found
return FALSE;
}
*/
/*********************************************************************
* @fn simpleBLEAddDeviceInfo
*
* @brief Add a device to the device discovery result list
*
* @return none
*/
/*static void simpleBLEAddDeviceInfo( uint8 *pAddr, uint8 addrType)
{
uint8 i;
// If result count not at max
if ( simpleBLEScanRes < DEFAULT_MAX_SCAN_RES )
{
// Check if device is already in scan results
for ( i = 0; i < simpleBLEScanRes; i++ )
{
if ( osal_memcmp( pAddr, simpleBLEDevList[i].addr , B_ADDR_LEN ) )
{
return;
}
}
// Add addr to scan result list
osal_memcpy( simpleBLEDevList[simpleBLEScanRes].addr, pAddr, B_ADDR_LEN );
simpleBLEDevList[simpleBLEScanRes].addrType = addrType;
// Increment scan result count
simpleBLEScanRes++;
}
}
*/
static void simpleBLEAddDeviceInfo_1(uint8 *pAddr, uint8 addrType,uint8 *pd, uint8 len,int8 rssi)
{
uint8 i;
// If result count not at max
if ( simpleBLEScanRes < DEFAULT_MAX_SCAN_RES )
{
// Check if device is already in scan results
for ( i = 0; i < simpleBLEScanRes; i++ )
{
if ( osal_memcmp( pAddr, simpleBLEDevList[i].addr , B_ADDR_LEN ) )
{
return;
}
}
// Add addr to scan result list
osal_memcpy( simpleBLEDevList[simpleBLEScanRes].addr, pAddr, B_ADDR_LEN );
simpleBLEDevList[simpleBLEScanRes].addrType = addrType;
osal_memcpy(&tagCibe.gapDevRec_tp[simpleBLEScanRes],pd,len);
tagCibe.gapDevRec_rssi[simpleBLEScanRes] = 256 - (uint8)rssi;
// Increment scan result count
simpleBLEScanRes++;
}
}
//xianshifunction
void simpleBLECentralDisp(void)
{
uint8 i;
//uint8 Addr[MAC_ADDR_CHAR_LEN];
uint8 strTp[80];
for(i = 0; i < simpleBLEScanRes; i++)
{
sprintf((char *)&strTp, "OK+DISC:%s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[5],4));
sprintf((char *)&strTp[16], ":%s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[9],16));
sprintf((char *)&strTp[49], ":%s",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[25],5));
sprintf((char *)&strTp[60], ":%s:-%0.3d\r\n", bdAddr2Str( simpleBLEDevList[i].addr ),tagCibe.gapDevRec_rssi[i]);
//sprintf((char *)&strTp[0], "OK+DISC:%s:%s:%s:%s:-%d\r\n",bdhex2Str(&tagCibe.gapDevRec_tp[i].data[5],4),bdhex2Str(&tagCibe.gapDevRec_tp[i].data[9],16),bdhex2Str(&tagCibe.gapDevRec_tp[i].data[25],5), bdAddr2Str( simpleBLEDevList[i].addr ),tagCibe.gapDevRec_rssi[i]);
NPI_WriteTransport((uint8 *)strTp, osal_strlen((char *)strTp));
}
NPI_WriteTransport("OK+DISCE", osal_strlen("OK+DISCE"));
GAPCentralRole_CancelRssi( simpleBLEConnHandle );
}