MAC_TABLE_ENTRY *FindWdsEntry(
IN PRTMP_ADAPTER pAd,
IN UCHAR Wcid,
IN PUCHAR pAddr,
IN UINT32 PhyMode)
{
MAC_TABLE_ENTRY *pEntry;
// lookup the match wds entry for the incoming packet.
pEntry = WdsTableLookupByWcid(pAd, Wcid, pAddr, TRUE);
if (pEntry == NULL)
pEntry = WdsTableLookup(pAd, pAddr, TRUE);
// Only Lazy mode will auto learning, match with FrDs=1 and ToDs=1
if((pEntry == NULL) && (pAd->WdsTab.Mode >= WDS_LAZY_MODE))
{
LONG WdsIdx = WdsEntryAlloc(pAd, pAddr);
if (WdsIdx >= 0)
{
// user doesn't specific a phy mode for WDS link.
if (pAd->WdsTab.WdsEntry[WdsIdx].PhyMode == 0xff)
pAd->WdsTab.WdsEntry[WdsIdx].PhyMode = PhyMode;
pEntry = MacTableInsertWDSEntry(pAd, pAddr, (UCHAR)WdsIdx);
}
else
pEntry = NULL;
}
return pEntry;
}
MAC_TABLE_ENTRY *FindWdsEntry(
IN RTMP_ADAPTER *pAd,
IN UCHAR Wcid,
IN UCHAR *pAddr,
IN UINT32 PhyMode)
{
MAC_TABLE_ENTRY *pEntry;
RT_802_11_WDS_ENTRY *wds_entry;
/* lookup the match wds entry for the incoming packet. */
pEntry = WdsTableLookupByWcid(pAd, Wcid, pAddr, TRUE);
if (pEntry == NULL)
pEntry = WdsTableLookup(pAd, pAddr, TRUE);
/* Only Lazy mode will auto learning, match with FrDs=1 and ToDs=1 */
if((pEntry == NULL) && (pAd->WdsTab.Mode >= WDS_LAZY_MODE))
{
INT WdsIdx = WdsEntryAlloc(pAd, pAddr);
if (WdsIdx >= 0 && WdsIdx < MAX_WDS_ENTRY)
{
wds_entry = &pAd->WdsTab.WdsEntry[WdsIdx];
/* user doesn't specific a phy mode for WDS link. */
if (wds_entry->wdev.PhyMode == 0xff)
wds_entry->wdev.PhyMode = PhyMode;
pEntry = MacTableInsertWDSEntry(pAd, pAddr, (UCHAR)WdsIdx);
RTMPSetSupportMCS(pAd,
OPMODE_AP,
pEntry,
pAd->CommonCfg.SupRate,
pAd->CommonCfg.SupRateLen,
pAd->CommonCfg.ExtRate,
pAd->CommonCfg.ExtRateLen,
#ifdef DOT11_VHT_AC
0,
NULL,
#endif /* DOT11_VHT_AC */
&pAd->CommonCfg.HtCapability,
sizeof(pAd->CommonCfg.HtCapability));
}
else
pEntry = NULL;
}
return pEntry;
}
VOID rtmp_read_wds_from_file(
IN PRTMP_ADAPTER pAd,
PSTRING tmpbuf,
PSTRING buffer)
{
PSTRING macptr;
INT i=0, j;
STRING tok_str[16];
BOOLEAN bUsePrevFormat = FALSE;
UCHAR macAddress[MAC_ADDR_LEN];
UCHAR keyMaterial[40];
UCHAR KeyLen, CipherAlg = CIPHER_NONE, KeyIdx;
PRT_802_11_WDS_ENTRY pWdsEntry;
/*WdsPhyMode */
if (RTMPGetKeyParameter("WdsPhyMode", tmpbuf, MAX_PARAM_BUFFER_SIZE, buffer, TRUE))
{
for (i=0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
if ((strncmp(macptr, "CCK", 3) == 0) || (strncmp(macptr, "cck", 3) == 0))
pAd->WdsTab.WdsEntry[i].PhyMode = MODE_CCK;
else if ((strncmp(macptr, "OFDM", 4) == 0) || (strncmp(macptr, "ofdm", 4) == 0))
pAd->WdsTab.WdsEntry[i].PhyMode = MODE_OFDM;
#ifdef DOT11_N_SUPPORT
else if ((strncmp(macptr, "HTMIX", 5) == 0) || (strncmp(macptr, "htmix", 5) == 0))
pAd->WdsTab.WdsEntry[i].PhyMode = MODE_HTMIX;
else if ((strncmp(macptr, "GREENFIELD", 10) == 0) || (strncmp(macptr, "greenfield", 10) == 0))
pAd->WdsTab.WdsEntry[i].PhyMode = MODE_HTGREENFIELD;
#endif /* DOT11_N_SUPPORT */
else
pAd->WdsTab.WdsEntry[i].PhyMode = 0xff;
DBGPRINT(RT_DEBUG_TRACE, ("If/wds%d - WdsPhyMode=%d\n", i, pAd->WdsTab.WdsEntry[i].PhyMode));
}
}
/*WdsList */
if (RTMPGetKeyParameter("WdsList", tmpbuf, MAX_PARAM_BUFFER_SIZE, buffer, TRUE))
{
if (pAd->WdsTab.Mode != WDS_LAZY_MODE)
{
for (i=0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
if(strlen(macptr) != 17) /*Mac address acceptable format 01:02:03:04:05:06 length 17 */
continue;
if(strcmp(macptr,"00:00:00:00:00:00") == 0)
continue;
if(i >= MAX_WDS_ENTRY)
break;
for (j=0; j<ETH_LENGTH_OF_ADDRESS; j++)
{
AtoH(macptr, &macAddress[j], 1);
macptr=macptr+3;
}
WdsEntryAlloc(pAd, macAddress);
}
}
}
/*WdsEncrypType */
if (RTMPGetKeyParameter("WdsEncrypType", tmpbuf, 128, buffer, TRUE))
{
for (i = 0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
if ((strncmp(macptr, "NONE", 4) == 0) || (strncmp(macptr, "none", 4) == 0))
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11WEPDisabled;
else if ((strncmp(macptr, "WEP", 3) == 0) || (strncmp(macptr, "wep", 3) == 0))
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11WEPEnabled;
else if ((strncmp(macptr, "TKIP", 4) == 0) || (strncmp(macptr, "tkip", 4) == 0))
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11Encryption2Enabled;
else if ((strncmp(macptr, "AES", 3) == 0) || (strncmp(macptr, "aes", 3) == 0))
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11Encryption3Enabled;
else
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11WEPDisabled;
DBGPRINT(RT_DEBUG_TRACE, ("WdsEncrypType[%d]=%d(%s)\n", i, pAd->WdsTab.WdsEntry[i].WepStatus, GetEncryptType(pAd->WdsTab.WdsEntry[i].WepStatus)));
}
/* Previous WDS only supports single encryption type. */
/* For backward compatible, other wds link encryption type shall be the same with the first. */
if (i == 1)
{
for (j = 1; j < MAX_WDS_ENTRY; j++)
{
pAd->WdsTab.WdsEntry[j].WepStatus = pAd->WdsTab.WdsEntry[0].WepStatus;
DBGPRINT(RT_DEBUG_TRACE, ("@WdsEncrypType[%d]=%d(%s)\n", j, pAd->WdsTab.WdsEntry[i].WepStatus, GetEncryptType(pAd->WdsTab.WdsEntry[i].WepStatus)));
}
}
}
/* WdsKey */
/* This is a previous parameter and it only stores WPA key material, not WEP key */
if (RTMPGetKeyParameter("WdsKey", tmpbuf, 255, buffer, FALSE))
{
for (i = 0; i < MAX_WDS_ENTRY; i++)
NdisZeroMemory(&pAd->WdsTab.WdsEntry[i].WdsKey, sizeof(CIPHER_KEY));
if (strlen(tmpbuf) > 0)
bUsePrevFormat = TRUE;
/* check if the wds-0 link key material is valid */
if (((pAd->WdsTab.WdsEntry[0].WepStatus == Ndis802_11Encryption2Enabled)
|| (pAd->WdsTab.WdsEntry[0].WepStatus == Ndis802_11Encryption3Enabled))
&& (strlen(tmpbuf) >= 8) && (strlen(tmpbuf) <= 64))
{
RT_CfgSetWPAPSKKey(pAd, tmpbuf, strlen(tmpbuf), (PUCHAR)RALINK_PASSPHRASE, sizeof(RALINK_PASSPHRASE), keyMaterial);
if (pAd->WdsTab.WdsEntry[0].WepStatus == Ndis802_11Encryption3Enabled)
pAd->WdsTab.WdsEntry[0].WdsKey.CipherAlg = CIPHER_AES;
else
pAd->WdsTab.WdsEntry[0].WdsKey.CipherAlg = CIPHER_TKIP;
NdisMoveMemory(&pAd->WdsTab.WdsEntry[0].WdsKey.Key, keyMaterial, 16);
pAd->WdsTab.WdsEntry[0].WdsKey.KeyLen = 16;
NdisMoveMemory(&pAd->WdsTab.WdsEntry[0].WdsKey.RxMic, keyMaterial+16, 8);
NdisMoveMemory(&pAd->WdsTab.WdsEntry[0].WdsKey.TxMic, keyMaterial+16, 8);
}
/* Previous WDS only supports single key-material. */
/* For backward compatible, other wds link key-material shall be the same with the first. */
if (pAd->WdsTab.WdsEntry[0].WdsKey.KeyLen == 16)
{
for (j = 1; j < MAX_WDS_ENTRY; j++)
{
NdisMoveMemory(&pAd->WdsTab.WdsEntry[j].WdsKey, &pAd->WdsTab.WdsEntry[0].WdsKey, sizeof(CIPHER_KEY));
}
}
}
/* The parameters can provide different key information for each WDS-Link */
/* no matter WEP or WPA */
if (!bUsePrevFormat)
{
for (i = 0; i < MAX_WDS_ENTRY; i++)
{
AP_WDS_KeyNameMakeUp(tok_str, sizeof(tok_str), i);
/* WdsXKey (X=0~MAX_WDS_ENTRY-1) */
if (RTMPGetKeyParameter(tok_str, tmpbuf, 128, buffer, FALSE))
{
if (pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption1Enabled)
{
/* Ascii type */
if (strlen(tmpbuf) == 5 || strlen(tmpbuf) == 13)
{
KeyLen = strlen(tmpbuf);
pAd->WdsTab.WdsEntry[i].WdsKey.KeyLen = KeyLen;
NdisMoveMemory(pAd->WdsTab.WdsEntry[i].WdsKey.Key, tmpbuf, KeyLen);
if (KeyLen == 5)
CipherAlg = CIPHER_WEP64;
else
CipherAlg = CIPHER_WEP128;
pAd->WdsTab.WdsEntry[i].WdsKey.CipherAlg = CipherAlg;
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d Key=%s ,type=Ascii, CipherAlg(%s)\n", i, tmpbuf, (CipherAlg == CIPHER_WEP64 ? "wep64" : "wep128")));
}
/* Hex type */
else if (strlen(tmpbuf) == 10 || strlen(tmpbuf) == 26)
{
KeyLen = strlen(tmpbuf);
pAd->WdsTab.WdsEntry[i].WdsKey.KeyLen = KeyLen / 2;
AtoH(tmpbuf, pAd->WdsTab.WdsEntry[i].WdsKey.Key, KeyLen / 2);
if (KeyLen == 10)
CipherAlg = CIPHER_WEP64;
else
CipherAlg = CIPHER_WEP128;
pAd->WdsTab.WdsEntry[i].WdsKey.CipherAlg = CipherAlg;
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d Key=%s ,type=Hex, CipherAlg(%s)\n", i, tmpbuf, (CipherAlg == CIPHER_WEP64 ? "wep64" : "wep128")));
}
/* Invalid type */
else
{
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11EncryptionDisabled;
NdisZeroMemory(&pAd->WdsTab.WdsEntry[i].WdsKey, sizeof(CIPHER_KEY));
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d has invalid key for WEP, reset encryption to OPEN\n", i));
}
}
else if ((pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption2Enabled)
|| (pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption3Enabled))
{
if ((strlen(tmpbuf) >= 8) && (strlen(tmpbuf) <= 64))
{
RT_CfgSetWPAPSKKey(pAd, tmpbuf, strlen(tmpbuf), (PUCHAR) RALINK_PASSPHRASE, sizeof(RALINK_PASSPHRASE), keyMaterial);
if (pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption3Enabled)
pAd->WdsTab.WdsEntry[i].WdsKey.CipherAlg = CIPHER_AES;
else
pAd->WdsTab.WdsEntry[i].WdsKey.CipherAlg = CIPHER_TKIP;
NdisMoveMemory(&pAd->WdsTab.WdsEntry[i].WdsKey.Key, keyMaterial, 16);
pAd->WdsTab.WdsEntry[i].WdsKey.KeyLen = 16;
NdisMoveMemory(&pAd->WdsTab.WdsEntry[i].WdsKey.RxMic, keyMaterial+16, 8);
NdisMoveMemory(&pAd->WdsTab.WdsEntry[i].WdsKey.TxMic, keyMaterial+16, 8);
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d Key=%s, CipherAlg(%s)\n", i, tmpbuf, (CipherAlg == CIPHER_AES ? "AES" : "TKIP")));
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d has invalid key for WPA, reset encryption to OPEN\n", i));
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11EncryptionDisabled;
NdisZeroMemory(&pAd->WdsTab.WdsEntry[i].WdsKey, sizeof(CIPHER_KEY));
}
}
else
{
pAd->WdsTab.WdsEntry[i].WepStatus = Ndis802_11EncryptionDisabled;
NdisZeroMemory(&pAd->WdsTab.WdsEntry[i].WdsKey, sizeof(CIPHER_KEY));
}
}
}
}
/* WdsDefaultKeyID */
if(RTMPGetKeyParameter("WdsDefaultKeyID", tmpbuf, 10, buffer, TRUE))
{
for (i = 0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
KeyIdx = (UCHAR) simple_strtol(macptr, 0, 10);
if((KeyIdx >= 1 ) && (KeyIdx <= 4))
pAd->WdsTab.WdsEntry[i].KeyIdx = (UCHAR) (KeyIdx - 1);
else
pAd->WdsTab.WdsEntry[i].KeyIdx = 0;
if ((pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption2Enabled)
|| (pAd->WdsTab.WdsEntry[i].WepStatus == Ndis802_11Encryption3Enabled))
pAd->WdsTab.WdsEntry[i].KeyIdx = 0;
DBGPRINT(RT_DEBUG_TRACE, ("IF/wds%d - WdsDefaultKeyID(0~3)=%d\n", i, pAd->WdsTab.WdsEntry[i].KeyIdx));
}
}
/* WdsTxMode */
if (RTMPGetKeyParameter("WdsTxMode", tmpbuf, 25, buffer, TRUE))
{
for (i = 0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
pWdsEntry = &pAd->WdsTab.WdsEntry[i];
pWdsEntry->DesiredTransmitSetting.field.FixedTxMode =
RT_CfgSetFixedTxPhyMode(macptr);
DBGPRINT(RT_DEBUG_TRACE, ("I/F(wds%d) Tx Mode = %d\n", i,
pWdsEntry->DesiredTransmitSetting.field.FixedTxMode));
}
}
/* WdsTxMcs */
if (RTMPGetKeyParameter("WdsTxMcs", tmpbuf, 50, buffer, TRUE))
{
for (i = 0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
pWdsEntry = &pAd->WdsTab.WdsEntry[i];
pWdsEntry->DesiredTransmitSetting.field.MCS =
RT_CfgSetTxMCSProc(macptr, &pWdsEntry->bAutoTxRateSwitch);
if (pWdsEntry->DesiredTransmitSetting.field.MCS == MCS_AUTO)
{
DBGPRINT(RT_DEBUG_TRACE, ("I/F(wds%d) Tx MCS = AUTO\n", i));
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("I/F(wds%d) Tx MCS = %d\n", i,
pWdsEntry->DesiredTransmitSetting.field.MCS));
}
}
}
/*WdsEnable */
if(RTMPGetKeyParameter("WdsEnable", tmpbuf, 10, buffer, TRUE))
{
RT_802_11_WDS_ENTRY *pWdsEntry;
switch(simple_strtol(tmpbuf, 0, 10))
{
case 2: /* Bridge mode, DisAllow association(stop Beacon generation and Probe Req. */
pAd->WdsTab.Mode = WDS_BRIDGE_MODE;
break;
case 1:
case 3: /* Repeater mode */
pAd->WdsTab.Mode = WDS_REPEATER_MODE;
break;
case 4: /* Lazy mode, Auto learn wds entry by same SSID, channel, security policy */
for(i = 0; i < MAX_WDS_ENTRY; i++)
{
pWdsEntry = &pAd->WdsTab.WdsEntry[i];
if (pWdsEntry->Valid)
WdsEntryDel(pAd, pWdsEntry->PeerWdsAddr);
/* When Lazy mode is enabled, the all wds-link shall share the same encryption type and key material */
if (i > 0)
{
pAd->WdsTab.WdsEntry[i].WepStatus = pAd->WdsTab.WdsEntry[0].WepStatus;
pAd->WdsTab.WdsEntry[i].KeyIdx = pAd->WdsTab.WdsEntry[0].KeyIdx;
NdisMoveMemory(&pAd->WdsTab.WdsEntry[i].WdsKey, &pAd->WdsTab.WdsEntry[0].WdsKey, sizeof(CIPHER_KEY));
}
}
pAd->WdsTab.Mode = WDS_LAZY_MODE;
break;
case 0: /* Disable mode */
default:
APWdsInitialize(pAd);
pAd->WdsTab.Mode = WDS_DISABLE_MODE;
break;
}
DBGPRINT(RT_DEBUG_TRACE, ("WDS-Enable mode=%d\n", pAd->WdsTab.Mode));
}
#ifdef WDS_VLAN_SUPPORT
/* WdsVlan */
if (RTMPGetKeyParameter("WDS_VLANID", tmpbuf, MAX_PARAM_BUFFER_SIZE, buffer, TRUE))
{
for (i=0, macptr = rstrtok(tmpbuf,";"); (macptr && i < MAX_WDS_ENTRY); macptr = rstrtok(NULL,";"), i++)
{
pAd->WdsTab.WdsEntry[i].VLAN_VID = simple_strtol(macptr, 0, 10);
pAd->WdsTab.WdsEntry[i].VLAN_Priority = 0;
DBGPRINT(RT_DEBUG_TRACE, ("If/wds%d - WdsVlanId=%d\n", i, pAd->WdsTab.WdsEntry[i].VLAN_VID));
}
}
#endif /* WDS_VLAN_SUPPORT */
}
