| /* |
| * Copyright (c) 2007-2008 Atheros Communications Inc. |
| * |
| * Permission to use, copy, modify, and/or distribute this software for any |
| * purpose with or without fee is hereby granted, provided that the above |
| * copyright notice and this permission notice appear in all copies. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
| * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| */ |
| /* */ |
| /* Module Name : iod.c */ |
| /* */ |
| /* Abstract */ |
| /* This module contains OID functions. */ |
| /* */ |
| /* NOTES */ |
| /* None */ |
| /* */ |
| /************************************************************************/ |
| #include "cprecomp.h" |
| #include "../hal/hpreg.h" |
| |
| /************************************************************************/ |
| /* */ |
| /* FUNCTION DESCRIPTION zfiWlanQueryMacAddress */ |
| /* Query OWN MAC address. */ |
| /* */ |
| /* INPUTS */ |
| /* addr : for return MAC address */ |
| /* */ |
| /* OUTPUTS */ |
| /* None */ |
| /* */ |
| /* AUTHOR */ |
| /* Stephen Chen ZyDAS Technology Corporation 2005.10 */ |
| /* */ |
| /************************************************************************/ |
| void zfiWlanQueryMacAddress(zdev_t* dev, u8_t* addr) |
| { |
| u16_t vapId = 0; |
| zmw_get_wlan_dev(dev); |
| |
| vapId = zfwGetVapId(dev); |
| |
| addr[0] = (u8_t)(wd->macAddr[0] & 0xff); |
| addr[1] = (u8_t)(wd->macAddr[0] >> 8); |
| addr[2] = (u8_t)(wd->macAddr[1] & 0xff); |
| addr[3] = (u8_t)(wd->macAddr[1] >> 8); |
| addr[4] = (u8_t)(wd->macAddr[2] & 0xff); |
| if (vapId == 0xffff) |
| addr[5] = (u8_t)(wd->macAddr[2] >> 8); |
| else |
| { |
| #ifdef ZM_VAPMODE_MULTILE_SSID |
| addr[5] = (u8_t)(wd->macAddr[2] >> 8); // Multiple SSID |
| #else |
| addr[5] = vapId + 1 + (u8_t)(wd->macAddr[2] >> 8); //VAP |
| #endif |
| } |
| |
| return; |
| } |
| |
| void zfiWlanQueryBssList(zdev_t* dev, struct zsBssList* pBssList) |
| { |
| struct zsBssInfo* pBssInfo; |
| struct zsBssInfo* pDstBssInfo; |
| u8_t i; |
| u8_t* pMemList; |
| u8_t* pMemInfo; |
| |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| pMemList = (u8_t*) pBssList; |
| pMemInfo = pMemList + sizeof(struct zsBssList); |
| pBssList->head = (struct zsBssInfo*) pMemInfo; |
| |
| zmw_enter_critical_section(dev); |
| |
| pBssInfo = wd->sta.bssList.head; |
| pDstBssInfo = (struct zsBssInfo*) pMemInfo; |
| pBssList->bssCount = wd->sta.bssList.bssCount; |
| |
| for( i=0; i<wd->sta.bssList.bssCount; i++ ) |
| { |
| zfMemoryCopy((u8_t*)pDstBssInfo, (u8_t*)pBssInfo, |
| sizeof(struct zsBssInfo)); |
| |
| if ( pBssInfo->next != NULL ) |
| { |
| pBssInfo = pBssInfo->next; |
| pDstBssInfo->next = pDstBssInfo + 1; |
| pDstBssInfo++; |
| } |
| else |
| { |
| zm_assert(i==(wd->sta.bssList.bssCount-1)); |
| } |
| } |
| |
| zmw_leave_critical_section(dev); |
| |
| zfScanMgrScanAck(dev); |
| } |
| |
| void zfiWlanQueryBssListV1(zdev_t* dev, struct zsBssListV1* bssListV1) |
| { |
| struct zsBssInfo* pBssInfo; |
| //struct zsBssInfo* pDstBssInfo; |
| u8_t i, j, bdrop = 0, k = 0, Same_Count = 0; |
| u8_t bssid[6]; |
| //u8_t* pMemList; |
| //u8_t* pMemInfo; |
| zmw_get_wlan_dev(dev); |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| |
| bssListV1->bssCount = wd->sta.bssList.bssCount; |
| |
| pBssInfo = wd->sta.bssList.head; |
| ZM_MAC_WORD_TO_BYTE(wd->sta.bssid, bssid); |
| |
| for( i=0; i<wd->sta.bssList.bssCount; i++ ) |
| { |
| bdrop = 0; |
| if ( zfStaIsConnected(dev) |
| && (wd->wlanMode == ZM_MODE_INFRASTRUCTURE ) ) |
| { |
| for (j = 0; j < 6; j++) |
| { |
| if ( pBssInfo->bssid[j] != bssid[j] ) |
| { |
| break; |
| } |
| } |
| |
| if ( (j == 6) |
| &&((pBssInfo->ssid[1] == wd->sta.ssidLen) || (pBssInfo->ssid[1] == 0) )&& (pBssInfo->frequency == wd->frequency) ) |
| { |
| if(pBssInfo->ssid[1] == 0) |
| pBssInfo->ssid[1] = wd->sta.ssidLen; |
| |
| if(Same_Count == 0) |
| {//First meet |
| Same_Count++; |
| } |
| else |
| {//same one |
| bdrop = 1; |
| bssListV1->bssCount--; |
| } |
| |
| } |
| } |
| |
| if (bdrop == 0) |
| { |
| zfMemoryCopy((u8_t*)(&bssListV1->bssInfo[k]), (u8_t*)pBssInfo, |
| sizeof(struct zsBssInfo)); |
| |
| if(Same_Count == 1) |
| { |
| zfMemoryCopy(&(bssListV1->bssInfo[k].ssid[2]), wd->sta.ssid, wd->sta.ssidLen); |
| Same_Count++; |
| } |
| |
| k++; |
| } |
| |
| if ( pBssInfo->next != NULL ) |
| { |
| pBssInfo = pBssInfo->next; |
| } |
| else |
| { |
| zm_assert(i==(wd->sta.bssList.bssCount-1)); |
| } |
| } |
| |
| zmw_leave_critical_section(dev); |
| |
| zfScanMgrScanAck(dev); |
| } |
| |
| void zfiWlanQueryAdHocCreatedBssDesc(zdev_t* dev, struct zsBssInfo *pBssInfo) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zfMemoryCopy((u8_t *)pBssInfo, (u8_t *)&wd->sta.ibssBssDesc, sizeof(struct zsBssInfo)); |
| } |
| |
| u8_t zfiWlanQueryAdHocIsCreator(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->sta.ibssBssIsCreator; |
| } |
| |
| u32_t zfiWlanQuerySupportMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->supportMode; |
| } |
| |
| u32_t zfiWlanQueryTransmitPower(zdev_t* dev) |
| { |
| u32_t ret = 0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if (zfStaIsConnected(dev)) { |
| ret = wd->sta.connPowerInHalfDbm; |
| } else { |
| ret = zfHpGetTransmitPower(dev); |
| } |
| |
| return ret; |
| } |
| |
| /************************************************************************/ |
| /* */ |
| /* FUNCTION DESCRIPTION zfiWlanFlushBssList */ |
| /* Flush BSSID List. */ |
| /* */ |
| /* INPUTS */ |
| /* dev : device pointer */ |
| /* */ |
| /* OUTPUTS */ |
| /* none */ |
| /* */ |
| /* AUTHOR */ |
| /* Stephen Chen Atheros Communications, INC. 2006.12 */ |
| /* */ |
| /************************************************************************/ |
| void zfiWlanFlushBssList(zdev_t* dev) |
| { |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| /* Call zfBssInfoRefresh() twice to remove all entry */ |
| zfBssInfoRefresh(dev, 1); |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetWlanMode(zdev_t* dev, u8_t wlanMode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->ws.wlanMode = wlanMode; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetAuthenticationMode(zdev_t* dev, u8_t authMode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->ws.authMode = authMode; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetWepStatus(zdev_t* dev, u8_t wepStatus) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->ws.wepStatus = wepStatus; |
| zmw_leave_critical_section(dev); |
| |
| } |
| |
| void zfiWlanSetSSID(zdev_t* dev, u8_t* ssid, u8_t ssidLength) |
| { |
| u16_t i; |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| if ( ssidLength <= 32 ) |
| { |
| zmw_enter_critical_section(dev); |
| |
| wd->ws.ssidLen = ssidLength; |
| zfMemoryCopy(wd->ws.ssid, ssid, ssidLength); |
| |
| if ( ssidLength < 32 ) |
| { |
| wd->ws.ssid[ssidLength] = 0; |
| } |
| |
| wd->ws.probingSsidList[0].ssidLen = ssidLength; |
| zfMemoryCopy(wd->ws.probingSsidList[0].ssid, ssid, ssidLength); |
| for (i=1; i<ZM_MAX_PROBE_HIDDEN_SSID_SIZE; i++) |
| { |
| wd->ws.probingSsidList[i].ssidLen = 0; |
| } |
| |
| zmw_leave_critical_section(dev); |
| } |
| } |
| |
| void zfiWlanSetFragThreshold(zdev_t* dev, u16_t fragThreshold) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| |
| if (fragThreshold == 0) |
| { /* fragmentation is disabled */ |
| wd->fragThreshold = 32767; |
| } |
| else if (fragThreshold < 256) |
| { |
| /* Minimum fragment threshold */ |
| wd->fragThreshold = 256; |
| } |
| else if (fragThreshold > 2346) |
| { |
| wd->fragThreshold = 2346; |
| } |
| else |
| { |
| wd->fragThreshold = fragThreshold & 0xfffe; |
| } |
| |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetRtsThreshold(zdev_t* dev, u16_t rtsThreshold) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->rtsThreshold = rtsThreshold; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetFrequency(zdev_t* dev, u32_t frequency, u8_t bImmediate) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| if ( bImmediate ) |
| { |
| zmw_enter_critical_section(dev); |
| wd->frequency = (u16_t) (frequency/1000); |
| zmw_leave_critical_section(dev); |
| zfCoreSetFrequency(dev, wd->frequency); |
| } |
| else |
| { |
| zmw_enter_critical_section(dev); |
| if( frequency == 0 ) |
| { // Auto select clean channel depend on wireless environment ! |
| wd->ws.autoSetFrequency = 0; |
| } |
| wd->ws.frequency = (u16_t) (frequency/1000); |
| zmw_leave_critical_section(dev); |
| } |
| } |
| |
| void zfiWlanSetBssid(zdev_t* dev, u8_t* bssid) |
| { |
| u16_t i; |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| for (i=0; i<6; i++) |
| { |
| wd->ws.desiredBssid[i] = bssid[i]; |
| } |
| wd->ws.bDesiredBssid = TRUE; |
| zmw_leave_critical_section(dev); |
| |
| } |
| |
| void zfiWlanSetBeaconInterval(zdev_t* dev, |
| u16_t beaconInterval, |
| u8_t bImmediate) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| if ( bImmediate ) |
| { |
| zmw_enter_critical_section(dev); |
| wd->beaconInterval = beaconInterval; |
| zmw_leave_critical_section(dev); |
| |
| /* update beacon interval here */ |
| } |
| else |
| { |
| zmw_enter_critical_section(dev); |
| wd->ws.beaconInterval = beaconInterval; |
| zmw_leave_critical_section(dev); |
| } |
| } |
| |
| |
| void zfiWlanSetDtimCount(zdev_t* dev, u8_t dtim) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| if (dtim > 0) |
| { |
| wd->ws.dtim = dtim; |
| } |
| zmw_leave_critical_section(dev); |
| } |
| |
| |
| void zfiWlanSetAtimWindow(zdev_t* dev, u16_t atimWindow, u8_t bImmediate) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| if ( bImmediate ) |
| { |
| zmw_enter_critical_section(dev); |
| wd->sta.atimWindow = atimWindow; |
| zmw_leave_critical_section(dev); |
| |
| /* atim window here */ |
| } |
| else |
| { |
| zmw_enter_critical_section(dev); |
| wd->ws.atimWindow = atimWindow; |
| zmw_leave_critical_section(dev); |
| } |
| } |
| |
| |
| void zfiWlanSetEncryMode(zdev_t* dev, u8_t encryMode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| if (wd->wlanMode == ZM_MODE_AP) |
| { |
| /* Hostapd Issue */ |
| if ((wd->ws.encryMode != ZM_AES) && (wd->ws.encryMode != ZM_TKIP)) |
| wd->ws.encryMode = encryMode; |
| } |
| else |
| wd->ws.encryMode = encryMode; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetDefaultKeyId(zdev_t* dev, u8_t keyId) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.keyId = keyId; |
| } |
| |
| u8_t zfiWlanQueryIsPKInstalled(zdev_t *dev, u8_t *staMacAddr) |
| { |
| u8_t isInstalled = 0; |
| |
| #if 1 |
| //#ifdef ZM_ENABLE_IBSS_WPA2PSK |
| u8_t res, peerIdx; |
| |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| res = zfStaFindOppositeByMACAddr(dev, (u16_t *)staMacAddr, &peerIdx); |
| if( res == 0 ) |
| { |
| isInstalled = wd->sta.oppositeInfo[peerIdx].pkInstalled; |
| } |
| zmw_leave_critical_section(dev); |
| //#endif |
| #endif |
| |
| return isInstalled; |
| } |
| |
| u8_t zfiWlanSetKey(zdev_t* dev, struct zsKeyInfo keyInfo) |
| { |
| u16_t broadcast[3] = {0xffff, 0xffff, 0xffff}; |
| u32_t* key; |
| u8_t encryMode = ZM_NO_WEP; |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| u8_t encryType = ZM_NO_WEP; |
| #endif |
| u8_t micKey[16]; |
| u16_t id = 0; |
| u8_t vapId, i, addr[6]; |
| u8_t userIdx=0; |
| |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| /* Determine opposite exist or not */ |
| u8_t res, peerIdx; |
| // u8_t userIdx=0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if ( wd->sta.ibssWpa2Psk == 1 ) |
| { |
| zmw_enter_critical_section(dev); |
| res = zfStaFindOppositeByMACAddr(dev, (u16_t*)keyInfo.macAddr, &peerIdx); |
| if( res == 0 ) |
| { |
| userIdx = peerIdx; |
| if ( wd->sta.oppositeInfo[userIdx].camIdx == 0xff ) |
| wd->sta.oppositeInfo[userIdx].camIdx = userIdx; |
| } |
| zmw_leave_critical_section(dev); |
| } |
| #else |
| zmw_get_wlan_dev(dev); |
| #endif |
| |
| if ( keyInfo.flag & ZM_KEY_FLAG_AUTHENTICATOR ) |
| { /* set key by authenticator */ |
| /* set pairwise key */ |
| if (keyInfo.flag & ZM_KEY_FLAG_PK) |
| { |
| /* Find STA's information */ |
| id = zfApFindSta(dev, keyInfo.macAddr); |
| if (id == 0xffff) |
| { |
| /* Can't STA in the staTable */ |
| return ZM_STATUS_FAILURE; |
| } |
| |
| wd->ap.staTable[id].iv16 = 0; |
| wd->ap.staTable[id].iv32 = 0; |
| |
| if (keyInfo.keyLength == 32) |
| { /* TKIP */ |
| //u8_t KeyRsc[6] = {0, 0, 0, 0, 0, 0}; |
| |
| /* In the current AP mode, we set KeyRsc to zero */ |
| //zfTkipInit(keyInfo.key, (u8_t*) wd->macAddr, |
| // &(wd->ap.staTable[id].txSeed), KeyRsc); |
| //zfTkipInit(keyInfo.key, (u8_t*) keyInfo.macAddr, |
| // &(wd->ap.staTable[id].rxSeed), KeyRsc); |
| #ifdef ZM_ENABLE_CENC |
| if (keyInfo.flag & ZM_KEY_FLAG_CENC) |
| { |
| zm_debug_msg0("Set CENC pairwise Key"); |
| |
| wd->ap.staTable[id].encryMode = ZM_CENC; |
| |
| /* Reset txiv and rxiv */ |
| wd->ap.staTable[id].txiv[0] = 0x5c365c37; |
| wd->ap.staTable[id].txiv[1] = 0x5c365c36; |
| wd->ap.staTable[id].txiv[2] = 0x5c365c36; |
| wd->ap.staTable[id].txiv[3] = 0x5c365c36; |
| |
| wd->ap.staTable[id].rxiv[0] = 0x5c365c36; |
| wd->ap.staTable[id].rxiv[1] = 0x5c365c36; |
| wd->ap.staTable[id].rxiv[2] = 0x5c365c36; |
| wd->ap.staTable[id].rxiv[3] = 0x5c365c36; |
| |
| /* Set Key Index */ |
| wd->ap.staTable[id].cencKeyIdx = keyInfo.keyIndex; |
| |
| //zfCoreSetKey(dev, id+1, 1, ZM_CENC, (u16_t *)keyInfo.macAddr, |
| // (u32_t*) &keyInfo.key[16]); |
| } |
| else |
| #endif //ZM_ENABLE_CENC |
| { |
| wd->ap.staTable[id].encryMode = ZM_TKIP; |
| |
| zfMemoryCopy(micKey, &keyInfo.key[16], 8); |
| zfMemoryCopy(&micKey[8], &keyInfo.key[24], 8); |
| |
| //zfCoreSetKey(dev, id+1, 1, ZM_TKIP, (u16_t *)keyInfo.macAddr, |
| // (u32_t*) micKey); |
| |
| /* For fragmentation, we use software MIC */ |
| zfMemoryCopy((u8_t *)&(wd->ap.staTable[id].txMicKey), &(keyInfo.key[16]), 8); |
| zfMemoryCopy((u8_t *)&(wd->ap.staTable[id].rxMicKey), &(keyInfo.key[24]), 8); |
| |
| } |
| } |
| else if (keyInfo.keyLength == 16) |
| { /* AES */ |
| wd->ap.staTable[id].encryMode = ZM_AES; |
| } |
| else if (keyInfo.keyLength == 0) |
| { |
| /* Clear Key Info */ |
| zfApClearStaKey(dev, (u16_t *)keyInfo.macAddr); |
| |
| return ZM_STATUS_SUCCESS; |
| } |
| else |
| { |
| return ZM_STATUS_FAILURE; |
| } |
| |
| //zfCoreSetKey(dev, id+1, 0, wd->ap.staTable[id].encryMode, |
| // (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| zfHpSetApPairwiseKey(dev, (u16_t *)keyInfo.macAddr, |
| wd->ap.staTable[id].encryMode, (u32_t*) keyInfo.key, |
| (u32_t*) &keyInfo.key[16], id+1); |
| wd->ap.staTable[id].keyIdx = id + 1 + 4; |
| } |
| else if (keyInfo.flag & ZM_KEY_FLAG_GK) |
| { |
| vapId = keyInfo.vapId; |
| |
| wd->ap.iv16[vapId] = 0; |
| wd->ap.iv32[vapId] = 0; |
| |
| if (keyInfo.keyLength == 32) |
| { /* TKIP */ |
| //u8_t KeyRsc[6] = {0, 0, 0, 0, 0, 0}; |
| |
| //zfTkipInit(keyInfo.key, (u8_t*) wd->macAddr, |
| // &(wd->ap.bcSeed), KeyRsc); |
| #ifdef ZM_ENABLE_CENC |
| if (keyInfo.flag & ZM_KEY_FLAG_CENC) |
| { |
| encryMode = ZM_CENC; |
| zm_debug_msg0("Set CENC group Key"); |
| |
| /* Reset txiv and rxiv */ |
| wd->ap.txiv[vapId][0] = 0x5c365c36; |
| wd->ap.txiv[vapId][1] = 0x5c365c36; |
| wd->ap.txiv[vapId][2] = 0x5c365c36; |
| wd->ap.txiv[vapId][3] = 0x5c365c36; |
| |
| //zfCoreSetKey(dev, 0, 1, ZM_CENC, keyInfo.vapAddr, |
| // (u32_t*) &keyInfo.key[16]); |
| key = (u32_t*) keyInfo.key; |
| } |
| else |
| #endif //ZM_ENABLE_CENC |
| { |
| encryMode = ZM_TKIP; |
| key = (u32_t *)keyInfo.key; |
| |
| /* set MIC key to HMAC */ |
| //zfCoreSetKey(dev, 0, 1, ZM_TKIP, broadcast, |
| // (u32_t*) (&keyInfo.key[16])); |
| //zfCoreSetKey(dev, 0, 1, ZM_TKIP, keyInfo.vapAddr, |
| // (u32_t*) (&keyInfo.key[16])); |
| |
| zfMicSetKey(&(keyInfo.key[16]), &(wd->ap.bcMicKey[0])); |
| key = (u32_t*) keyInfo.key; |
| } |
| } |
| else if (keyInfo.keyLength == 16) |
| { /* AES */ |
| encryMode = ZM_AES; |
| key = (u32_t *)keyInfo.key; |
| zm_debug_msg0("CWY - Set AES Group Key"); |
| } |
| else if (keyInfo.keyLength == 0) |
| { |
| /* Clear Key Info */ |
| zfApClearStaKey(dev, broadcast); |
| |
| /* Turn off WEP bit in the capability field */ |
| wd->ap.capab[vapId] &= 0xffef; |
| |
| return ZM_STATUS_SUCCESS; |
| } |
| else |
| { /* WEP */ |
| if (keyInfo.keyLength == 5) |
| { |
| encryMode = ZM_WEP64; |
| } |
| else if (keyInfo.keyLength == 13) |
| { |
| encryMode = ZM_WEP128; |
| } |
| else if (keyInfo.keyLength == 29) |
| { |
| encryMode = ZM_WEP256; |
| } |
| |
| key = (u32_t*) keyInfo.key; |
| } |
| |
| // Modification for CAM not support VAP search |
| //zfCoreSetKey(dev, 0, 0, encryMode, broadcast, key); |
| //zfCoreSetKey(dev, 0, 0, encryMode, wd->macAddr, key); |
| //zfCoreSetKey(dev, 0, 0, encryMode, keyInfo.vapAddr, key); |
| zfHpSetApGroupKey(dev, wd->macAddr, encryMode, |
| key, (u32_t*) &keyInfo.key[16], vapId); |
| |
| //zfiWlanSetEncryMode(dev, encryMode); |
| wd->ws.encryMode = encryMode; |
| |
| /* set the multicast address encryption type */ |
| wd->ap.encryMode[vapId] = encryMode; |
| |
| /* set the multicast key index */ |
| wd->ap.bcKeyIndex[vapId] = keyInfo.keyIndex; |
| wd->ap.bcHalKeyIdx[vapId] = vapId + 60; |
| |
| /* Turn on WEP bit in the capability field */ |
| wd->ap.capab[vapId] |= 0x10; |
| } |
| } |
| else |
| { /* set by supplicant */ |
| |
| if ( keyInfo.flag & ZM_KEY_FLAG_PK ) |
| { /* set pairwise key */ |
| |
| //zfTkipInit(keyInfo.key, (u8_t*) wd->macAddr, |
| // &wd->sta.txSeed, keyInfo.initIv); |
| //zfTkipInit(keyInfo.key, (u8_t*) wd->sta.bssid, |
| // &wd->sta.rxSeed[keyInfo.keyIndex], keyInfo.initIv); |
| |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| if ( wd->sta.ibssWpa2Psk == 1 ) |
| { |
| /* unicast -- > pairwise key */ |
| wd->sta.oppositeInfo[userIdx].iv16 = 0; |
| wd->sta.oppositeInfo[userIdx].iv32 = 0; |
| } |
| else |
| { |
| wd->sta.iv16 = 0; |
| wd->sta.iv32 = 0; |
| } |
| |
| wd->sta.oppositeInfo[userIdx].pkInstalled = 1; |
| #else |
| wd->sta.iv16 = 0; |
| wd->sta.iv32 = 0; |
| |
| wd->sta.oppositeInfo[userIdx].pkInstalled = 1; |
| #endif |
| |
| if ( keyInfo.keyLength == 32 ) |
| { /* TKIP */ |
| zfTkipInit(keyInfo.key, (u8_t*) wd->macAddr, |
| &wd->sta.txSeed, keyInfo.initIv); |
| zfTkipInit(keyInfo.key, (u8_t*) wd->sta.bssid, |
| &wd->sta.rxSeed[keyInfo.keyIndex], keyInfo.initIv); |
| |
| #ifdef ZM_ENABLE_CENC |
| if (keyInfo.flag & ZM_KEY_FLAG_CENC) |
| { |
| zm_debug_msg0("Set CENC pairwise Key"); |
| |
| wd->sta.encryMode = ZM_CENC; |
| |
| /* Reset txiv and rxiv */ |
| wd->sta.txiv[0] = 0x5c365c36; |
| wd->sta.txiv[1] = 0x5c365c36; |
| wd->sta.txiv[2] = 0x5c365c36; |
| wd->sta.txiv[3] = 0x5c365c36; |
| |
| wd->sta.rxiv[0] = 0x5c365c37; |
| wd->sta.rxiv[1] = 0x5c365c36; |
| wd->sta.rxiv[2] = 0x5c365c36; |
| wd->sta.rxiv[3] = 0x5c365c36; |
| |
| /* Set Key Index */ |
| wd->sta.cencKeyId = keyInfo.keyIndex; |
| |
| //zfCoreSetKey(dev, id+1, 1, ZM_CENC, (u16_t *)keyInfo.macAddr, |
| // (u32_t*) &keyInfo.key[16]); |
| } |
| else |
| #endif //ZM_ENABLE_CENC |
| { |
| wd->sta.encryMode = ZM_TKIP; |
| |
| //zfCoreSetKey(dev, 0, 1, ZM_TKIP, wd->sta.bssid, |
| // (u32_t*) &keyInfo.key[16]); |
| |
| zfMicSetKey(&keyInfo.key[16], &wd->sta.txMicKey); |
| zfMicSetKey(&keyInfo.key[24], |
| &wd->sta.rxMicKey[keyInfo.keyIndex]); |
| } |
| } |
| else if ( keyInfo.keyLength == 16 ) |
| { /* AES */ |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| if ( wd->sta.ibssWpa2Psk == 1 ) |
| { |
| wd->sta.oppositeInfo[userIdx].encryMode = ZM_AES; |
| encryType = wd->sta.oppositeInfo[userIdx].encryMode; |
| } |
| else |
| { |
| wd->sta.encryMode = ZM_AES; |
| encryType = wd->sta.encryMode; |
| } |
| #else |
| wd->sta.encryMode = ZM_AES; |
| #endif |
| } |
| else |
| { |
| return ZM_STATUS_FAILURE; |
| } |
| |
| /* user 0 */ |
| //zfCoreSetKey(dev, 0, 0, wd->sta.encryMode, |
| // wd->sta.bssid, (u32_t*) keyInfo.key); |
| //zfHpSetStaPairwiseKey(dev, wd->sta.bssid, wd->sta.encryMode, |
| // (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| if ( (keyInfo.keyLength==16) && (wd->sta.ibssWpa2Psk==1) ) |
| { /* If not AES-CCMP and ibss network , use traditional */ |
| zfHpSetPerUserKey(dev, |
| userIdx, |
| keyInfo.keyIndex, // key id == 0 ( Pairwise key = 0 ) |
| (u8_t*)keyInfo.macAddr, // RX need Source Address ( Address 2 ) |
| encryType, |
| // wd->sta.encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| wd->sta.oppositeInfo[userIdx].wpaState = ZM_STA_WPA_STATE_PK_OK ; |
| } |
| else |
| {/* Big Endian and Little Endian Compatibility */ |
| for (i = 0; i < 3; i++) |
| { |
| addr[2 * i] = wd->sta.bssid[i] & 0xff; |
| addr[2 * i + 1] = wd->sta.bssid[i] >> 8; |
| } |
| zfHpSetPerUserKey(dev, |
| ZM_USER_KEY_PK, // user id |
| 0, // key id |
| addr,//(u8_t *)wd->sta.bssid, |
| wd->sta.encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| wd->sta.keyId = 4; |
| } |
| #else |
| /* Big Endian and Little Endian Compatibility */ |
| for (i = 0; i < 3; i++) |
| { |
| addr[2 * i] = wd->sta.bssid[i] & 0xff; |
| addr[2 * i + 1] = wd->sta.bssid[i] >> 8; |
| } |
| zfHpSetPerUserKey(dev, |
| ZM_USER_KEY_PK, // user id |
| 0, // key id |
| addr,//(u8_t *)wd->sta.bssid, |
| wd->sta.encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| wd->sta.keyId = 4; |
| #endif |
| |
| wd->sta.wpaState = ZM_STA_WPA_STATE_PK_OK; |
| } |
| else if ( keyInfo.flag & ZM_KEY_FLAG_GK ) |
| { /* set group key */ |
| |
| zfTkipInit(keyInfo.key, (u8_t*) wd->sta.bssid, |
| &wd->sta.rxSeed[keyInfo.keyIndex], keyInfo.initIv); |
| |
| if ( keyInfo.keyLength == 32 ) |
| { /* TKIP */ |
| #ifdef ZM_ENABLE_CENC |
| if (keyInfo.flag & ZM_KEY_FLAG_CENC) |
| { |
| encryMode = ZM_CENC; |
| zm_debug_msg0("Set CENC group Key"); |
| |
| /* Reset txiv and rxiv */ |
| wd->sta.rxivGK[0] = 0x5c365c36; |
| wd->sta.rxivGK[1] = 0x5c365c36; |
| wd->sta.rxivGK[2] = 0x5c365c36; |
| wd->sta.rxivGK[3] = 0x5c365c36; |
| |
| //zfCoreSetKey(dev, 0, 1, ZM_CENC, keyInfo.vapAddr, |
| // (u32_t*) &keyInfo.key[16]); |
| key = (u32_t*) keyInfo.key; |
| } |
| else |
| #endif //ZM_ENABLE_CENC |
| { |
| encryMode = ZM_TKIP; |
| key = (u32_t*) wd->sta.rxSeed[keyInfo.keyIndex].tk; |
| |
| if ( !(keyInfo.flag & ZM_KEY_FLAG_INIT_IV) ) |
| { |
| wd->sta.rxSeed[keyInfo.keyIndex].iv16 = 0; |
| wd->sta.rxSeed[keyInfo.keyIndex].iv32 = 0; |
| } |
| |
| /* set MIC key to HMAC */ |
| //zfCoreSetKey(dev, 8, 1, ZM_TKIP, broadcast, |
| // (u32_t*) (&keyInfo.key[16])); |
| |
| zfMicSetKey(&keyInfo.key[24], |
| &wd->sta.rxMicKey[keyInfo.keyIndex]); |
| } |
| } |
| else if ( keyInfo.keyLength == 16 ) |
| { /* AES */ |
| encryMode = ZM_AES; |
| //key = (u32_t*) wd->sta.rxSeed[keyInfo.keyIndex].tk; |
| } |
| else |
| { /* WEP */ |
| if ( keyInfo.keyLength == 5 ) |
| { |
| encryMode = ZM_WEP64; |
| } |
| else if ( keyInfo.keyLength == 13 ) |
| { |
| encryMode = ZM_WEP128; |
| } |
| else if ( keyInfo.keyLength == 29 ) |
| { |
| encryMode = ZM_WEP256; |
| } |
| |
| key = (u32_t*) keyInfo.key; |
| } |
| |
| /* user 8 */ |
| //zfCoreSetKey(dev, 8, 0, encryMode, broadcast, key); |
| //zfHpSetStaGroupKey(dev, broadcast, encryMode, |
| // (u32_t*) keyInfo.key, (u32_t*) (&keyInfo.key[16])); |
| |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| if ( (keyInfo.keyLength==16) && (wd->sta.ibssWpa2Psk==1) ) |
| {/* If not AES-CCMP and ibss network , use traditional */ |
| zfHpSetPerUserKey(dev, |
| userIdx, |
| keyInfo.keyIndex, // key id |
| // (u8_t *)broadcast, // for only 2 stations IBSS netwrl ( A2 ) |
| (u8_t*)keyInfo.macAddr, // for multiple ( > 2 ) stations IBSS network ( A2 ) |
| encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| } |
| else |
| { |
| zfHpSetPerUserKey(dev, |
| ZM_USER_KEY_GK, // user id |
| 0, // key id |
| (u8_t *)broadcast, |
| encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| wd->sta.wpaState = ZM_STA_WPA_STATE_GK_OK; |
| } |
| #else |
| zfHpSetPerUserKey(dev, |
| ZM_USER_KEY_GK, // user id |
| 0, // key id |
| (u8_t *)broadcast, |
| encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| wd->sta.wpaState = ZM_STA_WPA_STATE_GK_OK; |
| #endif |
| } |
| else |
| { /* legacy WEP */ |
| zm_debug_msg0("legacy WEP"); |
| |
| if ( keyInfo.keyIndex >= 4 ) |
| { |
| return ZM_STATUS_FAILURE; |
| } |
| |
| if ( keyInfo.keyLength == 5 ) |
| { |
| zm_debug_msg0("WEP 64"); |
| |
| encryMode = ZM_WEP64; |
| } |
| else if ( keyInfo.keyLength == 13 ) |
| { |
| zm_debug_msg0("WEP 128"); |
| |
| encryMode = ZM_WEP128; |
| } |
| else if ( keyInfo.keyLength == 32 ) |
| { |
| /* TKIP */ |
| #if 0 |
| // Don't reset the IV since some AP would fail in IV check and drop our connection |
| if ( wd->sta.wpaState != ZM_STA_WPA_STATE_PK_OK ) |
| { |
| wd->sta.iv16 = 0; |
| wd->sta.iv32 = 0; |
| } |
| #endif |
| |
| encryMode = ZM_TKIP; |
| |
| zfTkipInit(keyInfo.key, (u8_t*) wd->sta.bssid, |
| &wd->sta.rxSeed[keyInfo.keyIndex], keyInfo.initIv); |
| zfMicSetKey(&keyInfo.key[24], |
| &wd->sta.rxMicKey[keyInfo.keyIndex]); |
| } |
| else if ( keyInfo.keyLength == 16 ) |
| { |
| /* AES */ |
| #if 0 |
| // Don't reset the IV since some AP would fail in IV check and drop our connection |
| if ( wd->sta.wpaState != ZM_STA_WPA_STATE_PK_OK ) |
| { |
| /* broadcast -- > group key */ |
| /* Only initialize when set our default key ! */ |
| wd->sta.iv16 = 0; |
| wd->sta.iv32 = 0; |
| } |
| #endif |
| |
| encryMode = ZM_AES; |
| } |
| else if ( keyInfo.keyLength == 29 ) |
| { |
| zm_debug_msg0("WEP 256"); |
| |
| encryMode = ZM_WEP256; |
| //zfCoreSetKey(dev, 64, 1, wd->sta.encryMode, |
| // wd->sta.bssid, (u32_t*) (&keyInfo.key[16])); |
| } |
| else |
| { |
| return ZM_STATUS_FAILURE; |
| } |
| |
| { |
| u8_t i; |
| |
| zm_debug_msg0("key = "); |
| for(i = 0; i < keyInfo.keyLength; i++) |
| { |
| zm_debug_msg2("", keyInfo.key[i]); |
| } |
| } |
| |
| if ( keyInfo.flag & ZM_KEY_FLAG_DEFAULT_KEY ) |
| { |
| //for WEP default key 1~3 and ATOM platform--CWYang(+) |
| vapId = 0; |
| wd->ap.bcHalKeyIdx[vapId] = keyInfo.keyIndex; |
| wd->ap.bcKeyIndex[vapId] = keyInfo.keyIndex; |
| wd->sta.keyId = keyInfo.keyIndex; |
| } |
| |
| if(encryMode == ZM_TKIP) |
| { |
| if(wd->TKIP_Group_KeyChanging == 0x1) |
| { |
| zm_debug_msg0("Countermeasure : Cancel Old Timer "); |
| zfTimerCancel(dev, ZM_EVENT_SKIP_COUNTERMEASURE); |
| } |
| else |
| { |
| zm_debug_msg0("Countermeasure : Create New Timer "); |
| } |
| |
| wd->TKIP_Group_KeyChanging = 0x1; |
| zfTimerSchedule(dev, ZM_EVENT_SKIP_COUNTERMEASURE, 150); |
| } |
| |
| |
| |
| //------------------------------------------------------------------------ |
| |
| /* use default key */ |
| //zfCoreSetKey(dev, ZM_USER_KEY_DEFAULT+keyInfo.keyIndex, 0, |
| // wd->sta.encryMode, wd->sta.bssid, (u32_t*) keyInfo.key); |
| |
| if ( encryMode == ZM_TKIP || |
| encryMode == ZM_AES ) |
| { |
| zfHpSetDefaultKey(dev, keyInfo.keyIndex, encryMode, |
| (u32_t*) keyInfo.key, (u32_t*) &keyInfo.key[16]); |
| |
| #ifdef ZM_ENABLE_IBSS_WPA2PSK |
| if ( (keyInfo.keyLength==16) && (wd->sta.ibssWpa2Psk==1) ) |
| {/* If not AES-CCMP and ibss network , use traditional */ |
| wd->sta.wpaState = ZM_STA_WPA_STATE_PK_OK; |
| } |
| else |
| { |
| if (wd->sta.wpaState == ZM_STA_WPA_STATE_PK_OK) |
| wd->sta.wpaState = ZM_STA_WPA_STATE_GK_OK; |
| else |
| { |
| wd->sta.wpaState = ZM_STA_WPA_STATE_PK_OK; |
| wd->sta.encryMode = encryMode; |
| wd->ws.encryMode = encryMode; |
| } |
| } |
| #else |
| if (wd->sta.wpaState == ZM_STA_WPA_STATE_PK_OK) |
| wd->sta.wpaState = ZM_STA_WPA_STATE_GK_OK; |
| else if ( wd->sta.wpaState == ZM_STA_WPA_STATE_INIT ) |
| { |
| wd->sta.wpaState = ZM_STA_WPA_STATE_PK_OK; |
| wd->sta.encryMode = encryMode; |
| wd->ws.encryMode = encryMode; |
| } |
| #endif |
| } |
| else |
| { |
| zfHpSetDefaultKey(dev, keyInfo.keyIndex, encryMode, |
| (u32_t*) keyInfo.key, NULL); |
| |
| /* Save key for software WEP */ |
| zfMemoryCopy(wd->sta.wepKey[keyInfo.keyIndex], keyInfo.key, |
| keyInfo.keyLength); |
| |
| /* TODO: Check whether we need to save the SWEncryMode */ |
| wd->sta.SWEncryMode[keyInfo.keyIndex] = encryMode; |
| |
| wd->sta.encryMode = encryMode; |
| wd->ws.encryMode = encryMode; |
| } |
| } |
| } |
| |
| // wd->sta.flagKeyChanging = 1; |
| return ZM_STATUS_SUCCESS; |
| } |
| |
| /* PSEUDO test */ |
| u8_t zfiWlanPSEUDOSetKey(zdev_t* dev, struct zsKeyInfo keyInfo) |
| { |
| //u16_t broadcast[3] = {0xffff, 0xffff, 0xffff}; |
| //u32_t* key; |
| u8_t micKey[16]; |
| |
| zmw_get_wlan_dev(dev); |
| |
| switch (keyInfo.keyLength) |
| { |
| case 5: |
| wd->sta.encryMode = ZM_WEP64; |
| /* use default key */ |
| zfCoreSetKey(dev, 64, 0, ZM_WEP64, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| break; |
| |
| case 13: |
| wd->sta.encryMode = ZM_WEP128; |
| /* use default key */ |
| zfCoreSetKey(dev, 64, 0, ZM_WEP128, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| break; |
| |
| case 29: |
| wd->sta.encryMode = ZM_WEP256; |
| /* use default key */ |
| zfCoreSetKey(dev, 64, 1, ZM_WEP256, (u16_t *)keyInfo.macAddr, (u32_t*) (&keyInfo.key[16])); |
| zfCoreSetKey(dev, 64, 0, ZM_WEP256, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| break; |
| |
| case 16: |
| wd->sta.encryMode = ZM_AES; |
| //zfCoreSetKey(dev, 0, 0, ZM_AES, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| zfCoreSetKey(dev, 64, 0, ZM_AES, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| break; |
| |
| case 32: |
| #ifdef ZM_ENABLE_CENC |
| if (keyInfo.flag & ZM_KEY_FLAG_CENC) |
| { |
| u16_t boardcastAddr[3] = {0xffff, 0xffff, 0xffff}; |
| u16_t Addr_a[] = { 0x0000, 0x0080, 0x0901}; |
| u16_t Addr_b[] = { 0x0000, 0x0080, 0x0902}; |
| /* CENC test: user0,1 and user2 for boardcast */ |
| wd->sta.encryMode = ZM_CENC; |
| zfCoreSetKey(dev, 0, 1, ZM_CENC, (u16_t *)Addr_a, (u32_t*) (&keyInfo.key[16])); |
| zfCoreSetKey(dev, 0, 0, ZM_CENC, (u16_t *)Addr_a, (u32_t*) keyInfo.key); |
| |
| zfCoreSetKey(dev, 1, 1, ZM_CENC, (u16_t *)Addr_b, (u32_t*) (&keyInfo.key[16])); |
| zfCoreSetKey(dev, 1, 0, ZM_CENC, (u16_t *)Addr_b, (u32_t*) keyInfo.key); |
| |
| zfCoreSetKey(dev, 2, 1, ZM_CENC, (u16_t *)boardcastAddr, (u32_t*) (&keyInfo.key[16])); |
| zfCoreSetKey(dev, 2, 0, ZM_CENC, (u16_t *)boardcastAddr, (u32_t*) keyInfo.key); |
| |
| /* Initialize PN sequence */ |
| wd->sta.txiv[0] = 0x5c365c36; |
| wd->sta.txiv[1] = 0x5c365c36; |
| wd->sta.txiv[2] = 0x5c365c36; |
| wd->sta.txiv[3] = 0x5c365c36; |
| } |
| else |
| #endif //ZM_ENABLE_CENC |
| { |
| wd->sta.encryMode = ZM_TKIP; |
| zfCoreSetKey(dev, 64, 1, ZM_TKIP, (u16_t *)keyInfo.macAddr, (u32_t*) micKey); |
| zfCoreSetKey(dev, 64, 0, ZM_TKIP, (u16_t *)keyInfo.macAddr, (u32_t*) keyInfo.key); |
| } |
| break; |
| default: |
| wd->sta.encryMode = ZM_NO_WEP; |
| } |
| |
| return ZM_STATUS_SUCCESS; |
| } |
| |
| void zfiWlanSetPowerSaveMode(zdev_t* dev, u8_t mode) |
| { |
| #if 0 |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.powerSaveMode = mode; |
| |
| /* send null data with PwrBit to inform AP */ |
| if ( mode > ZM_STA_PS_NONE ) |
| { |
| if ( wd->wlanMode == ZM_MODE_INFRASTRUCTURE ) |
| { |
| zfSendNullData(dev, 1); |
| } |
| |
| /* device into PS mode */ |
| zfPSDeviceSleep(dev); |
| } |
| #endif |
| |
| zfPowerSavingMgrSetMode(dev, mode); |
| } |
| |
| void zfiWlanSetMacAddress(zdev_t* dev, u16_t* mac) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->macAddr[0] = mac[0]; |
| wd->macAddr[1] = mac[1]; |
| wd->macAddr[2] = mac[2]; |
| |
| zfHpSetMacAddress(dev, mac, 0); |
| } |
| |
| u8_t zfiWlanQueryWlanMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->wlanMode; |
| } |
| |
| u8_t zfiWlanQueryAdapterState(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->state; |
| } |
| |
| u8_t zfiWlanQueryAuthenticationMode(zdev_t* dev, u8_t bWrapper) |
| { |
| u8_t authMode; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if ( bWrapper ) |
| { |
| authMode = wd->ws.authMode; |
| } |
| else |
| { |
| //authMode = wd->sta.authMode; |
| authMode = wd->sta.currentAuthMode; |
| } |
| |
| return authMode; |
| } |
| |
| u8_t zfiWlanQueryWepStatus(zdev_t* dev, u8_t bWrapper) |
| { |
| u8_t wepStatus; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if ( bWrapper ) |
| { |
| wepStatus = wd->ws.wepStatus; |
| } |
| else |
| { |
| wepStatus = wd->sta.wepStatus; |
| } |
| |
| return wepStatus; |
| } |
| |
| void zfiWlanQuerySSID(zdev_t* dev, u8_t* ssid, u8_t* pSsidLength) |
| { |
| u16_t vapId = 0; |
| zmw_get_wlan_dev(dev); |
| |
| if (wd->wlanMode == ZM_MODE_AP) |
| { |
| vapId = zfwGetVapId(dev); |
| |
| if (vapId == 0xffff) |
| { |
| *pSsidLength = wd->ap.ssidLen[0]; |
| zfMemoryCopy(ssid, wd->ap.ssid[0], wd->ap.ssidLen[0]); |
| } |
| else |
| { |
| *pSsidLength = wd->ap.ssidLen[vapId + 1]; |
| zfMemoryCopy(ssid, wd->ap.ssid[vapId + 1], wd->ap.ssidLen[vapId + 1]); |
| } |
| } |
| else |
| { |
| *pSsidLength = wd->sta.ssidLen; |
| zfMemoryCopy(ssid, wd->sta.ssid, wd->sta.ssidLen); |
| } |
| } |
| |
| u16_t zfiWlanQueryFragThreshold(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->fragThreshold; |
| } |
| |
| u16_t zfiWlanQueryRtsThreshold(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->rtsThreshold; |
| } |
| |
| u32_t zfiWlanQueryFrequency(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return (wd->frequency*1000); |
| } |
| |
| /*********************************************************** |
| * Function: zfiWlanQueryCurrentFrequency |
| * Return value: |
| * - 0 : no validate current frequency |
| * - (>0): current frequency depend on "qmode" |
| * Input: |
| * - qmode: |
| * 0: return value depend on the support mode, this |
| qmode is use to solve the bug #31223 |
| * 1: return the actually current frequency |
| ***********************************************************/ |
| u32_t zfiWlanQueryCurrentFrequency(zdev_t* dev, u8_t qmode) |
| { |
| u32_t frequency; |
| |
| zmw_get_wlan_dev(dev); |
| |
| switch (qmode) |
| { |
| case 0: |
| if (wd->sta.currentFrequency > 3000) |
| { |
| if (wd->supportMode & ZM_WIRELESS_MODE_5) |
| { |
| frequency = wd->sta.currentFrequency; |
| } |
| else if (wd->supportMode & ZM_WIRELESS_MODE_24) |
| { |
| frequency = zfChGetFirst2GhzChannel(dev); |
| } |
| else |
| { |
| frequency = 0; |
| } |
| } |
| else |
| { |
| if (wd->supportMode & ZM_WIRELESS_MODE_24) |
| { |
| frequency = wd->sta.currentFrequency; |
| } |
| else if (wd->supportMode & ZM_WIRELESS_MODE_5) |
| { |
| frequency = zfChGetLast5GhzChannel(dev); |
| } |
| else |
| { |
| frequency = 0; |
| } |
| } |
| break; |
| |
| case 1: |
| frequency = wd->sta.currentFrequency; |
| break; |
| |
| default: |
| frequency = 0; |
| } |
| |
| return (frequency*1000); |
| } |
| |
| u32_t zfiWlanQueryFrequencyAttribute(zdev_t* dev, u32_t freq) |
| { |
| u8_t i; |
| u16_t frequency = (u16_t) (freq/1000); |
| u32_t ret = 0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for (i = 0; i < wd->regulationTable.allowChannelCnt; i++) |
| { |
| if ( wd->regulationTable.allowChannel[i].channel == frequency ) |
| { |
| ret = wd->regulationTable.allowChannel[i].channelFlags; |
| } |
| } |
| |
| return ret; |
| } |
| |
| /* BandWidth 0=>20 1=>40 */ |
| /* ExtOffset 0=>20 1=>high control 40 3=>low control 40 */ |
| void zfiWlanQueryFrequencyHT(zdev_t* dev, u32_t *bandWidth, u32_t *extOffset) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| *bandWidth = wd->BandWidth40; |
| *extOffset = wd->ExtOffset; |
| } |
| |
| u8_t zfiWlanQueryCWMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->cwm.cw_mode; |
| } |
| |
| u32_t zfiWlanQueryCWEnable(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->cwm.cw_enable; |
| } |
| |
| void zfiWlanQueryBssid(zdev_t* dev, u8_t* bssid) |
| { |
| u8_t addr[6]; |
| |
| zmw_get_wlan_dev(dev); |
| |
| ZM_MAC_WORD_TO_BYTE(wd->sta.bssid, addr); |
| zfMemoryCopy(bssid, addr, 6); |
| } |
| |
| u16_t zfiWlanQueryBeaconInterval(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->beaconInterval; |
| } |
| |
| u32_t zfiWlanQueryRxBeaconTotal(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| wd->sta.rxBeaconTotal += wd->sta.rxBeaconCount; |
| |
| return wd->sta.rxBeaconTotal; |
| } |
| |
| u16_t zfiWlanQueryAtimWindow(zdev_t* dev) |
| { |
| u16_t atimWindow; |
| |
| zmw_get_wlan_dev(dev); |
| |
| atimWindow = wd->sta.atimWindow; |
| |
| return atimWindow; |
| } |
| |
| u8_t zfiWlanQueryEncryMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| if (wd->wlanMode == ZM_MODE_AP) |
| return wd->ap.encryMode[0]; |
| else |
| return wd->sta.encryMode; |
| } |
| |
| u16_t zfiWlanQueryCapability(zdev_t* dev) |
| { |
| u16_t capability; |
| |
| zmw_get_wlan_dev(dev); |
| |
| capability = wd->sta.capability[0] + |
| (((u16_t) wd->sta.capability[1]) << 8); |
| |
| return capability; |
| |
| } |
| |
| u16_t zfiWlanQueryAid(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->sta.aid; |
| } |
| |
| void zfiWlanQuerySupportRate(zdev_t* dev, u8_t* rateArray, u8_t* pLength) |
| { |
| u8_t i, j=0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for( i=0; i<4; i++ ) |
| { |
| if ( wd->bRate & (0x1 << i) ) |
| { |
| rateArray[j] = zg11bRateTbl[i] + |
| ((wd->bRateBasic & (0x1<<i))<<(7-i)); |
| j++; |
| } |
| } |
| |
| *pLength = j; |
| } |
| |
| void zfiWlanQueryExtSupportRate(zdev_t* dev, u8_t* rateArray, u8_t* pLength) |
| { |
| u8_t i, j=0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for( i=0; i<8; i++ ) |
| { |
| if ( wd->gRate & (0x1 << i) ) |
| { |
| rateArray[j] = zg11gRateTbl[i] + |
| ((wd->gRateBasic & (0x1<<i))<<(7-i)); |
| j++; |
| } |
| } |
| |
| *pLength = j; |
| } |
| |
| void zfiWlanQueryRsnIe(zdev_t* dev, u8_t* ie, u8_t* pLength) |
| { |
| u8_t len; |
| |
| zmw_get_wlan_dev(dev); |
| |
| len = wd->sta.rsnIe[1] + 2; |
| zfMemoryCopy(ie, wd->sta.rsnIe, len); |
| *pLength = len; |
| } |
| |
| void zfiWlanQueryWpaIe(zdev_t* dev, u8_t* ie, u8_t* pLength) |
| { |
| u8_t len; |
| |
| zmw_get_wlan_dev(dev); |
| |
| len = wd->sta.wpaIe[1] + 2; |
| zfMemoryCopy(ie, wd->sta.wpaIe, len); |
| *pLength = len; |
| |
| } |
| |
| u8_t zfiWlanQueryMulticastCipherAlgo(zdev_t *dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| switch( wd->sta.currentAuthMode ) |
| { |
| case ZM_AUTH_MODE_WPA2PSK: |
| case ZM_AUTH_MODE_WPA2: |
| if ( wd->sta.rsnIe[7] == 2 ) |
| { |
| return ZM_TKIP; |
| } |
| else |
| { |
| return ZM_AES; |
| } |
| break; |
| |
| case ZM_AUTH_MODE_WPAPSK: |
| case ZM_AUTH_MODE_WPA: |
| if ( wd->sta.rsnIe[11] == 2 ) |
| { |
| return ZM_TKIP; |
| } |
| else |
| { |
| return ZM_AES; |
| } |
| break; |
| |
| default: |
| return wd->sta.encryMode; |
| } |
| } |
| |
| u8_t zfiWlanQueryHTMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| // 0:Legancy, 1:N |
| return wd->sta.EnableHT; |
| } |
| |
| u8_t zfiWlanQueryBandWidth40(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| // 0:20M, 1:40M |
| return wd->BandWidth40; |
| } |
| |
| u16_t zfiWlanQueryRegionCode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->regulationTable.regionCode; |
| } |
| void zfiWlanSetWpaIe(zdev_t* dev, u8_t* ie, u8_t Length) |
| { |
| u16_t vapId = 0; |
| zmw_get_wlan_dev(dev); |
| |
| if (wd->wlanMode == ZM_MODE_AP) // AP Mode |
| { |
| vapId = zfwGetVapId(dev); |
| |
| if (vapId == 0xffff) |
| vapId = 0; |
| else |
| vapId++; |
| |
| zm_assert(Length < ZM_MAX_WPAIE_SIZE); |
| if (Length < ZM_MAX_WPAIE_SIZE) |
| { |
| wd->ap.wpaLen[vapId] = Length; |
| zfMemoryCopy(wd->ap.wpaIe[vapId], ie, wd->ap.wpaLen[vapId]); |
| } |
| |
| } |
| else |
| { |
| wd->sta.wpaLen = Length; |
| zfMemoryCopy(wd->sta.wpaIe, ie, wd->sta.wpaLen); |
| } |
| //zfiWlanSetWpaSupport(dev, 1); |
| if (wd->wlanMode == ZM_MODE_AP) // AP Mode |
| { |
| wd->ap.wpaSupport[vapId] = 1; |
| } |
| else |
| { |
| wd->sta.wpaSupport = 1; |
| } |
| |
| } |
| |
| void zfiWlanSetWpaSupport(zdev_t* dev, u8_t WpaSupport) |
| { |
| u16_t vapId = 0; |
| zmw_get_wlan_dev(dev); |
| |
| if (wd->wlanMode == ZM_MODE_AP) // AP Mode |
| { |
| vapId = zfwGetVapId(dev); |
| |
| if (vapId == 0xffff) |
| vapId = 0; |
| else |
| vapId++; |
| |
| wd->ap.wpaSupport[vapId] = WpaSupport; |
| } |
| else |
| { |
| wd->sta.wpaSupport = WpaSupport; |
| } |
| |
| } |
| |
| void zfiWlanSetProtectionMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.bProtectionMode = mode; |
| if (wd->sta.bProtectionMode == TRUE) |
| { |
| zfHpSetSlotTime(dev, 0); |
| } |
| else |
| { |
| zfHpSetSlotTime(dev, 1); |
| } |
| |
| zm_msg1_mm(ZM_LV_1, "wd->protectionMode=", wd->sta.bProtectionMode); |
| } |
| |
| void zfiWlanSetBasicRate(zdev_t* dev, u8_t bRateSet, u8_t gRateSet, |
| u32_t nRateSet) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.bRateBasic = bRateSet; |
| wd->ws.gRateBasic = gRateSet; |
| wd->ws.nRateBasic = nRateSet; |
| } |
| |
| void zfiWlanSetBGMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.bgMode = mode; |
| } |
| |
| void zfiWlanSetpreambleType(zdev_t* dev, u8_t type) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.preambleType = type; |
| } |
| |
| u8_t zfiWlanQuerypreambleType(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->ws.preambleType; |
| } |
| |
| u8_t zfiWlanQueryPowerSaveMode(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->sta.powerSaveMode; |
| } |
| |
| u8_t zfiWlanSetPmkidInfo(zdev_t* dev, u16_t* bssid, u8_t* pmkid) |
| { |
| u32_t i; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for(i=0; i<wd->sta.pmkidInfo.bssidCount; i++) |
| { |
| if ( zfMemoryIsEqual((u8_t*) wd->sta.pmkidInfo.bssidInfo[i].bssid, |
| (u8_t*) bssid, 6) ) |
| { |
| /* matched */ |
| break; |
| } |
| } |
| |
| if ( i < wd->sta.pmkidInfo.bssidCount ) |
| { |
| /* overwrite the original one */ |
| zfMemoryCopy(wd->sta.pmkidInfo.bssidInfo[i].pmkid, pmkid, 16); |
| } |
| else |
| { |
| if ( i < ZM_PMKID_MAX_BSS_CNT ) |
| { |
| wd->sta.pmkidInfo.bssidInfo[i].bssid[0] = bssid[0]; |
| wd->sta.pmkidInfo.bssidInfo[i].bssid[1] = bssid[1]; |
| wd->sta.pmkidInfo.bssidInfo[i].bssid[2] = bssid[2]; |
| |
| zfMemoryCopy(wd->sta.pmkidInfo.bssidInfo[i].pmkid, pmkid, 16); |
| wd->sta.pmkidInfo.bssidCount++; |
| } |
| } |
| |
| return 0; |
| } |
| |
| u32_t zfiWlanQueryPmkidInfo(zdev_t* dev, u8_t* buf, u32_t len) |
| { |
| //struct zsPmkidInfo* pPmkidInfo = ( struct zsPmkidInfo* ) buf; |
| u32_t size; |
| |
| zmw_get_wlan_dev(dev); |
| |
| size = sizeof(u32_t) + |
| wd->sta.pmkidInfo.bssidCount * sizeof(struct zsPmkidBssidInfo); |
| |
| if ( len < size ) |
| { |
| return wd->sta.pmkidInfo.bssidCount; |
| } |
| |
| zfMemoryCopy(buf, (u8_t*) &wd->sta.pmkidInfo, (u16_t) size); |
| |
| return 0; |
| } |
| |
| void zfiWlanSetMulticastList(zdev_t* dev, u8_t size, u8_t* pList) |
| { |
| struct zsMulticastAddr* pMacList = (struct zsMulticastAddr*) pList; |
| u8_t i; |
| u8_t bAllMulticast = 0; |
| //u32_t value; |
| |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.multicastList.size = size; |
| for(i=0; i<size; i++) |
| { |
| zfMemoryCopy(wd->sta.multicastList.macAddr[i].addr, |
| pMacList[i].addr, 6); |
| } |
| |
| if ( wd->sta.osRxFilter & ZM_PACKET_TYPE_ALL_MULTICAST ) |
| bAllMulticast = 1; |
| zfHpSetMulticastList(dev, size, pList, bAllMulticast); |
| |
| } |
| |
| void zfiWlanRemoveKey(zdev_t* dev, u8_t keyType, u8_t keyId) |
| { |
| u16_t fakeMacAddr[3] = {0, 0, 0}; |
| u32_t fakeKey[4] = {0, 0, 0, 0}; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if ( keyType == 0 ) |
| { |
| /* remove WEP key */ |
| zm_debug_msg0("remove WEP key"); |
| zfCoreSetKey(dev, ZM_USER_KEY_DEFAULT+keyId, 0, |
| ZM_NO_WEP, fakeMacAddr, fakeKey); |
| wd->sta.encryMode = ZM_NO_WEP; |
| } |
| else if ( keyType == 1 ) |
| { |
| /* remove pairwise key */ |
| zm_debug_msg0("remove pairwise key"); |
| zfHpRemoveKey(dev, ZM_USER_KEY_PK); |
| wd->sta.encryMode = ZM_NO_WEP; |
| } |
| else |
| { |
| /* remove group key */ |
| zm_debug_msg0("remove group key"); |
| zfHpRemoveKey(dev, ZM_USER_KEY_GK); |
| } |
| } |
| |
| |
| void zfiWlanQueryRegulationTable(zdev_t* dev, struct zsRegulationTable* pEntry) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zfMemoryCopy((u8_t*) pEntry, (u8_t*) &wd->regulationTable, |
| sizeof(struct zsRegulationTable)); |
| } |
| |
| /* parameter "time" is specified in ms */ |
| void zfiWlanSetScanTimerPerChannel(zdev_t* dev, u16_t time) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zm_debug_msg1("scan time (ms) = ", time); |
| |
| wd->sta.activescanTickPerChannel = time / ZM_MS_PER_TICK; |
| } |
| |
| void zfiWlanSetAutoReconnect(zdev_t* dev, u8_t enable) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.bAutoReconnect = enable; |
| //wd->sta.bAutoReconnectEnabled = enable; |
| } |
| |
| void zfiWlanSetStaWme(zdev_t* dev, u8_t enable, u8_t uapsdInfo) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.staWmeEnabled = enable & 0x3; |
| if ((enable & 0x2) != 0) |
| { |
| wd->ws.staWmeQosInfo = uapsdInfo & 0x6f; |
| } |
| else |
| { |
| wd->ws.staWmeQosInfo = 0; |
| } |
| } |
| |
| void zfiWlanSetApWme(zdev_t* dev, u8_t enable) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.apWmeEnabled = enable; |
| } |
| |
| u8_t zfiWlanQuerywmeEnable(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->ws.staWmeEnabled; |
| } |
| |
| void zfiWlanSetProbingHiddenSsid(zdev_t* dev, u8_t* ssid, u8_t ssidLen, |
| u16_t entry) |
| { |
| zmw_get_wlan_dev(dev); |
| zmw_declare_for_critical_section(); |
| |
| |
| if ((ssidLen <= 32) && (entry < ZM_MAX_PROBE_HIDDEN_SSID_SIZE)) |
| { |
| zmw_enter_critical_section(dev); |
| wd->ws.probingSsidList[entry].ssidLen = ssidLen; |
| zfMemoryCopy(wd->ws.probingSsidList[entry].ssid, ssid, ssidLen); |
| zmw_leave_critical_section(dev); |
| } |
| |
| return; |
| } |
| |
| void zfiWlanSetDisableProbingWithSsid(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.disableProbingWithSsid = mode; |
| |
| return; |
| } |
| |
| void zfiWlanSetDropUnencryptedPackets(zdev_t* dev, u8_t enable) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.dropUnencryptedPkts = enable; |
| } |
| |
| void zfiWlanSetStaRxSecurityCheckCb(zdev_t* dev, zfpStaRxSecurityCheckCb pStaRxSecurityCheckCb) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.pStaRxSecurityCheckCb = pStaRxSecurityCheckCb; |
| } |
| |
| void zfiWlanSetIBSSJoinOnly(zdev_t* dev, u8_t joinOnly) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.ibssJoinOnly = joinOnly; |
| } |
| |
| /************************************************************************/ |
| /* */ |
| /* FUNCTION DESCRIPTION zfiConfigWdsPort */ |
| /* Configure WDS port. */ |
| /* */ |
| /* INPUTS */ |
| /* dev : device pointer */ |
| /* wdsPortId : WDS port ID, start from 0 */ |
| /* flag : 0=>disable WDS port, 1=>enable WDS port */ |
| /* wdsAddr : WDS neighbor MAC address */ |
| /* encType : encryption type for WDS port */ |
| /* wdsKey : encryption key for WDS port */ |
| /* */ |
| /* OUTPUTS */ |
| /* Error code */ |
| /* */ |
| /* AUTHOR */ |
| /* Stephen Chen ZyDAS Technology Corporation 2006.6 */ |
| /* */ |
| /************************************************************************/ |
| u16_t zfiConfigWdsPort(zdev_t* dev, u8_t wdsPortId, u16_t flag, u16_t* wdsAddr, |
| u16_t encType, u32_t* wdsKey) |
| { |
| u16_t addr[3]; |
| u32_t key[4]; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if (wdsPortId >= ZM_MAX_WDS_SUPPORT) |
| { |
| return ZM_ERR_WDS_PORT_ID; |
| } |
| |
| if (flag == 1) |
| { |
| /* Enable WDS port */ |
| wd->ap.wds.macAddr[wdsPortId][0] = wdsAddr[0]; |
| wd->ap.wds.macAddr[wdsPortId][1] = wdsAddr[1]; |
| wd->ap.wds.macAddr[wdsPortId][2] = wdsAddr[2]; |
| |
| wd->ap.wds.wdsBitmap |= (1 << wdsPortId); |
| wd->ap.wds.encryMode[wdsPortId] = (u8_t) encType; |
| |
| zfCoreSetKey(dev, 10+ZM_MAX_WDS_SUPPORT, 0, (u8_t) encType, wdsAddr, wdsKey); |
| } |
| else |
| { |
| /* Disable WDS port */ |
| addr[0] = addr[1] = addr[2] = 0; |
| key[0] = key[1] = key[2] = key[3] = 0; |
| wd->ap.wds.wdsBitmap &= (~(1 << wdsPortId)); |
| zfCoreSetKey(dev, 10+ZM_MAX_WDS_SUPPORT, 0, ZM_NO_WEP, addr, key); |
| } |
| |
| return ZM_SUCCESS; |
| } |
| #ifdef ZM_ENABLE_CENC |
| /* CENC */ |
| void zfiWlanQueryGSN(zdev_t* dev, u8_t *gsn, u16_t vapId) |
| { |
| //struct zsWlanDev* wd = (struct zsWlanDev*) zmw_wlan_dev(dev); |
| u32_t txiv[4]; |
| zmw_get_wlan_dev(dev); |
| |
| /* convert little endian to big endian for 32 bits */ |
| txiv[3] = wd->ap.txiv[vapId][0]; |
| txiv[2] = wd->ap.txiv[vapId][1]; |
| txiv[1] = wd->ap.txiv[vapId][2]; |
| txiv[0] = wd->ap.txiv[vapId][3]; |
| |
| zfMemoryCopy(gsn, (u8_t*)txiv, 16); |
| } |
| #endif //ZM_ENABLE_CENC |
| //CWYang(+) |
| void zfiWlanQuerySignalInfo(zdev_t* dev, u8_t *buffer) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| /*Change Signal Strength/Quality Value to Human Sense Here*/ |
| |
| buffer[0] = wd->SignalStrength; |
| buffer[1] = wd->SignalQuality; |
| } |
| |
| /* OS-XP */ |
| u16_t zfiStaAddIeWpaRsn(zdev_t* dev, zbuf_t* buf, u16_t offset, u8_t frameType) |
| { |
| return zfStaAddIeWpaRsn(dev, buf, offset, frameType); |
| } |
| |
| /* zfiDebugCmd */ |
| /* cmd value-description */ |
| /* 0 schedule timer */ |
| /* 1 cancel timer */ |
| /* 2 clear timer */ |
| /* 3 test timer */ |
| /* 4 */ |
| /* 5 */ |
| /* 6 checksum test 0/1 */ |
| /* 7 enableProtectionMode */ |
| /* 8 rx packet content dump 0/1 */ |
| |
| u32_t zfiDebugCmd(zdev_t* dev, u32_t cmd, u32_t value) |
| { |
| u16_t event; |
| u32_t tick; |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| |
| zmw_enter_critical_section(dev); |
| |
| if ( cmd == 0 ) |
| { /* schedule timer */ |
| event = (u16_t) ((value >> 16) & 0xffff); |
| tick = value & 0xffff; |
| zfTimerSchedule(dev, event, tick); |
| } |
| else if ( cmd == 1 ) |
| { /* cancel timer */ |
| event = (u16_t) (value & 0xffff); |
| zfTimerCancel(dev, event); |
| } |
| else if ( cmd == 2 ) |
| { /* clear timer */ |
| zfTimerClear(dev); |
| } |
| else if ( cmd == 3 ) |
| { /* test timer */ |
| zfTimerSchedule(dev, 1, 500); |
| zfTimerSchedule(dev, 2, 1000); |
| zfTimerSchedule(dev, 3, 1000); |
| zfTimerSchedule(dev, 4, 1000); |
| zfTimerSchedule(dev, 5, 1500); |
| zfTimerSchedule(dev, 6, 2000); |
| zfTimerSchedule(dev, 7, 2200); |
| zfTimerSchedule(dev, 6, 2500); |
| zfTimerSchedule(dev, 8, 2800); |
| } |
| else if ( cmd == 4) |
| { |
| zfTimerSchedule(dev, 1, 500); |
| zfTimerSchedule(dev, 2, 1000); |
| zfTimerSchedule(dev, 3, 1000); |
| zfTimerSchedule(dev, 4, 1000); |
| zfTimerSchedule(dev, 5, 1500); |
| zfTimerSchedule(dev, 6, 2000); |
| zfTimerSchedule(dev, 7, 2200); |
| zfTimerSchedule(dev, 6, 2500); |
| zfTimerSchedule(dev, 8, 2800); |
| zfTimerCancel(dev, 1); |
| zfTimerCancel(dev, 3); |
| zfTimerCancel(dev, 6); |
| } |
| else if ( cmd == 5 ) |
| { |
| wd->sta.keyId = (u8_t) value; |
| } |
| else if ( cmd == 6 ) |
| { |
| /* 0: normal 1: always set TCP/UDP checksum zero */ |
| wd->checksumTest = value; |
| } |
| else if ( cmd == 7 ) |
| { |
| wd->enableProtectionMode = value; |
| zm_msg1_mm(ZM_LV_1, "wd->enableProtectionMode=", wd->enableProtectionMode); |
| } |
| else if ( cmd == 8 ) |
| { |
| /* rx packet content dump */ |
| if (value) |
| { |
| wd->rxPacketDump = 1; |
| } |
| else |
| { |
| wd->rxPacketDump = 0; |
| } |
| } |
| |
| |
| zmw_leave_critical_section(dev); |
| |
| return 0; |
| } |
| |
| #ifdef ZM_ENABLE_CENC |
| u8_t zfiWlanSetCencPairwiseKey(zdev_t* dev, u8_t keyid, u32_t *txiv, u32_t *rxiv, |
| u8_t *key, u8_t *mic) |
| { |
| struct zsKeyInfo keyInfo; |
| u8_t cencKey[32]; |
| u8_t i; |
| u16_t macAddr[3]; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for (i = 0; i < 16; i++) |
| cencKey[i] = key[i]; |
| for (i = 0; i < 16; i++) |
| cencKey[i + 16] = mic[i]; |
| keyInfo.key = cencKey; |
| keyInfo.keyLength = 32; |
| keyInfo.keyIndex = keyid; |
| keyInfo.flag = ZM_KEY_FLAG_CENC | ZM_KEY_FLAG_PK; |
| for (i = 0; i < 3; i++) |
| macAddr[i] = wd->sta.bssid[i]; |
| keyInfo.macAddr = macAddr; |
| |
| zfiWlanSetKey(dev, keyInfo); |
| |
| /* Reset txiv and rxiv */ |
| //wd->sta.txiv[0] = txiv[0]; |
| //wd->sta.txiv[1] = txiv[1]; |
| //wd->sta.txiv[2] = txiv[2]; |
| //wd->sta.txiv[3] = txiv[3]; |
| // |
| //wd->sta.rxiv[0] = rxiv[0]; |
| //wd->sta.rxiv[1] = rxiv[1]; |
| //wd->sta.rxiv[2] = rxiv[2]; |
| //wd->sta.rxiv[3] = rxiv[3]; |
| |
| return 0; |
| } |
| |
| u8_t zfiWlanSetCencGroupKey(zdev_t* dev, u8_t keyid, u32_t *rxiv, |
| u8_t *key, u8_t *mic) |
| { |
| struct zsKeyInfo keyInfo; |
| u8_t cencKey[32]; |
| u8_t i; |
| u16_t macAddr[6] = {0xffff, 0xffff, 0xffff}; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for (i = 0; i < 16; i++) |
| cencKey[i] = key[i]; |
| for (i = 0; i < 16; i++) |
| cencKey[i + 16] = mic[i]; |
| keyInfo.key = cencKey; |
| keyInfo.keyLength = 32; |
| keyInfo.keyIndex = keyid; |
| keyInfo.flag = ZM_KEY_FLAG_CENC | ZM_KEY_FLAG_GK; |
| keyInfo.vapId = 0; |
| for (i = 0; i < 3; i++) |
| keyInfo.vapAddr[i] = wd->macAddr[i]; |
| keyInfo.macAddr = macAddr; |
| |
| zfiWlanSetKey(dev, keyInfo); |
| |
| /* Reset txiv and rxiv */ |
| wd->sta.rxivGK[0] = ((rxiv[3] >> 24) & 0xFF) |
| + (((rxiv[3] >> 16) & 0xFF) << 8) |
| + (((rxiv[3] >> 8) & 0xFF) << 16) |
| + ((rxiv[3] & 0xFF) << 24); |
| wd->sta.rxivGK[1] = ((rxiv[2] >> 24) & 0xFF) |
| + (((rxiv[2] >> 16) & 0xFF) << 8) |
| + (((rxiv[2] >> 8) & 0xFF) << 16) |
| + ((rxiv[2] & 0xFF) << 24); |
| wd->sta.rxivGK[2] = ((rxiv[1] >> 24) & 0xFF) |
| + (((rxiv[1] >> 16) & 0xFF) << 8) |
| + (((rxiv[1] >> 8) & 0xFF) << 16) |
| + ((rxiv[1] & 0xFF) << 24); |
| wd->sta.rxivGK[3] = ((rxiv[0] >> 24) & 0xFF) |
| + (((rxiv[0] >> 16) & 0xFF) << 8) |
| + (((rxiv[0] >> 8) & 0xFF) << 16) |
| + ((rxiv[0] & 0xFF) << 24); |
| |
| wd->sta.authMode = ZM_AUTH_MODE_CENC; |
| wd->sta.currentAuthMode = ZM_AUTH_MODE_CENC; |
| |
| return 0; |
| } |
| #endif //ZM_ENABLE_CENC |
| |
| u8_t zfiWlanSetDot11DMode(zdev_t* dev, u8_t mode) |
| { |
| u8_t i; |
| |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.b802_11D = mode; |
| if (mode) //Enable 802.11d |
| { |
| wd->regulationTable.regionCode = NO_ENUMRD; |
| for (i = 0; i < wd->regulationTable.allowChannelCnt; i++) |
| wd->regulationTable.allowChannel[i].channelFlags |= ZM_REG_FLAG_CHANNEL_PASSIVE; |
| } |
| else //Disable |
| { |
| for (i = 0; i < wd->regulationTable.allowChannelCnt; i++) |
| wd->regulationTable.allowChannel[i].channelFlags &= ~ZM_REG_FLAG_CHANNEL_PASSIVE; |
| } |
| |
| return 0; |
| } |
| |
| u8_t zfiWlanSetDot11HDFSMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| //zm_debug_msg0("CWY - Enable 802.11h DFS"); |
| |
| // TODO : DFS Enable in 5250 to 5350 MHz and 5470 to 5725 MHz . |
| //if ( Adapter->ZD80211HSupport && |
| // Adapter->CardSetting.NetworkTypeInUse == Ndis802_11OFDM5 && |
| // ((ChannelNo >=52 && ChannelNo <= 64) || //5250~5350 MHZ |
| // (ChannelNo >=100 && ChannelNo <= 140))) //5470~5725 MHZ |
| //{ |
| // Adapter->ZD80211HSetting.DFSEnable=TRUE; |
| //} |
| //else |
| //{ |
| // Adapter->ZD80211HSetting.DFSEnable=FALSE; |
| //} |
| |
| wd->sta.DFSEnable = mode; |
| if (mode) |
| wd->sta.capability[1] |= ZM_BIT_0; |
| else |
| wd->sta.capability[1] &= (~ZM_BIT_0); |
| |
| return 0; |
| } |
| |
| u8_t zfiWlanSetDot11HTPCMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| // TODO : TPC Enable in 5150~5350 MHz and 5470~5725MHz. |
| //if ( Adapter->ZD80211HSupport && |
| // Adapter->CardSetting.NetworkTypeInUse == Ndis802_11OFDM5 && |
| // ((ChannelNo == 36 || ChannelNo == 40 || ChannelNo == 44 || ChannelNo == 48) || //5150~5250 MHZ , Not Japan |
| // (ChannelNo >=52 && ChannelNo <= 64) || //5250~5350 MHZ |
| // (ChannelNo >=100 && ChannelNo <= 140))) //5470~5725 MHZ |
| //{ |
| // Adapter->ZD80211HSetting.TPCEnable=TRUE; |
| //} |
| //else |
| //{ |
| // Adapter->ZD80211HSetting.TPCEnable=FALSE; |
| //} |
| |
| wd->sta.TPCEnable = mode; |
| if (mode) |
| wd->sta.capability[1] |= ZM_BIT_0; |
| else |
| wd->sta.capability[1] &= (~ZM_BIT_0); |
| |
| return 0; |
| } |
| |
| u8_t zfiWlanSetAniMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->aniEnable = mode; |
| if (mode) |
| zfHpAniAttach(dev); |
| |
| return 0; |
| } |
| |
| #ifdef ZM_OS_LINUX_FUNC |
| void zfiWlanShowTally(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zm_msg1_mm(ZM_LV_0, "Hw_UnderrunCnt = ", wd->commTally.Hw_UnderrunCnt); |
| zm_msg1_mm(ZM_LV_0, "Hw_TotalRxFrm = ", wd->commTally.Hw_TotalRxFrm); |
| zm_msg1_mm(ZM_LV_0, "Hw_CRC32Cnt = ", wd->commTally.Hw_CRC32Cnt); |
| zm_msg1_mm(ZM_LV_0, "Hw_CRC16Cnt = ", wd->commTally.Hw_CRC16Cnt); |
| zm_msg1_mm(ZM_LV_1, "Hw_DecrypErr_UNI = ", wd->commTally.Hw_DecrypErr_UNI); |
| zm_msg1_mm(ZM_LV_0, "Hw_RxFIFOOverrun = ", wd->commTally.Hw_RxFIFOOverrun); |
| zm_msg1_mm(ZM_LV_1, "Hw_DecrypErr_Mul = ", wd->commTally.Hw_DecrypErr_Mul); |
| zm_msg1_mm(ZM_LV_1, "Hw_RetryCnt = ", wd->commTally.Hw_RetryCnt); |
| zm_msg1_mm(ZM_LV_0, "Hw_TotalTxFrm = ", wd->commTally.Hw_TotalTxFrm); |
| zm_msg1_mm(ZM_LV_0, "Hw_RxTimeOut = ", wd->commTally.Hw_RxTimeOut); |
| zm_msg1_mm(ZM_LV_0, "Tx_MPDU = ", wd->commTally.Tx_MPDU); |
| zm_msg1_mm(ZM_LV_0, "BA_Fail = ", wd->commTally.BA_Fail); |
| zm_msg1_mm(ZM_LV_0, "Hw_Tx_AMPDU = ", wd->commTally.Hw_Tx_AMPDU); |
| zm_msg1_mm(ZM_LV_0, "Hw_Tx_MPDU = ", wd->commTally.Hw_Tx_MPDU); |
| |
| zm_msg1_mm(ZM_LV_1, "Hw_RxMPDU = ", wd->commTally.Hw_RxMPDU); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxDropMPDU = ", wd->commTally.Hw_RxDropMPDU); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxDelMPDU = ", wd->commTally.Hw_RxDelMPDU); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyMiscError = ", wd->commTally.Hw_RxPhyMiscError); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyXRError = ", wd->commTally.Hw_RxPhyXRError); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyOFDMError = ", wd->commTally.Hw_RxPhyOFDMError); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyCCKError = ", wd->commTally.Hw_RxPhyCCKError); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyHTError = ", wd->commTally.Hw_RxPhyHTError); |
| zm_msg1_mm(ZM_LV_1, "Hw_RxPhyTotalCount = ", wd->commTally.Hw_RxPhyTotalCount); |
| |
| if (!((wd->commTally.Tx_MPDU == 0) && (wd->commTally.BA_Fail == 0))) |
| { |
| zm_debug_msg_p("BA Fail Ratio(%) = ", wd->commTally.BA_Fail * 100, |
| (wd->commTally.BA_Fail + wd->commTally.Tx_MPDU)); |
| } |
| |
| if (!((wd->commTally.Hw_Tx_MPDU == 0) && (wd->commTally.Hw_Tx_AMPDU == 0))) |
| { |
| zm_debug_msg_p("Avg Agg Number = ", |
| wd->commTally.Hw_Tx_MPDU, wd->commTally.Hw_Tx_AMPDU); |
| } |
| } |
| #endif |
| |
| void zfiWlanSetMaxTxPower(zdev_t* dev, u8_t power2, u8_t power5) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->maxTxPower2 = power2; |
| wd->maxTxPower5 = power5; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanQueryMaxTxPower(zdev_t* dev, u8_t *power2, u8_t *power5) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| *power2 = wd->maxTxPower2; |
| *power5 = wd->maxTxPower5; |
| } |
| |
| void zfiWlanSetConnectMode(zdev_t* dev, u8_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->connectMode = mode; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetSupportMode(zdev_t* dev, u32_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->supportMode = mode; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanSetAdhocMode(zdev_t* dev, u32_t mode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->ws.adhocMode = mode; |
| } |
| |
| u32_t zfiWlanQueryAdhocMode(zdev_t* dev, u8_t bWrapper) |
| { |
| u32_t adhocMode; |
| |
| zmw_get_wlan_dev(dev); |
| |
| if ( bWrapper ) |
| { |
| adhocMode = wd->ws.adhocMode; |
| } |
| else |
| { |
| adhocMode = wd->wfc.bIbssGMode; |
| } |
| |
| return adhocMode; |
| } |
| |
| |
| u8_t zfiWlanSetCountryIsoName(zdev_t* dev, u8_t *countryIsoName, u8_t length) |
| { |
| u8_t buf[5]; |
| zmw_get_wlan_dev(dev); |
| |
| if (length == 4) |
| { |
| buf[2] = wd->ws.countryIsoName[0] = countryIsoName[2]; |
| buf[3] = wd->ws.countryIsoName[1] = countryIsoName[1]; |
| buf[4] = wd->ws.countryIsoName[2] = countryIsoName[0]; |
| } |
| else if (length == 3) |
| { |
| buf[2] = wd->ws.countryIsoName[0] = countryIsoName[1]; |
| buf[3] = wd->ws.countryIsoName[1] = countryIsoName[0]; |
| buf[4] = wd->ws.countryIsoName[2] = '\0'; |
| } |
| else |
| { |
| return 1; |
| } |
| |
| return zfHpGetRegulationTablefromISO(dev, buf, length); |
| } |
| |
| |
| const char* zfiWlanQueryCountryIsoName(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->ws.countryIsoName; |
| } |
| |
| |
| |
| void zfiWlanSetRegulatory(zdev_t* dev, u8_t CCS, u16_t Code, u8_t bfirstChannel) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| if (CCS) |
| { |
| /* Reset Regulation Table by Country Code */ |
| zfHpGetRegulationTablefromCountry(dev, Code); |
| } |
| else |
| { |
| /* Reset Regulation Table by Region Code */ |
| zfHpGetRegulationTablefromRegionCode(dev, Code); |
| } |
| |
| if (bfirstChannel) { |
| zmw_enter_critical_section(dev); |
| wd->frequency = zfChGetFirstChannel(dev, NULL); |
| zmw_leave_critical_section(dev); |
| zfCoreSetFrequency(dev, wd->frequency); |
| } |
| } |
| |
| |
| const char* zfiHpGetisoNamefromregionCode(zdev_t* dev, u16_t regionCode) |
| { |
| return zfHpGetisoNamefromregionCode(dev, regionCode); |
| } |
| |
| u16_t zfiWlanChannelToFrequency(zdev_t* dev, u8_t channel) |
| { |
| return zfChNumToFreq(dev, channel, 0); |
| } |
| |
| u8_t zfiWlanFrequencyToChannel(zdev_t* dev, u16_t freq) |
| { |
| u8_t is5GBand = 0; |
| |
| return zfChFreqToNum(freq, &is5GBand); |
| } |
| |
| void zfiWlanDisableDfsChannel(zdev_t* dev, u8_t disableFlag) |
| { |
| zfHpDisableDfsChannel(dev, disableFlag); |
| return; |
| } |
| |
| void zfiWlanSetLEDCtrlParam(zdev_t* dev, u8_t type, u8_t flag) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| zmw_declare_for_critical_section(); |
| |
| zmw_enter_critical_section(dev); |
| wd->ledStruct.LEDCtrlType = type; |
| wd->ledStruct.LEDCtrlFlagFromReg = flag; |
| zmw_leave_critical_section(dev); |
| } |
| |
| void zfiWlanEnableLeapConfig(zdev_t* dev, u8_t leapEnabled) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.leapEnabled = leapEnabled; |
| } |
| |
| u32_t zfiWlanQueryHwCapability(zdev_t* dev) |
| { |
| return zfHpCapability(dev); |
| } |
| |
| u32_t zfiWlanQueryReceivedPacket(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->sta.ReceivedPktRatePerSecond; |
| } |
| |
| void zfiWlanCheckSWEncryption(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| if (wd->sta.SWEncryptEnable != 0) |
| { |
| zfHpSWDecrypt(dev, 1); |
| } |
| } |
| |
| u16_t zfiWlanQueryAllowChannels(zdev_t* dev, u16_t *channels) |
| { |
| u16_t ii; |
| zmw_get_wlan_dev(dev); |
| |
| for (ii = 0; ii < wd->regulationTable.allowChannelCnt; ii++) |
| { |
| channels[ii] = wd->regulationTable.allowChannel[ii].channel; |
| } |
| |
| return wd->regulationTable.allowChannelCnt; |
| } |
| |
| void zfiWlanSetDynamicSIFSParam(zdev_t* dev, u8_t val) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->dynamicSIFSEnable = val; |
| |
| zm_debug_msg1("wd->dynamicSIFSEnable = ", wd->dynamicSIFSEnable) |
| } |
| |
| u16_t zfiWlanGetMulticastAddressCount(zdev_t* dev) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| return wd->sta.multicastList.size; |
| } |
| |
| void zfiWlanGetMulticastList(zdev_t* dev, u8_t* pMCList) |
| { |
| struct zsMulticastAddr* pMacList = (struct zsMulticastAddr*) pMCList; |
| u8_t i; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for ( i=0; i<wd->sta.multicastList.size; i++ ) |
| { |
| zfMemoryCopy(pMacList[i].addr, wd->sta.multicastList.macAddr[i].addr, 6); |
| } |
| } |
| |
| void zfiWlanSetPacketFilter(zdev_t* dev, u32_t PacketFilter) |
| { |
| u8_t bAllMulticast = 0; |
| u32_t oldFilter; |
| |
| zmw_get_wlan_dev(dev); |
| |
| oldFilter = wd->sta.osRxFilter; |
| |
| wd->sta.osRxFilter = PacketFilter; |
| |
| if ((oldFilter & ZM_PACKET_TYPE_ALL_MULTICAST) != |
| (wd->sta.osRxFilter & ZM_PACKET_TYPE_ALL_MULTICAST)) |
| { |
| if ( wd->sta.osRxFilter & ZM_PACKET_TYPE_ALL_MULTICAST ) |
| bAllMulticast = 1; |
| zfHpSetMulticastList(dev, wd->sta.multicastList.size, |
| (u8_t*)wd->sta.multicastList.macAddr, bAllMulticast); |
| } |
| } |
| |
| u8_t zfiCompareWithMulticastListAddress(zdev_t* dev, u16_t* dstMacAddr) |
| { |
| u8_t i; |
| u8_t bIsInMCListAddr = 0; |
| |
| zmw_get_wlan_dev(dev); |
| |
| for ( i=0; i<wd->sta.multicastList.size; i++ ) |
| { |
| if ( zfwMemoryIsEqual((u8_t*)dstMacAddr, (u8_t*)wd->sta.multicastList.macAddr[i].addr, 6) ) |
| { |
| bIsInMCListAddr = 1; |
| break; |
| } |
| } |
| |
| return bIsInMCListAddr; |
| } |
| |
| void zfiWlanSetSafeModeEnabled(zdev_t* dev, u8_t safeMode) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| wd->sta.bSafeMode = safeMode; |
| |
| if ( safeMode ) |
| zfStaEnableSWEncryption(dev, 1); |
| else |
| zfStaDisableSWEncryption(dev); |
| } |
| |
| void zfiWlanSetIBSSAdditionalIELength(zdev_t* dev, u32_t ibssAdditionalIESize, u8_t* ibssAdditionalIE) |
| { |
| zmw_get_wlan_dev(dev); |
| |
| if ( ibssAdditionalIESize ) |
| { |
| wd->sta.ibssAdditionalIESize = ibssAdditionalIESize; |
| zfMemoryCopy(wd->sta.ibssAdditionalIE, ibssAdditionalIE, (u16_t)ibssAdditionalIESize); |
| } |
| else |
| wd->sta.ibssAdditionalIESize = 0; |
| } |
