12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073 |
- #include "ZComDef.h"
- #include "OSAL.h"
- #include "OSAL_Nv.h"
- #include "nwk_globals.h"
- #include "AddrMgr.h"
- #include "BindingTable.h"
- #define NV_BIND_EMPTY 0xFF
- #define NV_BIND_REC_SIZE (gBIND_REC_SIZE)
- #define NV_BIND_ITEM_SIZE (gBIND_REC_SIZE * gNWK_MAX_BINDING_ENTRIES)
- typedef struct
- {
- uint8 srcEP;
- uint16 srcIndex;
- uint16 dstIndex;
- uint8 dstEP;
- uint8 dstAddrMode;
- uint8 clusterIDs;
- uint16* clusterIDList;
- } bindFields_t;
- void BindAddrMgrCB( uint8 update, AddrMgrEntry_t *entryOld,
- AddrMgrEntry_t *entryNew );
- BindingEntry_t *bindFindEmpty( void );
- uint16 bindingAddrMgsHelperFind( zAddrType_t *addr );
- uint8 bindingAddrMgsHelperConvert( uint16 idx, zAddrType_t *addr );
- void bindAddrMgrLocalLoad( void );
- uint16 bindAddrIndexGet( zAddrType_t* addr );
- static uint8 bindAddrMgrLocalLoaded = FALSE;
- BindingEntry_t *(*pbindAddEntry)( byte srcEpInt,
- zAddrType_t *dstAddr, byte dstEpInt,
- byte numClusterIds, uint16 *clusterIds ) = (void*)NULL;
- uint16 (*pbindNumOfEntries)( void ) = (void*)NULL;
- void (*pbindRemoveDev)( zAddrType_t *Addr ) = (void*)NULL;
- byte (*pBindInitNV)( void ) = (void*)NULL;
- void (*pBindSetDefaultNV)( void ) = (void*)NULL;
- uint16 (*pBindRestoreFromNV)( void ) = (void*)NULL;
- void (*pBindWriteNV)( void ) = (void*)NULL;
- #if ( ADDRMGR_CALLBACK_ENABLED == 1 )
- void BindAddrMgrCB( uint8 update, AddrMgrEntry_t *entryNew,
- AddrMgrEntry_t *entryOld )
- {
-
- }
- #endif
- void InitBindingTable( void )
- {
- osal_memset( BindingTable, 0xFF, gBIND_REC_SIZE * gNWK_MAX_BINDING_ENTRIES );
- pbindAddEntry = bindAddEntry;
- pbindNumOfEntries = bindNumOfEntries;
- pbindRemoveDev = bindRemoveDev;
- pBindInitNV = BindInitNV;
- pBindSetDefaultNV = BindSetDefaultNV;
- pBindRestoreFromNV = BindRestoreFromNV;
- pBindWriteNV = BindWriteNV;
- bindAddrMgrLocalLoaded = FALSE;
- #if ( ADDRMGR_CALLBACK_ENABLED == 1 )
-
- AddrMgrRegister( ADDRMGR_REG_BINDING, BindAddrMgrCB );
- #endif
- }
- BindingEntry_t *bindFindEmpty( void )
- {
- uint16 x;
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
-
- if ( BindingTable[x].srcEP == NV_BIND_EMPTY )
- {
- return ( &BindingTable[x] );
- }
- }
- return ( (BindingEntry_t *)NULL );
- }
- uint16 bindNumOfEntries( void )
- {
- uint16 x;
- uint16 found;
- for ( found = 0, x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
-
- if ( BindingTable[x].srcEP != NV_BIND_EMPTY )
- {
- found += BindingTable[x].numClusterIds;
- }
- }
- return ( found );
- }
- void bindCapacity( uint16 *maxEntries, uint16 *usedEntries )
- {
- uint16 x;
- uint16 used;
- for ( used = 0, x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
-
- if ( BindingTable[x].srcEP != NV_BIND_EMPTY )
- {
- used++;
- }
- }
- *maxEntries = gNWK_MAX_BINDING_ENTRIES;
- *usedEntries = used;
- }
- BindingEntry_t *bindAddEntry( byte srcEpInt,
- zAddrType_t *dstAddr, byte dstEpInt,
- byte numClusterIds, uint16 *clusterIds )
- {
- uint8 index;
- BindingEntry_t* entry;
- bindFields_t fields;
-
- entry = NULL;
-
- bindAddrMgrLocalLoad();
-
- fields.dstIndex = bindAddrIndexGet( dstAddr );
- fields.srcEP = srcEpInt;
- if ( dstAddr->addrMode == AddrGroup )
- {
- fields.dstAddrMode = DSTGROUPMODE_GROUP;
- fields.dstEP = 0;
- }
- else
- {
- fields.dstAddrMode = DSTGROUPMODE_ADDR;
- fields.dstEP = dstEpInt;
- }
- if ( fields.dstIndex != INVALID_NODE_ADDR )
- {
- for ( index = 0; index < gNWK_MAX_BINDING_ENTRIES; index++ )
- {
- if ( ( fields.srcEP == BindingTable[index].srcEP ) &&
- ( fields.dstAddrMode == BindingTable[index].dstGroupMode ) &&
- ( fields.dstIndex == BindingTable[index].dstIdx ) &&
- ( fields.dstEP == BindingTable[index].dstEP ) )
- {
- entry = &BindingTable[index];
-
- break;
- }
- }
- if ( entry != NULL )
- {
-
- for ( index = 0; index < numClusterIds; index++ )
- {
-
- if ( bindIsClusterIDinList( entry, clusterIds[index] ) == FALSE )
- {
-
- if ( bindAddClusterIdToList( entry, clusterIds[index] ) == FALSE )
- {
-
- entry = NULL;
- }
- }
- }
- }
- else
- {
-
- entry = bindFindEmpty();
-
- if ( entry != NULL )
- {
-
- entry->srcEP = fields.srcEP;
- entry->dstGroupMode = fields.dstAddrMode;
- entry->dstIdx = fields.dstIndex;
- entry->dstEP = fields.dstEP;
- if ( numClusterIds > gMAX_BINDING_CLUSTER_IDS )
- {
- numClusterIds = gMAX_BINDING_CLUSTER_IDS;
- }
- entry->numClusterIds = numClusterIds;
- osal_memcpy( entry->clusterIdList,
- clusterIds,
- numClusterIds * sizeof(uint16) );
- }
- }
- }
- return entry;
- }
- byte bindRemoveEntry( BindingEntry_t *pBind )
- {
- osal_memset( pBind, 0xFF, gBIND_REC_SIZE );
- return ( TRUE );
- }
- byte bindIsClusterIDinList( BindingEntry_t *entry, uint16 clusterId )
- {
- uint8 x;
- if ( entry != NULL )
- {
- for ( x = 0; x < entry->numClusterIds; x++ )
- {
- if ( entry->clusterIdList[x] == clusterId )
- {
- return ( TRUE );
- }
- }
- }
- return ( FALSE );
- }
- byte bindRemoveClusterIdFromList( BindingEntry_t *entry, uint16 clusterId )
- {
- byte x;
- uint16 *listPtr;
- byte numIds;
- if ( entry )
- {
- if ( entry->numClusterIds > 0 )
- {
- listPtr = entry->clusterIdList;
- numIds = entry->numClusterIds;
-
- for ( x = 0; x < numIds; x++ )
- {
- if ( entry->clusterIdList[x] != clusterId )
- {
- *listPtr++ = entry->clusterIdList[x];
- }
- else
- {
- entry->numClusterIds--;
- if ( entry->numClusterIds == 0 )
- {
- break;
- }
- }
- }
- }
- }
- if ( entry && (entry->numClusterIds > 0) )
- {
- return ( TRUE );
- }
- else
- {
- return ( FALSE );
- }
- }
- byte bindAddClusterIdToList( BindingEntry_t *entry, uint16 clusterId )
- {
- if ( entry && entry->numClusterIds < gMAX_BINDING_CLUSTER_IDS )
- {
-
- entry->clusterIdList[entry->numClusterIds] = clusterId;
- entry->numClusterIds++;
- return ( TRUE );
- }
- return ( FALSE );
- }
- BindingEntry_t *bindFindExisting( byte srcEpInt,
- zAddrType_t *dstAddr, byte dstEpInt )
- {
- uint16 dstIdx;
- uint16 x;
-
- if ( dstAddr->addrMode == AddrGroup )
- {
- dstIdx = dstAddr->addr.shortAddr;
- }
- else
- {
- dstIdx = bindingAddrMgsHelperFind( dstAddr );
- }
- if ( dstIdx == INVALID_NODE_ADDR )
- {
- return ( (BindingEntry_t *)NULL );
- }
-
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- if ( (BindingTable[x].srcEP == srcEpInt) )
- {
- if ( ((dstAddr->addrMode == AddrGroup)
- && (BindingTable[x].dstGroupMode == DSTGROUPMODE_GROUP)
- && (dstIdx == BindingTable[x].dstIdx))
- || ((dstAddr->addrMode != AddrGroup)
- && (BindingTable[x].dstGroupMode == DSTGROUPMODE_ADDR)
- && (dstIdx == BindingTable[x].dstIdx) && (BindingTable[x].dstEP == dstEpInt)) )
- {
- return ( &BindingTable[x] );
- }
- }
- }
- return ( (BindingEntry_t *)NULL );
- }
- void bindRemoveDev( zAddrType_t *Addr )
- {
- uint16 idx;
- uint16 x;
- if ( Addr->addrMode == AddrGroup )
- {
- idx = Addr->addr.shortAddr;
- }
- else
- {
- idx = bindingAddrMgsHelperFind( Addr );
- }
- if ( idx == INVALID_NODE_ADDR )
- {
- return;
- }
-
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- if ( ( (Addr->addrMode == AddrGroup) && (BindingTable[x].dstGroupMode == DSTGROUPMODE_GROUP)
- && (BindingTable[x].dstIdx == idx) ) ||
- ( (Addr->addrMode != AddrGroup) && (BindingTable[x].dstGroupMode == DSTGROUPMODE_ADDR)
- && (BindingTable[x].dstIdx == idx) ) )
- {
- bindRemoveEntry( &BindingTable[x] );
- }
- }
- }
- void bindRemoveSrcDev( uint8 ep )
- {
- uint16 x;
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- if ( (ep == 0xFF) || (ep == BindingTable[x].srcEP) )
- {
- bindRemoveEntry( &BindingTable[x] );
- }
- }
- }
- byte bindNumBoundTo( zAddrType_t *devAddr, byte devEpInt, byte srcMode )
- {
- BindingEntry_t *pBind;
- uint16 idx;
- byte num;
- uint16 x;
-
- num = 0;
- if ( devAddr->addrMode == AddrGroup )
- {
- idx = devAddr->addr.shortAddr;
- }
- else
- {
- idx = bindingAddrMgsHelperFind( devAddr );
- }
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- pBind = &BindingTable[x];
- if ( srcMode )
- {
- if ( pBind->srcEP == devEpInt )
- {
- num++;
- }
- }
- else
- {
- if ( ((devAddr->addrMode == AddrGroup)
- && (pBind->dstGroupMode == DSTGROUPMODE_GROUP) && (pBind->dstIdx == idx))
- || ((devAddr->addrMode != AddrGroup) && (pBind->dstGroupMode == DSTGROUPMODE_ADDR)
- && (pBind->dstIdx == idx) && (pBind->dstEP == devEpInt)) )
- {
- num++;
- }
- }
- }
- return num;
- }
- uint16 bindNumReflections( uint8 ep, uint16 clusterID )
- {
- uint16 x;
- BindingEntry_t *pBind;
- uint16 cnt = 0;
- uint8 bindEP;
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- pBind = &BindingTable[x];
- bindEP = pBind->srcEP;
- if ( (bindEP == ep) && (bindIsClusterIDinList( pBind, clusterID )) )
- {
- cnt++;
- }
- }
- return ( cnt );
- }
- BindingEntry_t *bindFind( uint8 ep, uint16 clusterID, uint8 skipping )
- {
- BindingEntry_t *pBind;
- byte skipped = 0;
- uint16 x;
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- pBind = &BindingTable[x];
- if ( ( pBind->srcEP == ep) && bindIsClusterIDinList( pBind, clusterID ))
- {
- if ( skipped < skipping )
- {
- skipped++;
- }
- else
- {
- return ( pBind );
- }
- }
- }
- return ( (BindingEntry_t *)NULL );
- }
- byte BindInitNV( void )
- {
- byte ret;
-
- ret = osal_nv_item_init( ZCD_NV_BINDING_TABLE,
- (uint16)(gBIND_REC_SIZE + NV_BIND_ITEM_SIZE), NULL );
- if ( ret != ZSUCCESS )
- {
- BindSetDefaultNV();
- }
- return ( ret );
- }
- void BindSetDefaultNV( void )
- {
- nvBindingHdr_t hdr;
-
- hdr.numRecs = 0;
-
- osal_nv_write( ZCD_NV_BINDING_TABLE, 0, sizeof( nvBindingHdr_t ), &hdr );
- }
- uint16 BindRestoreFromNV( void )
- {
- nvBindingHdr_t hdr;
- uint16 numAdded = 0;
- if ( osal_nv_read( ZCD_NV_BINDING_TABLE, 0, sizeof(nvBindingHdr_t), &hdr ) == ZSuccess )
- {
- if (hdr.numRecs > 0)
- {
-
- if ( osal_nv_read( ZCD_NV_BINDING_TABLE,
- (uint16)(sizeof(nvBindingHdr_t)),
- (NV_BIND_REC_SIZE * gNWK_MAX_BINDING_ENTRIES), BindingTable ) == ZSUCCESS )
- {
- numAdded = gNWK_MAX_BINDING_ENTRIES;
- }
- }
- }
- return ( numAdded );
- }
- void BindWriteNV( void )
- {
- BindingEntry_t *pBind;
- BindingEntry_t bind;
- nvBindingHdr_t hdr;
- uint16 x;
- hdr.numRecs = 0;
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- pBind = &BindingTable[x];
- osal_memcpy( &bind, pBind, gBIND_REC_SIZE );
-
- osal_nv_write( ZCD_NV_BINDING_TABLE,
- (uint16)((sizeof(nvBindingHdr_t)) + (x * NV_BIND_REC_SIZE)),
- NV_BIND_REC_SIZE, &bind );
- if ( pBind->srcEP != NV_BIND_EMPTY )
- {
- hdr.numRecs++;
- }
- }
-
- osal_nv_write( ZCD_NV_BINDING_TABLE, 0, sizeof(nvBindingHdr_t), &hdr );
- }
- void bindUpdateAddr( uint16 oldAddr, uint16 newAddr )
- {
- uint16 oldIdx;
- uint16 newIdx;
- zAddrType_t addr;
- uint16 x;
- BindingEntry_t *pBind;
- addr.addrMode = Addr16Bit;
- addr.addr.shortAddr = oldAddr;
- oldIdx = bindingAddrMgsHelperFind( &addr );
- addr.addr.shortAddr = newAddr;
- newIdx = bindingAddrMgsHelperFind( &addr );
- for ( x = 0; x < gNWK_MAX_BINDING_ENTRIES; x++ )
- {
- pBind = &BindingTable[x];
- if ( pBind->dstIdx == oldIdx )
- {
- pBind->dstIdx = newIdx;
- }
- }
- }
- uint16 bindingAddrMgsHelperFind( zAddrType_t *addr )
- {
- AddrMgrEntry_t entry;
-
- entry.user = ADDRMGR_USER_BINDING;
- if ( addr->addrMode == Addr16Bit )
- {
- entry.nwkAddr = addr->addr.shortAddr;
- AddrMgrEntryLookupNwk( &entry );
- }
- else
- {
- AddrMgrExtAddrSet( entry.extAddr, addr->addr.extAddr );
- AddrMgrEntryLookupExt( &entry );
- }
- return ( entry.index );
- }
- uint8 bindingAddrMgsHelperConvert( uint16 idx, zAddrType_t *addr )
- {
- AddrMgrEntry_t entry;
- uint8 stat;
-
- entry.user = ADDRMGR_USER_BINDING;
- entry.index = idx;
- stat = AddrMgrEntryGet( &entry );
- if ( stat )
- {
- addr->addrMode = Addr64Bit;
- osal_cpyExtAddr( addr->addr.extAddr, entry.extAddr );
- }
- return ( stat );
- }
- uint16 bindingAddrMgsHelperConvertShort( uint16 idx )
- {
- AddrMgrEntry_t entry;
-
- entry.user = ADDRMGR_USER_BINDING;
- entry.index = idx;
- AddrMgrEntryGet( &entry );
- return ( entry.nwkAddr );
- }
- void bindAddrMgrLocalLoad( void )
- {
- AddrMgrEntry_t entry;
- uint16 parent;
-
-
- if ( bindAddrMgrLocalLoaded == FALSE )
- {
-
- entry.user = ADDRMGR_USER_BINDING;
- entry.nwkAddr = _NIB.nwkDevAddress;
- AddrMgrExtAddrSet( entry.extAddr, NLME_GetExtAddr() );
- AddrMgrEntryUpdate( &entry );
-
- parent = NLME_GetCoordShortAddr();
- if ( ( parent != entry.nwkAddr ) &&
- ( parent != INVALID_NODE_ADDR ) )
- {
-
- entry.nwkAddr = parent;
- NLME_GetCoordExtAddr( entry.extAddr );
- AddrMgrEntryUpdate( &entry );
- }
- bindAddrMgrLocalLoaded = TRUE;
- }
- }
- uint16 bindAddrIndexGet( zAddrType_t* addr )
- {
- AddrMgrEntry_t entry;
- uint8 update;
- update = FALSE;
-
- entry.user = ADDRMGR_USER_BINDING;
- if ( addr->addrMode == Addr16Bit )
- {
- entry.nwkAddr = addr->addr.shortAddr;
- if ( AddrMgrEntryLookupNwk( &entry ) == FALSE )
- {
- update = TRUE;
- }
- }
- else if ( addr->addrMode == Addr64Bit )
- {
- AddrMgrExtAddrSet( entry.extAddr, addr->addr.extAddr );
- if ( AddrMgrEntryLookupExt( &entry ) == FALSE )
- {
- update = TRUE;
- }
- }
- else if ( addr->addrMode == AddrGroup )
- {
- entry.index = addr->addr.shortAddr;
- }
- else
- {
- entry.index = INVALID_NODE_ADDR;
- }
- if ( update )
- {
- AddrMgrEntryUpdate( &entry );
- }
- return entry.index;
- }
- BindingEntry_t *GetBindingTableEntry( uint16 Nth )
- {
- BindingEntry_t *rtrn = NULL;
- #if defined ( REFLECTOR )
- uint16 idx, cnt = 0;
- for ( idx = 0; idx < gNWK_MAX_BINDING_ENTRIES; idx++ )
- {
- if ( BindingTable[idx].srcEP != NV_BIND_EMPTY )
- {
- if ( cnt++ == Nth )
- {
- rtrn = BindingTable+idx;
- break;
- }
- }
- }
- #else
- (void)Nth;
- #endif
- return rtrn;
- }
|