123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779 |
- #if defined (MT_MAC_FUNC) || defined (MT_MAC_CB_FUNC)
- #include "ZComDef.h"
- #include "OSAL.h"
- #include "MT.h"
- #include "MT_UART.h"
- #include "ZMAC.h"
- #include "MT_MAC.h"
- #if !defined( WIN32 )
- #include "OnBoard.h"
- #endif
- #include "mac_radio_defs.h"
- #include "hal_uart.h"
- #ifdef MAC_SECURITY
- #include "mac_security_pib.h"
- #endif
- #define MT_MAC_PEND_LEN(pendAddrSpec) ((((pendAddrSpec) & 0x07) * 2) + \
- ((((pendAddrSpec) & 0x70) >> 4) * 8))
- #define MT_MAC_ED_SCAN_MAXCHANNELS 27
- #define MT_MAC_PEND_LEN_MAX 32
- #define MT_MAC_SDU_LEN_MAX 32
- #define MT_MAC_SCAN_RESULT_LEN_MAX 32
- #define MT_MAC_BEACON_PAYLOAD_MAX 16
- #define DEFAULT_NSDU_HANDLE 0x00
- #define MT_MAC_LEN_ASSOCIATE_IND 0x14
- #define MT_MAC_LEN_ASSOCIATE_CNF 0x0E
- #define MT_MAC_LEN_DISASSOCIATE_IND 0x14
- #define MT_MAC_LEN_DISASSOCIATE_CNF 0x0c
- #define MT_MAC_LEN_BEACON_NOTIFY_IND 0x63
- #define MT_MAC_LEN_ORPHAN_IND 0x13
- #define MT_MAC_LEN_SCAN_CNF 0x09
- #define MT_MAC_LEN_SYNC_LOSS_IND 0x10
- #define MT_MAC_LEN_COMM_STATUS_IND 0x21
- #define MT_MAC_LEN_DATA_CNF 0x08
- #define MT_MAC_LEN_DATA_IND 0x2C
- #define MT_MAC_LEN_PURGE_CNF 0x02
- uint16 _macCallbackSub;
- static uint8 mtMacBeaconPayload[MT_MAC_BEACON_PAYLOAD_MAX];
- static void MT_MacSpi2Sec( ZMacSec_t *pSec, uint8 *pSrc );
- static void MT_MacSpi2Addr( zAddrType_t *pDst, uint8 *pSrc );
- static void MT_MacAddr2Spi( uint8 *pDst, zAddrType_t *pSrc );
- static void MT_MacExtCpy( uint8 *pDst, uint8 *pSrc );
- static void MT_MacRevExtCpy( uint8 *pDst, uint8 *pSrc );
- void MT_MacResetReq(uint8 *pBuf);
- void MT_MacInit(uint8 *pBuf);
- void MT_MacStartReq(uint8 *pBuf);
- void MT_MacSyncReq(uint8 *pBuf);
- void MT_MacDataReq(uint8 *pBuf);
- void MT_MacAssociateReq(uint8 *pBuf);
- void MT_MacDisassociateReq(uint8 *pBuf);
- void MT_MacGetReq(uint8 *pBuf);
- void MT_MacSetReq(uint8 *pBuf);
- #ifdef MAC_SECURITY
- void MT_MacSecurityGetReq(uint8 *pBuf);
- void MT_MacSecuritySetReq(uint8 *pBuf);
- #endif
- void MT_MacScanReq(uint8 * pBuf);
- void MT_MacPollReq(uint8 *pBuf);
- void MT_MacPurgeReq(uint8 *pBuf);
- void MT_MacSetRxGainReq(uint8 *pBuf);
- void MT_MacAssociateRsp(uint8 *pBuf);
- void MT_MacOrphanRsp(uint8 *pBuf);
- uint8 MT_MacCommandProcessing (uint8 *pBuf)
- {
- uint8 status = MT_RPC_SUCCESS;
- switch (pBuf[MT_RPC_POS_CMD1])
- {
- case MT_MAC_RESET_REQ:
- MT_MacResetReq(pBuf);
- break;
- case MT_MAC_INIT:
- MT_MacInit(pBuf);
- break;
- case MT_MAC_START_REQ:
- MT_MacStartReq(pBuf);
- break;
- case MT_MAC_SYNC_REQ:
- MT_MacSyncReq(pBuf);
- break;
- case MT_MAC_DATA_REQ:
- MT_MacDataReq(pBuf);
- break;
- case MT_MAC_ASSOCIATE_REQ:
- MT_MacAssociateReq(pBuf);
- break;
- case MT_MAC_DISASSOCIATE_REQ:
- MT_MacDisassociateReq(pBuf);
- break;
- case MT_MAC_GET_REQ:
- MT_MacGetReq(pBuf);
- break;
- case MT_MAC_SET_REQ:
- MT_MacSetReq(pBuf);
- break;
- #ifdef MAC_SECURITY
- case MT_MAC_SECURITY_GET_REQ:
- MT_MacSecurityGetReq(pBuf);
- break;
- case MT_MAC_SECURITY_SET_REQ:
- MT_MacSecuritySetReq(pBuf);
- break;
- #endif
- case MT_MAC_GTS_REQ:
-
- break;
- case MT_MAC_SCAN_REQ:
- MT_MacScanReq(pBuf);
- break;
- case MT_MAC_POLL_REQ:
- MT_MacPollReq(pBuf);
- break;
- case MT_MAC_PURGE_REQ:
- MT_MacPurgeReq(pBuf);
- break;
- case MT_MAC_SET_RX_GAIN_REQ:
- MT_MacSetRxGainReq(pBuf);
- break;
- case MT_MAC_ASSOCIATE_RSP:
- MT_MacAssociateRsp(pBuf);
- break;
- case MT_MAC_ORPHAN_RSP:
- MT_MacOrphanRsp(pBuf);
- break;
- default:
- status = MT_RPC_ERR_COMMAND_ID;
- break;
- }
- return status;
- }
- void MT_MacResetReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
- retValue = ZMacReset(*pBuf);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacInit(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
- retValue = ZMacInit();
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacStartReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- #ifdef RTR_NWK
- ZMacStartReq_t startReq;
- #endif
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
- #ifdef RTR_NWK
-
- startReq.StartTime = BUILD_UINT32 (pBuf[0], pBuf[1], pBuf[2], pBuf[3]);
- pBuf += 4;
-
- startReq.PANID = BUILD_UINT16( pBuf[0] , pBuf[1] );
- pBuf += 2;
-
- startReq.LogicalChannel = *pBuf++;
- startReq.ChannelPage = *pBuf++;
- startReq.BeaconOrder = *pBuf++;
- startReq.SuperframeOrder = *pBuf++;
- startReq.PANCoordinator = *pBuf++;
- startReq.BatteryLifeExt = *pBuf++;
- startReq.CoordRealignment = *pBuf++;
-
- MT_MacSpi2Sec( &startReq.RealignSec, pBuf );
- pBuf += ZTEST_DEFAULT_SEC_LEN;
-
- MT_MacSpi2Sec( &startReq.BeaconSec, pBuf );
-
- retValue = ZMacStartReq( &startReq );
- #else
- retValue = ZMacDenied;
- #endif
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacSyncReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacSyncReq_t syncReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- syncReq.LogicalChannel = *pBuf++;
-
- syncReq.ChannelPage = *pBuf++;
-
- syncReq.TrackBeacon = *pBuf;
-
- retValue = ZMacSyncReq( &syncReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacDataReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacDataReq_t dataReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- dataReq.DstAddr.addrMode = *pBuf++;
-
- MT_MacSpi2Addr( &dataReq.DstAddr, pBuf);
- pBuf += Z_EXTADDR_LEN;
-
- dataReq.DstPANId = BUILD_UINT16( pBuf[0] , pBuf[1] );
- pBuf += 2;
-
- dataReq.SrcAddrMode = *pBuf++;
-
- dataReq.Handle = *pBuf++;
-
- dataReq.TxOptions = *pBuf++;
-
- dataReq.Channel = *pBuf++;
-
- dataReq.Power = *pBuf++;
-
- MT_MacSpi2Sec( &dataReq.Sec, pBuf );
- pBuf += ZTEST_DEFAULT_SEC_LEN;
-
- dataReq.msduLength = *pBuf++;
-
- dataReq.msdu = pBuf;
-
- retValue = ZMacDataReq( &dataReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacAssociateReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacAssociateReq_t assocReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- assocReq.LogicalChannel = *pBuf++;
-
- assocReq.ChannelPage = *pBuf++;
-
- assocReq.CoordAddress.addrMode = *pBuf++;
-
- MT_MacSpi2Addr( &assocReq.CoordAddress, pBuf );
- pBuf += Z_EXTADDR_LEN;
-
- assocReq.CoordPANId = BUILD_UINT16( pBuf[0] , pBuf[1] );
- pBuf += 2;
-
- assocReq.CapabilityFlags = *pBuf++;
-
- MT_MacSpi2Sec( &assocReq.Sec, pBuf );
-
- retValue = ZMacAssociateReq( &assocReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacDisassociateReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacDisassociateReq_t disassocReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- disassocReq.DeviceAddress.addrMode = *pBuf++;
-
- MT_MacSpi2Addr( &disassocReq.DeviceAddress, pBuf);
- pBuf += Z_EXTADDR_LEN;
-
- disassocReq.DevicePanId = BUILD_UINT16( pBuf[0] , pBuf[1] );
- pBuf += 2;
-
- disassocReq.DisassociateReason = *pBuf++;
-
- disassocReq.TxIndirect = *pBuf++;
-
- MT_MacSpi2Sec( &disassocReq.Sec, pBuf );
-
- retValue = ZMacDisassociateReq( &disassocReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacGetReq(uint8 *pBuf)
- {
- uint8 respLen, cmdId, attr;
- uint8 *pRetBuf;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- respLen = ZTEST_DEFAULT_PARAM_LEN;
-
- pRetBuf = osal_mem_alloc(respLen);
-
- attr = *pBuf;
- if (pRetBuf)
- {
-
- osal_memset(pRetBuf, 0, respLen);
-
- pRetBuf[0] = ZFailure;
-
- pRetBuf[0] = ZMacGetReq(attr, &pRetBuf[1]);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, respLen, pRetBuf );
-
- osal_mem_free(pRetBuf);
- }
- }
- void MT_MacSetReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId, attr;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- attr = *pBuf;
-
- if ( attr == ZMacBeaconMSDU )
- {
- osal_memcpy( mtMacBeaconPayload, pBuf + 1, MT_MAC_BEACON_PAYLOAD_MAX );
- retValue = ZMacSetReq( (ZMacAttributes_t)attr , (byte *) &mtMacBeaconPayload );
- }
- else
- {
- retValue = ZMacSetReq( (ZMacAttributes_t)attr , pBuf + 1 );
- }
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- #ifdef MAC_SECURITY
- void MT_MacSecurityGetReq(uint8 *pBuf)
- {
- uint8 respLen, cmdId, attr;
- uint8 *pRetBuf;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- respLen = ZTEST_DEFAULT_SEC_PARAM_LEN;
-
- pRetBuf = osal_mem_alloc(respLen);
-
- attr = *pBuf++;
- if (pRetBuf)
- {
-
- osal_memset(pRetBuf, 0, respLen);
-
- switch (attr)
- {
- case MAC_KEY_ID_LOOKUP_ENTRY:
- case MAC_KEY_DEVICE_ENTRY:
- case MAC_KEY_USAGE_ENTRY:
-
- pRetBuf[1] = *pBuf++;
- pRetBuf[2] = *pBuf;
- break;
- case MAC_KEY_ENTRY:
- case MAC_DEVICE_ENTRY:
- case MAC_SECURITY_LEVEL_ENTRY:
-
- pRetBuf[1] = *pBuf;
- break;
- }
-
-
- pRetBuf[0] = ZMacSecurityGetReq(attr, &pRetBuf[1]);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, respLen, pRetBuf );
-
- osal_mem_free(pRetBuf);
- }
- }
- void MT_MacSecuritySetReq(uint8 *pBuf)
- {
- uint8 cmdId, attr;
- uint8 retValue = ZMAC_SUCCESS;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- attr = *pBuf++;
- if (attr == MAC_KEY_TABLE || attr == MAC_DEVICE_TABLE || attr == MAC_SECURITY_LEVEL_TABLE)
- {
- pBuf = NULL;
- }
- retValue = ZMacSecuritySetReq( (ZMacAttributes_t)attr , pBuf );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- #endif
- void MT_MacScanReq(uint8 * pBuf)
- {
- uint8 retValue, cmdId;
- ZMacScanReq_t scanReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- scanReq.ScanChannels = BUILD_UINT32 (pBuf[0], pBuf[1], pBuf[2], pBuf[3]);
- pBuf += 4;
-
- scanReq.ScanType = *pBuf++;
-
- scanReq.ScanDuration = *pBuf++;
-
- scanReq.ChannelPage = *pBuf++;
-
- scanReq.MaxResults = *pBuf++;
-
- MT_MacSpi2Sec( &scanReq.Sec, pBuf );
-
- retValue = ZMacScanReq( &scanReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacPollReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacPollReq_t pollReq;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- pollReq.CoordAddress.addrMode = *pBuf++;
-
- MT_MacSpi2Addr( &pollReq.CoordAddress, pBuf);
- pBuf += Z_EXTADDR_LEN;
-
- pollReq.CoordPanId = BUILD_UINT16(pBuf[0] , pBuf[1]);
- pBuf += 2;
-
- MT_MacSpi2Sec(&pollReq.Sec, pBuf);
-
- retValue = ZMacPollReq( &pollReq );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacPurgeReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- retValue = ZMacPurgeReq (*pBuf);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacSetRxGainReq(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
- #ifdef HAL_PA_LNA
-
- if (*pBuf)
- {
- HAL_PA_LNA_RX_HGM();
- }
- else
- {
- HAL_PA_LNA_RX_LGM();
- }
- retValue = ZSuccess;
- #else
- retValue = ZFailure;
- #endif
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue );
- }
- void MT_MacAssociateRsp(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacAssociateRsp_t assocRsp;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
- #ifdef RTR_NWK
-
- MT_MacExtCpy(assocRsp.DeviceAddress, pBuf);
- pBuf += Z_EXTADDR_LEN;
-
- assocRsp.AssocShortAddress = BUILD_UINT16(pBuf[0],pBuf[1]);
- pBuf += 2;
-
- assocRsp.Status = *pBuf++;
-
- MT_MacSpi2Sec( &assocRsp.Sec, pBuf );
-
- retValue = ZMacAssociateRsp( &assocRsp );
- #else
- retValue = ZMacDenied;
- #endif
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue);
- }
- void MT_MacOrphanRsp(uint8 *pBuf)
- {
- uint8 retValue, cmdId;
- ZMacOrphanRsp_t orphanRsp;
-
- cmdId = pBuf[MT_RPC_POS_CMD1];
- pBuf += MT_RPC_FRAME_HDR_SZ;
-
- MT_MacRevExtCpy( orphanRsp.OrphanAddress, pBuf );
- pBuf += Z_EXTADDR_LEN;
-
- orphanRsp.ShortAddress = BUILD_UINT16( pBuf[0] , pBuf[1] );
- pBuf += 2;
-
- orphanRsp.AssociatedMember = *pBuf++;
-
- MT_MacSpi2Sec( &orphanRsp.Sec, pBuf );
-
- retValue = ZMacOrphanRsp( &orphanRsp );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_SRSP | (uint8)MT_RPC_SYS_MAC), cmdId, 1, &retValue);
- }
- #if defined ( MT_MAC_CB_FUNC )
- void nwk_MTCallbackSubNwkSyncLossInd( ZMacSyncLossInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_SYNC_LOSS_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = LO_UINT16( param->PANId );
- *tp++ = HI_UINT16( param->PANId );
-
- *tp++ = param->LogicalChannel;
-
- *tp++ = param->ChannelPage;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_SYNC_LOSS_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkAssociateInd( ZMacAssociateInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_ASSOCIATE_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- MT_MacAddr2Spi(pRetBuf, (zAddrType_t*)param->DeviceAddress);
- tp += Z_EXTADDR_LEN;
-
- *tp++ = param->CapabilityFlags;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_ASSOCIATE_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkAssociateCnf( ZMacAssociateCnf_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_ASSOCIATE_CNF;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = LO_UINT16( param->AssocShortAddress );
- *tp++ = HI_UINT16( param->AssocShortAddress );
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_ASSOCIATE_CNF, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkBeaconNotifyInd ( ZMacBeaconNotifyInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_BEACON_NOTIFY_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->BSN;
-
- *tp++ = BREAK_UINT32( param->pPanDesc->TimeStamp, 0 );
- *tp++ = BREAK_UINT32( param->pPanDesc->TimeStamp, 1 );
- *tp++ = BREAK_UINT32( param->pPanDesc->TimeStamp, 2 );
- *tp++ = BREAK_UINT32( param->pPanDesc->TimeStamp, 3 );
-
- *tp++ = param->pPanDesc->CoordAddress.addrMode;
-
- MT_MacAddr2Spi( tp, ¶m->pPanDesc->CoordAddress );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = LO_UINT16( param->pPanDesc->CoordPANId );
- *tp++ = HI_UINT16( param->pPanDesc->CoordPANId );
-
- *tp++ = LO_UINT16( param->pPanDesc->SuperframeSpec );
- *tp++ = HI_UINT16( param->pPanDesc->SuperframeSpec );
-
- *tp++ = param->pPanDesc->LogicalChannel;
-
- *tp++ = param->pPanDesc->GTSPermit;
-
- *tp++ = param->pPanDesc->LinkQuality;
-
- *tp++ = param->pPanDesc->SecurityFailure;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->pPanDesc->Sec);
- tp += ZTEST_DEFAULT_SEC_LEN;
-
- *tp++ = param->PendAddrSpec;
-
- osal_memset( tp, 0, MT_MAC_PEND_LEN_MAX );
- osal_memcpy( tp, param->AddrList, MIN(MT_MAC_PEND_LEN_MAX, MT_MAC_PEND_LEN(param->PendAddrSpec)) );
- tp += MT_MAC_PEND_LEN_MAX;
-
- *tp++ = param->sduLength;
-
- osal_memset( tp, 0, MT_MAC_SDU_LEN_MAX );
- osal_memcpy( tp, param->sdu, MIN(MT_MAC_SDU_LEN_MAX, param->sduLength) );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_BEACON_NOTIFY_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkDataCnf( ZMacDataCnf_t *param )
- {
- uint8 *pRetBuf, *tp;
-
- pRetBuf = osal_mem_alloc(MT_MAC_LEN_DATA_CNF);
- if (pRetBuf)
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = param->msduHandle;
-
- *tp++ = BREAK_UINT32( param->Timestamp, 0 );
- *tp++ = BREAK_UINT32( param->Timestamp, 1 );
- *tp++ = BREAK_UINT32( param->Timestamp, 2 );
- *tp++ = BREAK_UINT32( param->Timestamp, 3 );
-
- *tp++ = LO_UINT16( param->Timestamp2);
- *tp = HI_UINT16( param->Timestamp2);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_DATA_CNF, MT_MAC_LEN_DATA_CNF, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkDataInd( ZMacDataInd_t *param )
- {
- uint8 respLen, tempLen;
- uint8 *pRetBuf, *tp;
-
- respLen = MT_MAC_LEN_DATA_IND + ZTEST_DEFAULT_DATA_LEN;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->SrcAddr.addrMode;
- if (param->SrcAddr.addrMode != SADDR_MODE_NONE)
- {
-
- MT_MacAddr2Spi( tp, ¶m->SrcAddr );
- }
- else
- {
-
- for ( uint8 i = 0; i< Z_EXTADDR_LEN; i++ )
- {
- tp[i] = 0x00;
- }
- }
- tp += Z_EXTADDR_LEN;
-
- *tp++ = param->DstAddr.addrMode;
-
- MT_MacAddr2Spi( tp, ¶m->DstAddr );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = BREAK_UINT32( param->Timestamp, 0 );
- *tp++ = BREAK_UINT32( param->Timestamp, 1 );
- *tp++ = BREAK_UINT32( param->Timestamp, 2 );
- *tp++ = BREAK_UINT32( param->Timestamp, 3 );
-
- *tp++ = LO_UINT16( param->Timestamp2);
- *tp++ = HI_UINT16( param->Timestamp2);
-
- *tp++ = LO_UINT16( param->SrcPANId );
- *tp++ = HI_UINT16( param->SrcPANId );
-
- *tp++ = LO_UINT16( param->DstPANId );
- *tp++ = HI_UINT16( param->DstPANId );
-
- *tp++ = param->mpduLinkQuality;
-
- *tp++ = param->Correlation;
-
- *tp++ = param->Rssi;
-
- *tp++ = param->Dsn;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
- tp += ZTEST_DEFAULT_SEC_LEN;
-
- if ( param->msduLength < ZTEST_DEFAULT_DATA_LEN )
- tempLen = param->msduLength;
- else
- tempLen = ZTEST_DEFAULT_DATA_LEN;
-
- *tp++ = tempLen;
-
- osal_memset( tp, 0, ZTEST_DEFAULT_DATA_LEN );
- osal_memcpy( tp, param->msdu, tempLen );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_DATA_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkDisassociateInd( ZMacDisassociateInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_DISASSOCIATE_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- MT_MacRevExtCpy( pRetBuf, param->DeviceAddress );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = param->DisassociateReason;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_DISASSOCIATE_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkDisassociateCnf( ZMacDisassociateCnf_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_DISASSOCIATE_CNF;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = param->DeviceAddress.addrMode;
-
- MT_MacAddr2Spi( tp, ¶m->DeviceAddress );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = LO_UINT16( param->panID );
- *tp = HI_UINT16( param->panID );
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_DISASSOCIATE_CNF, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkOrphanInd( ZMacOrphanInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_ORPHAN_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- MT_MacRevExtCpy( tp, param->OrphanAddress );
- tp += Z_EXTADDR_LEN;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_ORPHAN_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkPollCnf( byte Status )
- {
- uint8 retValue;
-
- retValue = Status;
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_POLL_CNF, 1, &retValue);
- }
- void nwk_MTCallbackSubNwkScanCnf( ZMacScanCnf_t *param )
- {
- uint8 respLen, resultLen;
- uint8 *pRetBuf, *tp;
-
- if ( param->ScanType == ZMAC_ED_SCAN )
- resultLen = MT_MAC_ED_SCAN_MAXCHANNELS;
- else if ( param->ScanType == ZMAC_ACTIVE_SCAN )
- resultLen = (param->ResultListSize * sizeof( ZMacPanDesc_t ));
- else if ( param->ScanType == ZMAC_PASSIVE_SCAN )
- resultLen = (param->ResultListSize * sizeof( ZMacPanDesc_t ));
- else if ( param->ScanType == ZMAC_ORPHAN_SCAN )
- resultLen = 0;
- else
- return;
-
- resultLen = MIN(resultLen, MT_MAC_SCAN_RESULT_LEN_MAX);
- respLen = MT_MAC_LEN_SCAN_CNF + MT_MAC_SCAN_RESULT_LEN_MAX + 1;
-
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = 0;
-
- *tp++ = param->ScanType;
-
- *tp++ = param->ChannelPage;
-
- *tp++ = BREAK_UINT32( param->UnscannedChannels, 0 );
- *tp++ = BREAK_UINT32( param->UnscannedChannels, 1 );
- *tp++ = BREAK_UINT32( param->UnscannedChannels, 2 );
- *tp++ = BREAK_UINT32( param->UnscannedChannels, 3 );
-
- *tp++ = param->ResultListSize;
-
- *tp++ = MT_MAC_SCAN_RESULT_LEN_MAX;
-
- osal_memcpy( tp, param->Result.pPanDescriptor, resultLen );
-
- osal_memset( tp, 0, (MT_MAC_SCAN_RESULT_LEN_MAX - resultLen));
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_SCAN_CNF, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubCommStatusInd ( ZMacCommStatusInd_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_COMM_STATUS_IND;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp++ = param->SrcAddress.addrMode;
- MT_MacAddr2Spi( tp, ¶m->SrcAddress );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = param->DstAddress.addrMode;
- MT_MacAddr2Spi( tp, ¶m->DstAddress );
- tp += Z_EXTADDR_LEN;
-
- *tp++ = LO_UINT16( param->PANId );
- *tp++ = HI_UINT16( param->PANId );
-
- *tp++ = param->Reason;
-
- MT_MacSpi2Sec ((ZMacSec_t *)tp, (uint8 *)¶m->Sec);
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_COMM_STATUS_IND, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- void nwk_MTCallbackSubNwkStartCnf( uint8 Status )
- {
- uint8 retValue;
- retValue = Status;
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_START_CNF, 1, &retValue);
- }
- void nwk_MTCallbackSubNwkRxEnableCnf ( byte Status )
- {
- uint8 retValue;
-
- retValue = Status;
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_RX_ENABLE_CNF, 1, &retValue);
- }
- void nwk_MTCallbackSubNwkPurgeCnf( ZMacPurgeCnf_t *param )
- {
- uint8 respLen;
- uint8 *pRetBuf, *tp;
- respLen = MT_MAC_LEN_PURGE_CNF;
- pRetBuf = osal_mem_alloc (respLen);
- if ( pRetBuf )
- {
- tp = pRetBuf;
-
- *tp++ = param->hdr.Status;
-
- *tp = param->msduHandle;
-
- MT_BuildAndSendZToolResponse(((uint8)MT_RPC_CMD_AREQ | (uint8)MT_RPC_SYS_MAC), MT_MAC_PURGE_CNF, respLen, pRetBuf);
-
- osal_mem_free(pRetBuf);
- }
- }
- #endif
- static void MT_MacExtCpy( uint8 *pDst, uint8 *pSrc )
- {
- int8 i;
- for ( i = 0; i < Z_EXTADDR_LEN; i++ )
- {
- *pDst++ = pSrc[i];
- }
- }
- static void MT_MacRevExtCpy( uint8 *pDst, uint8 *pSrc )
- {
- int8 i;
- for ( i = Z_EXTADDR_LEN - 1; i >= 0; i-- )
- {
- *pDst++ = pSrc[i];
- }
- }
- static void MT_MacSpi2Addr( zAddrType_t *pDst, uint8 *pSrc )
- {
- if ( pDst->addrMode == Addr16Bit )
- {
- pDst->addr.shortAddr = BUILD_UINT16( pSrc[0] , pSrc[1] );
- }
- else if ( pDst->addrMode == Addr64Bit )
- {
- MT_MacRevExtCpy( pDst->addr.extAddr, pSrc );
- }
- }
- static void MT_MacSpi2Sec( ZMacSec_t *pSec, uint8 *pSrc )
- {
-
- osal_memcpy (pSec, pSrc, sizeof (ZMacSec_t));
- }
- static void MT_MacAddr2Spi( uint8 *pDst, zAddrType_t *pSrc )
- {
- if ( pSrc->addrMode == Addr16Bit )
- {
- *pDst++ = LO_UINT16( pSrc->addr.shortAddr );
- *pDst++ = HI_UINT16( pSrc->addr.shortAddr );
- *pDst++ = 0; *pDst++ = 0; *pDst++ = 0;
- *pDst++ = 0; *pDst++ = 0; *pDst = 0;
- }
- else if ( pSrc->addrMode == Addr64Bit )
- {
- for ( uint8 i = 0; i< Z_EXTADDR_LEN; i++ )
- {
- *pDst++ = pSrc->addr.extAddr[i];
- }
- }
- else
- {
- for ( uint8 i = 0; i< Z_EXTADDR_LEN; i++ )
- {
- *pDst++ = pSrc->addr.extAddr[i];
- }
- }
- }
- #endif
|