| /* |
| * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc. |
| * All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License along |
| * with this program; if not, write to the Free Software Foundation, Inc., |
| * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| * |
| * |
| * File: key.c |
| * |
| * Purpose: Implement functions for 802.11i Key management |
| * |
| * Author: Jerry Chen |
| * |
| * Date: May 29, 2003 |
| * |
| * Functions: |
| * KeyvInitTable - Init Key management table |
| * KeybGetKey - Get Key from table |
| * KeybSetKey - Set Key to table |
| * KeybRemoveKey - Remove Key from table |
| * KeybGetTransmitKey - Get Transmit Key from table |
| * |
| * Revision History: |
| * |
| */ |
| |
| #include "tmacro.h" |
| #include "key.h" |
| #include "mac.h" |
| #include "rndis.h" |
| #include "control.h" |
| |
| /*--------------------- Static Definitions -------------------------*/ |
| |
| /*--------------------- Static Classes ----------------------------*/ |
| |
| /*--------------------- Static Variables --------------------------*/ |
| static int msglevel =MSG_LEVEL_INFO; |
| //static int msglevel =MSG_LEVEL_DEBUG; |
| /*--------------------- Static Functions --------------------------*/ |
| |
| /*--------------------- Export Variables --------------------------*/ |
| |
| /*--------------------- Static Definitions -------------------------*/ |
| |
| /*--------------------- Static Classes ----------------------------*/ |
| |
| /*--------------------- Static Variables --------------------------*/ |
| |
| /*--------------------- Static Functions --------------------------*/ |
| static VOID |
| s_vCheckKeyTableValid (PVOID pDeviceHandler, PSKeyManagement pTable) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i; |
| WORD wLength = 0; |
| BYTE pbyData[MAX_KEY_TABLE]; |
| |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| (pTable->KeyTable[i].PairwiseKey.bKeyValid == FALSE) && |
| (pTable->KeyTable[i].GroupKey[0].bKeyValid == FALSE) && |
| (pTable->KeyTable[i].GroupKey[1].bKeyValid == FALSE) && |
| (pTable->KeyTable[i].GroupKey[2].bKeyValid == FALSE) && |
| (pTable->KeyTable[i].GroupKey[3].bKeyValid == FALSE) |
| ) { |
| |
| pTable->KeyTable[i].bInUse = FALSE; |
| pTable->KeyTable[i].wKeyCtl = 0; |
| pTable->KeyTable[i].bSoftWEP = FALSE; |
| pbyData[wLength++] = (BYTE) i; |
| //MACvDisableKeyEntry(pDevice, i); |
| } |
| } |
| if ( wLength != 0 ) { |
| CONTROLnsRequestOut(pDevice, |
| MESSAGE_TYPE_CLRKEYENTRY, |
| 0, |
| 0, |
| wLength, |
| pbyData |
| ); |
| } |
| |
| } |
| |
| |
| /*--------------------- Export Functions --------------------------*/ |
| |
| |
| /* |
| * Description: Init Key management table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * Out: |
| * none |
| * |
| * Return Value: none |
| * |
| */ |
| VOID KeyvInitTable(PVOID pDeviceHandler, PSKeyManagement pTable) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i; |
| int jj; |
| BYTE pbyData[MAX_KEY_TABLE+1]; |
| |
| spin_lock_irq(&pDevice->lock); |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| pTable->KeyTable[i].bInUse = FALSE; |
| pTable->KeyTable[i].PairwiseKey.bKeyValid = FALSE; |
| pTable->KeyTable[i].PairwiseKey.pvKeyTable = (PVOID)&pTable->KeyTable[i]; |
| for (jj=0; jj < MAX_GROUP_KEY; jj++) { |
| pTable->KeyTable[i].GroupKey[jj].bKeyValid = FALSE; |
| pTable->KeyTable[i].GroupKey[jj].pvKeyTable = (PVOID) &(pTable->KeyTable[i]); |
| } |
| pTable->KeyTable[i].wKeyCtl = 0; |
| pTable->KeyTable[i].dwGTKeyIndex = 0; |
| pTable->KeyTable[i].bSoftWEP = FALSE; |
| pbyData[i] = (BYTE) i; |
| } |
| pbyData[i] = (BYTE) i; |
| CONTROLnsRequestOut(pDevice, |
| MESSAGE_TYPE_CLRKEYENTRY, |
| 0, |
| 0, |
| 11, |
| pbyData |
| ); |
| |
| spin_unlock_irq(&pDevice->lock); |
| |
| return; |
| } |
| |
| |
| /* |
| * Description: Get Key from table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * pbyBSSID - BSSID of Key |
| * dwKeyIndex - Key Index (0xFFFFFFFF means pairwise key) |
| * Out: |
| * pKey - Key return |
| * |
| * Return Value: TRUE if found otherwise FALSE |
| * |
| */ |
| BOOL KeybGetKey ( |
| IN PSKeyManagement pTable, |
| IN PBYTE pbyBSSID, |
| IN DWORD dwKeyIndex, |
| OUT PSKeyItem *pKey |
| ) |
| { |
| int i; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybGetKey() \n"); |
| |
| *pKey = NULL; |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| IS_ETH_ADDRESS_EQUAL(pTable->KeyTable[i].abyBSSID,pbyBSSID)) { |
| if (dwKeyIndex == 0xFFFFFFFF) { |
| if (pTable->KeyTable[i].PairwiseKey.bKeyValid == TRUE) { |
| *pKey = &(pTable->KeyTable[i].PairwiseKey); |
| return (TRUE); |
| } |
| else { |
| return (FALSE); |
| } |
| } else if (dwKeyIndex < MAX_GROUP_KEY) { |
| if (pTable->KeyTable[i].GroupKey[dwKeyIndex].bKeyValid == TRUE) { |
| *pKey = &(pTable->KeyTable[i].GroupKey[dwKeyIndex]); |
| return (TRUE); |
| } |
| else { |
| return (FALSE); |
| } |
| } |
| else { |
| return (FALSE); |
| } |
| } |
| } |
| return (FALSE); |
| } |
| |
| |
| /* |
| * Description: Set Key to table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * pbyBSSID - BSSID of Key |
| * dwKeyIndex - Key index (reference to NDIS DDK) |
| * uKeyLength - Key length |
| * KeyRSC - Key RSC |
| * pbyKey - Pointer to key |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| BOOL KeybSetKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| PBYTE pbyBSSID, |
| DWORD dwKeyIndex, |
| ULONG uKeyLength, |
| PQWORD pKeyRSC, |
| PBYTE pbyKey, |
| BYTE byKeyDecMode |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i,j; |
| UINT ii; |
| PSKeyItem pKey; |
| UINT uKeyIdx; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Enter KeybSetKey: %lX\n", dwKeyIndex); |
| |
| j = (MAX_KEY_TABLE-1); |
| for (i=0;i<(MAX_KEY_TABLE-1);i++) { |
| if ((pTable->KeyTable[i].bInUse == FALSE) && |
| (j == (MAX_KEY_TABLE-1))) { |
| // found empty table |
| j = i; |
| } |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| IS_ETH_ADDRESS_EQUAL(pTable->KeyTable[i].abyBSSID,pbyBSSID)) { |
| // found table already exist |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { |
| // Pairwise key |
| pKey = &(pTable->KeyTable[i].PairwiseKey); |
| pTable->KeyTable[i].wKeyCtl &= 0xFFF0; // clear pairwise key control filed |
| pTable->KeyTable[i].wKeyCtl |= byKeyDecMode; |
| uKeyIdx = 4; // use HW key entry 4 for pairwise key |
| } else { |
| // Group key |
| if ((dwKeyIndex & 0x000000FF) >= MAX_GROUP_KEY) |
| return (FALSE); |
| pKey = &(pTable->KeyTable[i].GroupKey[dwKeyIndex & 0x000000FF]); |
| if ((dwKeyIndex & TRANSMIT_KEY) != 0) { |
| // Group transmit key |
| pTable->KeyTable[i].dwGTKeyIndex = dwKeyIndex; |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Group transmit key(R)[%lX]: %d\n", pTable->KeyTable[i].dwGTKeyIndex, i); |
| } |
| pTable->KeyTable[i].wKeyCtl &= 0xFF0F; // clear group key control filed |
| pTable->KeyTable[i].wKeyCtl |= (byKeyDecMode << 4); |
| pTable->KeyTable[i].wKeyCtl |= 0x0040; // use group key for group address |
| uKeyIdx = (dwKeyIndex & 0x000000FF); |
| } |
| pTable->KeyTable[i].wKeyCtl |= 0x8000; // enable on-fly |
| |
| pKey->bKeyValid = TRUE; |
| pKey->uKeyLength = uKeyLength; |
| pKey->dwKeyIndex = dwKeyIndex; |
| pKey->byCipherSuite = byKeyDecMode; |
| memcpy(pKey->abyKey, pbyKey, uKeyLength); |
| if (byKeyDecMode == KEY_CTL_WEP) { |
| if (uKeyLength == WLAN_WEP40_KEYLEN) |
| pKey->abyKey[15] &= 0x7F; |
| if (uKeyLength == WLAN_WEP104_KEYLEN) |
| pKey->abyKey[15] |= 0x80; |
| } |
| MACvSetKeyEntry(pDevice, pTable->KeyTable[i].wKeyCtl, i, uKeyIdx, pbyBSSID, (PDWORD)pKey->abyKey); |
| |
| if ((dwKeyIndex & USE_KEYRSC) == 0) { |
| // RSC set by NIC |
| memset(&(pKey->KeyRSC), 0, sizeof(QWORD)); |
| } |
| else { |
| memcpy(&(pKey->KeyRSC), pKeyRSC, sizeof(QWORD)); |
| } |
| pKey->dwTSC47_16 = 0; |
| pKey->wTSC15_0 = 0; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybSetKey(R): \n"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->bKeyValid: %d\n ", pKey->bKeyValid); |
| //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->uKeyLength: %d\n ", pKey->uKeyLength); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->abyKey: "); |
| for (ii = 0; ii < pKey->uKeyLength; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%02x ", pKey->abyKey[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwTSC47_16: %lx\n ", pKey->dwTSC47_16); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->wTSC15_0: %x\n ", pKey->wTSC15_0); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwKeyIndex: %lx\n ", pKey->dwKeyIndex); |
| |
| return (TRUE); |
| } |
| } |
| if (j < (MAX_KEY_TABLE-1)) { |
| memcpy(pTable->KeyTable[j].abyBSSID,pbyBSSID,U_ETHER_ADDR_LEN); |
| pTable->KeyTable[j].bInUse = TRUE; |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { |
| // Pairwise key |
| pKey = &(pTable->KeyTable[j].PairwiseKey); |
| pTable->KeyTable[j].wKeyCtl &= 0xFFF0; // clear pairwise key control filed |
| pTable->KeyTable[j].wKeyCtl |= byKeyDecMode; |
| uKeyIdx = 4; // use HW key entry 4 for pairwise key |
| } else { |
| // Group key |
| if ((dwKeyIndex & 0x000000FF) >= MAX_GROUP_KEY) |
| return (FALSE); |
| pKey = &(pTable->KeyTable[j].GroupKey[dwKeyIndex & 0x000000FF]); |
| if ((dwKeyIndex & TRANSMIT_KEY) != 0) { |
| // Group transmit key |
| pTable->KeyTable[j].dwGTKeyIndex = dwKeyIndex; |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Group transmit key(N)[%lX]: %d\n", pTable->KeyTable[j].dwGTKeyIndex, j); |
| } |
| pTable->KeyTable[j].wKeyCtl &= 0xFF0F; // clear group key control filed |
| pTable->KeyTable[j].wKeyCtl |= (byKeyDecMode << 4); |
| pTable->KeyTable[j].wKeyCtl |= 0x0040; // use group key for group address |
| uKeyIdx = (dwKeyIndex & 0x000000FF); |
| } |
| pTable->KeyTable[j].wKeyCtl |= 0x8000; // enable on-fly |
| |
| pKey->bKeyValid = TRUE; |
| pKey->uKeyLength = uKeyLength; |
| pKey->dwKeyIndex = dwKeyIndex; |
| pKey->byCipherSuite = byKeyDecMode; |
| memcpy(pKey->abyKey, pbyKey, uKeyLength); |
| if (byKeyDecMode == KEY_CTL_WEP) { |
| if (uKeyLength == WLAN_WEP40_KEYLEN) |
| pKey->abyKey[15] &= 0x7F; |
| if (uKeyLength == WLAN_WEP104_KEYLEN) |
| pKey->abyKey[15] |= 0x80; |
| } |
| MACvSetKeyEntry(pDevice, pTable->KeyTable[j].wKeyCtl, j, uKeyIdx, pbyBSSID, (PDWORD)pKey->abyKey); |
| |
| if ((dwKeyIndex & USE_KEYRSC) == 0) { |
| // RSC set by NIC |
| memset(&(pKey->KeyRSC), 0, sizeof(QWORD)); |
| } |
| else { |
| memcpy(&(pKey->KeyRSC), pKeyRSC, sizeof(QWORD)); |
| } |
| pKey->dwTSC47_16 = 0; |
| pKey->wTSC15_0 = 0; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybSetKey(N): \n"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->bKeyValid: %d\n ", pKey->bKeyValid); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->uKeyLength: %d\n ", (int)pKey->uKeyLength); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->abyKey: "); |
| for (ii = 0; ii < pKey->uKeyLength; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%02x ", pKey->abyKey[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwTSC47_16: %lx\n ", pKey->dwTSC47_16); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->wTSC15_0: %x\n ", pKey->wTSC15_0); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwKeyIndex: %lx\n ", pKey->dwKeyIndex); |
| |
| return (TRUE); |
| } |
| return (FALSE); |
| } |
| |
| |
| /* |
| * Description: Remove Key from table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * pbyBSSID - BSSID of Key |
| * dwKeyIndex - Key Index (reference to NDIS DDK) |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| BOOL KeybRemoveKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| PBYTE pbyBSSID, |
| DWORD dwKeyIndex |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i; |
| BOOL bReturnValue = FALSE; |
| |
| if (IS_BROADCAST_ADDRESS(pbyBSSID)) { |
| // dealte all key |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| pTable->KeyTable[i].PairwiseKey.bKeyValid = FALSE; |
| } |
| bReturnValue = TRUE; |
| } |
| else if ((dwKeyIndex & 0x000000FF) < MAX_GROUP_KEY) { |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| pTable->KeyTable[i].GroupKey[dwKeyIndex & 0x000000FF].bKeyValid = FALSE; |
| if ((dwKeyIndex & 0x7FFFFFFF) == (pTable->KeyTable[i].dwGTKeyIndex & 0x7FFFFFFF)) { |
| // remove Group transmit key |
| pTable->KeyTable[i].dwGTKeyIndex = 0; |
| } |
| } |
| bReturnValue = TRUE; |
| } |
| else { |
| bReturnValue = FALSE; |
| } |
| |
| } else { |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ( (pTable->KeyTable[i].bInUse == TRUE) && |
| IS_ETH_ADDRESS_EQUAL(pTable->KeyTable[i].abyBSSID,pbyBSSID)) { |
| |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { |
| pTable->KeyTable[i].PairwiseKey.bKeyValid = FALSE; |
| bReturnValue = TRUE; |
| break; |
| } |
| else if ((dwKeyIndex & 0x000000FF) < MAX_GROUP_KEY) { |
| pTable->KeyTable[i].GroupKey[dwKeyIndex & 0x000000FF].bKeyValid = FALSE; |
| if ((dwKeyIndex & 0x7FFFFFFF) == (pTable->KeyTable[i].dwGTKeyIndex & 0x7FFFFFFF)) { |
| // remove Group transmit key |
| pTable->KeyTable[i].dwGTKeyIndex = 0; |
| } |
| bReturnValue = TRUE; |
| break; |
| } |
| else { |
| bReturnValue = FALSE; |
| break; |
| } |
| } //pTable->KeyTable[i].bInUse == TRUE |
| } //for |
| bReturnValue = TRUE; |
| } |
| |
| s_vCheckKeyTableValid(pDevice,pTable); |
| return bReturnValue; |
| |
| |
| } |
| |
| |
| /* |
| * Description: Remove Key from table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * pbyBSSID - BSSID of Key |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| BOOL KeybRemoveAllKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| PBYTE pbyBSSID |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i,u; |
| |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| IS_ETH_ADDRESS_EQUAL(pTable->KeyTable[i].abyBSSID,pbyBSSID)) { |
| pTable->KeyTable[i].PairwiseKey.bKeyValid = FALSE; |
| for(u=0;u<MAX_GROUP_KEY;u++) { |
| pTable->KeyTable[i].GroupKey[u].bKeyValid = FALSE; |
| } |
| pTable->KeyTable[i].dwGTKeyIndex = 0; |
| s_vCheckKeyTableValid(pDevice, pTable); |
| return (TRUE); |
| } |
| } |
| return (FALSE); |
| } |
| |
| /* |
| * Description: Remove WEP Key from table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| VOID KeyvRemoveWEPKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| DWORD dwKeyIndex |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| |
| if ((dwKeyIndex & 0x000000FF) < MAX_GROUP_KEY) { |
| if (pTable->KeyTable[MAX_KEY_TABLE-1].bInUse == TRUE) { |
| if (pTable->KeyTable[MAX_KEY_TABLE-1].GroupKey[dwKeyIndex & 0x000000FF].byCipherSuite == KEY_CTL_WEP) { |
| pTable->KeyTable[MAX_KEY_TABLE-1].GroupKey[dwKeyIndex & 0x000000FF].bKeyValid = FALSE; |
| if ((dwKeyIndex & 0x7FFFFFFF) == (pTable->KeyTable[MAX_KEY_TABLE-1].dwGTKeyIndex & 0x7FFFFFFF)) { |
| // remove Group transmit key |
| pTable->KeyTable[MAX_KEY_TABLE-1].dwGTKeyIndex = 0; |
| } |
| } |
| } |
| s_vCheckKeyTableValid(pDevice, pTable); |
| } |
| return; |
| } |
| |
| VOID KeyvRemoveAllWEPKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| |
| int i; |
| |
| for(i=0;i<MAX_GROUP_KEY;i++) { |
| KeyvRemoveWEPKey(pDevice,pTable, i); |
| } |
| |
| } |
| |
| /* |
| * Description: Get Transmit Key from table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * pbyBSSID - BSSID of Key |
| * Out: |
| * pKey - Key return |
| * |
| * Return Value: TRUE if found otherwise FALSE |
| * |
| */ |
| BOOL KeybGetTransmitKey ( |
| IN PSKeyManagement pTable, |
| IN PBYTE pbyBSSID, |
| IN DWORD dwKeyType, |
| OUT PSKeyItem *pKey |
| ) |
| { |
| int i, ii; |
| |
| *pKey = NULL; |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| IS_ETH_ADDRESS_EQUAL(pTable->KeyTable[i].abyBSSID,pbyBSSID)) { |
| |
| if (dwKeyType == PAIRWISE_KEY) { |
| |
| if (pTable->KeyTable[i].PairwiseKey.bKeyValid == TRUE) { |
| *pKey = &(pTable->KeyTable[i].PairwiseKey); |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybGetTransmitKey:"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"PAIRWISE_KEY: KeyTable.abyBSSID: "); |
| for (ii = 0; ii < 6; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"%x ", pTable->KeyTable[i].abyBSSID[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| |
| |
| return (TRUE); |
| } |
| else { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"PairwiseKey.bKeyValid == FALSE\n"); |
| return (FALSE); |
| } |
| } // End of Type == PAIRWISE |
| else { |
| if (pTable->KeyTable[i].dwGTKeyIndex == 0) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ERROR: dwGTKeyIndex == 0 !!!\n"); |
| return FALSE; |
| } |
| if (pTable->KeyTable[i].GroupKey[(pTable->KeyTable[i].dwGTKeyIndex&0x000000FF)].bKeyValid == TRUE) { |
| *pKey = &(pTable->KeyTable[i].GroupKey[(pTable->KeyTable[i].dwGTKeyIndex&0x000000FF)]); |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybGetTransmitKey:"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"GROUP_KEY: KeyTable.abyBSSID\n"); |
| for (ii = 0; ii < 6; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"%x ", pTable->KeyTable[i].abyBSSID[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"dwGTKeyIndex: %lX\n", pTable->KeyTable[i].dwGTKeyIndex); |
| |
| return (TRUE); |
| } |
| else { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"GroupKey.bKeyValid == FALSE\n"); |
| return (FALSE); |
| } |
| } // End of Type = GROUP |
| } // BSSID match |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ERROR: NO Match BSSID !!! "); |
| for (ii = 0; ii < 6; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"%02x ", *(pbyBSSID+ii)); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| return (FALSE); |
| } |
| |
| |
| /* |
| * Description: Check Pairewise Key |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if found otherwise FALSE |
| * |
| */ |
| BOOL KeybCheckPairewiseKey ( |
| IN PSKeyManagement pTable, |
| OUT PSKeyItem *pKey |
| ) |
| { |
| int i; |
| |
| *pKey = NULL; |
| for (i=0;i<MAX_KEY_TABLE;i++) { |
| if ((pTable->KeyTable[i].bInUse == TRUE) && |
| (pTable->KeyTable[i].PairwiseKey.bKeyValid == TRUE)) { |
| *pKey = &(pTable->KeyTable[i].PairwiseKey); |
| return (TRUE); |
| } |
| } |
| return (FALSE); |
| } |
| |
| /* |
| * Description: Set Key to table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * dwKeyIndex - Key index (reference to NDIS DDK) |
| * uKeyLength - Key length |
| * KeyRSC - Key RSC |
| * pbyKey - Pointer to key |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| BOOL KeybSetDefaultKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| DWORD dwKeyIndex, |
| ULONG uKeyLength, |
| PQWORD pKeyRSC, |
| PBYTE pbyKey, |
| BYTE byKeyDecMode |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| UINT ii; |
| PSKeyItem pKey; |
| UINT uKeyIdx; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Enter KeybSetDefaultKey: %1x, %d \n", (int)dwKeyIndex, (int)uKeyLength); |
| |
| |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { // Pairwise key |
| return (FALSE); |
| } else if ((dwKeyIndex & 0x000000FF) >= MAX_GROUP_KEY) { |
| return (FALSE); |
| } |
| |
| pTable->KeyTable[MAX_KEY_TABLE-1].bInUse = TRUE; |
| for(ii=0;ii<U_ETHER_ADDR_LEN;ii++) |
| pTable->KeyTable[MAX_KEY_TABLE-1].abyBSSID[ii] = 0xFF; |
| |
| // Group key |
| pKey = &(pTable->KeyTable[MAX_KEY_TABLE-1].GroupKey[dwKeyIndex & 0x000000FF]); |
| if ((dwKeyIndex & TRANSMIT_KEY) != 0) { |
| // Group transmit key |
| pTable->KeyTable[MAX_KEY_TABLE-1].dwGTKeyIndex = dwKeyIndex; |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Group transmit key(R)[%lX]: %d\n", pTable->KeyTable[MAX_KEY_TABLE-1].dwGTKeyIndex, MAX_KEY_TABLE-1); |
| |
| } |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl &= 0x7F00; // clear all key control filed |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl |= (byKeyDecMode << 4); |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl |= (byKeyDecMode); |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl |= 0x0044; // use group key for all address |
| uKeyIdx = (dwKeyIndex & 0x000000FF); |
| |
| if ((uKeyLength == WLAN_WEP232_KEYLEN) && |
| (byKeyDecMode == KEY_CTL_WEP)) { |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl |= 0x4000; // disable on-fly disable address match |
| pTable->KeyTable[MAX_KEY_TABLE-1].bSoftWEP = TRUE; |
| } else { |
| if (pTable->KeyTable[MAX_KEY_TABLE-1].bSoftWEP == FALSE) |
| pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl |= 0xC000; // enable on-fly disable address match |
| } |
| |
| pKey->bKeyValid = TRUE; |
| pKey->uKeyLength = uKeyLength; |
| pKey->dwKeyIndex = dwKeyIndex; |
| pKey->byCipherSuite = byKeyDecMode; |
| memcpy(pKey->abyKey, pbyKey, uKeyLength); |
| if (byKeyDecMode == KEY_CTL_WEP) { |
| if (uKeyLength == WLAN_WEP40_KEYLEN) |
| pKey->abyKey[15] &= 0x7F; |
| if (uKeyLength == WLAN_WEP104_KEYLEN) |
| pKey->abyKey[15] |= 0x80; |
| } |
| |
| MACvSetKeyEntry(pDevice, pTable->KeyTable[MAX_KEY_TABLE-1].wKeyCtl, MAX_KEY_TABLE-1, uKeyIdx, pTable->KeyTable[MAX_KEY_TABLE-1].abyBSSID, (PDWORD) pKey->abyKey); |
| |
| if ((dwKeyIndex & USE_KEYRSC) == 0) { |
| // RSC set by NIC |
| memset(&(pKey->KeyRSC), 0, sizeof(QWORD)); |
| } else { |
| memcpy(&(pKey->KeyRSC), pKeyRSC, sizeof(QWORD)); |
| } |
| pKey->dwTSC47_16 = 0; |
| pKey->wTSC15_0 = 0; |
| |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybSetKey(R): \n"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->bKeyValid: %d\n", pKey->bKeyValid); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->uKeyLength: %d\n", (int)pKey->uKeyLength); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->abyKey: \n"); |
| for (ii = 0; ii < pKey->uKeyLength; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"%x", pKey->abyKey[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwTSC47_16: %lx\n", pKey->dwTSC47_16); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->wTSC15_0: %x\n", pKey->wTSC15_0); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->dwKeyIndex: %lx\n", pKey->dwKeyIndex); |
| |
| return (TRUE); |
| } |
| |
| |
| /* |
| * Description: Set Key to table |
| * |
| * Parameters: |
| * In: |
| * pTable - Pointer to Key table |
| * dwKeyIndex - Key index (reference to NDIS DDK) |
| * uKeyLength - Key length |
| * KeyRSC - Key RSC |
| * pbyKey - Pointer to key |
| * Out: |
| * none |
| * |
| * Return Value: TRUE if success otherwise FALSE |
| * |
| */ |
| BOOL KeybSetAllGroupKey ( |
| PVOID pDeviceHandler, |
| PSKeyManagement pTable, |
| DWORD dwKeyIndex, |
| ULONG uKeyLength, |
| PQWORD pKeyRSC, |
| PBYTE pbyKey, |
| BYTE byKeyDecMode |
| ) |
| { |
| PSDevice pDevice = (PSDevice) pDeviceHandler; |
| int i; |
| UINT ii; |
| PSKeyItem pKey; |
| UINT uKeyIdx; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Enter KeybSetAllGroupKey: %lX\n", dwKeyIndex); |
| |
| |
| if ((dwKeyIndex & PAIRWISE_KEY) != 0) { // Pairwise key |
| return (FALSE); |
| } else if ((dwKeyIndex & 0x000000FF) >= MAX_GROUP_KEY) { |
| return (FALSE); |
| } |
| |
| for (i=0; i < MAX_KEY_TABLE-1; i++) { |
| if (pTable->KeyTable[i].bInUse == TRUE) { |
| // found table already exist |
| // Group key |
| pKey = &(pTable->KeyTable[i].GroupKey[dwKeyIndex & 0x000000FF]); |
| if ((dwKeyIndex & TRANSMIT_KEY) != 0) { |
| // Group transmit key |
| pTable->KeyTable[i].dwGTKeyIndex = dwKeyIndex; |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Group transmit key(R)[%lX]: %d\n", pTable->KeyTable[i].dwGTKeyIndex, i); |
| |
| } |
| pTable->KeyTable[i].wKeyCtl &= 0xFF0F; // clear group key control filed |
| pTable->KeyTable[i].wKeyCtl |= (byKeyDecMode << 4); |
| pTable->KeyTable[i].wKeyCtl |= 0x0040; // use group key for group address |
| uKeyIdx = (dwKeyIndex & 0x000000FF); |
| |
| pTable->KeyTable[i].wKeyCtl |= 0x8000; // enable on-fly |
| |
| pKey->bKeyValid = TRUE; |
| pKey->uKeyLength = uKeyLength; |
| pKey->dwKeyIndex = dwKeyIndex; |
| pKey->byCipherSuite = byKeyDecMode; |
| memcpy(pKey->abyKey, pbyKey, uKeyLength); |
| if (byKeyDecMode == KEY_CTL_WEP) { |
| if (uKeyLength == WLAN_WEP40_KEYLEN) |
| pKey->abyKey[15] &= 0x7F; |
| if (uKeyLength == WLAN_WEP104_KEYLEN) |
| pKey->abyKey[15] |= 0x80; |
| } |
| |
| MACvSetKeyEntry(pDevice, pTable->KeyTable[i].wKeyCtl, i, uKeyIdx, pTable->KeyTable[i].abyBSSID, (PDWORD) pKey->abyKey); |
| |
| if ((dwKeyIndex & USE_KEYRSC) == 0) { |
| // RSC set by NIC |
| memset(&(pKey->KeyRSC), 0, sizeof(QWORD)); |
| } |
| else { |
| memcpy(&(pKey->KeyRSC), pKeyRSC, sizeof(QWORD)); |
| } |
| pKey->dwTSC47_16 = 0; |
| pKey->wTSC15_0 = 0; |
| |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"KeybSetKey(R): \n"); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->bKeyValid: %d\n ", pKey->bKeyValid); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->uKeyLength: %d\n ", (int)pKey->uKeyLength); |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"pKey->abyKey: "); |
| for (ii = 0; ii < pKey->uKeyLength; ii++) { |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"%02x ", pKey->abyKey[ii]); |
| } |
| DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"\n"); |
| |
| //DBG_PRN_GRP12(("pKey->dwTSC47_16: %lX\n ", pKey->dwTSC47_16)); |
| //DBG_PRN_GRP12(("pKey->wTSC15_0: %X\n ", pKey->wTSC15_0)); |
| //DBG_PRN_GRP12(("pKey->dwKeyIndex: %lX\n ", pKey->dwKeyIndex)); |
| |
| } // (pTable->KeyTable[i].bInUse == TRUE) |
| } |
| return (TRUE); |
| } |
