extractedLnx/linux-2.6.30/drivers/staging/rt2870/sta_ioctl.c_RTMPSetInformation.c
INT RTMPSetInformation(
IN PRTMP_ADAPTER pAdapter,
IN OUT struct ifreq *rq,
IN INT cmd)
{
struct iwreq *wrq = (struct iwreq *) rq;
NDIS_802_11_SSID Ssid;
NDIS_802_11_MAC_ADDRESS Bssid;
RT_802_11_PHY_MODE PhyMode;
RT_802_11_STA_CONFIG StaConfig;
NDIS_802_11_RATES aryRates;
RT_802_11_PREAMBLE Preamble;
NDIS_802_11_WEP_STATUS WepStatus;
NDIS_802_11_AUTHENTICATION_MODE AuthMode = Ndis802_11AuthModeMax;
NDIS_802_11_NETWORK_INFRASTRUCTURE BssType;
NDIS_802_11_RTS_THRESHOLD RtsThresh;
NDIS_802_11_FRAGMENTATION_THRESHOLD FragThresh;
NDIS_802_11_POWER_MODE PowerMode;
PNDIS_802_11_KEY pKey = NULL;
PNDIS_802_11_WEP pWepKey =NULL;
PNDIS_802_11_REMOVE_KEY pRemoveKey = NULL;
NDIS_802_11_CONFIGURATION Config, *pConfig = NULL;
NDIS_802_11_NETWORK_TYPE NetType;
ULONG Now;
UINT KeyIdx = 0;
INT Status = NDIS_STATUS_SUCCESS, MaxPhyMode = PHY_11G;
ULONG PowerTemp;
BOOLEAN RadioState;
BOOLEAN StateMachineTouched = FALSE;
#ifdef DOT11_N_SUPPORT
OID_SET_HT_PHYMODE HT_PhyMode; //11n ,kathy
#endif // DOT11_N_SUPPORT //
#ifdef WPA_SUPPLICANT_SUPPORT
PNDIS_802_11_PMKID pPmkId = NULL;
BOOLEAN IEEE8021xState = FALSE;
BOOLEAN IEEE8021x_required_keys = FALSE;
UCHAR wpa_supplicant_enable = 0;
#endif // WPA_SUPPLICANT_SUPPORT //
#ifdef SNMP_SUPPORT
TX_RTY_CFG_STRUC tx_rty_cfg;
ULONG ShortRetryLimit, LongRetryLimit;
UCHAR ctmp;
#endif // SNMP_SUPPORT //
#ifdef DOT11_N_SUPPORT
MaxPhyMode = PHY_11N_5G;
#endif // DOT11_N_SUPPORT //
DBGPRINT(RT_DEBUG_TRACE, ("-->RTMPSetInformation(), 0x%08x\n", cmd&0x7FFF));
switch(cmd & 0x7FFF) {
case RT_OID_802_11_COUNTRY_REGION:
if (wrq->u.data.length < sizeof(UCHAR))
Status = -EINVAL;
// Only avaliable when EEPROM not programming
else if (!(pAdapter->CommonCfg.CountryRegion & 0x80) && !(pAdapter->CommonCfg.CountryRegionForABand & 0x80))
{
ULONG Country;
UCHAR TmpPhy;
Status = copy_from_user(&Country, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->CommonCfg.CountryRegion = (UCHAR)(Country & 0x000000FF);
pAdapter->CommonCfg.CountryRegionForABand = (UCHAR)((Country >> 8) & 0x000000FF);
TmpPhy = pAdapter->CommonCfg.PhyMode;
pAdapter->CommonCfg.PhyMode = 0xff;
// Build all corresponding channel information
RTMPSetPhyMode(pAdapter, TmpPhy);
#ifdef DOT11_N_SUPPORT
SetCommonHT(pAdapter);
#endif // DOT11_N_SUPPORT //
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_COUNTRY_REGION (A:%d B/G:%d)\n", pAdapter->CommonCfg.CountryRegionForABand,
pAdapter->CommonCfg.CountryRegion));
}
break;
case OID_802_11_BSSID_LIST_SCAN:
#ifdef RALINK_ATE
if (ATE_ON(pAdapter))
{
DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
break;
}
#endif // RALINK_ATE //
Now = jiffies;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_BSSID_LIST_SCAN, TxCnt = %d \n", pAdapter->RalinkCounters.LastOneSecTotalTxCount));
if (MONITOR_ON(pAdapter))
{
DBGPRINT(RT_DEBUG_TRACE, ("!!! Driver is in Monitor Mode now !!!\n"));
break;
}
//Benson add 20080527, when radio off, sta don't need to scan
if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_RADIO_OFF))
break;
if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
{
DBGPRINT(RT_DEBUG_TRACE, ("!!! Driver is scanning now !!!\n"));
pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
Status = NDIS_STATUS_SUCCESS;
break;
}
if (pAdapter->RalinkCounters.LastOneSecTotalTxCount > 100)
{
DBGPRINT(RT_DEBUG_TRACE, ("!!! Link UP, ignore this set::OID_802_11_BSSID_LIST_SCAN\n"));
Status = NDIS_STATUS_SUCCESS;
pAdapter->StaCfg.ScanCnt = 99; // Prevent auto scan triggered by this OID
break;
}
if ((OPSTATUS_TEST_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED)) &&
((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA) ||
(pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
(pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2) ||
(pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK)) &&
(pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_NOT_SECURED))
{
DBGPRINT(RT_DEBUG_TRACE, ("!!! Link UP, Port Not Secured! ignore this set::OID_802_11_BSSID_LIST_SCAN\n"));
Status = NDIS_STATUS_SUCCESS;
pAdapter->StaCfg.ScanCnt = 99; // Prevent auto scan triggered by this OID
break;
}
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
{
RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
}
// tell CNTL state machine to call NdisMSetInformationComplete() after completing
// this request, because this request is initiated by NDIS.
pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
// Reset allowed scan retries
pAdapter->StaCfg.ScanCnt = 0;
pAdapter->StaCfg.LastScanTime = Now;
pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
RTMP_SET_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS);
MlmeEnqueue(pAdapter,
MLME_CNTL_STATE_MACHINE,
OID_802_11_BSSID_LIST_SCAN,
0,
NULL);
Status = NDIS_STATUS_SUCCESS;
StateMachineTouched = TRUE;
break;
case OID_802_11_SSID:
if (wrq->u.data.length != sizeof(NDIS_802_11_SSID))
Status = -EINVAL;
else
{
PCHAR pSsidString = NULL;
Status = copy_from_user(&Ssid, wrq->u.data.pointer, wrq->u.data.length);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SSID (Len=%d,Ssid=%s)\n", Ssid.SsidLength, Ssid.Ssid));
if (Ssid.SsidLength > MAX_LEN_OF_SSID)
Status = -EINVAL;
else
{
if (Ssid.SsidLength == 0)
{
Set_SSID_Proc(pAdapter, "");
}
else
{
pSsidString = (CHAR *) kmalloc(MAX_LEN_OF_SSID+1, MEM_ALLOC_FLAG);
if (pSsidString)
{
NdisZeroMemory(pSsidString, MAX_LEN_OF_SSID+1);
NdisMoveMemory(pSsidString, Ssid.Ssid, Ssid.SsidLength);
Set_SSID_Proc(pAdapter, pSsidString);
kfree(pSsidString);
}
else
Status = -ENOMEM;
}
}
}
break;
case OID_802_11_BSSID:
#ifdef RALINK_ATE
if (ATE_ON(pAdapter))
{
DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
break;
}
#endif // RALINK_ATE //
if (wrq->u.data.length != sizeof(NDIS_802_11_MAC_ADDRESS))
Status = -EINVAL;
else
{
Status = copy_from_user(&Bssid, wrq->u.data.pointer, wrq->u.data.length);
// tell CNTL state machine to call NdisMSetInformationComplete() after completing
// this request, because this request is initiated by NDIS.
pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
// Prevent to connect AP again in STAMlmePeriodicExec
pAdapter->MlmeAux.AutoReconnectSsidLen= 32;
// Reset allowed scan retries
pAdapter->StaCfg.ScanCnt = 0;
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
{
RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
}
MlmeEnqueue(pAdapter,
MLME_CNTL_STATE_MACHINE,
OID_802_11_BSSID,
sizeof(NDIS_802_11_MAC_ADDRESS),
(VOID *)&Bssid);
Status = NDIS_STATUS_SUCCESS;
StateMachineTouched = TRUE;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_BSSID %02x:%02x:%02x:%02x:%02x:%02x\n",
Bssid[0], Bssid[1], Bssid[2], Bssid[3], Bssid[4], Bssid[5]));
}
break;
case RT_OID_802_11_RADIO:
if (wrq->u.data.length != sizeof(BOOLEAN))
Status = -EINVAL;
else
{
Status = copy_from_user(&RadioState, wrq->u.data.pointer, wrq->u.data.length);
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_RADIO (=%d)\n", RadioState));
if (pAdapter->StaCfg.bSwRadio != RadioState)
{
pAdapter->StaCfg.bSwRadio = RadioState;
if (pAdapter->StaCfg.bRadio != (pAdapter->StaCfg.bHwRadio && pAdapter->StaCfg.bSwRadio))
{
pAdapter->StaCfg.bRadio = (pAdapter->StaCfg.bHwRadio && pAdapter->StaCfg.bSwRadio);
if (pAdapter->StaCfg.bRadio == TRUE)
{
MlmeRadioOn(pAdapter);
// Update extra information
pAdapter->ExtraInfo = EXTRA_INFO_CLEAR;
}
else
{
MlmeRadioOff(pAdapter);
// Update extra information
pAdapter->ExtraInfo = SW_RADIO_OFF;
}
}
}
}
break;
case RT_OID_802_11_PHY_MODE:
if (wrq->u.data.length != sizeof(RT_802_11_PHY_MODE))
Status = -EINVAL;
else
{
Status = copy_from_user(&PhyMode, wrq->u.data.pointer, wrq->u.data.length);
if (PhyMode <= MaxPhyMode)
{
RTMPSetPhyMode(pAdapter, PhyMode);
#ifdef DOT11_N_SUPPORT
SetCommonHT(pAdapter);
#endif // DOT11_N_SUPPORT //
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_PHY_MODE (=%d)\n", PhyMode));
}
break;
case RT_OID_802_11_STA_CONFIG:
if (wrq->u.data.length != sizeof(RT_802_11_STA_CONFIG))
Status = -EINVAL;
else
{
Status = copy_from_user(&StaConfig, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->CommonCfg.bEnableTxBurst = StaConfig.EnableTxBurst;
pAdapter->CommonCfg.UseBGProtection = StaConfig.UseBGProtection;
pAdapter->CommonCfg.bUseShortSlotTime = 1; // 2003-10-30 always SHORT SLOT capable
if ((pAdapter->CommonCfg.PhyMode != StaConfig.AdhocMode) &&
(StaConfig.AdhocMode <= MaxPhyMode))
{
// allow dynamic change of "USE OFDM rate or not" in ADHOC mode
// if setting changed, need to reset current TX rate as well as BEACON frame format
if (pAdapter->StaCfg.BssType == BSS_ADHOC)
{
pAdapter->CommonCfg.PhyMode = StaConfig.AdhocMode;
RTMPSetPhyMode(pAdapter, PhyMode);
MlmeUpdateTxRates(pAdapter, FALSE, 0);
MakeIbssBeacon(pAdapter); // re-build BEACON frame
AsicEnableIbssSync(pAdapter); // copy to on-chip memory
}
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_STA_CONFIG (Burst=%d, Protection=%ld,ShortSlot=%d\n",
pAdapter->CommonCfg.bEnableTxBurst,
pAdapter->CommonCfg.UseBGProtection,
pAdapter->CommonCfg.bUseShortSlotTime));
}
break;
case OID_802_11_DESIRED_RATES:
if (wrq->u.data.length != sizeof(NDIS_802_11_RATES))
Status = -EINVAL;
else
{
Status = copy_from_user(&aryRates, wrq->u.data.pointer, wrq->u.data.length);
NdisZeroMemory(pAdapter->CommonCfg.DesireRate, MAX_LEN_OF_SUPPORTED_RATES);
NdisMoveMemory(pAdapter->CommonCfg.DesireRate, &aryRates, sizeof(NDIS_802_11_RATES));
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DESIRED_RATES (%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x)\n",
pAdapter->CommonCfg.DesireRate[0],pAdapter->CommonCfg.DesireRate[1],
pAdapter->CommonCfg.DesireRate[2],pAdapter->CommonCfg.DesireRate[3],
pAdapter->CommonCfg.DesireRate[4],pAdapter->CommonCfg.DesireRate[5],
pAdapter->CommonCfg.DesireRate[6],pAdapter->CommonCfg.DesireRate[7] ));
// Changing DesiredRate may affect the MAX TX rate we used to TX frames out
MlmeUpdateTxRates(pAdapter, FALSE, 0);
}
break;
case RT_OID_802_11_PREAMBLE:
if (wrq->u.data.length != sizeof(RT_802_11_PREAMBLE))
Status = -EINVAL;
else
{
Status = copy_from_user(&Preamble, wrq->u.data.pointer, wrq->u.data.length);
if (Preamble == Rt802_11PreambleShort)
{
pAdapter->CommonCfg.TxPreamble = Preamble;
MlmeSetTxPreamble(pAdapter, Rt802_11PreambleShort);
}
else if ((Preamble == Rt802_11PreambleLong) || (Preamble == Rt802_11PreambleAuto))
{
// if user wants AUTO, initialize to LONG here, then change according to AP's
// capability upon association.
pAdapter->CommonCfg.TxPreamble = Preamble;
MlmeSetTxPreamble(pAdapter, Rt802_11PreambleLong);
}
else
{
Status = -EINVAL;
break;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_PREAMBLE (=%d)\n", Preamble));
}
break;
case OID_802_11_WEP_STATUS:
if (wrq->u.data.length != sizeof(NDIS_802_11_WEP_STATUS))
Status = -EINVAL;
else
{
Status = copy_from_user(&WepStatus, wrq->u.data.pointer, wrq->u.data.length);
// Since TKIP, AES, WEP are all supported. It should not have any invalid setting
if (WepStatus <= Ndis802_11Encryption3KeyAbsent)
{
if (pAdapter->StaCfg.WepStatus != WepStatus)
{
// Config has changed
pAdapter->bConfigChanged = TRUE;
}
pAdapter->StaCfg.WepStatus = WepStatus;
pAdapter->StaCfg.OrigWepStatus = WepStatus;
pAdapter->StaCfg.PairCipher = WepStatus;
pAdapter->StaCfg.GroupCipher = WepStatus;
}
else
{
Status = -EINVAL;
break;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEP_STATUS (=%d)\n",WepStatus));
}
break;
case OID_802_11_AUTHENTICATION_MODE:
if (wrq->u.data.length != sizeof(NDIS_802_11_AUTHENTICATION_MODE))
Status = -EINVAL;
else
{
Status = copy_from_user(&AuthMode, wrq->u.data.pointer, wrq->u.data.length);
if (AuthMode > Ndis802_11AuthModeMax)
{
Status = -EINVAL;
break;
}
else
{
if (pAdapter->StaCfg.AuthMode != AuthMode)
{
// Config has changed
pAdapter->bConfigChanged = TRUE;
}
pAdapter->StaCfg.AuthMode = AuthMode;
}
pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_AUTHENTICATION_MODE (=%d) \n",pAdapter->StaCfg.AuthMode));
}
break;
case OID_802_11_INFRASTRUCTURE_MODE:
if (wrq->u.data.length != sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE))
Status = -EINVAL;
else
{
Status = copy_from_user(&BssType, wrq->u.data.pointer, wrq->u.data.length);
if (BssType == Ndis802_11IBSS)
Set_NetworkType_Proc(pAdapter, "Adhoc");
else if (BssType == Ndis802_11Infrastructure)
Set_NetworkType_Proc(pAdapter, "Infra");
else if (BssType == Ndis802_11Monitor)
Set_NetworkType_Proc(pAdapter, "Monitor");
else
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_INFRASTRUCTURE_MODE (unknown)\n"));
}
}
break;
case OID_802_11_REMOVE_WEP:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_WEP\n"));
if (wrq->u.data.length != sizeof(NDIS_802_11_KEY_INDEX))
{
Status = -EINVAL;
}
else
{
KeyIdx = *(NDIS_802_11_KEY_INDEX *) wrq->u.data.pointer;
if (KeyIdx & 0x80000000)
{
// Should never set default bit when remove key
Status = -EINVAL;
}
else
{
KeyIdx = KeyIdx & 0x0fffffff;
if (KeyIdx >= 4){
Status = -EINVAL;
}
else
{
pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = 0;
pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_NONE;
AsicRemoveSharedKeyEntry(pAdapter, 0, (UCHAR)KeyIdx);
}
}
}
break;
case RT_OID_802_11_RESET_COUNTERS:
NdisZeroMemory(&pAdapter->WlanCounters, sizeof(COUNTER_802_11));
NdisZeroMemory(&pAdapter->Counters8023, sizeof(COUNTER_802_3));
NdisZeroMemory(&pAdapter->RalinkCounters, sizeof(COUNTER_RALINK));
pAdapter->Counters8023.RxNoBuffer = 0;
pAdapter->Counters8023.GoodReceives = 0;
pAdapter->Counters8023.RxNoBuffer = 0;
#ifdef RT2870
pAdapter->BulkOutComplete = 0;
pAdapter->BulkOutCompleteOther= 0;
pAdapter->BulkOutCompleteCancel = 0;
pAdapter->BulkOutReq = 0;
pAdapter->BulkInReq= 0;
pAdapter->BulkInComplete = 0;
pAdapter->BulkInCompleteFail = 0;
#endif // RT2870 //
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_RESET_COUNTERS \n"));
break;
case OID_802_11_RTS_THRESHOLD:
if (wrq->u.data.length != sizeof(NDIS_802_11_RTS_THRESHOLD))
Status = -EINVAL;
else
{
Status = copy_from_user(&RtsThresh, wrq->u.data.pointer, wrq->u.data.length);
if (RtsThresh > MAX_RTS_THRESHOLD)
Status = -EINVAL;
else
pAdapter->CommonCfg.RtsThreshold = (USHORT)RtsThresh;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_RTS_THRESHOLD (=%ld)\n",RtsThresh));
break;
case OID_802_11_FRAGMENTATION_THRESHOLD:
if (wrq->u.data.length != sizeof(NDIS_802_11_FRAGMENTATION_THRESHOLD))
Status = -EINVAL;
else
{
Status = copy_from_user(&FragThresh, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->CommonCfg.bUseZeroToDisableFragment = FALSE;
if (FragThresh > MAX_FRAG_THRESHOLD || FragThresh < MIN_FRAG_THRESHOLD)
{
if (FragThresh == 0)
{
pAdapter->CommonCfg.FragmentThreshold = MAX_FRAG_THRESHOLD;
pAdapter->CommonCfg.bUseZeroToDisableFragment = TRUE;
}
else
Status = -EINVAL;
}
else
pAdapter->CommonCfg.FragmentThreshold = (USHORT)FragThresh;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_FRAGMENTATION_THRESHOLD (=%ld) \n",FragThresh));
break;
case OID_802_11_POWER_MODE:
if (wrq->u.data.length != sizeof(NDIS_802_11_POWER_MODE))
Status = -EINVAL;
else
{
Status = copy_from_user(&PowerMode, wrq->u.data.pointer, wrq->u.data.length);
if (PowerMode == Ndis802_11PowerModeCAM)
Set_PSMode_Proc(pAdapter, "CAM");
else if (PowerMode == Ndis802_11PowerModeMAX_PSP)
Set_PSMode_Proc(pAdapter, "Max_PSP");
else if (PowerMode == Ndis802_11PowerModeFast_PSP)
Set_PSMode_Proc(pAdapter, "Fast_PSP");
else if (PowerMode == Ndis802_11PowerModeLegacy_PSP)
Set_PSMode_Proc(pAdapter, "Legacy_PSP");
else
Status = -EINVAL;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_POWER_MODE (=%d)\n",PowerMode));
break;
case RT_OID_802_11_TX_POWER_LEVEL_1:
if (wrq->u.data.length < sizeof(ULONG))
Status = -EINVAL;
else
{
Status = copy_from_user(&PowerTemp, wrq->u.data.pointer, wrq->u.data.length);
if (PowerTemp > 100)
PowerTemp = 0xffffffff; // AUTO
pAdapter->CommonCfg.TxPowerDefault = PowerTemp; //keep current setting.
pAdapter->CommonCfg.TxPowerPercentage = pAdapter->CommonCfg.TxPowerDefault;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_TX_POWER_LEVEL_1 (=%ld)\n", pAdapter->CommonCfg.TxPowerPercentage));
}
break;
case OID_802_11_NETWORK_TYPE_IN_USE:
if (wrq->u.data.length != sizeof(NDIS_802_11_NETWORK_TYPE))
Status = -EINVAL;
else
{
Status = copy_from_user(&NetType, wrq->u.data.pointer, wrq->u.data.length);
if (NetType == Ndis802_11DS)
RTMPSetPhyMode(pAdapter, PHY_11B);
else if (NetType == Ndis802_11OFDM24)
RTMPSetPhyMode(pAdapter, PHY_11BG_MIXED);
else if (NetType == Ndis802_11OFDM5)
RTMPSetPhyMode(pAdapter, PHY_11A);
else
Status = -EINVAL;
#ifdef DOT11_N_SUPPORT
if (Status == NDIS_STATUS_SUCCESS)
SetCommonHT(pAdapter);
#endif // DOT11_N_SUPPORT //
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_NETWORK_TYPE_IN_USE (=%d)\n",NetType));
}
break;
// For WPA PSK PMK key
case RT_OID_802_11_ADD_WPA:
pKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if(pKey == NULL)
{
Status = -ENOMEM;
break;
}
Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
if (pKey->Length != wrq->u.data.length)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA, Failed!!\n"));
}
else
{
if ((pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPAPSK) &&
(pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPA2PSK) &&
(pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPANone) )
{
Status = -EOPNOTSUPP;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA, Failed!! [AuthMode != WPAPSK/WPA2PSK/WPANONE]\n"));
}
else if ((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
(pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK) ||
(pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPANone) ) // Only for WPA PSK mode
{
NdisMoveMemory(pAdapter->StaCfg.PMK, &pKey->KeyMaterial, pKey->KeyLength);
// Use RaConfig as PSK agent.
// Start STA supplicant state machine
if (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPANone)
pAdapter->StaCfg.WpaState = SS_START;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
}
else
{
pAdapter->StaCfg.WpaState = SS_NOTUSE;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
}
}
kfree(pKey);
break;
case OID_802_11_REMOVE_KEY:
pRemoveKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if(pRemoveKey == NULL)
{
Status = -ENOMEM;
break;
}
Status = copy_from_user(pRemoveKey, wrq->u.data.pointer, wrq->u.data.length);
if (pRemoveKey->Length != wrq->u.data.length)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!\n"));
}
else
{
if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
{
RTMPWPARemoveKeyProc(pAdapter, pRemoveKey);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Remove WPA Key!!\n"));
}
else
{
KeyIdx = pRemoveKey->KeyIndex;
if (KeyIdx & 0x80000000)
{
// Should never set default bit when remove key
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!(Should never set default bit when remove key)\n"));
}
else
{
KeyIdx = KeyIdx & 0x0fffffff;
if (KeyIdx > 3)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!(KeyId[%d] out of range)\n", KeyIdx));
}
else
{
pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = 0;
pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_NONE;
AsicRemoveSharedKeyEntry(pAdapter, 0, (UCHAR)KeyIdx);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY (id=0x%x, Len=%d-byte)\n", pRemoveKey->KeyIndex, pRemoveKey->Length));
}
}
}
}
kfree(pRemoveKey);
break;
// New for WPA
case OID_802_11_ADD_KEY:
pKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if(pKey == NULL)
{
Status = -ENOMEM;
break;
}
Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
if (pKey->Length != wrq->u.data.length)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_KEY, Failed!!\n"));
}
else
{
RTMPAddKey(pAdapter, pKey);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_KEY (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
}
kfree(pKey);
break;
case OID_802_11_CONFIGURATION:
if (wrq->u.data.length != sizeof(NDIS_802_11_CONFIGURATION))
Status = -EINVAL;
else
{
Status = copy_from_user(&Config, wrq->u.data.pointer, wrq->u.data.length);
pConfig = &Config;
if ((pConfig->BeaconPeriod >= 20) && (pConfig->BeaconPeriod <=400))
pAdapter->CommonCfg.BeaconPeriod = (USHORT) pConfig->BeaconPeriod;
pAdapter->StaActive.AtimWin = (USHORT) pConfig->ATIMWindow;
MAP_KHZ_TO_CHANNEL_ID(pConfig->DSConfig, pAdapter->CommonCfg.Channel);
//
// Save the channel on MlmeAux for CntlOidRTBssidProc used.
//
pAdapter->MlmeAux.Channel = pAdapter->CommonCfg.Channel;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_CONFIGURATION (BeacnPeriod=%ld,AtimW=%ld,Ch=%d)\n",
pConfig->BeaconPeriod, pConfig->ATIMWindow, pAdapter->CommonCfg.Channel));
// Config has changed
pAdapter->bConfigChanged = TRUE;
}
break;
#ifdef DOT11_N_SUPPORT
case RT_OID_802_11_SET_HT_PHYMODE:
if (wrq->u.data.length != sizeof(OID_SET_HT_PHYMODE))
Status = -EINVAL;
else
{
POID_SET_HT_PHYMODE pHTPhyMode = &HT_PhyMode;
Status = copy_from_user(&HT_PhyMode, wrq->u.data.pointer, wrq->u.data.length);
DBGPRINT(RT_DEBUG_TRACE, ("Set::pHTPhyMode (PhyMode = %d,TransmitNo = %d, HtMode = %d, ExtOffset = %d , MCS = %d, BW = %d, STBC = %d, SHORTGI = %d) \n",
pHTPhyMode->PhyMode, pHTPhyMode->TransmitNo,pHTPhyMode->HtMode,pHTPhyMode->ExtOffset,
pHTPhyMode->MCS, pHTPhyMode->BW, pHTPhyMode->STBC, pHTPhyMode->SHORTGI));
if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED)
RTMPSetHT(pAdapter, pHTPhyMode);
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_HT_PHYMODE(MCS=%d,BW=%d,SGI=%d,STBC=%d)\n",
pAdapter->StaCfg.HTPhyMode.field.MCS, pAdapter->StaCfg.HTPhyMode.field.BW, pAdapter->StaCfg.HTPhyMode.field.ShortGI,
pAdapter->StaCfg.HTPhyMode.field.STBC));
break;
#endif // DOT11_N_SUPPORT //
case RT_OID_802_11_SET_APSD_SETTING:
if (wrq->u.data.length != sizeof(ULONG))
Status = -EINVAL;
else
{
ULONG apsd ;
Status = copy_from_user(&apsd, wrq->u.data.pointer, wrq->u.data.length);
/*-------------------------------------------------------------------
|B31~B7 | B6~B5 | B4 | B3 | B2 | B1 | B0 |
---------------------------------------------------------------------
| Rsvd | Max SP Len | AC_VO | AC_VI | AC_BK | AC_BE | APSD Capable |
---------------------------------------------------------------------*/
pAdapter->CommonCfg.bAPSDCapable = (apsd & 0x00000001) ? TRUE : FALSE;
pAdapter->CommonCfg.bAPSDAC_BE = ((apsd & 0x00000002) >> 1) ? TRUE : FALSE;
pAdapter->CommonCfg.bAPSDAC_BK = ((apsd & 0x00000004) >> 2) ? TRUE : FALSE;
pAdapter->CommonCfg.bAPSDAC_VI = ((apsd & 0x00000008) >> 3) ? TRUE : FALSE;
pAdapter->CommonCfg.bAPSDAC_VO = ((apsd & 0x00000010) >> 4) ? TRUE : FALSE;
pAdapter->CommonCfg.MaxSPLength = (UCHAR)((apsd & 0x00000060) >> 5);
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_APSD_SETTING (apsd=0x%lx, APSDCap=%d, [BE,BK,VI,VO]=[%d/%d/%d/%d], MaxSPLen=%d)\n", apsd, pAdapter->CommonCfg.bAPSDCapable,
pAdapter->CommonCfg.bAPSDAC_BE, pAdapter->CommonCfg.bAPSDAC_BK, pAdapter->CommonCfg.bAPSDAC_VI, pAdapter->CommonCfg.bAPSDAC_VO, pAdapter->CommonCfg.MaxSPLength));
}
break;
case RT_OID_802_11_SET_APSD_PSM:
if (wrq->u.data.length != sizeof(ULONG))
Status = -EINVAL;
else
{
// Driver needs to notify AP when PSM changes
Status = copy_from_user(&pAdapter->CommonCfg.bAPSDForcePowerSave, wrq->u.data.pointer, wrq->u.data.length);
if (pAdapter->CommonCfg.bAPSDForcePowerSave != pAdapter->StaCfg.Psm)
{
MlmeSetPsmBit(pAdapter, pAdapter->CommonCfg.bAPSDForcePowerSave);
RTMPSendNullFrame(pAdapter, pAdapter->CommonCfg.TxRate, TRUE);
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_APSD_PSM (bAPSDForcePowerSave:%d)\n", pAdapter->CommonCfg.bAPSDForcePowerSave));
}
break;
#ifdef QOS_DLS_SUPPORT
case RT_OID_802_11_SET_DLS:
if (wrq->u.data.length != sizeof(ULONG))
Status = -EINVAL;
else
{
BOOLEAN oldvalue = pAdapter->CommonCfg.bDLSCapable;
Status = copy_from_user(&pAdapter->CommonCfg.bDLSCapable, wrq->u.data.pointer, wrq->u.data.length);
if (oldvalue && !pAdapter->CommonCfg.bDLSCapable)
{
int i;
// tear down local dls table entry
for (i=0; i<MAX_NUM_OF_INIT_DLS_ENTRY; i++)
{
if (pAdapter->StaCfg.DLSEntry[i].Valid && (pAdapter->StaCfg.DLSEntry[i].Status == DLS_FINISH))
{
pAdapter->StaCfg.DLSEntry[i].Status = DLS_NONE;
pAdapter->StaCfg.DLSEntry[i].Valid = FALSE;
RTMPSendDLSTearDownFrame(pAdapter, pAdapter->StaCfg.DLSEntry[i].MacAddr);
}
}
// tear down peer dls table entry
for (i=MAX_NUM_OF_INIT_DLS_ENTRY; i<MAX_NUM_OF_DLS_ENTRY; i++)
{
if (pAdapter->StaCfg.DLSEntry[i].Valid && (pAdapter->StaCfg.DLSEntry[i].Status == DLS_FINISH))
{
pAdapter->StaCfg.DLSEntry[i].Status = DLS_NONE;
pAdapter->StaCfg.DLSEntry[i].Valid = FALSE;
RTMPSendDLSTearDownFrame(pAdapter, pAdapter->StaCfg.DLSEntry[i].MacAddr);
}
}
}
DBGPRINT(RT_DEBUG_TRACE,("Set::RT_OID_802_11_SET_DLS (=%d)\n", pAdapter->CommonCfg.bDLSCapable));
}
break;
case RT_OID_802_11_SET_DLS_PARAM:
if (wrq->u.data.length != sizeof(RT_802_11_DLS_UI))
Status = -EINVAL;
else
{
RT_802_11_DLS Dls;
NdisZeroMemory(&Dls, sizeof(RT_802_11_DLS));
RTMPMoveMemory(&Dls, wrq->u.data.pointer, sizeof(RT_802_11_DLS_UI));
MlmeEnqueue(pAdapter,
MLME_CNTL_STATE_MACHINE,
RT_OID_802_11_SET_DLS_PARAM,
sizeof(RT_802_11_DLS),
&Dls);
DBGPRINT(RT_DEBUG_TRACE,("Set::RT_OID_802_11_SET_DLS_PARAM \n"));
}
break;
#endif // QOS_DLS_SUPPORT //
case RT_OID_802_11_SET_WMM:
if (wrq->u.data.length != sizeof(BOOLEAN))
Status = -EINVAL;
else
{
Status = copy_from_user(&pAdapter->CommonCfg.bWmmCapable, wrq->u.data.pointer, wrq->u.data.length);
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_WMM (=%d) \n", pAdapter->CommonCfg.bWmmCapable));
}
break;
case OID_802_11_DISASSOCIATE:
#ifdef RALINK_ATE
if (ATE_ON(pAdapter))
{
DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
break;
}
#endif // RALINK_ATE //
//
// Set NdisRadioStateOff to TRUE, instead of called MlmeRadioOff.
// Later on, NDIS_802_11_BSSID_LIST_EX->NumberOfItems should be 0
// when query OID_802_11_BSSID_LIST.
//
// TRUE: NumberOfItems will set to 0.
// FALSE: NumberOfItems no change.
//
pAdapter->CommonCfg.NdisRadioStateOff = TRUE;
// Set to immediately send the media disconnect event
pAdapter->MlmeAux.CurrReqIsFromNdis = TRUE;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DISASSOCIATE \n"));
if (INFRA_ON(pAdapter))
{
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
{
RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
}
MlmeEnqueue(pAdapter,
MLME_CNTL_STATE_MACHINE,
OID_802_11_DISASSOCIATE,
0,
NULL);
StateMachineTouched = TRUE;
}
break;
#ifdef DOT11_N_SUPPORT
case RT_OID_802_11_SET_IMME_BA_CAP:
if (wrq->u.data.length != sizeof(OID_BACAP_STRUC))
Status = -EINVAL;
else
{
OID_BACAP_STRUC Orde ;
Status = copy_from_user(&Orde, wrq->u.data.pointer, wrq->u.data.length);
if (Orde.Policy > BA_NOTUSE)
{
Status = NDIS_STATUS_INVALID_DATA;
}
else if (Orde.Policy == BA_NOTUSE)
{
pAdapter->CommonCfg.BACapability.field.Policy = BA_NOTUSE;
pAdapter->CommonCfg.BACapability.field.MpduDensity = Orde.MpduDensity;
pAdapter->CommonCfg.DesiredHtPhy.MpduDensity = Orde.MpduDensity;
pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable = Orde.AmsduEnable;
pAdapter->CommonCfg.DesiredHtPhy.AmsduSize= Orde.AmsduSize;
pAdapter->CommonCfg.DesiredHtPhy.MimoPs= Orde.MMPSmode;
pAdapter->CommonCfg.BACapability.field.MMPSmode = Orde.MMPSmode;
// UPdata to HT IE
pAdapter->CommonCfg.HtCapability.HtCapInfo.MimoPs = Orde.MMPSmode;
pAdapter->CommonCfg.HtCapability.HtCapInfo.AMsduSize = Orde.AmsduSize;
pAdapter->CommonCfg.HtCapability.HtCapParm.MpduDensity = Orde.MpduDensity;
}
else
{
pAdapter->CommonCfg.BACapability.field.AutoBA = Orde.AutoBA;
pAdapter->CommonCfg.BACapability.field.Policy = IMMED_BA; // we only support immediate BA.
pAdapter->CommonCfg.BACapability.field.MpduDensity = Orde.MpduDensity;
pAdapter->CommonCfg.DesiredHtPhy.MpduDensity = Orde.MpduDensity;
pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable = Orde.AmsduEnable;
pAdapter->CommonCfg.DesiredHtPhy.AmsduSize= Orde.AmsduSize;
pAdapter->CommonCfg.DesiredHtPhy.MimoPs = Orde.MMPSmode;
pAdapter->CommonCfg.BACapability.field.MMPSmode = Orde.MMPSmode;
// UPdata to HT IE
pAdapter->CommonCfg.HtCapability.HtCapInfo.MimoPs = Orde.MMPSmode;
pAdapter->CommonCfg.HtCapability.HtCapInfo.AMsduSize = Orde.AmsduSize;
pAdapter->CommonCfg.HtCapability.HtCapParm.MpduDensity = Orde.MpduDensity;
if (pAdapter->CommonCfg.BACapability.field.RxBAWinLimit > MAX_RX_REORDERBUF)
pAdapter->CommonCfg.BACapability.field.RxBAWinLimit = MAX_RX_REORDERBUF;
}
pAdapter->CommonCfg.REGBACapability.word = pAdapter->CommonCfg.BACapability.word;
DBGPRINT(RT_DEBUG_TRACE, ("Set::(Orde.AutoBA = %d) (Policy=%d)(ReBAWinLimit=%d)(TxBAWinLimit=%d)(AutoMode=%d)\n",Orde.AutoBA, pAdapter->CommonCfg.BACapability.field.Policy,
pAdapter->CommonCfg.BACapability.field.RxBAWinLimit,pAdapter->CommonCfg.BACapability.field.TxBAWinLimit, pAdapter->CommonCfg.BACapability.field.AutoBA));
DBGPRINT(RT_DEBUG_TRACE, ("Set::(MimoPs = %d)(AmsduEnable = %d) (AmsduSize=%d)(MpduDensity=%d)\n",pAdapter->CommonCfg.DesiredHtPhy.MimoPs, pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable,
pAdapter->CommonCfg.DesiredHtPhy.AmsduSize, pAdapter->CommonCfg.DesiredHtPhy.MpduDensity));
}
break;
case RT_OID_802_11_ADD_IMME_BA:
DBGPRINT(RT_DEBUG_TRACE, (" Set :: RT_OID_802_11_ADD_IMME_BA \n"));
if (wrq->u.data.length != sizeof(OID_ADD_BA_ENTRY))
Status = -EINVAL;
else
{
UCHAR index;
OID_ADD_BA_ENTRY BA;
MAC_TABLE_ENTRY *pEntry;
Status = copy_from_user(&BA, wrq->u.data.pointer, wrq->u.data.length);
if (BA.TID > 15)
{
Status = NDIS_STATUS_INVALID_DATA;
break;
}
else
{
//BATableInsertEntry
//As ad-hoc mode, BA pair is not limited to only BSSID. so add via OID.
index = BA.TID;
// in ad hoc mode, when adding BA pair, we should insert this entry into MACEntry too
pEntry = MacTableLookup(pAdapter, BA.MACAddr);
if (!pEntry)
{
DBGPRINT(RT_DEBUG_TRACE, ("RT_OID_802_11_ADD_IMME_BA. break on no connection.----:%x:%x\n", BA.MACAddr[4], BA.MACAddr[5]));
break;
}
if (BA.IsRecipient == FALSE)
{
if (pEntry->bIAmBadAtheros == TRUE)
pAdapter->CommonCfg.BACapability.field.RxBAWinLimit = 0x10;
BAOriSessionSetUp(pAdapter, pEntry, index, 0, 100, TRUE);
}
else
{
//BATableInsertEntry(pAdapter, pEntry->Aid, BA.MACAddr, 0, 0xffff, BA.TID, BA.nMSDU, BA.IsRecipient);
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_IMME_BA. Rec = %d. Mac = %x:%x:%x:%x:%x:%x . \n",
BA.IsRecipient, BA.MACAddr[0], BA.MACAddr[1], BA.MACAddr[2], BA.MACAddr[2]
, BA.MACAddr[4], BA.MACAddr[5]));
}
}
break;
case RT_OID_802_11_TEAR_IMME_BA:
DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA \n"));
if (wrq->u.data.length != sizeof(OID_ADD_BA_ENTRY))
Status = -EINVAL;
else
{
POID_ADD_BA_ENTRY pBA;
MAC_TABLE_ENTRY *pEntry;
pBA = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if (pBA == NULL)
{
DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA kmalloc() can't allocate enough memory\n"));
Status = NDIS_STATUS_FAILURE;
}
else
{
Status = copy_from_user(pBA, wrq->u.data.pointer, wrq->u.data.length);
DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA(TID=%d, bAllTid=%d)\n", pBA->TID, pBA->bAllTid));
if (!pBA->bAllTid && (pBA->TID > NUM_OF_TID))
{
Status = NDIS_STATUS_INVALID_DATA;
break;
}
if (pBA->IsRecipient == FALSE)
{
pEntry = MacTableLookup(pAdapter, pBA->MACAddr);
DBGPRINT(RT_DEBUG_TRACE, (" pBA->IsRecipient == FALSE\n"));
if (pEntry)
{
DBGPRINT(RT_DEBUG_TRACE, (" pBA->pEntry\n"));
BAOriSessionTearDown(pAdapter, pEntry->Aid, pBA->TID, FALSE, TRUE);
}
else
DBGPRINT(RT_DEBUG_TRACE, ("Set :: Not found pEntry \n"));
}
else
{
pEntry = MacTableLookup(pAdapter, pBA->MACAddr);
if (pEntry)
{
BARecSessionTearDown( pAdapter, (UCHAR)pEntry->Aid, pBA->TID, TRUE);
}
else
DBGPRINT(RT_DEBUG_TRACE, ("Set :: Not found pEntry \n"));
}
kfree(pBA);
}
}
break;
#endif // DOT11_N_SUPPORT //
// For WPA_SUPPLICANT to set static wep key
case OID_802_11_ADD_WEP:
pWepKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if(pWepKey == NULL)
{
Status = -ENOMEM;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed!!\n"));
break;
}
Status = copy_from_user(pWepKey, wrq->u.data.pointer, wrq->u.data.length);
if (Status)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed (length mismatch)!!\n"));
}
else
{
KeyIdx = pWepKey->KeyIndex & 0x0fffffff;
// KeyIdx must be 0 ~ 3
if (KeyIdx > 4)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed (KeyIdx must be smaller than 4)!!\n"));
}
else
{
UCHAR CipherAlg = 0;
PUCHAR Key;
// set key material and key length
NdisZeroMemory(pAdapter->SharedKey[BSS0][KeyIdx].Key, 16);
pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = (UCHAR) pWepKey->KeyLength;
NdisMoveMemory(pAdapter->SharedKey[BSS0][KeyIdx].Key, &pWepKey->KeyMaterial, pWepKey->KeyLength);
switch(pWepKey->KeyLength)
{
case 5:
CipherAlg = CIPHER_WEP64;
break;
case 13:
CipherAlg = CIPHER_WEP128;
break;
default:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, only support CIPHER_WEP64(len:5) & CIPHER_WEP128(len:13)!!\n"));
Status = -EINVAL;
break;
}
pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CipherAlg;
// Default key for tx (shared key)
if (pWepKey->KeyIndex & 0x80000000)
{
#ifdef WPA_SUPPLICANT_SUPPORT
// set key material and key length
NdisZeroMemory(pAdapter->StaCfg.DesireSharedKey[KeyIdx].Key, 16);
pAdapter->StaCfg.DesireSharedKey[KeyIdx].KeyLen = (UCHAR) pWepKey->KeyLength;
NdisMoveMemory(pAdapter->StaCfg.DesireSharedKey[KeyIdx].Key, &pWepKey->KeyMaterial, pWepKey->KeyLength);
pAdapter->StaCfg.DesireSharedKeyId = KeyIdx;
pAdapter->StaCfg.DesireSharedKey[KeyIdx].CipherAlg = CipherAlg;
#endif // WPA_SUPPLICANT_SUPPORT //
pAdapter->StaCfg.DefaultKeyId = (UCHAR) KeyIdx;
}
#ifdef WPA_SUPPLICANT_SUPPORT
if ((pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE) &&
(pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA))
{
Key = pWepKey->KeyMaterial;
// Set Group key material to Asic
AsicAddSharedKeyEntry(pAdapter, BSS0, KeyIdx, CipherAlg, Key, NULL, NULL);
// Update WCID attribute table and IVEIV table for this group key table
RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, NULL);
STA_PORT_SECURED(pAdapter);
// Indicate Connected for GUI
pAdapter->IndicateMediaState = NdisMediaStateConnected;
}
else if (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_SECURED)
#endif // WPA_SUPPLICANT_SUPPORT
{
Key = pAdapter->SharedKey[BSS0][KeyIdx].Key;
// Set key material and cipherAlg to Asic
AsicAddSharedKeyEntry(pAdapter, BSS0, KeyIdx, CipherAlg, Key, NULL, NULL);
if (pWepKey->KeyIndex & 0x80000000)
{
PMAC_TABLE_ENTRY pEntry = &pAdapter->MacTab.Content[BSSID_WCID];
// Assign group key info
RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, NULL);
// Assign pairwise key info
RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, pEntry);
}
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP (id=0x%x, Len=%d-byte), %s\n", pWepKey->KeyIndex, pWepKey->KeyLength, (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_SECURED) ? "Port Secured":"Port NOT Secured"));
}
}
kfree(pWepKey);
break;
#ifdef WPA_SUPPLICANT_SUPPORT
case OID_SET_COUNTERMEASURES:
if (wrq->u.data.length != sizeof(int))
Status = -EINVAL;
else
{
int enabled = 0;
Status = copy_from_user(&enabled, wrq->u.data.pointer, wrq->u.data.length);
if (enabled == 1)
pAdapter->StaCfg.bBlockAssoc = TRUE;
else
// WPA MIC error should block association attempt for 60 seconds
pAdapter->StaCfg.bBlockAssoc = FALSE;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_SET_COUNTERMEASURES bBlockAssoc=%s\n", pAdapter->StaCfg.bBlockAssoc ? "TRUE":"FALSE"));
}
break;
case RT_OID_WPA_SUPPLICANT_SUPPORT:
if (wrq->u.data.length != sizeof(UCHAR))
Status = -EINVAL;
else
{
Status = copy_from_user(&wpa_supplicant_enable, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->StaCfg.WpaSupplicantUP = wpa_supplicant_enable;
DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_WPA_SUPPLICANT_SUPPORT (=%d)\n", pAdapter->StaCfg.WpaSupplicantUP));
}
break;
case OID_802_11_DEAUTHENTICATION:
if (wrq->u.data.length != sizeof(MLME_DEAUTH_REQ_STRUCT))
Status = -EINVAL;
else
{
MLME_DEAUTH_REQ_STRUCT *pInfo;
MLME_QUEUE_ELEM *MsgElem = (MLME_QUEUE_ELEM *) kmalloc(sizeof(MLME_QUEUE_ELEM), MEM_ALLOC_FLAG);
pInfo = (MLME_DEAUTH_REQ_STRUCT *) MsgElem->Msg;
Status = copy_from_user(pInfo, wrq->u.data.pointer, wrq->u.data.length);
MlmeDeauthReqAction(pAdapter, MsgElem);
kfree(MsgElem);
if (INFRA_ON(pAdapter))
{
LinkDown(pAdapter, FALSE);
pAdapter->Mlme.AssocMachine.CurrState = ASSOC_IDLE;
}
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DEAUTHENTICATION (Reason=%d)\n", pInfo->Reason));
}
break;
case OID_802_11_DROP_UNENCRYPTED:
if (wrq->u.data.length != sizeof(int))
Status = -EINVAL;
else
{
int enabled = 0;
Status = copy_from_user(&enabled, wrq->u.data.pointer, wrq->u.data.length);
if (enabled == 1)
pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
else
pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
NdisAcquireSpinLock(&pAdapter->MacTabLock);
pAdapter->MacTab.Content[BSSID_WCID].PortSecured = pAdapter->StaCfg.PortSecured;
NdisReleaseSpinLock(&pAdapter->MacTabLock);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DROP_UNENCRYPTED (=%d)\n", enabled));
}
break;
case OID_802_11_SET_IEEE8021X:
if (wrq->u.data.length != sizeof(BOOLEAN))
Status = -EINVAL;
else
{
Status = copy_from_user(&IEEE8021xState, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->StaCfg.IEEE8021X = IEEE8021xState;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SET_IEEE8021X (=%d)\n", IEEE8021xState));
}
break;
case OID_802_11_SET_IEEE8021X_REQUIRE_KEY:
if (wrq->u.data.length != sizeof(BOOLEAN))
Status = -EINVAL;
else
{
Status = copy_from_user(&IEEE8021x_required_keys, wrq->u.data.pointer, wrq->u.data.length);
pAdapter->StaCfg.IEEE8021x_required_keys = IEEE8021x_required_keys;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SET_IEEE8021X_REQUIRE_KEY (%d)\n", IEEE8021x_required_keys));
}
break;
case OID_802_11_PMKID:
pPmkId = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
if(pPmkId == NULL) {
Status = -ENOMEM;
break;
}
Status = copy_from_user(pPmkId, wrq->u.data.pointer, wrq->u.data.length);
// check the PMKID information
if (pPmkId->BSSIDInfoCount == 0)
NdisZeroMemory(pAdapter->StaCfg.SavedPMK, sizeof(BSSID_INFO)*PMKID_NO);
else
{
PBSSID_INFO pBssIdInfo;
UINT BssIdx;
UINT CachedIdx;
for (BssIdx = 0; BssIdx < pPmkId->BSSIDInfoCount; BssIdx++)
{
// point to the indexed BSSID_INFO structure
pBssIdInfo = (PBSSID_INFO) ((PUCHAR) pPmkId + 2 * sizeof(UINT) + BssIdx * sizeof(BSSID_INFO));
// Find the entry in the saved data base.
for (CachedIdx = 0; CachedIdx < pAdapter->StaCfg.SavedPMKNum; CachedIdx++)
{
// compare the BSSID
if (NdisEqualMemory(pBssIdInfo->BSSID, pAdapter->StaCfg.SavedPMK[CachedIdx].BSSID, sizeof(NDIS_802_11_MAC_ADDRESS)))
break;
}
// Found, replace it
if (CachedIdx < PMKID_NO)
{
DBGPRINT(RT_DEBUG_OFF, ("Update OID_802_11_PMKID, idx = %d\n", CachedIdx));
NdisMoveMemory(&pAdapter->StaCfg.SavedPMK[CachedIdx], pBssIdInfo, sizeof(BSSID_INFO));
pAdapter->StaCfg.SavedPMKNum++;
}
// Not found, replace the last one
else
{
// Randomly replace one
CachedIdx = (pBssIdInfo->BSSID[5] % PMKID_NO);
DBGPRINT(RT_DEBUG_OFF, ("Update OID_802_11_PMKID, idx = %d\n", CachedIdx));
NdisMoveMemory(&pAdapter->StaCfg.SavedPMK[CachedIdx], pBssIdInfo, sizeof(BSSID_INFO));
}
}
}
if(pPmkId)
kfree(pPmkId);
break;
#endif // WPA_SUPPLICANT_SUPPORT //
#ifdef SNMP_SUPPORT
case OID_802_11_SHORTRETRYLIMIT:
if (wrq->u.data.length != sizeof(ULONG))
Status = -EINVAL;
else
{
Status = copy_from_user(&ShortRetryLimit, wrq->u.data.pointer, wrq->u.data.length);
RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
tx_rty_cfg.field.ShortRtyLimit = ShortRetryLimit;
RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SHORTRETRYLIMIT (tx_rty_cfg.field.ShortRetryLimit=%d, ShortRetryLimit=%ld)\n", tx_rty_cfg.field.ShortRtyLimit, ShortRetryLimit));
}
break;
case OID_802_11_LONGRETRYLIMIT:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_LONGRETRYLIMIT \n"));
if (wrq->u.data.length != sizeof(ULONG))
Status = -EINVAL;
else
{
Status = copy_from_user(&LongRetryLimit, wrq->u.data.pointer, wrq->u.data.length);
RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
tx_rty_cfg.field.LongRtyLimit = LongRetryLimit;
RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_LONGRETRYLIMIT (tx_rty_cfg.field.LongRetryLimit= %d,LongRetryLimit=%ld)\n", tx_rty_cfg.field.LongRtyLimit, LongRetryLimit));
}
break;
case OID_802_11_WEPDEFAULTKEYVALUE:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYVALUE\n"));
pKey = kmalloc(wrq->u.data.length, GFP_KERNEL);
Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
//pKey = &WepKey;
if ( pKey->Length != wrq->u.data.length)
{
Status = -EINVAL;
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYVALUE, Failed!!\n"));
}
KeyIdx = pKey->KeyIndex & 0x0fffffff;
DBGPRINT(RT_DEBUG_TRACE,("pKey->KeyIndex =%d, pKey->KeyLength=%d\n", pKey->KeyIndex, pKey->KeyLength));
// it is a shared key
if (KeyIdx > 4)
Status = -EINVAL;
else
{
pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen = (UCHAR) pKey->KeyLength;
NdisMoveMemory(&pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].Key, &pKey->KeyMaterial, pKey->KeyLength);
if (pKey->KeyIndex & 0x80000000)
{
// Default key for tx (shared key)
pAdapter->StaCfg.DefaultKeyId = (UCHAR) KeyIdx;
}
//RestartAPIsRequired = TRUE;
}
break;
case OID_802_11_WEPDEFAULTKEYID:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYID \n"));
if (wrq->u.data.length != sizeof(UCHAR))
Status = -EINVAL;
else
Status = copy_from_user(&pAdapter->StaCfg.DefaultKeyId, wrq->u.data.pointer, wrq->u.data.length);
break;
case OID_802_11_CURRENTCHANNEL:
DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_CURRENTCHANNEL \n"));
if (wrq->u.data.length != sizeof(UCHAR))
Status = -EINVAL;
else
{
Status = copy_from_user(&ctmp, wrq->u.data.pointer, wrq->u.data.length);
sprintf(&ctmp,"%d", ctmp);
Set_Channel_Proc(pAdapter, &ctmp);
}
break;
#endif
default:
DBGPRINT(RT_DEBUG_TRACE, ("Set::unknown IOCTL's subcmd = 0x%08x\n", cmd));
Status = -EOPNOTSUPP;
break;
}
return Status;
}
Generated by GNU enscript 1.6.4.