12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219 |
-
- #if ( HOST_CONFIG & ( CENTRAL_CFG | PERIPHERAL_CFG ) )
- #include "bcomdef.h"
- #include "OSAL.h"
- #include "osal_snv.h"
- #include "gap.h"
- #include "linkdb.h"
- #include "gatt.h"
- #include "gatt_uuid.h"
- #include "hci.h"
- #include "gattservapp.h"
- #include "gapgattserver.h"
- #include "gapbondmgr.h"
- #define GAP_BOND_SYNC_CC_EVT 0x0001
- #define GAP_BOND_SAVE_REC_EVT 0x0002
- #define NV_COMPACT_THRESHOLD 80
- #define GAP_BONDED_STATE_AUTHENTICATED 0x0001
- #define GAP_BONDED_STATE_SERVICE_CHANGED 0x0002
- #define GAP_BOND_REC_ID_OFFSET 0
- #define GAP_BOND_LOCAL_LTK_OFFSET 1
- #define GAP_BOND_DEV_LTK_OFFSET 2
- #define GAP_BOND_DEV_IRK_OFFSET 3
- #define GAP_BOND_DEV_CSRK_OFFSET 4
- #define GAP_BOND_DEV_SIGN_COUNTER_OFFSET 5
- #define GAP_BOND_REC_IDS 6
- #define calcNvID(Idx, offset) (((((Idx) * GAP_BOND_REC_IDS) + (offset))) + BLE_NVID_GAP_BOND_START)
- #define mainRecordNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_REC_ID_OFFSET))
- #define localLTKNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_LOCAL_LTK_OFFSET))
- #define devLTKNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_DEV_LTK_OFFSET))
- #define devIRKNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_DEV_IRK_OFFSET))
- #define devCSRKNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_DEV_CSRK_OFFSET))
- #define devSignCounterNvID(bondIdx) (calcNvID((bondIdx), GAP_BOND_DEV_SIGN_COUNTER_OFFSET))
- #define gattCfgNvID(Idx) ((Idx) + BLE_NVID_GATT_CFG_START)
- #define MIN_ENC_KEYSIZE 7
- #define MAX_ENC_KEYSIZE 16
- typedef struct
- {
- uint8 LTK[KEYLEN];
- uint16 div;
- uint8 rand[B_RANDOM_NUM_SIZE];
- uint8 keySize;
- } gapBondLTK_t;
- typedef struct
- {
- uint8 publicAddr[B_ADDR_LEN];
- uint8 reconnectAddr[B_ADDR_LEN];
- uint16 stateFlags;
- } gapBondRec_t;
- typedef struct
- {
- uint16 attrHandle;
- uint8 value;
- } gapBondCharCfg_t;
- static uint8 gapBondMgr_TaskID = INVALID_TASK_ID;
- static uint8 gapBond_PairingMode = GAPBOND_PAIRING_MODE_WAIT_FOR_REQ;
- static uint16 gapBond_InitiateWait = 1000;
- static uint8 gapBond_MITM = FALSE;
- static uint8 gapBond_IOCap = GAPBOND_IO_CAP_DISPLAY_ONLY;
- static uint8 gapBond_OOBDataFlag = FALSE;
- static uint8 gapBond_OOBData[KEYLEN] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
- static uint8 gapBond_Bonding = FALSE;
- static uint8 gapBond_AutoFail = FALSE;
- static uint8 gapBond_AutoFailReason = SMP_PAIRING_FAILED_NOT_SUPPORTED;
- static uint8 gapBond_KeyDistList =
- (
- GAPBOND_KEYDIST_SENCKEY
- | GAPBOND_KEYDIST_SIDKEY
- | GAPBOND_KEYDIST_SSIGN
- | GAPBOND_KEYDIST_MENCKEY
- | GAPBOND_KEYDIST_MIDKEY
- | GAPBOND_KEYDIST_MSIGN
- );
- static uint32 gapBond_Passcode = 0;
- static uint8 gapBond_KeySize = MAX_ENC_KEYSIZE;
- #if ( HOST_CONFIG & CENTRAL_CFG )
- static uint8 gapBond_BondFailOption = GAPBOND_FAIL_TERMINATE_LINK;
- #endif
- static const gapBondCBs_t *pGapBondCB = NULL;
- static gapBondRec_t bonds[GAP_BONDINGS_MAX] = {0};
- static uint8 autoSyncWhiteList = FALSE;
- static uint8 eraseAllBonds = FALSE;
- static uint8 bondsToDelete[GAP_BONDINGS_MAX] = {FALSE};
- static uint8 bondIdx = GAP_BONDINGS_MAX;
- static gapAuthCompleteEvent_t *pAuthEvt = NULL;
- static uint8 gapBondMgrChangeState( uint8 idx, uint16 state, uint8 set );
- static uint8 gapBondMgrUpdateCharCfg( uint8 idx, uint16 attrHandle, uint16 value );
- static gapBondCharCfg_t *gapBondMgrFindCharCfgItem( uint16 attrHandle,
- gapBondCharCfg_t *charCfgTbl );
- static void gapBondMgrInvertCharCfgItem( gapBondCharCfg_t *charCfgTbl );
- static uint8 gapBondMgrAddBond( gapBondRec_t *pBondRec, gapAuthCompleteEvent_t *pPkt );
- static uint8 gapBondMgrGetStateFlags( uint8 idx );
- static bStatus_t gapBondMgrGetPublicAddr( uint8 idx, uint8 *pAddr );
- static uint8 gapBondMgrFindReconnectAddr( uint8 *pReconnectAddr );
- static uint8 gapBondMgrFindAddr( uint8 *pDevAddr );
- static uint8 gapBondMgrResolvePrivateAddr( uint8 *pAddr );
- static void gapBondMgrReadBonds( void );
- static uint8 gapBondMgrFindEmpty( void );
- static uint8 gapBondMgrBondTotal( void );
- static bStatus_t gapBondMgrEraseAllBondings( void );
- static bStatus_t gapBondMgrEraseBonding( uint8 idx );
- static uint8 gapBondMgr_ProcessOSALMsg( osal_event_hdr_t *pMsg );
- static void gapBondMgrSendServiceChange( linkDBItem_t *pLinkItem );
- static void gapBondMgr_ProcessGATTMsg( gattMsgEvent_t *pMsg );
- static void gapBondMgr_ProcessGATTServMsg( gattEventHdr_t *pMsg );
- static void gapBondSetupPrivFlag( void );
- static void gapBondMgrBondReq( uint16 connHandle, uint8 idx, uint8 stateFlags,
- uint8 role, uint8 startEncryption );
- static void gapBondMgrAuthenticate( uint16 connHandle, uint8 addrType,
- gapPairingReq_t *pPairReq );
- static void gapBondMgr_SyncWhiteList( void );
- static uint8 gapBondMgr_SyncCharCfg( uint16 connHandle );
- static void gapBondFreeAuthEvt( void );
- #if ( HOST_CONFIG & PERIPHERAL_CFG )
- static void gapBondMgrSlaveSecurityReq( uint16 connHandle );
- #endif
- bStatus_t GAPBondMgr_SetParameter( uint16 param, uint8 len, void *pValue )
- {
- bStatus_t ret = SUCCESS;
- switch ( param )
- {
- case GAPBOND_PAIRING_MODE:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= GAPBOND_PAIRING_MODE_INITIATE) )
- {
- gapBond_PairingMode = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_INITIATE_WAIT:
- if ( len == sizeof ( uint16 ) )
- {
- gapBond_InitiateWait = *((uint16*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_MITM_PROTECTION:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= TRUE) )
- {
- gapBond_MITM = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_IO_CAPABILITIES:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= GAPBOND_IO_CAP_KEYBOARD_DISPLAY) )
- {
- gapBond_IOCap = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_OOB_ENABLED:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= TRUE) )
- {
- gapBond_OOBDataFlag = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_OOB_DATA:
- if ( len == KEYLEN )
- {
- VOID osal_memcpy( gapBond_OOBData, pValue, KEYLEN ) ;
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_BONDING_ENABLED:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= TRUE) )
- {
- gapBond_Bonding = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_KEY_DIST_LIST:
- if ( len == sizeof ( uint8 ) )
- {
- gapBond_KeyDistList = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_DEFAULT_PASSCODE:
- if ( (len == sizeof ( uint32 ))
- && (*((uint32*)pValue) <= GAP_PASSCODE_MAX) )
- {
- gapBond_Passcode = *((uint32*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_ERASE_ALLBONDS:
- if ( len == 0 )
- {
-
- if ( GAP_NumActiveConnections() == 0 )
- {
-
- VOID gapBondMgrEraseAllBondings();
-
- VOID osal_snv_compact( NV_COMPACT_THRESHOLD );
-
- gapBondMgrReadBonds();
- }
- else
- {
- eraseAllBonds = TRUE;
- }
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_ERASE_SINGLEBOND:
- if ( len == (1 + B_ADDR_LEN) )
- {
- uint8 idx;
- uint8 devAddr[B_ADDR_LEN];
-
- VOID osal_revmemcpy( devAddr, (uint8 *)pValue+1, B_ADDR_LEN );
-
-
- idx = GAPBondMgr_ResolveAddr( *((uint8 *)pValue), devAddr, NULL );
- if ( idx < GAP_BONDINGS_MAX )
- {
-
- if ( GAP_NumActiveConnections() == 0 )
- {
-
- VOID gapBondMgrEraseBonding( idx );
-
-
- VOID osal_snv_compact( NV_COMPACT_THRESHOLD );
-
-
- gapBondMgrReadBonds();
- }
- else
- {
-
- bondsToDelete[idx] = TRUE;
- }
- }
- else
- {
- ret = INVALIDPARAMETER;
- }
- }
- else
- {
-
- ret = bleInvalidRange;
- }
- break;
-
- case GAPBOND_AUTO_FAIL_PAIRING:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= TRUE) )
- {
- gapBond_AutoFail = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_AUTO_FAIL_REASON:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= SMP_PAIRING_FAILED_REPEATED_ATTEMPTS) )
- {
- gapBond_AutoFailReason = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_KEYSIZE:
- if ( (len == sizeof ( uint8 ))
- && ((*((uint8*)pValue) >= MIN_ENC_KEYSIZE) && (*((uint8*)pValue) <= MAX_ENC_KEYSIZE)) )
- {
- gapBond_KeySize = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- case GAPBOND_AUTO_SYNC_WL:
- if ( len == sizeof( uint8 ) )
- {
- uint8 oldVal = autoSyncWhiteList;
- autoSyncWhiteList = *((uint8 *)pValue);
-
- if ( ( oldVal == FALSE ) && ( autoSyncWhiteList == TRUE ) )
- {
-
- gapBondMgrReadBonds();
- }
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- #if ( HOST_CONFIG & CENTRAL_CFG )
- case GAPBOND_BOND_FAIL_ACTION:
- if ( (len == sizeof ( uint8 )) && (*((uint8*)pValue) <= GAPBOND_FAIL_TERMINATE_ERASE_BONDS) )
- {
- gapBond_BondFailOption = *((uint8*)pValue);
- }
- else
- {
- ret = bleInvalidRange;
- }
- break;
- #endif
- default:
-
- if ( (param < TGAP_PARAMID_MAX) && (len == sizeof ( uint16 )) )
- {
- ret = GAP_SetParamValue( param, *((uint16*)pValue) );
- }
- else
- {
- ret = INVALIDPARAMETER;
- }
- break;
- }
- return ( ret );
- }
- bStatus_t GAPBondMgr_GetParameter( uint16 param, void *pValue )
- {
- bStatus_t ret = SUCCESS;
- switch ( param )
- {
- case GAPBOND_PAIRING_MODE:
- *((uint8*)pValue) = gapBond_PairingMode;
- break;
- case GAPBOND_INITIATE_WAIT:
- *((uint16*)pValue) = gapBond_InitiateWait;
- break;
- case GAPBOND_MITM_PROTECTION:
- *((uint8*)pValue) = gapBond_MITM;
- break;
- case GAPBOND_IO_CAPABILITIES:
- *((uint8*)pValue) = gapBond_IOCap;
- break;
- case GAPBOND_OOB_ENABLED:
- *((uint8*)pValue) = gapBond_OOBDataFlag;
- break;
- case GAPBOND_OOB_DATA:
- VOID osal_memcpy( pValue, gapBond_OOBData, KEYLEN ) ;
- break;
- case GAPBOND_BONDING_ENABLED:
- *((uint8*)pValue) = gapBond_Bonding;
- break;
- case GAPBOND_KEY_DIST_LIST:
- *((uint8*)pValue) = gapBond_KeyDistList;
- break;
- case GAPBOND_DEFAULT_PASSCODE:
- *((uint32*)pValue) = gapBond_Passcode;
- break;
- case GAPBOND_AUTO_FAIL_PAIRING:
- *((uint8*)pValue) = gapBond_AutoFail;
- break;
- case GAPBOND_AUTO_FAIL_REASON:
- *((uint8*)pValue) = gapBond_AutoFailReason;
- break;
- case GAPBOND_KEYSIZE:
- *((uint8*)pValue) = gapBond_KeySize;
- break;
- case GAPBOND_AUTO_SYNC_WL:
- *((uint8*)pValue) = autoSyncWhiteList;
- break;
- case GAPBOND_BOND_COUNT:
- *((uint8*)pValue) = gapBondMgrBondTotal();
- break;
- default:
-
- if ( param < TGAP_PARAMID_MAX )
- {
- *((uint16*)pValue) = GAP_GetParamValue( param );
- }
- else
- {
- ret = INVALIDPARAMETER;
- }
- break;
- }
- return ( ret );
- }
- bStatus_t GAPBondMgr_LinkEst( uint8 addrType, uint8 *pDevAddr, uint16 connHandle, uint8 role )
- {
- uint8 idx;
- uint8 publicAddr[B_ADDR_LEN]
- = {0, 0, 0, 0, 0, 0};
- idx = GAPBondMgr_ResolveAddr( addrType, pDevAddr, publicAddr );
- if ( idx < GAP_BONDINGS_MAX )
- {
- uint8 stateFlags = gapBondMgrGetStateFlags( idx );
- smSigningInfo_t signingInfo;
- gapBondCharCfg_t charCfg[GAP_CHAR_CFG_MAX];
-
-
- gapBondMgrBondReq( connHandle, idx, stateFlags, role,
- ((gapBond_PairingMode == GAPBOND_PAIRING_MODE_INITIATE ) ? TRUE : FALSE) );
-
- VOID osal_memset( &signingInfo, 0, sizeof ( smSigningInfo_t ) );
- if ( osal_snv_read( devCSRKNvID(idx), KEYLEN, signingInfo.srk ) == SUCCESS )
- {
- if ( osal_isbufset( signingInfo.srk, 0xFF, KEYLEN ) == FALSE )
- {
-
- VOID osal_snv_read( devSignCounterNvID(idx), sizeof ( uint32 ), &(signingInfo.signCounter) );
- VOID GAP_Signable( connHandle,
- ((stateFlags & GAP_BONDED_STATE_AUTHENTICATED) ? TRUE : FALSE),
- &signingInfo );
- }
- }
-
- if ( osal_snv_read( gattCfgNvID(idx), sizeof ( charCfg ), charCfg ) == SUCCESS )
- {
- gapBondMgrInvertCharCfgItem( charCfg );
- for ( uint8 i = 0; i < GAP_CHAR_CFG_MAX; i++ )
- {
- gapBondCharCfg_t *pItem = &(charCfg[i]);
-
- if ( pItem->attrHandle != GATT_INVALID_HANDLE )
- {
- VOID GATTServApp_UpdateCharCfg( connHandle, pItem->attrHandle,
- (uint16)(pItem->value) );
- }
- }
- }
-
- if ( stateFlags & GAP_BONDED_STATE_SERVICE_CHANGED )
- {
- VOID GATTServApp_SendServiceChangedInd( connHandle, gapBondMgr_TaskID );
- }
- }
- #if ( HOST_CONFIG & CENTRAL_CFG )
- else if ( role == GAP_PROFILE_CENTRAL &&
- gapBond_PairingMode == GAPBOND_PAIRING_MODE_INITIATE )
- {
-
- gapBondMgrAuthenticate( connHandle, addrType, NULL );
-
- if ( pGapBondCB && pGapBondCB->pairStateCB )
- {
- pGapBondCB->pairStateCB( connHandle, GAPBOND_PAIRING_STATE_STARTED, SUCCESS );
- }
- }
- #endif
- #if ( HOST_CONFIG & PERIPHERAL_CFG )
-
-
- if ( role == GAP_PROFILE_PERIPHERAL &&
- gapBond_PairingMode == GAPBOND_PAIRING_MODE_INITIATE )
- {
- gapBondMgrSlaveSecurityReq( connHandle );
- }
- #endif
- return ( SUCCESS );
- }
- uint8 GAPBondMgr_ResolveAddr( uint8 addrType, uint8 *pDevAddr, uint8 *pResolvedAddr )
- {
- uint8 idx = GAP_BONDINGS_MAX;
- switch ( addrType )
- {
- case ADDRTYPE_PUBLIC:
- case ADDRTYPE_STATIC:
- idx = gapBondMgrFindAddr( pDevAddr );
- if ( (idx < GAP_BONDINGS_MAX) && (pResolvedAddr) )
- {
- VOID osal_memcpy( pResolvedAddr, pDevAddr, B_ADDR_LEN );
- }
- break;
- case ADDRTYPE_PRIVATE_NONRESOLVE:
-
- idx = gapBondMgrFindReconnectAddr( pDevAddr );
- if ( (idx < GAP_BONDINGS_MAX) && (pResolvedAddr) )
- {
- VOID gapBondMgrGetPublicAddr( idx, pResolvedAddr );
- }
- break;
- case ADDRTYPE_PRIVATE_RESOLVE:
-
- idx = gapBondMgrResolvePrivateAddr( pDevAddr );
- if ( (idx < GAP_BONDINGS_MAX) && (pResolvedAddr) )
- {
- VOID gapBondMgrGetPublicAddr( idx, pResolvedAddr );
- }
- break;
- default:
- break;
- }
- return ( idx );
- }
- bStatus_t GAPBondMgr_ServiceChangeInd( uint16 connectionHandle, uint8 setParam )
- {
- bStatus_t ret = bleNoResources;
- if ( connectionHandle == 0xFFFF )
- {
- uint8 idx;
-
- for ( idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
- if ( gapBondMgrChangeState( idx, GAP_BONDED_STATE_SERVICE_CHANGED, setParam ) )
- {
- ret = SUCCESS;
- }
- }
-
- if ( setParam )
- {
-
- linkDB_PerformFunc( gapBondMgrSendServiceChange );
- }
- }
- else
- {
-
- linkDBItem_t *pLinkItem = linkDB_Find( connectionHandle );
- if ( pLinkItem )
- {
- uint8 idx;
- idx = GAPBondMgr_ResolveAddr( pLinkItem->addrType, pLinkItem->addr, NULL );
- if ( idx < GAP_BONDINGS_MAX )
- {
-
- VOID gapBondMgrChangeState( idx, GAP_BONDED_STATE_SERVICE_CHANGED, setParam );
- ret = SUCCESS;
- }
-
- if ( setParam )
- {
- gapBondMgrSendServiceChange( pLinkItem );
- }
- }
- else
- {
- ret = bleNotConnected;
- }
- }
- return ( ret );
- }
- bStatus_t GAPBondMgr_UpdateCharCfg( uint16 connectionHandle, uint16 attrHandle, uint16 value )
- {
- bStatus_t ret = bleNoResources;
- if ( connectionHandle == INVALID_CONNHANDLE )
- {
- uint8 idx;
-
- for ( idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
- if ( gapBondMgrUpdateCharCfg( idx, attrHandle, value ) )
- {
- ret = SUCCESS;
- }
- }
- }
- else
- {
-
- linkDBItem_t *pLinkItem = linkDB_Find( connectionHandle );
- if ( pLinkItem )
- {
- uint8 idx = GAPBondMgr_ResolveAddr( pLinkItem->addrType, pLinkItem->addr, NULL );
- if ( idx < GAP_BONDINGS_MAX )
- {
-
- VOID gapBondMgrUpdateCharCfg( idx, attrHandle, value );
- ret = SUCCESS;
- }
- }
- else
- {
- ret = bleNotConnected;
- }
- }
- return ( ret );
- }
- void GAPBondMgr_Register( gapBondCBs_t *pCB )
- {
- pGapBondCB = pCB;
- if(gapBondMgr_TaskID != INVALID_TASK_ID)
- {
-
- VOID GAP_SetParamValue( TGAP_AUTH_TASK_ID, gapBondMgr_TaskID );
-
- GATTServApp_RegisterForMsg( gapBondMgr_TaskID );
- }
- }
- bStatus_t GAPBondMgr_PasscodeRsp( uint16 connectionHandle, uint8 status, uint32 passcode )
- {
- bStatus_t ret = SUCCESS;
- if ( status == SUCCESS )
- {
-
- passcode = passcode % (GAP_PASSCODE_MAX + 1);
- ret = GAP_PasscodeUpdate( passcode, connectionHandle );
- if ( ret != SUCCESS )
- {
- VOID GAP_TerminateAuth( connectionHandle, SMP_PAIRING_FAILED_PASSKEY_ENTRY_FAILED );
- }
- }
- else
- {
- VOID GAP_TerminateAuth( connectionHandle, status );
- }
- return ret;
- }
- uint8 GAPBondMgr_ProcessGAPMsg( gapEventHdr_t *pMsg )
- {
- switch ( pMsg->opcode )
- {
- case GAP_PASSKEY_NEEDED_EVENT:
- {
- gapPasskeyNeededEvent_t *pPkt = (gapPasskeyNeededEvent_t *)pMsg;
- if ( pGapBondCB && pGapBondCB->passcodeCB )
- {
-
- pGapBondCB->passcodeCB( pPkt->deviceAddr, pPkt->connectionHandle, pPkt->uiInputs, pPkt->uiOutputs );
- }
- else
- {
-
- if ( GAP_PasscodeUpdate( gapBond_Passcode, pPkt->connectionHandle ) != SUCCESS )
- {
- VOID GAP_TerminateAuth( pPkt->connectionHandle, SMP_PAIRING_FAILED_PASSKEY_ENTRY_FAILED );
- }
- }
- }
- break;
- case GAP_AUTHENTICATION_COMPLETE_EVENT:
- {
- gapAuthCompleteEvent_t *pPkt = (gapAuthCompleteEvent_t *)pMsg;
-
- if ( (pPkt->hdr.status == SUCCESS) &&
- (pPkt->authState & SM_AUTH_STATE_BONDING) &&
- (pAuthEvt == NULL) )
- {
- gapBondRec_t bondRec;
- VOID osal_memset( &bondRec, 0, sizeof ( gapBondRec_t ) ) ;
-
- if ( pPkt->pIdentityInfo )
- {
- VOID osal_memcpy( bondRec.publicAddr, pPkt->pIdentityInfo->bd_addr, B_ADDR_LEN );
- }
- else
- {
- linkDBItem_t *pLinkItem = linkDB_Find( pPkt->connectionHandle );
- if ( pLinkItem )
- {
- VOID osal_memcpy( bondRec.publicAddr, pLinkItem->addr, B_ADDR_LEN );
- }
- else
- {
-
- break;
- }
- }
-
- bondRec.stateFlags |= (pPkt->authState & SM_AUTH_STATE_AUTHENTICATED) ? GAP_BONDED_STATE_AUTHENTICATED : 0;
- if ( !gapBondMgrAddBond( &bondRec, pPkt ) )
- {
-
- osal_set_event( gapBondMgr_TaskID, GAP_BOND_SAVE_REC_EVT );
-
-
- return ( FALSE );
- }
- }
-
- if ( pGapBondCB && pGapBondCB->pairStateCB )
- {
- pGapBondCB->pairStateCB( pPkt->connectionHandle, GAPBOND_PAIRING_STATE_COMPLETE, pPkt->hdr.status );
- }
- }
- break;
- case GAP_BOND_COMPLETE_EVENT:
-
-
-
- {
- gapBondCompleteEvent_t *pPkt = (gapBondCompleteEvent_t *)pMsg;
- #if ( HOST_CONFIG & CENTRAL_CFG )
- if ( pPkt->hdr.status == LL_ENC_KEY_REQ_REJECTED )
- {
-
-
- linkDBItem_t *pLinkItem = linkDB_Find( pPkt->connectionHandle );
- if ( pLinkItem )
- {
- switch ( gapBond_BondFailOption )
- {
- case GAPBOND_FAIL_INITIATE_PAIRING:
-
- gapBondMgrAuthenticate( pPkt->connectionHandle, pLinkItem->addrType, NULL );
- break;
- case GAPBOND_FAIL_TERMINATE_LINK:
-
- GAP_TerminateLinkReq( pLinkItem->taskID, pPkt->connectionHandle, HCI_DISCONNECT_AUTH_FAILURE );
- break;
- case GAPBOND_FAIL_TERMINATE_ERASE_BONDS:
-
- VOID GAPBondMgr_SetParameter( GAPBOND_ERASE_ALLBONDS, 0, NULL );
-
- GAP_TerminateLinkReq( pLinkItem->taskID, pPkt->connectionHandle, HCI_DISCONNECT_AUTH_FAILURE );
- break;
- case GAPBOND_FAIL_NO_ACTION:
-
- default:
-
- break;
- }
- }
- }
- #endif
- if ( pGapBondCB && pGapBondCB->pairStateCB )
- {
- pGapBondCB->pairStateCB( pPkt->connectionHandle, GAPBOND_PAIRING_STATE_BONDED, pMsg->hdr.status );
- }
- }
- break;
- case GAP_SIGNATURE_UPDATED_EVENT:
- {
- uint8 idx;
- gapSignUpdateEvent_t *pPkt = (gapSignUpdateEvent_t *)pMsg;
- idx = GAPBondMgr_ResolveAddr( pPkt->addrType, pPkt->devAddr, NULL );
- if ( idx < GAP_BONDINGS_MAX )
- {
-
- VOID osal_snv_write( devSignCounterNvID(idx), sizeof ( uint32 ), &(pPkt->signCounter) );
- }
- }
- break;
- #if ( HOST_CONFIG & PERIPHERAL_CFG )
- case GAP_PAIRING_REQ_EVENT:
- {
- gapPairingReqEvent_t *pPkt = (gapPairingReqEvent_t *)pMsg;
- if ( gapBond_AutoFail != FALSE )
- {
-
- VOID GAP_TerminateAuth( pPkt->connectionHandle, gapBond_AutoFailReason );
- }
- else if ( gapBond_PairingMode == GAPBOND_PAIRING_MODE_NO_PAIRING )
- {
-
- VOID GAP_TerminateAuth( pPkt->connectionHandle, SMP_PAIRING_FAILED_NOT_SUPPORTED );
- }
- else
- {
- linkDBItem_t *pLinkItem = linkDB_Find( pPkt->connectionHandle );
-
- if ( pPkt->pairReq.authReq & SM_AUTH_STATE_BONDING )
- {
- if ( pLinkItem )
- {
- if ( (pLinkItem->addrType != ADDRTYPE_PUBLIC) && (pPkt->pairReq.keyDist.mIdKey == FALSE) )
- {
- uint8 publicAddr[B_ADDR_LEN];
-
- if ( GAPBondMgr_ResolveAddr(pLinkItem->addrType, pLinkItem->addr, publicAddr ) == FALSE )
- {
-
- VOID GAP_TerminateAuth( pPkt->connectionHandle, SMP_PAIRING_FAILED_AUTH_REQ );
- break;
- }
- }
- }
- else
- {
-
- break;
- }
- }
-
- gapBondMgrAuthenticate( pPkt->connectionHandle, pLinkItem->addrType, &(pPkt->pairReq) );
-
- if ( pGapBondCB && pGapBondCB->pairStateCB )
- {
- pGapBondCB->pairStateCB( pPkt->connectionHandle, GAPBOND_PAIRING_STATE_STARTED, SUCCESS );
- }
- }
- }
- break;
- #endif
- #if ( HOST_CONFIG & CENTRAL_CFG )
- case GAP_SLAVE_REQUESTED_SECURITY_EVENT:
- {
- uint16 connHandle = ((gapSlaveSecurityReqEvent_t *)pMsg)->connectionHandle;
- uint8 idx;
- uint8 publicAddr[B_ADDR_LEN] = {0, 0, 0, 0, 0, 0};
- linkDBItem_t *pLink = linkDB_Find( connHandle );
-
- if (pLink != NULL && gapBond_PairingMode != GAPBOND_PAIRING_MODE_INITIATE)
- {
-
- idx = GAPBondMgr_ResolveAddr( pLink->addrType, pLink->addr, publicAddr );
- if ( idx < GAP_BONDINGS_MAX )
- {
- gapBondMgrBondReq( connHandle, idx, gapBondMgrGetStateFlags( idx ),
- GAP_PROFILE_CENTRAL, TRUE );
- }
-
- else if ( gapBond_PairingMode == GAPBOND_PAIRING_MODE_NO_PAIRING )
- {
-
- VOID GAP_TerminateAuth( connHandle, SMP_PAIRING_FAILED_NOT_SUPPORTED );
- }
-
- else if (gapBond_PairingMode == GAPBOND_PAIRING_MODE_WAIT_FOR_REQ)
- {
-
- gapBondMgrAuthenticate( connHandle, pLink->addrType, NULL );
- }
- }
- }
- break;
- #endif
- case GAP_LINK_TERMINATED_EVENT:
- if ( GAP_NumActiveConnections() == 0 )
- {
-
- if ( eraseAllBonds == TRUE )
- {
- VOID gapBondMgrEraseAllBondings();
- eraseAllBonds = FALSE;
-
-
- osal_memset( bondsToDelete, FALSE, sizeof( bondsToDelete ) );
- }
- else
- {
-
- for (uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++)
- {
- if ( bondsToDelete[idx] == TRUE )
- {
- VOID gapBondMgrEraseBonding( idx );
- bondsToDelete[idx] = FALSE;
- }
- }
- }
-
- VOID osal_snv_compact( NV_COMPACT_THRESHOLD );
-
- gapBondMgrReadBonds();
- }
- break;
- default:
- break;
- }
-
- return ( TRUE );
- }
- static uint8 gapBondMgrChangeState( uint8 idx, uint16 state, uint8 set )
- {
- gapBondRec_t bondRec;
-
- if ( (osal_snv_read( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec ) == SUCCESS)
- && (osal_isbufset( bondRec.publicAddr, 0xFF, B_ADDR_LEN ) == FALSE) )
- {
-
- uint8 stateFlags = bondRec.stateFlags;
- if ( set )
- {
- stateFlags |= state;
- }
- else
- {
- stateFlags &= ~(state);
- }
- if ( stateFlags != bondRec.stateFlags )
- {
- bondRec.stateFlags = stateFlags;
- VOID osal_snv_write( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec );
- }
- return ( TRUE );
- }
- return ( FALSE );
- }
- static uint8 gapBondMgrUpdateCharCfg( uint8 idx, uint16 attrHandle, uint16 value )
- {
- gapBondRec_t bondRec;
-
- if ( ( osal_snv_read( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec ) == SUCCESS )
- && ( osal_isbufset( bondRec.publicAddr, 0xFF, B_ADDR_LEN ) == FALSE ) )
- {
- gapBondCharCfg_t charCfg[GAP_CHAR_CFG_MAX];
- if ( osal_snv_read( gattCfgNvID(idx), sizeof ( charCfg ), charCfg ) == SUCCESS )
- {
- uint8 update = FALSE;
- gapBondMgrInvertCharCfgItem( charCfg );
- if ( attrHandle == GATT_INVALID_HANDLE )
- {
- if ( osal_isbufset( (uint8 *)charCfg, 0x00, sizeof ( charCfg ) ) == FALSE )
- {
-
- VOID osal_memset( (void *)charCfg, 0x00, sizeof ( charCfg ) );
- update = TRUE;
- }
- }
- else
- {
- gapBondCharCfg_t *pItem = gapBondMgrFindCharCfgItem( attrHandle, charCfg );
- if ( pItem == NULL )
- {
-
- if ( ( value == GATT_CFG_NO_OPERATION ) ||
- ( ( pItem = gapBondMgrFindCharCfgItem( GATT_INVALID_HANDLE, charCfg ) ) == NULL ) )
- {
- return ( FALSE );
- }
- pItem->attrHandle = attrHandle;
- }
- if ( pItem->value != value )
- {
-
- pItem->value = (uint8)value;
- if ( value == GATT_CFG_NO_OPERATION )
- {
-
- pItem->attrHandle = GATT_INVALID_HANDLE;
- }
- update = TRUE;
- }
- }
-
- if ( update )
- {
- gapBondMgrInvertCharCfgItem( charCfg );
- VOID osal_snv_write( gattCfgNvID(idx), sizeof( charCfg ), charCfg );
- }
- }
- return ( TRUE );
- }
- return ( FALSE );
- }
- static gapBondCharCfg_t *gapBondMgrFindCharCfgItem( uint16 attrHandle,
- gapBondCharCfg_t *charCfgTbl )
- {
- for ( uint8 i = 0; i < GAP_CHAR_CFG_MAX; i++ )
- {
- if ( charCfgTbl[i].attrHandle == attrHandle )
- {
- return ( &(charCfgTbl[i]) );
- }
- }
- return ( (gapBondCharCfg_t *)NULL );
- }
- static void gapBondMgrInvertCharCfgItem( gapBondCharCfg_t *charCfgTbl )
- {
- for ( uint8 i = 0; i < GAP_CHAR_CFG_MAX; i++ )
- {
- charCfgTbl[i].attrHandle = ~(charCfgTbl[i].attrHandle);
- charCfgTbl[i].value = ~(charCfgTbl[i].value);
- }
- }
- static uint8 gapBondMgrAddBond( gapBondRec_t *pBondRec, gapAuthCompleteEvent_t *pPkt )
- {
-
- if ( pAuthEvt == NULL )
- {
-
- if ( ( pBondRec == NULL ) || ( pPkt == NULL ) )
- {
- return ( TRUE );
- }
-
- bondIdx = gapBondMgrFindAddr( pBondRec->publicAddr );
- if ( bondIdx >= GAP_BONDINGS_MAX )
- {
- bondIdx = gapBondMgrFindEmpty();
- }
- }
- if ( bondIdx < GAP_BONDINGS_MAX )
- {
-
- if ( pAuthEvt == NULL )
- {
- gapBondCharCfg_t charCfg[GAP_CHAR_CFG_MAX];
-
-
- VOID osal_snv_write( mainRecordNvID(bondIdx), sizeof ( gapBondRec_t ), pBondRec );
-
-
-
- VOID osal_memset( charCfg, 0xFF, sizeof ( charCfg ) );
- VOID osal_snv_write( gattCfgNvID(bondIdx), sizeof ( charCfg ), charCfg );
-
- VOID osal_memcpy( &(bonds[bondIdx]), pBondRec, sizeof ( gapBondRec_t ) );
-
-
- pAuthEvt = pPkt;
- }
- else
- {
-
- if ( pAuthEvt->pSecurityInfo )
- {
- VOID osal_snv_write( localLTKNvID(bondIdx), sizeof ( gapBondLTK_t ), pAuthEvt->pSecurityInfo );
- pAuthEvt->pSecurityInfo = NULL;
- }
-
- else if ( pAuthEvt->pDevSecInfo )
- {
- VOID osal_snv_write( devLTKNvID(bondIdx), sizeof ( gapBondLTK_t ), pAuthEvt->pDevSecInfo );
- pAuthEvt->pDevSecInfo = NULL;
- }
-
- else if ( pAuthEvt->pIdentityInfo )
- {
- VOID osal_snv_write( devIRKNvID(bondIdx), KEYLEN, pAuthEvt->pIdentityInfo->irk );
- pAuthEvt->pIdentityInfo = NULL;
- }
-
- else if ( pAuthEvt->pSigningInfo )
- {
- VOID osal_snv_write( devCSRKNvID(bondIdx), KEYLEN, pAuthEvt->pSigningInfo->srk );
- VOID osal_snv_write( devSignCounterNvID(bondIdx), sizeof ( uint32 ), &(pAuthEvt->pSigningInfo->signCounter) );
- pAuthEvt->pSigningInfo = NULL;
- }
- else
- {
- if ( autoSyncWhiteList )
- {
- gapBondMgr_SyncWhiteList();
- }
-
- gapBondSetupPrivFlag();
-
- return ( TRUE );
- }
- }
-
-
- return ( FALSE );
- }
- return ( TRUE );
- }
- static uint8 gapBondMgrGetStateFlags( uint8 idx )
- {
- gapBondRec_t bondRec;
- if ( osal_snv_read( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec ) == SUCCESS )
- {
- return ( bondRec.stateFlags );
- }
- return ( 0 );
- }
- static bStatus_t gapBondMgrGetPublicAddr( uint8 idx, uint8 *pAddr )
- {
- bStatus_t stat;
- gapBondRec_t bondRec;
-
- if ( (idx >= GAP_BONDINGS_MAX) || (pAddr == NULL) )
- {
- return ( INVALIDPARAMETER );
- }
- stat = osal_snv_read( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec );
- if ( stat == SUCCESS )
- {
- VOID osal_memcpy( pAddr, bondRec.publicAddr, B_ADDR_LEN );
- }
- return ( stat );
- }
- static uint8 gapBondMgrFindReconnectAddr( uint8 *pReconnectAddr )
- {
-
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
-
- if ( osal_memcmp( bonds[idx].reconnectAddr, pReconnectAddr, B_ADDR_LEN ) )
- {
- return ( idx );
- }
- }
- return ( GAP_BONDINGS_MAX );
- }
- static uint8 gapBondMgrFindAddr( uint8 *pDevAddr )
- {
-
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
-
- if ( osal_memcmp( bonds[idx].publicAddr, pDevAddr, B_ADDR_LEN ) )
- {
- return ( idx );
- }
- }
- return ( GAP_BONDINGS_MAX );
- }
- static uint8 gapBondMgrResolvePrivateAddr( uint8 *pDevAddr )
- {
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
- uint8 IRK[KEYLEN];
-
- if ( osal_snv_read( devIRKNvID(idx), KEYLEN, IRK ) == SUCCESS )
- {
- if ( ( osal_isbufset( IRK, 0xFF, KEYLEN ) == FALSE ) &&
- ( GAP_ResolvePrivateAddr( IRK, pDevAddr ) == SUCCESS ) )
- {
- return ( idx );
- }
- }
- }
- return ( GAP_BONDINGS_MAX );
- }
- static void gapBondMgrReadBonds( void )
- {
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
-
- if ( osal_snv_read( mainRecordNvID(idx), sizeof( gapBondRec_t ), &(bonds[idx]) ) != SUCCESS )
- {
-
- VOID osal_memset( bonds[idx].publicAddr, 0xFF, B_ADDR_LEN );
- VOID osal_memset( bonds[idx].reconnectAddr, 0xFF, B_ADDR_LEN );
- bonds[idx].stateFlags = 0;
- }
- }
- if ( autoSyncWhiteList )
- {
- gapBondMgr_SyncWhiteList();
- }
-
- gapBondSetupPrivFlag();
- }
- static uint8 gapBondMgrFindEmpty( void )
- {
-
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
-
- if ( osal_isbufset( bonds[idx].publicAddr, 0xFF, B_ADDR_LEN ) )
- {
- return ( idx );
- }
- }
- return ( GAP_BONDINGS_MAX );
- }
- static uint8 gapBondMgrBondTotal( void )
- {
- uint8 numBonds = 0;
-
- for ( uint8 idx = 0; idx < GAP_BONDINGS_MAX; idx++ )
- {
-
- if ( osal_isbufset( bonds[idx].publicAddr, 0xFF, B_ADDR_LEN ) == FALSE )
- {
- numBonds++;
- }
- }
- return ( numBonds );
- }
- static bStatus_t gapBondMgrEraseAllBondings( void )
- {
- bStatus_t stat = SUCCESS;
-
- for ( uint8 idx = 0; (idx < GAP_BONDINGS_MAX) && (stat == SUCCESS); idx++ )
- {
-
- stat = gapBondMgrEraseBonding( idx );
- }
- return ( stat );
- }
- static bStatus_t gapBondMgrEraseBonding( uint8 idx )
- {
- bStatus_t ret;
- gapBondRec_t bondRec;
- if ( idx == bondIdx )
- {
-
- osal_clear_event( gapBondMgr_TaskID, GAP_BOND_SYNC_CC_EVT );
- osal_clear_event( gapBondMgr_TaskID, GAP_BOND_SAVE_REC_EVT );
- gapBondFreeAuthEvt();
- }
-
-
- if ( ( osal_snv_read( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec ) == SUCCESS )
- && (osal_isbufset( bondRec.publicAddr, 0xFF, B_ADDR_LEN ) == FALSE) )
- {
- gapBondLTK_t ltk;
- gapBondCharCfg_t charCfg[GAP_CHAR_CFG_MAX];
- VOID osal_memset( &bondRec, 0xFF, sizeof ( gapBondRec_t ) );
- VOID osal_memset( <k, 0xFF, sizeof ( gapBondLTK_t ) );
- VOID osal_memset( charCfg, 0xFF, sizeof ( charCfg ) );
-
- ret = osal_snv_write( mainRecordNvID(idx), sizeof ( gapBondRec_t ), &bondRec );
- ret |= osal_snv_write( localLTKNvID(idx), sizeof ( gapBondLTK_t ), <k );
- ret |= osal_snv_write( devLTKNvID(idx), sizeof ( gapBondLTK_t ), <k );
- ret |= osal_snv_write( devIRKNvID(idx), KEYLEN, ltk.LTK );
- ret |= osal_snv_write( devCSRKNvID(idx), KEYLEN, ltk.LTK );
- ret |= osal_snv_write( devSignCounterNvID(idx), sizeof ( uint32 ), ltk.LTK );
-
- ret |= osal_snv_write( gattCfgNvID(idx), sizeof ( charCfg ), charCfg );
- }
- else
- {
- ret = SUCCESS;
- }
- return ( ret );
- }
- void GAPBondMgr_Init( uint8 task_id )
- {
- gapBondMgr_TaskID = task_id;
-
- gapBondMgrReadBonds();
- }
- uint16 GAPBondMgr_ProcessEvent( uint8 task_id, uint16 events )
- {
- VOID task_id;
- if ( events & SYS_EVENT_MSG )
- {
- uint8 *pMsg;
- if ( (pMsg = osal_msg_receive( gapBondMgr_TaskID )) != NULL )
- {
- if ( gapBondMgr_ProcessOSALMsg( (osal_event_hdr_t *)pMsg ) )
- {
-
- VOID osal_msg_deallocate( pMsg );
- }
- }
-
- return (events ^ SYS_EVENT_MSG);
- }
- if ( events & GAP_BOND_SAVE_REC_EVT )
- {
-
- if ( gapBondMgrAddBond( NULL, NULL ) )
- {
-
- osal_set_event( gapBondMgr_TaskID, GAP_BOND_SYNC_CC_EVT );
-
- return (events ^ GAP_BOND_SAVE_REC_EVT);
- }
- return ( GAP_BOND_SAVE_REC_EVT );
- }
-
- if ( events & GAP_BOND_SYNC_CC_EVT )
- {
-
-
- if ( gapBondMgr_SyncCharCfg( pAuthEvt->connectionHandle ) )
- {
- if ( pGapBondCB && pGapBondCB->pairStateCB )
- {
-
- pGapBondCB->pairStateCB( pAuthEvt->connectionHandle, GAPBOND_PAIRING_STATE_COMPLETE, SUCCESS );
- }
-
-
- gapBondFreeAuthEvt();
-
- return (events ^ GAP_BOND_SYNC_CC_EVT);
- }
-
- return ( GAP_BOND_SYNC_CC_EVT );
- }
-
- return 0;
- }
- static uint8 gapBondMgr_ProcessOSALMsg( osal_event_hdr_t *pMsg )
- {
- uint8 safeToDealloc = TRUE;
-
- switch ( pMsg->event )
- {
- case GAP_MSG_EVENT:
- safeToDealloc = GAPBondMgr_ProcessGAPMsg( (gapEventHdr_t *)pMsg );
- break;
- case GATT_MSG_EVENT:
- gapBondMgr_ProcessGATTMsg( (gattMsgEvent_t *)pMsg );
- break;
- case GATT_SERV_MSG_EVENT:
- gapBondMgr_ProcessGATTServMsg( (gattEventHdr_t *)pMsg );
- break;
- default:
- break;
- }
-
- return ( safeToDealloc );
- }
- uint8 GAPBondMgr_CheckNVLen( uint8 id, uint8 len )
- {
- uint8 stat = FAILURE;
-
- switch ( (id - BLE_NVID_GAP_BOND_START) % GAP_BOND_REC_IDS )
- {
- case GAP_BOND_REC_ID_OFFSET:
- if ( len == sizeof ( gapBondRec_t ) )
- {
- stat = SUCCESS;
- }
- break;
- case GAP_BOND_LOCAL_LTK_OFFSET:
- case GAP_BOND_DEV_LTK_OFFSET:
- if ( len == sizeof ( gapBondLTK_t ) )
- {
- stat = SUCCESS;
- }
- break;
- case GAP_BOND_DEV_IRK_OFFSET:
- case GAP_BOND_DEV_CSRK_OFFSET:
- if ( len == KEYLEN )
- {
- stat = SUCCESS;
- }
- break;
- case GAP_BOND_DEV_SIGN_COUNTER_OFFSET:
- if ( len == sizeof ( uint32 ) )
- {
- stat = SUCCESS;
- }
- break;
- default:
- break;
- }
- return ( stat );
- }
- static void gapBondMgr_ProcessGATTMsg( gattMsgEvent_t *pMsg )
- {
-
- switch ( pMsg->method )
- {
- case ATT_HANDLE_VALUE_CFM:
-
- VOID GAPBondMgr_ServiceChangeInd( pMsg->connHandle, 0x00 );
- break;
- default:
-
- break;
- }
- }
- static void gapBondMgr_ProcessGATTServMsg( gattEventHdr_t *pMsg )
- {
-
- switch ( pMsg->method )
- {
- case GATT_CLIENT_CHAR_CFG_UPDATED_EVENT:
- {
- gattClientCharCfgUpdatedEvent_t *pEvent = (gattClientCharCfgUpdatedEvent_t *)pMsg;
- VOID GAPBondMgr_UpdateCharCfg( pEvent->connHandle, pEvent->attrHandle, pEvent->value );
- }
- break;
- default:
-
- break;
- }
- }
- static void gapBondMgrSendServiceChange( linkDBItem_t *pLinkItem )
- {
- VOID GATTServApp_SendServiceChangedInd( pLinkItem->connectionHandle,
- gapBondMgr_TaskID );
- }
- static void gapBondSetupPrivFlag( void )
- {
- uint8 privFlagProp;
- if ( gapBondMgrBondTotal() > 1 )
- {
- privFlagProp = GATT_PROP_READ;
- }
- else
- {
- privFlagProp = GATT_PROP_READ | GATT_PROP_WRITE;
- }
-
- VOID GGS_SetParameter( GGS_PERI_PRIVACY_FLAG_PROPS, sizeof ( uint8 ), &privFlagProp );
- }
- static void gapBondMgrAuthenticate( uint16 connHandle, uint8 addrType,
- gapPairingReq_t *pPairReq )
- {
- gapAuthParams_t params;
- VOID osal_memset( ¶ms, 0, sizeof ( gapAuthParams_t ) );
-
- params.connectionHandle = connHandle;
- params.secReqs.ioCaps = gapBond_IOCap;
- params.secReqs.oobAvailable = gapBond_OOBDataFlag;
- params.secReqs.maxEncKeySize = gapBond_KeySize;
- params.secReqs.keyDist.sEncKey = (gapBond_KeyDistList & GAPBOND_KEYDIST_SENCKEY) ? TRUE : FALSE;
- params.secReqs.keyDist.sIdKey = (gapBond_KeyDistList & GAPBOND_KEYDIST_SIDKEY) ? TRUE : FALSE;
- params.secReqs.keyDist.mEncKey = (gapBond_KeyDistList & GAPBOND_KEYDIST_MENCKEY) ? TRUE : FALSE;
- params.secReqs.keyDist.mIdKey = (gapBond_KeyDistList & GAPBOND_KEYDIST_MIDKEY) ? TRUE : FALSE;
- params.secReqs.keyDist.mSign = (gapBond_KeyDistList & GAPBOND_KEYDIST_MSIGN) ? TRUE : FALSE;
- params.secReqs.keyDist.sSign = (gapBond_KeyDistList & GAPBOND_KEYDIST_SSIGN) ? TRUE : FALSE;
-
- if ( gapBond_OOBDataFlag )
- {
- VOID osal_memcpy( params.secReqs.oob, gapBond_OOBData, KEYLEN );
- }
- if ( gapBond_Bonding && addrType != ADDRTYPE_PUBLIC )
- {
-
- params.secReqs.keyDist.sIdKey = TRUE;
- }
- params.secReqs.authReq |= (gapBond_Bonding) ? SM_AUTH_STATE_BONDING : 0;
- params.secReqs.authReq |= (gapBond_MITM) ? SM_AUTH_STATE_AUTHENTICATED : 0;
- VOID GAP_Authenticate( ¶ms, pPairReq );
- }
- #if ( HOST_CONFIG & PERIPHERAL_CFG )
- static void gapBondMgrSlaveSecurityReq( uint16 connHandle )
- {
- uint8 authReq = 0;
- authReq |= (gapBond_Bonding) ? SM_AUTH_STATE_BONDING : 0;
- authReq |= (gapBond_MITM) ? SM_AUTH_STATE_AUTHENTICATED : 0;
- VOID GAP_SendSlaveSecurityRequest( connHandle, authReq );
- }
- #endif
- static void gapBondMgrBondReq( uint16 connHandle, uint8 idx, uint8 stateFlags,
- uint8 role, uint8 startEncryption )
- {
- smSecurityInfo_t ltk;
- osalSnvId_t nvId;
- if ( role == GAP_PROFILE_CENTRAL )
- {
- nvId = devLTKNvID( idx );
- }
- else
- {
- nvId = localLTKNvID( idx );
- }
-
- VOID osal_memset( <k, 0, sizeof ( smSecurityInfo_t ) );
- if ( osal_snv_read( nvId, sizeof ( smSecurityInfo_t ), <k ) == SUCCESS )
- {
- if ( (ltk.keySize >= MIN_ENC_KEYSIZE) && (ltk.keySize <= MAX_ENC_KEYSIZE) )
- {
- VOID GAP_Bond( connHandle,
- ((stateFlags & GAP_BONDED_STATE_AUTHENTICATED) ? TRUE : FALSE),
- <k, startEncryption );
- }
- }
- }
- static void gapBondMgr_SyncWhiteList( void )
- {
-
- VOID HCI_LE_ClearWhiteListCmd();
-
- for( uint8 i = 0; i < GAP_BONDINGS_MAX; i++)
- {
-
- if ( osal_isbufset( bonds[i].publicAddr, 0xFF, B_ADDR_LEN ) == FALSE )
- {
- VOID HCI_LE_AddWhiteListCmd( HCI_PUBLIC_DEVICE_ADDRESS, bonds[i].publicAddr );
- }
- }
- }
- static uint8 gapBondMgr_SyncCharCfg( uint16 connHandle )
- {
- static gattAttribute_t *pAttr = NULL;
- static uint16 service;
-
-
-
-
-
-
- if ( pAttr == NULL )
- {
- pAttr = GATT_FindHandleUUID( GATT_MIN_HANDLE, GATT_MAX_HANDLE,
- clientCharCfgUUID, ATT_BT_UUID_SIZE, &service );
- }
-
- if ( pAttr != NULL )
- {
- uint8 len;
- uint8 attrVal[ATT_BT_UUID_SIZE];
-
-
- if ( GATTServApp_ReadAttr( connHandle, pAttr, service, attrVal,
- &len, 0, ATT_BT_UUID_SIZE ) == SUCCESS )
- {
- uint16 value = BUILD_UINT16(attrVal[0], attrVal[1]);
- if ( value != GATT_CFG_NO_OPERATION )
- {
-
- VOID GAPBondMgr_UpdateCharCfg( connHandle, pAttr->handle, value );
- }
- }
-
- pAttr = GATT_FindNextAttr( pAttr, GATT_MAX_HANDLE, service, NULL );
- }
-
- return ( pAttr == NULL );
- }
- static void gapBondFreeAuthEvt( void )
- {
- if ( pAuthEvt != NULL )
- {
-
- VOID osal_msg_deallocate( (uint8 *)pAuthEvt );
- pAuthEvt = NULL;
- }
-
- bondIdx = GAP_BONDINGS_MAX;
- }
- #endif
|