![Dan Carpenter](/assets/img/avatar_default.png)
copy_to_user() returns the number of bytes remaining but we want to return a negative error code. This is in the ioctl handler and the error code gets passed to userspace. Signed-off-by: Dan Carpenter <error27@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2917 lines
85 KiB
C
2917 lines
85 KiB
C
/*
|
|
*************************************************************************
|
|
* Ralink Tech Inc.
|
|
* 5F., No.36, Taiyuan St., Jhubei City,
|
|
* Hsinchu County 302,
|
|
* Taiwan, R.O.C.
|
|
*
|
|
* (c) Copyright 2002-2007, Ralink Technology, Inc.
|
|
*
|
|
* 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., *
|
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
|
* *
|
|
*************************************************************************
|
|
|
|
Module Name:
|
|
sta_ioctl.c
|
|
|
|
Abstract:
|
|
IOCTL related subroutines
|
|
|
|
Revision History:
|
|
Who When What
|
|
-------- ---------- ----------------------------------------------
|
|
Rory Chen 01-03-2003 created
|
|
Rory Chen 02-14-2005 modify to support RT61
|
|
*/
|
|
|
|
#include "rt_config.h"
|
|
|
|
#ifdef DBG
|
|
extern unsigned long RTDebugLevel;
|
|
#endif
|
|
|
|
#define NR_WEP_KEYS 4
|
|
#define WEP_SMALL_KEY_LEN (40/8)
|
|
#define WEP_LARGE_KEY_LEN (104/8)
|
|
|
|
#define GROUP_KEY_NO 4
|
|
|
|
extern u8 CipherWpa2Template[];
|
|
|
|
struct PACKED rt_version_info {
|
|
u8 DriverVersionW;
|
|
u8 DriverVersionX;
|
|
u8 DriverVersionY;
|
|
u8 DriverVersionZ;
|
|
u32 DriverBuildYear;
|
|
u32 DriverBuildMonth;
|
|
u32 DriverBuildDay;
|
|
};
|
|
|
|
static __s32 ralinkrate[] = { 2, 4, 11, 22, /* CCK */
|
|
12, 18, 24, 36, 48, 72, 96, 108, /* OFDM */
|
|
13, 26, 39, 52, 78, 104, 117, 130, 26, 52, 78, 104, 156, 208, 234, 260, /* 20MHz, 800ns GI, MCS: 0 ~ 15 */
|
|
39, 78, 117, 156, 234, 312, 351, 390, /* 20MHz, 800ns GI, MCS: 16 ~ 23 */
|
|
27, 54, 81, 108, 162, 216, 243, 270, 54, 108, 162, 216, 324, 432, 486, 540, /* 40MHz, 800ns GI, MCS: 0 ~ 15 */
|
|
81, 162, 243, 324, 486, 648, 729, 810, /* 40MHz, 800ns GI, MCS: 16 ~ 23 */
|
|
14, 29, 43, 57, 87, 115, 130, 144, 29, 59, 87, 115, 173, 230, 260, 288, /* 20MHz, 400ns GI, MCS: 0 ~ 15 */
|
|
43, 87, 130, 173, 260, 317, 390, 433, /* 20MHz, 400ns GI, MCS: 16 ~ 23 */
|
|
30, 60, 90, 120, 180, 240, 270, 300, 60, 120, 180, 240, 360, 480, 540, 600, /* 40MHz, 400ns GI, MCS: 0 ~ 15 */
|
|
90, 180, 270, 360, 540, 720, 810, 900
|
|
};
|
|
|
|
int Set_SSID_Proc(struct rt_rtmp_adapter *pAdapter, char *arg);
|
|
|
|
int Set_NetworkType_Proc(struct rt_rtmp_adapter *pAdapter, char *arg);
|
|
|
|
void RTMPAddKey(struct rt_rtmp_adapter *pAd, struct rt_ndis_802_11_key *pKey)
|
|
{
|
|
unsigned long KeyIdx;
|
|
struct rt_mac_table_entry *pEntry;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("RTMPAddKey ------>\n"));
|
|
|
|
if (pAd->StaCfg.AuthMode >= Ndis802_11AuthModeWPA) {
|
|
if (pKey->KeyIndex & 0x80000000) {
|
|
if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone) {
|
|
NdisZeroMemory(pAd->StaCfg.PMK, 32);
|
|
NdisMoveMemory(pAd->StaCfg.PMK,
|
|
pKey->KeyMaterial,
|
|
pKey->KeyLength);
|
|
goto end;
|
|
}
|
|
/* Update PTK */
|
|
NdisZeroMemory(&pAd->SharedKey[BSS0][0],
|
|
sizeof(struct rt_cipher_key));
|
|
pAd->SharedKey[BSS0][0].KeyLen = LEN_TKIP_EK;
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][0].Key,
|
|
pKey->KeyMaterial, LEN_TKIP_EK);
|
|
|
|
if (pAd->StaCfg.PairCipher ==
|
|
Ndis802_11Encryption2Enabled) {
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][0].RxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK,
|
|
LEN_TKIP_TXMICK);
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][0].TxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK +
|
|
LEN_TKIP_TXMICK,
|
|
LEN_TKIP_RXMICK);
|
|
} else {
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][0].TxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK,
|
|
LEN_TKIP_TXMICK);
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][0].RxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK +
|
|
LEN_TKIP_TXMICK,
|
|
LEN_TKIP_RXMICK);
|
|
}
|
|
|
|
/* Decide its ChiperAlg */
|
|
if (pAd->StaCfg.PairCipher ==
|
|
Ndis802_11Encryption2Enabled)
|
|
pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_TKIP;
|
|
else if (pAd->StaCfg.PairCipher ==
|
|
Ndis802_11Encryption3Enabled)
|
|
pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_AES;
|
|
else
|
|
pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_NONE;
|
|
|
|
/* Update these related information to struct rt_mac_table_entry */
|
|
pEntry = &pAd->MacTab.Content[BSSID_WCID];
|
|
NdisMoveMemory(pEntry->PairwiseKey.Key,
|
|
pAd->SharedKey[BSS0][0].Key,
|
|
LEN_TKIP_EK);
|
|
NdisMoveMemory(pEntry->PairwiseKey.RxMic,
|
|
pAd->SharedKey[BSS0][0].RxMic,
|
|
LEN_TKIP_RXMICK);
|
|
NdisMoveMemory(pEntry->PairwiseKey.TxMic,
|
|
pAd->SharedKey[BSS0][0].TxMic,
|
|
LEN_TKIP_TXMICK);
|
|
pEntry->PairwiseKey.CipherAlg =
|
|
pAd->SharedKey[BSS0][0].CipherAlg;
|
|
|
|
/* Update pairwise key information to ASIC Shared Key Table */
|
|
AsicAddSharedKeyEntry(pAd,
|
|
BSS0,
|
|
0,
|
|
pAd->SharedKey[BSS0][0].CipherAlg,
|
|
pAd->SharedKey[BSS0][0].Key,
|
|
pAd->SharedKey[BSS0][0].TxMic,
|
|
pAd->SharedKey[BSS0][0].RxMic);
|
|
|
|
/* Update ASIC WCID attribute table and IVEIV table */
|
|
RTMPAddWcidAttributeEntry(pAd,
|
|
BSS0,
|
|
0,
|
|
pAd->SharedKey[BSS0][0].
|
|
CipherAlg, pEntry);
|
|
|
|
if (pAd->StaCfg.AuthMode >= Ndis802_11AuthModeWPA2) {
|
|
/* set 802.1x port control */
|
|
/*pAd->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAd);
|
|
|
|
/* Indicate Connected for GUI */
|
|
pAd->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
}
|
|
} else {
|
|
/* Update GTK */
|
|
pAd->StaCfg.DefaultKeyId = (pKey->KeyIndex & 0xFF);
|
|
NdisZeroMemory(&pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId],
|
|
sizeof(struct rt_cipher_key));
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].KeyLen =
|
|
LEN_TKIP_EK;
|
|
NdisMoveMemory(pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].Key,
|
|
pKey->KeyMaterial, LEN_TKIP_EK);
|
|
|
|
if (pAd->StaCfg.GroupCipher ==
|
|
Ndis802_11Encryption2Enabled) {
|
|
NdisMoveMemory(pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
RxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK,
|
|
LEN_TKIP_TXMICK);
|
|
NdisMoveMemory(pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
TxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK +
|
|
LEN_TKIP_TXMICK,
|
|
LEN_TKIP_RXMICK);
|
|
} else {
|
|
NdisMoveMemory(pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
TxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK,
|
|
LEN_TKIP_TXMICK);
|
|
NdisMoveMemory(pAd->
|
|
SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
RxMic,
|
|
pKey->KeyMaterial + LEN_TKIP_EK +
|
|
LEN_TKIP_TXMICK,
|
|
LEN_TKIP_RXMICK);
|
|
}
|
|
|
|
/* Update Shared Key CipherAlg */
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].
|
|
CipherAlg = CIPHER_NONE;
|
|
if (pAd->StaCfg.GroupCipher ==
|
|
Ndis802_11Encryption2Enabled)
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].
|
|
CipherAlg = CIPHER_TKIP;
|
|
else if (pAd->StaCfg.GroupCipher ==
|
|
Ndis802_11Encryption3Enabled)
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].
|
|
CipherAlg = CIPHER_AES;
|
|
|
|
/* Update group key information to ASIC Shared Key Table */
|
|
AsicAddSharedKeyEntry(pAd,
|
|
BSS0,
|
|
pAd->StaCfg.DefaultKeyId,
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
CipherAlg,
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
Key,
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
TxMic,
|
|
pAd->SharedKey[BSS0][pAd->StaCfg.
|
|
DefaultKeyId].
|
|
RxMic);
|
|
|
|
/* Update ASIC WCID attribute table and IVEIV table */
|
|
RTMPAddWcidAttributeEntry(pAd,
|
|
BSS0,
|
|
pAd->StaCfg.DefaultKeyId,
|
|
pAd->SharedKey[BSS0][pAd->
|
|
StaCfg.
|
|
DefaultKeyId].
|
|
CipherAlg, NULL);
|
|
|
|
/* set 802.1x port control */
|
|
/*pAd->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAd);
|
|
|
|
/* Indicate Connected for GUI */
|
|
pAd->IndicateMediaState = NdisMediaStateConnected;
|
|
}
|
|
} else /* dynamic WEP from wpa_supplicant */
|
|
{
|
|
u8 CipherAlg;
|
|
u8 *Key;
|
|
|
|
if (pKey->KeyLength == 32)
|
|
goto end;
|
|
|
|
KeyIdx = pKey->KeyIndex & 0x0fffffff;
|
|
|
|
if (KeyIdx < 4) {
|
|
/* it is a default shared key, for Pairwise key setting */
|
|
if (pKey->KeyIndex & 0x80000000) {
|
|
pEntry = MacTableLookup(pAd, pKey->BSSID);
|
|
|
|
if (pEntry) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("RTMPAddKey: Set Pair-wise Key\n"));
|
|
|
|
/* set key material and key length */
|
|
pEntry->PairwiseKey.KeyLen =
|
|
(u8)pKey->KeyLength;
|
|
NdisMoveMemory(pEntry->PairwiseKey.Key,
|
|
&pKey->KeyMaterial,
|
|
pKey->KeyLength);
|
|
|
|
/* set Cipher type */
|
|
if (pKey->KeyLength == 5)
|
|
pEntry->PairwiseKey.CipherAlg =
|
|
CIPHER_WEP64;
|
|
else
|
|
pEntry->PairwiseKey.CipherAlg =
|
|
CIPHER_WEP128;
|
|
|
|
/* Add Pair-wise key to Asic */
|
|
AsicAddPairwiseKeyEntry(pAd,
|
|
pEntry->Addr,
|
|
(u8)pEntry->
|
|
Aid,
|
|
&pEntry->
|
|
PairwiseKey);
|
|
|
|
/* update WCID attribute table and IVEIV table for this entry */
|
|
RTMPAddWcidAttributeEntry(pAd, BSS0, KeyIdx, /* The value may be not zero */
|
|
pEntry->
|
|
PairwiseKey.
|
|
CipherAlg,
|
|
pEntry);
|
|
|
|
}
|
|
} else {
|
|
/* Default key for tx (shared key) */
|
|
pAd->StaCfg.DefaultKeyId = (u8)KeyIdx;
|
|
|
|
/* set key material and key length */
|
|
pAd->SharedKey[BSS0][KeyIdx].KeyLen =
|
|
(u8)pKey->KeyLength;
|
|
NdisMoveMemory(pAd->SharedKey[BSS0][KeyIdx].Key,
|
|
&pKey->KeyMaterial,
|
|
pKey->KeyLength);
|
|
|
|
/* Set Ciper type */
|
|
if (pKey->KeyLength == 5)
|
|
pAd->SharedKey[BSS0][KeyIdx].CipherAlg =
|
|
CIPHER_WEP64;
|
|
else
|
|
pAd->SharedKey[BSS0][KeyIdx].CipherAlg =
|
|
CIPHER_WEP128;
|
|
|
|
CipherAlg =
|
|
pAd->SharedKey[BSS0][KeyIdx].CipherAlg;
|
|
Key = pAd->SharedKey[BSS0][KeyIdx].Key;
|
|
|
|
/* Set Group key material to Asic */
|
|
AsicAddSharedKeyEntry(pAd, BSS0, KeyIdx,
|
|
CipherAlg, Key, NULL,
|
|
NULL);
|
|
|
|
/* Update WCID attribute table and IVEIV table for this group key table */
|
|
RTMPAddWcidAttributeEntry(pAd, BSS0, KeyIdx,
|
|
CipherAlg, NULL);
|
|
|
|
}
|
|
}
|
|
}
|
|
end:
|
|
return;
|
|
}
|
|
|
|
char *rtstrchr(const char *s, int c)
|
|
{
|
|
for (; *s != (char)c; ++s)
|
|
if (*s == '\0')
|
|
return NULL;
|
|
return (char *)s;
|
|
}
|
|
|
|
/*
|
|
This is required for LinEX2004/kernel2.6.7 to provide iwlist scanning function
|
|
*/
|
|
|
|
int
|
|
rt_ioctl_giwname(struct net_device *dev,
|
|
struct iw_request_info *info, char *name, char *extra)
|
|
{
|
|
strncpy(name, "Ralink STA", IFNAMSIZ);
|
|
/* RT2870 2.1.0.0 uses "RT2870 Wireless" */
|
|
/* RT3090 2.1.0.0 uses "RT2860 Wireless" */
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwfreq(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_freq *freq, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
int chan = -1;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (freq->e > 1)
|
|
return -EINVAL;
|
|
|
|
if ((freq->e == 0) && (freq->m <= 1000))
|
|
chan = freq->m; /* Setting by channel number */
|
|
else
|
|
MAP_KHZ_TO_CHANNEL_ID((freq->m / 100), chan); /* Setting by frequency - search the table , like 2.412G, 2.422G, */
|
|
|
|
if (ChannelSanity(pAdapter, chan) == TRUE) {
|
|
pAdapter->CommonCfg.Channel = chan;
|
|
DBGPRINT(RT_DEBUG_ERROR,
|
|
("==>rt_ioctl_siwfreq::SIOCSIWFREQ[cmd=0x%x] (Channel=%d)\n",
|
|
SIOCSIWFREQ, pAdapter->CommonCfg.Channel));
|
|
} else
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwfreq(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_freq *freq, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
u8 ch;
|
|
unsigned long m = 2412000;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
ch = pAdapter->CommonCfg.Channel;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("==>rt_ioctl_giwfreq %d\n", ch));
|
|
|
|
MAP_CHANNEL_ID_TO_KHZ(ch, m);
|
|
freq->m = m * 100;
|
|
freq->e = 1;
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwmode(struct net_device *dev,
|
|
struct iw_request_info *info, __u32 * mode, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
switch (*mode) {
|
|
case IW_MODE_ADHOC:
|
|
Set_NetworkType_Proc(pAdapter, "Adhoc");
|
|
break;
|
|
case IW_MODE_INFRA:
|
|
Set_NetworkType_Proc(pAdapter, "Infra");
|
|
break;
|
|
case IW_MODE_MONITOR:
|
|
Set_NetworkType_Proc(pAdapter, "Monitor");
|
|
break;
|
|
default:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("===>rt_ioctl_siwmode::SIOCSIWMODE (unknown %d)\n",
|
|
*mode));
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Reset Ralink supplicant to not use, it will be set to start when UI set PMK key */
|
|
pAdapter->StaCfg.WpaState = SS_NOTUSE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwmode(struct net_device *dev,
|
|
struct iw_request_info *info, __u32 * mode, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
if (ADHOC_ON(pAdapter))
|
|
*mode = IW_MODE_ADHOC;
|
|
else if (INFRA_ON(pAdapter))
|
|
*mode = IW_MODE_INFRA;
|
|
else if (MONITOR_ON(pAdapter)) {
|
|
*mode = IW_MODE_MONITOR;
|
|
} else
|
|
*mode = IW_MODE_AUTO;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("==>rt_ioctl_giwmode(mode=%d)\n", *mode));
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwsens(struct net_device *dev,
|
|
struct iw_request_info *info, char *name, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwsens(struct net_device *dev,
|
|
struct iw_request_info *info, char *name, char *extra)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwrange(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
struct iw_range *range = (struct iw_range *)extra;
|
|
u16 val;
|
|
int i;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===>rt_ioctl_giwrange\n"));
|
|
data->length = sizeof(struct iw_range);
|
|
memset(range, 0, sizeof(struct iw_range));
|
|
|
|
range->txpower_capa = IW_TXPOW_DBM;
|
|
|
|
if (INFRA_ON(pAdapter) || ADHOC_ON(pAdapter)) {
|
|
range->min_pmp = 1 * 1024;
|
|
range->max_pmp = 65535 * 1024;
|
|
range->min_pmt = 1 * 1024;
|
|
range->max_pmt = 1000 * 1024;
|
|
range->pmp_flags = IW_POWER_PERIOD;
|
|
range->pmt_flags = IW_POWER_TIMEOUT;
|
|
range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT |
|
|
IW_POWER_UNICAST_R | IW_POWER_ALL_R;
|
|
}
|
|
|
|
range->we_version_compiled = WIRELESS_EXT;
|
|
range->we_version_source = 14;
|
|
|
|
range->retry_capa = IW_RETRY_LIMIT;
|
|
range->retry_flags = IW_RETRY_LIMIT;
|
|
range->min_retry = 0;
|
|
range->max_retry = 255;
|
|
|
|
range->num_channels = pAdapter->ChannelListNum;
|
|
|
|
val = 0;
|
|
for (i = 1; i <= range->num_channels; i++) {
|
|
u32 m = 2412000;
|
|
range->freq[val].i = pAdapter->ChannelList[i - 1].Channel;
|
|
MAP_CHANNEL_ID_TO_KHZ(pAdapter->ChannelList[i - 1].Channel, m);
|
|
range->freq[val].m = m * 100; /* OS_HZ */
|
|
|
|
range->freq[val].e = 1;
|
|
val++;
|
|
if (val == IW_MAX_FREQUENCIES)
|
|
break;
|
|
}
|
|
range->num_frequency = val;
|
|
|
|
range->max_qual.qual = 100; /* what is correct max? This was not
|
|
* documented exactly. At least
|
|
* 69 has been observed. */
|
|
range->max_qual.level = 0; /* dB */
|
|
range->max_qual.noise = 0; /* dB */
|
|
|
|
/* What would be suitable values for "average/typical" qual? */
|
|
range->avg_qual.qual = 20;
|
|
range->avg_qual.level = -60;
|
|
range->avg_qual.noise = -95;
|
|
range->sensitivity = 3;
|
|
|
|
range->max_encoding_tokens = NR_WEP_KEYS;
|
|
range->num_encoding_sizes = 2;
|
|
range->encoding_size[0] = 5;
|
|
range->encoding_size[1] = 13;
|
|
|
|
range->min_rts = 0;
|
|
range->max_rts = 2347;
|
|
range->min_frag = 256;
|
|
range->max_frag = 2346;
|
|
|
|
/* IW_ENC_CAPA_* bit field */
|
|
range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
|
|
IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwap(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct sockaddr *ap_addr, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
NDIS_802_11_MAC_ADDRESS Bssid;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE) {
|
|
RTMP_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;
|
|
/* Prevent to connect AP again in STAMlmePeriodicExec */
|
|
pAdapter->MlmeAux.AutoReconnectSsidLen = 32;
|
|
|
|
memcpy(Bssid, ap_addr->sa_data, MAC_ADDR_LEN);
|
|
MlmeEnqueue(pAdapter,
|
|
MLME_CNTL_STATE_MACHINE,
|
|
OID_802_11_BSSID,
|
|
sizeof(NDIS_802_11_MAC_ADDRESS), (void *) & Bssid);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("IOCTL::SIOCSIWAP %02x:%02x:%02x:%02x:%02x:%02x\n", Bssid[0],
|
|
Bssid[1], Bssid[2], Bssid[3], Bssid[4], Bssid[5]));
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwap(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct sockaddr *ap_addr, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
if (INFRA_ON(pAdapter) || ADHOC_ON(pAdapter)) {
|
|
ap_addr->sa_family = ARPHRD_ETHER;
|
|
memcpy(ap_addr->sa_data, &pAdapter->CommonCfg.Bssid, ETH_ALEN);
|
|
}
|
|
/* Add for RT2870 */
|
|
else if (pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE) {
|
|
ap_addr->sa_family = ARPHRD_ETHER;
|
|
memcpy(ap_addr->sa_data, &pAdapter->MlmeAux.Bssid, ETH_ALEN);
|
|
} else {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("IOCTL::SIOCGIWAP(=EMPTY)\n"));
|
|
return -ENOTCONN;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Units are in db above the noise floor. That means the
|
|
* rssi values reported in the tx/rx descriptors in the
|
|
* driver are the SNR expressed in db.
|
|
*
|
|
* If you assume that the noise floor is -95, which is an
|
|
* excellent assumption 99.5 % of the time, then you can
|
|
* derive the absolute signal level (i.e. -95 + rssi).
|
|
* There are some other slight factors to take into account
|
|
* depending on whether the rssi measurement is from 11b,
|
|
* 11g, or 11a. These differences are at most 2db and
|
|
* can be documented.
|
|
*
|
|
* NB: various calculations are based on the orinoco/wavelan
|
|
* drivers for compatibility
|
|
*/
|
|
static void set_quality(struct rt_rtmp_adapter *pAdapter,
|
|
struct iw_quality *iq, signed char rssi)
|
|
{
|
|
__u8 ChannelQuality;
|
|
|
|
/* Normalize Rssi */
|
|
if (rssi >= -50)
|
|
ChannelQuality = 100;
|
|
else if (rssi >= -80) /* between -50 ~ -80dbm */
|
|
ChannelQuality = (__u8) (24 + ((rssi + 80) * 26) / 10);
|
|
else if (rssi >= -90) /* between -80 ~ -90dbm */
|
|
ChannelQuality = (__u8) ((rssi + 90) * 26) / 10;
|
|
else
|
|
ChannelQuality = 0;
|
|
|
|
iq->qual = (__u8) ChannelQuality;
|
|
|
|
iq->level = (__u8) (rssi);
|
|
iq->noise = (pAdapter->BbpWriteLatch[66] > pAdapter->BbpTuning.FalseCcaUpperThreshold) ? ((__u8) pAdapter->BbpTuning.FalseCcaUpperThreshold) : ((__u8) pAdapter->BbpWriteLatch[66]); /* noise level (dBm) */
|
|
iq->noise += 256 - 143;
|
|
iq->updated = pAdapter->iw_stats.qual.updated;
|
|
}
|
|
|
|
int rt_ioctl_iwaplist(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
struct sockaddr addr[IW_MAX_AP];
|
|
struct iw_quality qual[IW_MAX_AP];
|
|
int i;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
data->length = 0;
|
|
return 0;
|
|
/*return -ENETDOWN; */
|
|
}
|
|
|
|
for (i = 0; i < IW_MAX_AP; i++) {
|
|
if (i >= pAdapter->ScanTab.BssNr)
|
|
break;
|
|
addr[i].sa_family = ARPHRD_ETHER;
|
|
memcpy(addr[i].sa_data, &pAdapter->ScanTab.BssEntry[i].Bssid,
|
|
MAC_ADDR_LEN);
|
|
set_quality(pAdapter, &qual[i],
|
|
pAdapter->ScanTab.BssEntry[i].Rssi);
|
|
}
|
|
data->length = i;
|
|
memcpy(extra, &addr, i * sizeof(addr[0]));
|
|
data->flags = 1; /* signal quality present (sort of) */
|
|
memcpy(extra + i * sizeof(addr[0]), &qual, i * sizeof(qual[i]));
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwscan(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
unsigned long Now;
|
|
int Status = NDIS_STATUS_SUCCESS;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (MONITOR_ON(pAdapter)) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Driver is in Monitor Mode now!\n"));
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE) {
|
|
pAdapter->StaCfg.WpaSupplicantScanCount++;
|
|
}
|
|
|
|
pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
|
|
if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
|
|
return NDIS_STATUS_SUCCESS;
|
|
do {
|
|
Now = jiffies;
|
|
|
|
if ((pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE)
|
|
&& (pAdapter->StaCfg.WpaSupplicantScanCount > 3)) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("WpaSupplicantScanCount > 3\n"));
|
|
Status = NDIS_STATUS_SUCCESS;
|
|
break;
|
|
}
|
|
|
|
if ((OPSTATUS_TEST_FLAG
|
|
(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED))
|
|
&& ((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA)
|
|
|| (pAdapter->StaCfg.AuthMode ==
|
|
Ndis802_11AuthModeWPAPSK))
|
|
&& (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;
|
|
break;
|
|
}
|
|
|
|
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE) {
|
|
RTMP_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;
|
|
|
|
MlmeEnqueue(pAdapter,
|
|
MLME_CNTL_STATE_MACHINE,
|
|
OID_802_11_BSSID_LIST_SCAN, 0, NULL);
|
|
|
|
Status = NDIS_STATUS_SUCCESS;
|
|
RTMP_MLME_HANDLER(pAdapter);
|
|
} while (0);
|
|
return NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
int rt_ioctl_giwscan(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
int i = 0;
|
|
char *current_ev = extra, *previous_ev = extra;
|
|
char *end_buf;
|
|
char *current_val;
|
|
char custom[MAX_CUSTOM_LEN] = { 0 };
|
|
struct iw_event iwe;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS)) {
|
|
/*
|
|
* Still scanning, indicate the caller should try again.
|
|
*/
|
|
return -EAGAIN;
|
|
}
|
|
|
|
if (pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE) {
|
|
pAdapter->StaCfg.WpaSupplicantScanCount = 0;
|
|
}
|
|
|
|
if (pAdapter->ScanTab.BssNr == 0) {
|
|
data->length = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (data->length > 0)
|
|
end_buf = extra + data->length;
|
|
else
|
|
end_buf = extra + IW_SCAN_MAX_DATA;
|
|
|
|
for (i = 0; i < pAdapter->ScanTab.BssNr; i++) {
|
|
if (current_ev >= end_buf) {
|
|
return -E2BIG;
|
|
}
|
|
/*MAC address */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWAP;
|
|
iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
|
|
memcpy(iwe.u.ap_addr.sa_data,
|
|
&pAdapter->ScanTab.BssEntry[i].Bssid, ETH_ALEN);
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_event(info, current_ev, end_buf, &iwe,
|
|
IW_EV_ADDR_LEN);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*
|
|
Protocol:
|
|
it will show scanned AP's WirelessMode .
|
|
it might be
|
|
802.11a
|
|
802.11a/n
|
|
802.11g/n
|
|
802.11b/g/n
|
|
802.11g
|
|
802.11b/g
|
|
*/
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWNAME;
|
|
|
|
{
|
|
struct rt_bss_entry *pBssEntry = &pAdapter->ScanTab.BssEntry[i];
|
|
BOOLEAN isGonly = FALSE;
|
|
int rateCnt = 0;
|
|
|
|
if (pBssEntry->Channel > 14) {
|
|
if (pBssEntry->HtCapabilityLen != 0)
|
|
strcpy(iwe.u.name, "802.11a/n");
|
|
else
|
|
strcpy(iwe.u.name, "802.11a");
|
|
} else {
|
|
/*
|
|
if one of non B mode rate is set supported rate . it mean G only.
|
|
*/
|
|
for (rateCnt = 0;
|
|
rateCnt < pBssEntry->SupRateLen;
|
|
rateCnt++) {
|
|
/*
|
|
6Mbps(140) 9Mbps(146) and >=12Mbps(152) are supported rate , it mean G only.
|
|
*/
|
|
if (pBssEntry->SupRate[rateCnt] == 140
|
|
|| pBssEntry->SupRate[rateCnt] ==
|
|
146
|
|
|| pBssEntry->SupRate[rateCnt] >=
|
|
152)
|
|
isGonly = TRUE;
|
|
}
|
|
|
|
for (rateCnt = 0;
|
|
rateCnt < pBssEntry->ExtRateLen;
|
|
rateCnt++) {
|
|
if (pBssEntry->ExtRate[rateCnt] == 140
|
|
|| pBssEntry->ExtRate[rateCnt] ==
|
|
146
|
|
|| pBssEntry->ExtRate[rateCnt] >=
|
|
152)
|
|
isGonly = TRUE;
|
|
}
|
|
|
|
if (pBssEntry->HtCapabilityLen != 0) {
|
|
if (isGonly == TRUE)
|
|
strcpy(iwe.u.name, "802.11g/n");
|
|
else
|
|
strcpy(iwe.u.name,
|
|
"802.11b/g/n");
|
|
} else {
|
|
if (isGonly == TRUE)
|
|
strcpy(iwe.u.name, "802.11g");
|
|
else {
|
|
if (pBssEntry->SupRateLen == 4
|
|
&& pBssEntry->ExtRateLen ==
|
|
0)
|
|
strcpy(iwe.u.name,
|
|
"802.11b");
|
|
else
|
|
strcpy(iwe.u.name,
|
|
"802.11b/g");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_event(info, current_ev, end_buf, &iwe,
|
|
IW_EV_ADDR_LEN);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*ESSID */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWESSID;
|
|
iwe.u.data.length = pAdapter->ScanTab.BssEntry[i].SsidLen;
|
|
iwe.u.data.flags = 1;
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_point(info, current_ev, end_buf, &iwe,
|
|
(char *)pAdapter->ScanTab.
|
|
BssEntry[i].Ssid);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*Network Type */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWMODE;
|
|
if (pAdapter->ScanTab.BssEntry[i].BssType == Ndis802_11IBSS) {
|
|
iwe.u.mode = IW_MODE_ADHOC;
|
|
} else if (pAdapter->ScanTab.BssEntry[i].BssType ==
|
|
Ndis802_11Infrastructure) {
|
|
iwe.u.mode = IW_MODE_INFRA;
|
|
} else {
|
|
iwe.u.mode = IW_MODE_AUTO;
|
|
}
|
|
iwe.len = IW_EV_UINT_LEN;
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_event(info, current_ev, end_buf, &iwe,
|
|
IW_EV_UINT_LEN);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*Channel and Frequency */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWFREQ;
|
|
iwe.u.freq.m = pAdapter->ScanTab.BssEntry[i].Channel;
|
|
iwe.u.freq.e = 0;
|
|
iwe.u.freq.i = 0;
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_event(info, current_ev, end_buf, &iwe,
|
|
IW_EV_FREQ_LEN);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*Add quality statistics */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = IWEVQUAL;
|
|
iwe.u.qual.level = 0;
|
|
iwe.u.qual.noise = 0;
|
|
set_quality(pAdapter, &iwe.u.qual,
|
|
pAdapter->ScanTab.BssEntry[i].Rssi);
|
|
current_ev =
|
|
iwe_stream_add_event(info, current_ev, end_buf, &iwe,
|
|
IW_EV_QUAL_LEN);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*Encyption key */
|
|
/*================================ */
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWENCODE;
|
|
if (CAP_IS_PRIVACY_ON
|
|
(pAdapter->ScanTab.BssEntry[i].CapabilityInfo))
|
|
iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
|
|
else
|
|
iwe.u.data.flags = IW_ENCODE_DISABLED;
|
|
|
|
previous_ev = current_ev;
|
|
current_ev =
|
|
iwe_stream_add_point(info, current_ev, end_buf, &iwe,
|
|
(char *)pAdapter->
|
|
SharedKey[BSS0][(iwe.u.data.
|
|
flags &
|
|
IW_ENCODE_INDEX) -
|
|
1].Key);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
|
|
/*Bit Rate */
|
|
/*================================ */
|
|
if (pAdapter->ScanTab.BssEntry[i].SupRateLen) {
|
|
u8 tmpRate =
|
|
pAdapter->ScanTab.BssEntry[i].SupRate[pAdapter->
|
|
ScanTab.
|
|
BssEntry[i].
|
|
SupRateLen -
|
|
1];
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
iwe.cmd = SIOCGIWRATE;
|
|
current_val = current_ev + IW_EV_LCP_LEN;
|
|
if (tmpRate == 0x82)
|
|
iwe.u.bitrate.value = 1 * 1000000;
|
|
else if (tmpRate == 0x84)
|
|
iwe.u.bitrate.value = 2 * 1000000;
|
|
else if (tmpRate == 0x8B)
|
|
iwe.u.bitrate.value = 5.5 * 1000000;
|
|
else if (tmpRate == 0x96)
|
|
iwe.u.bitrate.value = 11 * 1000000;
|
|
else
|
|
iwe.u.bitrate.value = (tmpRate / 2) * 1000000;
|
|
|
|
if (tmpRate == 0x6c
|
|
&& pAdapter->ScanTab.BssEntry[i].HtCapabilityLen >
|
|
0) {
|
|
int rate_count = ARRAY_SIZE(ralinkrate);
|
|
struct rt_ht_cap_info capInfo =
|
|
pAdapter->ScanTab.BssEntry[i].HtCapability.
|
|
HtCapInfo;
|
|
int shortGI =
|
|
capInfo.ChannelWidth ? capInfo.
|
|
ShortGIfor40 : capInfo.ShortGIfor20;
|
|
int maxMCS =
|
|
pAdapter->ScanTab.BssEntry[i].HtCapability.
|
|
MCSSet[1] ? 15 : 7;
|
|
int rate_index =
|
|
12 + ((u8)capInfo.ChannelWidth * 24) +
|
|
((u8)shortGI * 48) + ((u8)maxMCS);
|
|
|
|
if (rate_index < 0)
|
|
rate_index = 0;
|
|
if (rate_index >= rate_count)
|
|
rate_index = rate_count - 1;
|
|
iwe.u.bitrate.value =
|
|
ralinkrate[rate_index] * 500000;
|
|
}
|
|
|
|
iwe.u.bitrate.disabled = 0;
|
|
current_val = iwe_stream_add_value(info, current_ev,
|
|
current_val, end_buf,
|
|
&iwe,
|
|
IW_EV_PARAM_LEN);
|
|
|
|
if ((current_val - current_ev) > IW_EV_LCP_LEN)
|
|
current_ev = current_val;
|
|
else
|
|
return -E2BIG;
|
|
}
|
|
/*WPA IE */
|
|
if (pAdapter->ScanTab.BssEntry[i].WpaIE.IELen > 0) {
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
memset(&custom[0], 0, MAX_CUSTOM_LEN);
|
|
memcpy(custom,
|
|
&(pAdapter->ScanTab.BssEntry[i].WpaIE.IE[0]),
|
|
pAdapter->ScanTab.BssEntry[i].WpaIE.IELen);
|
|
iwe.cmd = IWEVGENIE;
|
|
iwe.u.data.length =
|
|
pAdapter->ScanTab.BssEntry[i].WpaIE.IELen;
|
|
current_ev =
|
|
iwe_stream_add_point(info, current_ev, end_buf,
|
|
&iwe, custom);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
}
|
|
/*WPA2 IE */
|
|
if (pAdapter->ScanTab.BssEntry[i].RsnIE.IELen > 0) {
|
|
memset(&iwe, 0, sizeof(iwe));
|
|
memset(&custom[0], 0, MAX_CUSTOM_LEN);
|
|
memcpy(custom,
|
|
&(pAdapter->ScanTab.BssEntry[i].RsnIE.IE[0]),
|
|
pAdapter->ScanTab.BssEntry[i].RsnIE.IELen);
|
|
iwe.cmd = IWEVGENIE;
|
|
iwe.u.data.length =
|
|
pAdapter->ScanTab.BssEntry[i].RsnIE.IELen;
|
|
current_ev =
|
|
iwe_stream_add_point(info, current_ev, end_buf,
|
|
&iwe, custom);
|
|
if (current_ev == previous_ev)
|
|
return -E2BIG;
|
|
}
|
|
}
|
|
|
|
data->length = current_ev - extra;
|
|
pAdapter->StaCfg.bScanReqIsFromWebUI = FALSE;
|
|
DBGPRINT(RT_DEBUG_ERROR,
|
|
("===>rt_ioctl_giwscan. %d(%d) BSS returned, data->length = %d\n",
|
|
i, pAdapter->ScanTab.BssNr, data->length));
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwessid(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *essid)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (data->flags) {
|
|
char *pSsidString = NULL;
|
|
|
|
/* Includes null character. */
|
|
if (data->length > (IW_ESSID_MAX_SIZE + 1))
|
|
return -E2BIG;
|
|
|
|
pSsidString = kmalloc(MAX_LEN_OF_SSID + 1, MEM_ALLOC_FLAG);
|
|
if (pSsidString) {
|
|
NdisZeroMemory(pSsidString, MAX_LEN_OF_SSID + 1);
|
|
NdisMoveMemory(pSsidString, essid, data->length);
|
|
if (Set_SSID_Proc(pAdapter, pSsidString) == FALSE)
|
|
return -EINVAL;
|
|
} else
|
|
return -ENOMEM;
|
|
} else {
|
|
/* ANY ssid */
|
|
if (Set_SSID_Proc(pAdapter, "") == FALSE)
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwessid(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *essid)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
data->flags = 1;
|
|
if (MONITOR_ON(pAdapter)) {
|
|
data->length = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (OPSTATUS_TEST_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("MediaState is connected\n"));
|
|
data->length = pAdapter->CommonCfg.SsidLen;
|
|
memcpy(essid, pAdapter->CommonCfg.Ssid,
|
|
pAdapter->CommonCfg.SsidLen);
|
|
}
|
|
#ifdef RTMP_MAC_USB
|
|
/* Add for RT2870 */
|
|
else if (pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE) {
|
|
data->length = pAdapter->CommonCfg.SsidLen;
|
|
memcpy(essid, pAdapter->CommonCfg.Ssid,
|
|
pAdapter->CommonCfg.SsidLen);
|
|
}
|
|
#endif /* RTMP_MAC_USB // */
|
|
else { /*the ANY ssid was specified */
|
|
data->length = 0;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("MediaState is not connected, ess\n"));
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
int rt_ioctl_siwnickn(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *nickname)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (data->length > IW_ESSID_MAX_SIZE)
|
|
return -EINVAL;
|
|
|
|
memset(pAdapter->nickname, 0, IW_ESSID_MAX_SIZE + 1);
|
|
memcpy(pAdapter->nickname, nickname, data->length);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwnickn(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *data, char *nickname)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
if (data->length > strlen((char *)pAdapter->nickname) + 1)
|
|
data->length = strlen((char *)pAdapter->nickname) + 1;
|
|
if (data->length > 0) {
|
|
memcpy(nickname, pAdapter->nickname, data->length - 1);
|
|
nickname[data->length - 1] = '\0';
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwrts(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_param *rts, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
u16 val;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (rts->disabled)
|
|
val = MAX_RTS_THRESHOLD;
|
|
else if (rts->value < 0 || rts->value > MAX_RTS_THRESHOLD)
|
|
return -EINVAL;
|
|
else if (rts->value == 0)
|
|
val = MAX_RTS_THRESHOLD;
|
|
else
|
|
val = rts->value;
|
|
|
|
if (val != pAdapter->CommonCfg.RtsThreshold)
|
|
pAdapter->CommonCfg.RtsThreshold = val;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwrts(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_param *rts, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
rts->value = pAdapter->CommonCfg.RtsThreshold;
|
|
rts->disabled = (rts->value == MAX_RTS_THRESHOLD);
|
|
rts->fixed = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwfrag(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_param *frag, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
u16 val;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (frag->disabled)
|
|
val = MAX_FRAG_THRESHOLD;
|
|
else if (frag->value >= MIN_FRAG_THRESHOLD
|
|
&& frag->value <= MAX_FRAG_THRESHOLD)
|
|
val = __cpu_to_le16(frag->value & ~0x1); /* even numbers only */
|
|
else if (frag->value == 0)
|
|
val = MAX_FRAG_THRESHOLD;
|
|
else
|
|
return -EINVAL;
|
|
|
|
pAdapter->CommonCfg.FragmentThreshold = val;
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwfrag(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_param *frag, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
frag->value = pAdapter->CommonCfg.FragmentThreshold;
|
|
frag->disabled = (frag->value == MAX_FRAG_THRESHOLD);
|
|
frag->fixed = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
#define MAX_WEP_KEY_SIZE 13
|
|
#define MIN_WEP_KEY_SIZE 5
|
|
int rt_ioctl_siwencode(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *erq, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if ((erq->length == 0) && (erq->flags & IW_ENCODE_DISABLED)) {
|
|
pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
|
|
goto done;
|
|
} else if (erq->flags & IW_ENCODE_RESTRICTED
|
|
|| erq->flags & IW_ENCODE_OPEN) {
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
pAdapter->StaCfg.PairCipher = Ndis802_11WEPEnabled;
|
|
pAdapter->StaCfg.GroupCipher = Ndis802_11WEPEnabled;
|
|
pAdapter->StaCfg.WepStatus = Ndis802_11WEPEnabled;
|
|
pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
|
|
if (erq->flags & IW_ENCODE_RESTRICTED)
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeShared;
|
|
else
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
|
|
}
|
|
|
|
if (erq->length > 0) {
|
|
int keyIdx = (erq->flags & IW_ENCODE_INDEX) - 1;
|
|
/* Check the size of the key */
|
|
if (erq->length > MAX_WEP_KEY_SIZE) {
|
|
return -EINVAL;
|
|
}
|
|
/* Check key index */
|
|
if ((keyIdx < 0) || (keyIdx >= NR_WEP_KEYS)) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("==>rt_ioctl_siwencode::Wrong keyIdx=%d! Using default key instead (%d)\n",
|
|
keyIdx, pAdapter->StaCfg.DefaultKeyId));
|
|
|
|
/*Using default key */
|
|
keyIdx = pAdapter->StaCfg.DefaultKeyId;
|
|
} else
|
|
pAdapter->StaCfg.DefaultKeyId = keyIdx;
|
|
|
|
NdisZeroMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, 16);
|
|
|
|
if (erq->length == MAX_WEP_KEY_SIZE) {
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen =
|
|
MAX_WEP_KEY_SIZE;
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg =
|
|
CIPHER_WEP128;
|
|
} else if (erq->length == MIN_WEP_KEY_SIZE) {
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen =
|
|
MIN_WEP_KEY_SIZE;
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg =
|
|
CIPHER_WEP64;
|
|
} else
|
|
/* Disable the key */
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen = 0;
|
|
|
|
/* Check if the key is not marked as invalid */
|
|
if (!(erq->flags & IW_ENCODE_NOKEY)) {
|
|
/* Copy the key in the driver */
|
|
NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key,
|
|
extra, erq->length);
|
|
}
|
|
} else {
|
|
/* Do we want to just set the transmit key index ? */
|
|
int index = (erq->flags & IW_ENCODE_INDEX) - 1;
|
|
if ((index >= 0) && (index < 4)) {
|
|
pAdapter->StaCfg.DefaultKeyId = index;
|
|
} else
|
|
/* Don't complain if only change the mode */
|
|
if (!(erq->flags & IW_ENCODE_MODE))
|
|
return -EINVAL;
|
|
}
|
|
|
|
done:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("==>rt_ioctl_siwencode::erq->flags=%x\n", erq->flags));
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("==>rt_ioctl_siwencode::AuthMode=%x\n",
|
|
pAdapter->StaCfg.AuthMode));
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("==>rt_ioctl_siwencode::DefaultKeyId=%x, KeyLen = %d\n",
|
|
pAdapter->StaCfg.DefaultKeyId,
|
|
pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].
|
|
KeyLen));
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("==>rt_ioctl_siwencode::WepStatus=%x\n",
|
|
pAdapter->StaCfg.WepStatus));
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
rt_ioctl_giwencode(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
struct iw_point *erq, char *key)
|
|
{
|
|
int kid;
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
kid = erq->flags & IW_ENCODE_INDEX;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("===>rt_ioctl_giwencode %d\n", erq->flags & IW_ENCODE_INDEX));
|
|
|
|
if (pAdapter->StaCfg.WepStatus == Ndis802_11WEPDisabled) {
|
|
erq->length = 0;
|
|
erq->flags = IW_ENCODE_DISABLED;
|
|
} else if ((kid > 0) && (kid <= 4)) {
|
|
/* copy wep key */
|
|
erq->flags = kid; /* NB: base 1 */
|
|
if (erq->length > pAdapter->SharedKey[BSS0][kid - 1].KeyLen)
|
|
erq->length = pAdapter->SharedKey[BSS0][kid - 1].KeyLen;
|
|
memcpy(key, pAdapter->SharedKey[BSS0][kid - 1].Key,
|
|
erq->length);
|
|
/*if ((kid == pAdapter->PortCfg.DefaultKeyId)) */
|
|
/*erq->flags |= IW_ENCODE_ENABLED; */ /* XXX */
|
|
if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
|
|
erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
|
|
else
|
|
erq->flags |= IW_ENCODE_OPEN; /* XXX */
|
|
|
|
} else if (kid == 0) {
|
|
if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
|
|
erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
|
|
else
|
|
erq->flags |= IW_ENCODE_OPEN; /* XXX */
|
|
erq->length =
|
|
pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].
|
|
KeyLen;
|
|
memcpy(key,
|
|
pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].
|
|
Key, erq->length);
|
|
/* copy default key ID */
|
|
if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
|
|
erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
|
|
else
|
|
erq->flags |= IW_ENCODE_OPEN; /* XXX */
|
|
erq->flags = pAdapter->StaCfg.DefaultKeyId + 1; /* NB: base 1 */
|
|
erq->flags |= IW_ENCODE_ENABLED; /* XXX */
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
void getBaInfo(struct rt_rtmp_adapter *pAd, char *pOutBuf)
|
|
{
|
|
int i, j;
|
|
struct rt_ba_ori_entry *pOriBAEntry;
|
|
struct rt_ba_rec_entry *pRecBAEntry;
|
|
|
|
for (i = 0; i < MAX_LEN_OF_MAC_TABLE; i++) {
|
|
struct rt_mac_table_entry *pEntry = &pAd->MacTab.Content[i];
|
|
if (((pEntry->ValidAsCLI || pEntry->ValidAsApCli)
|
|
&& (pEntry->Sst == SST_ASSOC))
|
|
|| (pEntry->ValidAsWDS) || (pEntry->ValidAsMesh)) {
|
|
sprintf(pOutBuf + strlen(pOutBuf),
|
|
"\n%02X:%02X:%02X:%02X:%02X:%02X (Aid = %d) (AP) -\n",
|
|
pEntry->Addr[0], pEntry->Addr[1],
|
|
pEntry->Addr[2], pEntry->Addr[3],
|
|
pEntry->Addr[4], pEntry->Addr[5], pEntry->Aid);
|
|
|
|
sprintf(pOutBuf, "%s[Recipient]\n", pOutBuf);
|
|
for (j = 0; j < NUM_OF_TID; j++) {
|
|
if (pEntry->BARecWcidArray[j] != 0) {
|
|
pRecBAEntry =
|
|
&pAd->BATable.BARecEntry[pEntry->
|
|
BARecWcidArray
|
|
[j]];
|
|
sprintf(pOutBuf + strlen(pOutBuf),
|
|
"TID=%d, BAWinSize=%d, LastIndSeq=%d, ReorderingPkts=%d\n",
|
|
j, pRecBAEntry->BAWinSize,
|
|
pRecBAEntry->LastIndSeq,
|
|
pRecBAEntry->list.qlen);
|
|
}
|
|
}
|
|
sprintf(pOutBuf, "%s\n", pOutBuf);
|
|
|
|
sprintf(pOutBuf, "%s[Originator]\n", pOutBuf);
|
|
for (j = 0; j < NUM_OF_TID; j++) {
|
|
if (pEntry->BAOriWcidArray[j] != 0) {
|
|
pOriBAEntry =
|
|
&pAd->BATable.BAOriEntry[pEntry->
|
|
BAOriWcidArray
|
|
[j]];
|
|
sprintf(pOutBuf + strlen(pOutBuf),
|
|
"TID=%d, BAWinSize=%d, StartSeq=%d, CurTxSeq=%d\n",
|
|
j, pOriBAEntry->BAWinSize,
|
|
pOriBAEntry->Sequence,
|
|
pEntry->TxSeq[j]);
|
|
}
|
|
}
|
|
sprintf(pOutBuf, "%s\n\n", pOutBuf);
|
|
}
|
|
if (strlen(pOutBuf) > (IW_PRIV_SIZE_MASK - 30))
|
|
break;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
int rt_ioctl_siwmlme(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
struct iw_mlme *pMlme = (struct iw_mlme *)wrqu->data.pointer;
|
|
struct rt_mlme_queue_elem MsgElem;
|
|
struct rt_mlme_disassoc_req DisAssocReq;
|
|
struct rt_mlme_deauth_req DeAuthReq;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("====> %s\n", __func__));
|
|
|
|
if (pMlme == NULL)
|
|
return -EINVAL;
|
|
|
|
switch (pMlme->cmd) {
|
|
#ifdef IW_MLME_DEAUTH
|
|
case IW_MLME_DEAUTH:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("====> %s - IW_MLME_DEAUTH\n", __func__));
|
|
COPY_MAC_ADDR(DeAuthReq.Addr, pAd->CommonCfg.Bssid);
|
|
DeAuthReq.Reason = pMlme->reason_code;
|
|
MsgElem.MsgLen = sizeof(struct rt_mlme_deauth_req);
|
|
NdisMoveMemory(MsgElem.Msg, &DeAuthReq,
|
|
sizeof(struct rt_mlme_deauth_req));
|
|
MlmeDeauthReqAction(pAd, &MsgElem);
|
|
if (INFRA_ON(pAd)) {
|
|
LinkDown(pAd, FALSE);
|
|
pAd->Mlme.AssocMachine.CurrState = ASSOC_IDLE;
|
|
}
|
|
break;
|
|
#endif /* IW_MLME_DEAUTH // */
|
|
#ifdef IW_MLME_DISASSOC
|
|
case IW_MLME_DISASSOC:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("====> %s - IW_MLME_DISASSOC\n", __func__));
|
|
COPY_MAC_ADDR(DisAssocReq.Addr, pAd->CommonCfg.Bssid);
|
|
DisAssocReq.Reason = pMlme->reason_code;
|
|
|
|
MsgElem.Machine = ASSOC_STATE_MACHINE;
|
|
MsgElem.MsgType = MT2_MLME_DISASSOC_REQ;
|
|
MsgElem.MsgLen = sizeof(struct rt_mlme_disassoc_req);
|
|
NdisMoveMemory(MsgElem.Msg, &DisAssocReq,
|
|
sizeof(struct rt_mlme_disassoc_req));
|
|
|
|
pAd->Mlme.CntlMachine.CurrState = CNTL_WAIT_OID_DISASSOC;
|
|
MlmeDisassocReqAction(pAd, &MsgElem);
|
|
break;
|
|
#endif /* IW_MLME_DISASSOC // */
|
|
default:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("====> %s - Unknow Command\n", __func__));
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwauth(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
struct iw_param *param = &wrqu->param;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
switch (param->flags & IW_AUTH_INDEX) {
|
|
case IW_AUTH_WPA_VERSION:
|
|
if (param->value == IW_AUTH_WPA_VERSION_WPA) {
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPAPSK;
|
|
if (pAdapter->StaCfg.BssType == BSS_ADHOC)
|
|
pAdapter->StaCfg.AuthMode =
|
|
Ndis802_11AuthModeWPANone;
|
|
} else if (param->value == IW_AUTH_WPA_VERSION_WPA2)
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA2PSK;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_WPA_VERSION - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_CIPHER_PAIRWISE:
|
|
if (param->value == IW_AUTH_CIPHER_NONE) {
|
|
pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.OrigWepStatus =
|
|
pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
|
|
} else if (param->value == IW_AUTH_CIPHER_WEP40 ||
|
|
param->value == IW_AUTH_CIPHER_WEP104) {
|
|
pAdapter->StaCfg.WepStatus = Ndis802_11WEPEnabled;
|
|
pAdapter->StaCfg.OrigWepStatus =
|
|
pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.PairCipher = Ndis802_11WEPEnabled;
|
|
pAdapter->StaCfg.IEEE8021X = FALSE;
|
|
} else if (param->value == IW_AUTH_CIPHER_TKIP) {
|
|
pAdapter->StaCfg.WepStatus =
|
|
Ndis802_11Encryption2Enabled;
|
|
pAdapter->StaCfg.OrigWepStatus =
|
|
pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.PairCipher =
|
|
Ndis802_11Encryption2Enabled;
|
|
} else if (param->value == IW_AUTH_CIPHER_CCMP) {
|
|
pAdapter->StaCfg.WepStatus =
|
|
Ndis802_11Encryption3Enabled;
|
|
pAdapter->StaCfg.OrigWepStatus =
|
|
pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.PairCipher =
|
|
Ndis802_11Encryption3Enabled;
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_CIPHER_PAIRWISE - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_CIPHER_GROUP:
|
|
if (param->value == IW_AUTH_CIPHER_NONE) {
|
|
pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
|
|
} else if (param->value == IW_AUTH_CIPHER_WEP40 ||
|
|
param->value == IW_AUTH_CIPHER_WEP104) {
|
|
pAdapter->StaCfg.GroupCipher = Ndis802_11WEPEnabled;
|
|
} else if (param->value == IW_AUTH_CIPHER_TKIP) {
|
|
pAdapter->StaCfg.GroupCipher =
|
|
Ndis802_11Encryption2Enabled;
|
|
} else if (param->value == IW_AUTH_CIPHER_CCMP) {
|
|
pAdapter->StaCfg.GroupCipher =
|
|
Ndis802_11Encryption3Enabled;
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_CIPHER_GROUP - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_KEY_MGMT:
|
|
if (param->value == IW_AUTH_KEY_MGMT_802_1X) {
|
|
if (pAdapter->StaCfg.AuthMode ==
|
|
Ndis802_11AuthModeWPAPSK) {
|
|
pAdapter->StaCfg.AuthMode =
|
|
Ndis802_11AuthModeWPA;
|
|
pAdapter->StaCfg.IEEE8021X = FALSE;
|
|
} else if (pAdapter->StaCfg.AuthMode ==
|
|
Ndis802_11AuthModeWPA2PSK) {
|
|
pAdapter->StaCfg.AuthMode =
|
|
Ndis802_11AuthModeWPA2;
|
|
pAdapter->StaCfg.IEEE8021X = FALSE;
|
|
} else
|
|
/* WEP 1x */
|
|
pAdapter->StaCfg.IEEE8021X = TRUE;
|
|
} else if (param->value == 0) {
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_KEY_MGMT - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_RX_UNENCRYPTED_EAPOL:
|
|
break;
|
|
case IW_AUTH_PRIVACY_INVOKED:
|
|
/*if (param->value == 0)
|
|
{
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
|
|
pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
|
|
pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
|
|
pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
|
|
} */
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_PRIVACY_INVOKED - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_DROP_UNENCRYPTED:
|
|
if (param->value != 0)
|
|
pAdapter->StaCfg.PortSecured =
|
|
WPA_802_1X_PORT_NOT_SECURED;
|
|
else {
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_WPA_VERSION - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_80211_AUTH_ALG:
|
|
if (param->value & IW_AUTH_ALG_SHARED_KEY) {
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeShared;
|
|
} else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
|
|
} else
|
|
return -EINVAL;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_80211_AUTH_ALG - param->value = %d!\n",
|
|
__func__, param->value));
|
|
break;
|
|
case IW_AUTH_WPA_ENABLED:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_AUTH_WPA_ENABLED - Driver supports WPA!(param->value = %d)\n",
|
|
__func__, param->value));
|
|
break;
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwauth(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
struct iw_param *param = &wrqu->param;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
switch (param->flags & IW_AUTH_INDEX) {
|
|
case IW_AUTH_DROP_UNENCRYPTED:
|
|
param->value =
|
|
(pAdapter->StaCfg.WepStatus ==
|
|
Ndis802_11WEPDisabled) ? 0 : 1;
|
|
break;
|
|
|
|
case IW_AUTH_80211_AUTH_ALG:
|
|
param->value =
|
|
(pAdapter->StaCfg.AuthMode ==
|
|
Ndis802_11AuthModeShared) ? IW_AUTH_ALG_SHARED_KEY :
|
|
IW_AUTH_ALG_OPEN_SYSTEM;
|
|
break;
|
|
|
|
case IW_AUTH_WPA_ENABLED:
|
|
param->value =
|
|
(pAdapter->StaCfg.AuthMode >=
|
|
Ndis802_11AuthModeWPA) ? 1 : 0;
|
|
break;
|
|
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_giwauth::param->value = %d!\n", param->value));
|
|
return 0;
|
|
}
|
|
|
|
void fnSetCipherKey(struct rt_rtmp_adapter *pAdapter,
|
|
int keyIdx,
|
|
u8 CipherAlg,
|
|
IN BOOLEAN bGTK, IN struct iw_encode_ext *ext)
|
|
{
|
|
NdisZeroMemory(&pAdapter->SharedKey[BSS0][keyIdx], sizeof(struct rt_cipher_key));
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen = LEN_TKIP_EK;
|
|
NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, ext->key,
|
|
LEN_TKIP_EK);
|
|
NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].TxMic,
|
|
ext->key + LEN_TKIP_EK, LEN_TKIP_TXMICK);
|
|
NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].RxMic,
|
|
ext->key + LEN_TKIP_EK + LEN_TKIP_TXMICK,
|
|
LEN_TKIP_RXMICK);
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CipherAlg;
|
|
|
|
/* Update group key information to ASIC Shared Key Table */
|
|
AsicAddSharedKeyEntry(pAdapter,
|
|
BSS0,
|
|
keyIdx,
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg,
|
|
pAdapter->SharedKey[BSS0][keyIdx].Key,
|
|
pAdapter->SharedKey[BSS0][keyIdx].TxMic,
|
|
pAdapter->SharedKey[BSS0][keyIdx].RxMic);
|
|
|
|
if (bGTK)
|
|
/* Update ASIC WCID attribute table and IVEIV table */
|
|
RTMPAddWcidAttributeEntry(pAdapter,
|
|
BSS0,
|
|
keyIdx,
|
|
pAdapter->SharedKey[BSS0][keyIdx].
|
|
CipherAlg, NULL);
|
|
else
|
|
/* Update ASIC WCID attribute table and IVEIV table */
|
|
RTMPAddWcidAttributeEntry(pAdapter,
|
|
BSS0,
|
|
keyIdx,
|
|
pAdapter->SharedKey[BSS0][keyIdx].
|
|
CipherAlg,
|
|
&pAdapter->MacTab.
|
|
Content[BSSID_WCID]);
|
|
}
|
|
|
|
int rt_ioctl_siwencodeext(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAdapter = NULL;
|
|
struct iw_point *encoding = &wrqu->encoding;
|
|
struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
|
|
int keyIdx, alg = ext->alg;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAdapter, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if (encoding->flags & IW_ENCODE_DISABLED) {
|
|
keyIdx = (encoding->flags & IW_ENCODE_INDEX) - 1;
|
|
/* set BSSID wcid entry of the Pair-wise Key table as no-security mode */
|
|
AsicRemovePairwiseKeyEntry(pAdapter, BSS0, BSSID_WCID);
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen = 0;
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_NONE;
|
|
AsicRemoveSharedKeyEntry(pAdapter, 0, (u8)keyIdx);
|
|
NdisZeroMemory(&pAdapter->SharedKey[BSS0][keyIdx],
|
|
sizeof(struct rt_cipher_key));
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::Remove all keys!(encoding->flags = %x)\n",
|
|
__func__, encoding->flags));
|
|
} else {
|
|
/* Get Key Index and convet to our own defined key index */
|
|
keyIdx = (encoding->flags & IW_ENCODE_INDEX) - 1;
|
|
if ((keyIdx < 0) || (keyIdx >= NR_WEP_KEYS))
|
|
return -EINVAL;
|
|
|
|
if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
|
|
pAdapter->StaCfg.DefaultKeyId = keyIdx;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::DefaultKeyId = %d\n", __func__,
|
|
pAdapter->StaCfg.DefaultKeyId));
|
|
}
|
|
|
|
switch (alg) {
|
|
case IW_ENCODE_ALG_NONE:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_ENCODE_ALG_NONE\n", __func__));
|
|
break;
|
|
case IW_ENCODE_ALG_WEP:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_ENCODE_ALG_WEP - ext->key_len = %d, keyIdx = %d\n",
|
|
__func__, ext->key_len, keyIdx));
|
|
if (ext->key_len == MAX_WEP_KEY_SIZE) {
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen =
|
|
MAX_WEP_KEY_SIZE;
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg =
|
|
CIPHER_WEP128;
|
|
} else if (ext->key_len == MIN_WEP_KEY_SIZE) {
|
|
pAdapter->SharedKey[BSS0][keyIdx].KeyLen =
|
|
MIN_WEP_KEY_SIZE;
|
|
pAdapter->SharedKey[BSS0][keyIdx].CipherAlg =
|
|
CIPHER_WEP64;
|
|
} else
|
|
return -EINVAL;
|
|
|
|
NdisZeroMemory(pAdapter->SharedKey[BSS0][keyIdx].Key,
|
|
16);
|
|
NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key,
|
|
ext->key, ext->key_len);
|
|
if (pAdapter->StaCfg.GroupCipher ==
|
|
Ndis802_11GroupWEP40Enabled
|
|
|| pAdapter->StaCfg.GroupCipher ==
|
|
Ndis802_11GroupWEP104Enabled) {
|
|
/* Set Group key material to Asic */
|
|
AsicAddSharedKeyEntry(pAdapter, BSS0, keyIdx,
|
|
pAdapter->
|
|
SharedKey[BSS0][keyIdx].
|
|
CipherAlg,
|
|
pAdapter->
|
|
SharedKey[BSS0][keyIdx].
|
|
Key, NULL, NULL);
|
|
|
|
/* Update WCID attribute table and IVEIV table for this group key table */
|
|
RTMPAddWcidAttributeEntry(pAdapter, BSS0,
|
|
keyIdx,
|
|
pAdapter->
|
|
SharedKey[BSS0]
|
|
[keyIdx].CipherAlg,
|
|
NULL);
|
|
|
|
STA_PORT_SECURED(pAdapter);
|
|
|
|
/* Indicate Connected for GUI */
|
|
pAdapter->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
}
|
|
break;
|
|
case IW_ENCODE_ALG_TKIP:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("%s::IW_ENCODE_ALG_TKIP - keyIdx = %d, ext->key_len = %d\n",
|
|
__func__, keyIdx, ext->key_len));
|
|
if (ext->key_len == 32) {
|
|
if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
|
|
fnSetCipherKey(pAdapter, keyIdx,
|
|
CIPHER_TKIP, FALSE, ext);
|
|
if (pAdapter->StaCfg.AuthMode >=
|
|
Ndis802_11AuthModeWPA2) {
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
pAdapter->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
}
|
|
} else if (ext->
|
|
ext_flags & IW_ENCODE_EXT_GROUP_KEY)
|
|
{
|
|
fnSetCipherKey(pAdapter, keyIdx,
|
|
CIPHER_TKIP, TRUE, ext);
|
|
|
|
/* set 802.1x port control */
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
pAdapter->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
}
|
|
} else
|
|
return -EINVAL;
|
|
break;
|
|
case IW_ENCODE_ALG_CCMP:
|
|
if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
|
|
fnSetCipherKey(pAdapter, keyIdx, CIPHER_AES,
|
|
FALSE, ext);
|
|
if (pAdapter->StaCfg.AuthMode >=
|
|
Ndis802_11AuthModeWPA2)
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
pAdapter->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
} else if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
|
|
fnSetCipherKey(pAdapter, keyIdx, CIPHER_AES,
|
|
TRUE, ext);
|
|
|
|
/* set 802.1x port control */
|
|
/*pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED; */
|
|
STA_PORT_SECURED(pAdapter);
|
|
pAdapter->IndicateMediaState =
|
|
NdisMediaStateConnected;
|
|
}
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
rt_ioctl_giwencodeext(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
char *pKey = NULL;
|
|
struct iw_point *encoding = &wrqu->encoding;
|
|
struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
|
|
int idx, max_key_len;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===> rt_ioctl_giwencodeext\n"));
|
|
|
|
max_key_len = encoding->length - sizeof(*ext);
|
|
if (max_key_len < 0)
|
|
return -EINVAL;
|
|
|
|
idx = encoding->flags & IW_ENCODE_INDEX;
|
|
if (idx) {
|
|
if (idx < 1 || idx > 4)
|
|
return -EINVAL;
|
|
idx--;
|
|
|
|
if ((pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled) ||
|
|
(pAd->StaCfg.WepStatus == Ndis802_11Encryption3Enabled)) {
|
|
if (idx != pAd->StaCfg.DefaultKeyId) {
|
|
ext->key_len = 0;
|
|
return 0;
|
|
}
|
|
}
|
|
} else
|
|
idx = pAd->StaCfg.DefaultKeyId;
|
|
|
|
encoding->flags = idx + 1;
|
|
memset(ext, 0, sizeof(*ext));
|
|
|
|
ext->key_len = 0;
|
|
switch (pAd->StaCfg.WepStatus) {
|
|
case Ndis802_11WEPDisabled:
|
|
ext->alg = IW_ENCODE_ALG_NONE;
|
|
encoding->flags |= IW_ENCODE_DISABLED;
|
|
break;
|
|
case Ndis802_11WEPEnabled:
|
|
ext->alg = IW_ENCODE_ALG_WEP;
|
|
if (pAd->SharedKey[BSS0][idx].KeyLen > max_key_len)
|
|
return -E2BIG;
|
|
else {
|
|
ext->key_len = pAd->SharedKey[BSS0][idx].KeyLen;
|
|
pKey = (char *)& (pAd->SharedKey[BSS0][idx].Key[0]);
|
|
}
|
|
break;
|
|
case Ndis802_11Encryption2Enabled:
|
|
case Ndis802_11Encryption3Enabled:
|
|
if (pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled)
|
|
ext->alg = IW_ENCODE_ALG_TKIP;
|
|
else
|
|
ext->alg = IW_ENCODE_ALG_CCMP;
|
|
|
|
if (max_key_len < 32)
|
|
return -E2BIG;
|
|
else {
|
|
ext->key_len = 32;
|
|
pKey = (char *)& pAd->StaCfg.PMK[0];
|
|
}
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (ext->key_len && pKey) {
|
|
encoding->flags |= IW_ENCODE_ENABLED;
|
|
memcpy(ext->key, pKey, ext->key_len);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwgenie(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===> rt_ioctl_siwgenie\n"));
|
|
pAd->StaCfg.bRSN_IE_FromWpaSupplicant = FALSE;
|
|
if (wrqu->data.length > MAX_LEN_OF_RSNIE ||
|
|
(wrqu->data.length && extra == NULL))
|
|
return -EINVAL;
|
|
|
|
if (wrqu->data.length) {
|
|
pAd->StaCfg.RSNIE_Len = wrqu->data.length;
|
|
NdisMoveMemory(&pAd->StaCfg.RSN_IE[0], extra,
|
|
pAd->StaCfg.RSNIE_Len);
|
|
pAd->StaCfg.bRSN_IE_FromWpaSupplicant = TRUE;
|
|
} else {
|
|
pAd->StaCfg.RSNIE_Len = 0;
|
|
NdisZeroMemory(&pAd->StaCfg.RSN_IE[0], MAX_LEN_OF_RSNIE);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwgenie(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
if ((pAd->StaCfg.RSNIE_Len == 0) ||
|
|
(pAd->StaCfg.AuthMode < Ndis802_11AuthModeWPA)) {
|
|
wrqu->data.length = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (pAd->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE) {
|
|
if (wrqu->data.length < pAd->StaCfg.RSNIE_Len)
|
|
return -E2BIG;
|
|
|
|
wrqu->data.length = pAd->StaCfg.RSNIE_Len;
|
|
memcpy(extra, &pAd->StaCfg.RSN_IE[0], pAd->StaCfg.RSNIE_Len);
|
|
} else {
|
|
u8 RSNIe = IE_WPA;
|
|
|
|
if (wrqu->data.length < (pAd->StaCfg.RSNIE_Len + 2)) /* ID, Len */
|
|
return -E2BIG;
|
|
wrqu->data.length = pAd->StaCfg.RSNIE_Len + 2;
|
|
|
|
if ((pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK) ||
|
|
(pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2))
|
|
RSNIe = IE_RSN;
|
|
|
|
extra[0] = (char)RSNIe;
|
|
extra[1] = pAd->StaCfg.RSNIE_Len;
|
|
memcpy(extra + 2, &pAd->StaCfg.RSN_IE[0],
|
|
pAd->StaCfg.RSNIE_Len);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwpmksa(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
struct iw_pmksa *pPmksa = (struct iw_pmksa *)wrqu->data.pointer;
|
|
int CachedIdx = 0, idx = 0;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
if (pPmksa == NULL)
|
|
return -EINVAL;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===> rt_ioctl_siwpmksa\n"));
|
|
switch (pPmksa->cmd) {
|
|
case IW_PMKSA_FLUSH:
|
|
NdisZeroMemory(pAd->StaCfg.SavedPMK,
|
|
sizeof(struct rt_bssid_info) * PMKID_NO);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwpmksa - IW_PMKSA_FLUSH\n"));
|
|
break;
|
|
case IW_PMKSA_REMOVE:
|
|
for (CachedIdx = 0; CachedIdx < pAd->StaCfg.SavedPMKNum;
|
|
CachedIdx++) {
|
|
/* compare the BSSID */
|
|
if (NdisEqualMemory
|
|
(pPmksa->bssid.sa_data,
|
|
pAd->StaCfg.SavedPMK[CachedIdx].BSSID,
|
|
MAC_ADDR_LEN)) {
|
|
NdisZeroMemory(pAd->StaCfg.SavedPMK[CachedIdx].
|
|
BSSID, MAC_ADDR_LEN);
|
|
NdisZeroMemory(pAd->StaCfg.SavedPMK[CachedIdx].
|
|
PMKID, 16);
|
|
for (idx = CachedIdx;
|
|
idx < (pAd->StaCfg.SavedPMKNum - 1);
|
|
idx++) {
|
|
NdisMoveMemory(&pAd->StaCfg.
|
|
SavedPMK[idx].BSSID[0],
|
|
&pAd->StaCfg.
|
|
SavedPMK[idx +
|
|
1].BSSID[0],
|
|
MAC_ADDR_LEN);
|
|
NdisMoveMemory(&pAd->StaCfg.
|
|
SavedPMK[idx].PMKID[0],
|
|
&pAd->StaCfg.
|
|
SavedPMK[idx +
|
|
1].PMKID[0],
|
|
16);
|
|
}
|
|
pAd->StaCfg.SavedPMKNum--;
|
|
break;
|
|
}
|
|
}
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwpmksa - IW_PMKSA_REMOVE\n"));
|
|
break;
|
|
case IW_PMKSA_ADD:
|
|
for (CachedIdx = 0; CachedIdx < pAd->StaCfg.SavedPMKNum;
|
|
CachedIdx++) {
|
|
/* compare the BSSID */
|
|
if (NdisEqualMemory
|
|
(pPmksa->bssid.sa_data,
|
|
pAd->StaCfg.SavedPMK[CachedIdx].BSSID,
|
|
MAC_ADDR_LEN))
|
|
break;
|
|
}
|
|
|
|
/* Found, replace it */
|
|
if (CachedIdx < PMKID_NO) {
|
|
DBGPRINT(RT_DEBUG_OFF,
|
|
("Update PMKID, idx = %d\n", CachedIdx));
|
|
NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].
|
|
BSSID[0], pPmksa->bssid.sa_data,
|
|
MAC_ADDR_LEN);
|
|
NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].
|
|
PMKID[0], pPmksa->pmkid, 16);
|
|
pAd->StaCfg.SavedPMKNum++;
|
|
}
|
|
/* Not found, replace the last one */
|
|
else {
|
|
/* Randomly replace one */
|
|
CachedIdx = (pPmksa->bssid.sa_data[5] % PMKID_NO);
|
|
DBGPRINT(RT_DEBUG_OFF,
|
|
("Update PMKID, idx = %d\n", CachedIdx));
|
|
NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].
|
|
BSSID[0], pPmksa->bssid.sa_data,
|
|
MAC_ADDR_LEN);
|
|
NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].
|
|
PMKID[0], pPmksa->pmkid, 16);
|
|
}
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwpmksa - IW_PMKSA_ADD\n"));
|
|
break;
|
|
default:
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwpmksa - Unknown Command!\n"));
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_siwrate(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
u32 rate = wrqu->bitrate.value, fixed = wrqu->bitrate.fixed;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwrate::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwrate::(rate = %d, fixed = %d)\n", rate, fixed));
|
|
/* rate = -1 => auto rate
|
|
rate = X, fixed = 1 => (fixed rate X)
|
|
*/
|
|
if (rate == -1) {
|
|
/*Auto Rate */
|
|
pAd->StaCfg.DesiredTransmitSetting.field.MCS = MCS_AUTO;
|
|
pAd->StaCfg.bAutoTxRateSwitch = TRUE;
|
|
if ((pAd->CommonCfg.PhyMode <= PHY_11G) ||
|
|
(pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE <=
|
|
MODE_OFDM))
|
|
RTMPSetDesiredRates(pAd, -1);
|
|
|
|
SetCommonHT(pAd);
|
|
} else {
|
|
if (fixed) {
|
|
pAd->StaCfg.bAutoTxRateSwitch = FALSE;
|
|
if ((pAd->CommonCfg.PhyMode <= PHY_11G) ||
|
|
(pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.
|
|
MODE <= MODE_OFDM))
|
|
RTMPSetDesiredRates(pAd, rate);
|
|
else {
|
|
pAd->StaCfg.DesiredTransmitSetting.field.MCS =
|
|
MCS_AUTO;
|
|
SetCommonHT(pAd);
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("rt_ioctl_siwrate::(HtMcs=%d)\n",
|
|
pAd->StaCfg.DesiredTransmitSetting.field.
|
|
MCS));
|
|
} else {
|
|
/* TODO: rate = X, fixed = 0 => (rates <= X) */
|
|
return -EOPNOTSUPP;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rt_ioctl_giwrate(struct net_device *dev,
|
|
struct iw_request_info *info,
|
|
union iwreq_data *wrqu, char *extra)
|
|
{
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
int rate_index = 0, rate_count = 0;
|
|
HTTRANSMIT_SETTING ht_setting;
|
|
/* Remove to global variable
|
|
__s32 ralinkrate[] =
|
|
{2, 4, 11, 22, // CCK
|
|
12, 18, 24, 36, 48, 72, 96, 108, // OFDM
|
|
13, 26, 39, 52, 78, 104, 117, 130, 26, 52, 78, 104, 156, 208, 234, 260, // 20MHz, 800ns GI, MCS: 0 ~ 15
|
|
39, 78, 117, 156, 234, 312, 351, 390, // 20MHz, 800ns GI, MCS: 16 ~ 23
|
|
27, 54, 81, 108, 162, 216, 243, 270, 54, 108, 162, 216, 324, 432, 486, 540, // 40MHz, 800ns GI, MCS: 0 ~ 15
|
|
81, 162, 243, 324, 486, 648, 729, 810, // 40MHz, 800ns GI, MCS: 16 ~ 23
|
|
14, 29, 43, 57, 87, 115, 130, 144, 29, 59, 87, 115, 173, 230, 260, 288, // 20MHz, 400ns GI, MCS: 0 ~ 15
|
|
43, 87, 130, 173, 260, 317, 390, 433, // 20MHz, 400ns GI, MCS: 16 ~ 23
|
|
30, 60, 90, 120, 180, 240, 270, 300, 60, 120, 180, 240, 360, 480, 540, 600, // 40MHz, 400ns GI, MCS: 0 ~ 15
|
|
90, 180, 270, 360, 540, 720, 810, 900}; // 40MHz, 400ns GI, MCS: 16 ~ 23
|
|
*/
|
|
GET_PAD_FROM_NET_DEV(pAd, dev);
|
|
|
|
rate_count = ARRAY_SIZE(ralinkrate);
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
|
|
if ((pAd->StaCfg.bAutoTxRateSwitch == FALSE) &&
|
|
(INFRA_ON(pAd)) &&
|
|
((pAd->CommonCfg.PhyMode <= PHY_11G)
|
|
|| (pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE <=
|
|
MODE_OFDM)))
|
|
ht_setting.word = pAd->StaCfg.HTPhyMode.word;
|
|
else
|
|
ht_setting.word =
|
|
pAd->MacTab.Content[BSSID_WCID].HTPhyMode.word;
|
|
|
|
if (ht_setting.field.MODE >= MODE_HTMIX) {
|
|
/* rate_index = 12 + ((u8)ht_setting.field.BW *16) + ((u8)ht_setting.field.ShortGI *32) + ((u8)ht_setting.field.MCS); */
|
|
rate_index =
|
|
12 + ((u8)ht_setting.field.BW * 24) +
|
|
((u8)ht_setting.field.ShortGI * 48) +
|
|
((u8)ht_setting.field.MCS);
|
|
} else if (ht_setting.field.MODE == MODE_OFDM)
|
|
rate_index = (u8)(ht_setting.field.MCS) + 4;
|
|
else if (ht_setting.field.MODE == MODE_CCK)
|
|
rate_index = (u8)(ht_setting.field.MCS);
|
|
|
|
if (rate_index < 0)
|
|
rate_index = 0;
|
|
|
|
if (rate_index >= rate_count)
|
|
rate_index = rate_count - 1;
|
|
|
|
wrqu->bitrate.value = ralinkrate[rate_index] * 500000;
|
|
wrqu->bitrate.disabled = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const iw_handler rt_handler[] = {
|
|
(iw_handler) NULL, /* SIOCSIWCOMMIT */
|
|
(iw_handler) rt_ioctl_giwname, /* SIOCGIWNAME */
|
|
(iw_handler) NULL, /* SIOCSIWNWID */
|
|
(iw_handler) NULL, /* SIOCGIWNWID */
|
|
(iw_handler) rt_ioctl_siwfreq, /* SIOCSIWFREQ */
|
|
(iw_handler) rt_ioctl_giwfreq, /* SIOCGIWFREQ */
|
|
(iw_handler) rt_ioctl_siwmode, /* SIOCSIWMODE */
|
|
(iw_handler) rt_ioctl_giwmode, /* SIOCGIWMODE */
|
|
(iw_handler) NULL, /* SIOCSIWSENS */
|
|
(iw_handler) NULL, /* SIOCGIWSENS */
|
|
(iw_handler) NULL /* not used */ , /* SIOCSIWRANGE */
|
|
(iw_handler) rt_ioctl_giwrange, /* SIOCGIWRANGE */
|
|
(iw_handler) NULL /* not used */ , /* SIOCSIWPRIV */
|
|
(iw_handler) NULL /* kernel code */ , /* SIOCGIWPRIV */
|
|
(iw_handler) NULL /* not used */ , /* SIOCSIWSTATS */
|
|
(iw_handler) rt28xx_get_wireless_stats /* kernel code */ , /* SIOCGIWSTATS */
|
|
(iw_handler) NULL, /* SIOCSIWSPY */
|
|
(iw_handler) NULL, /* SIOCGIWSPY */
|
|
(iw_handler) NULL, /* SIOCSIWTHRSPY */
|
|
(iw_handler) NULL, /* SIOCGIWTHRSPY */
|
|
(iw_handler) rt_ioctl_siwap, /* SIOCSIWAP */
|
|
(iw_handler) rt_ioctl_giwap, /* SIOCGIWAP */
|
|
(iw_handler) rt_ioctl_siwmlme, /* SIOCSIWMLME */
|
|
(iw_handler) rt_ioctl_iwaplist, /* SIOCGIWAPLIST */
|
|
(iw_handler) rt_ioctl_siwscan, /* SIOCSIWSCAN */
|
|
(iw_handler) rt_ioctl_giwscan, /* SIOCGIWSCAN */
|
|
(iw_handler) rt_ioctl_siwessid, /* SIOCSIWESSID */
|
|
(iw_handler) rt_ioctl_giwessid, /* SIOCGIWESSID */
|
|
(iw_handler) rt_ioctl_siwnickn, /* SIOCSIWNICKN */
|
|
(iw_handler) rt_ioctl_giwnickn, /* SIOCGIWNICKN */
|
|
(iw_handler) NULL, /* -- hole -- */
|
|
(iw_handler) NULL, /* -- hole -- */
|
|
(iw_handler) rt_ioctl_siwrate, /* SIOCSIWRATE */
|
|
(iw_handler) rt_ioctl_giwrate, /* SIOCGIWRATE */
|
|
(iw_handler) rt_ioctl_siwrts, /* SIOCSIWRTS */
|
|
(iw_handler) rt_ioctl_giwrts, /* SIOCGIWRTS */
|
|
(iw_handler) rt_ioctl_siwfrag, /* SIOCSIWFRAG */
|
|
(iw_handler) rt_ioctl_giwfrag, /* SIOCGIWFRAG */
|
|
(iw_handler) NULL, /* SIOCSIWTXPOW */
|
|
(iw_handler) NULL, /* SIOCGIWTXPOW */
|
|
(iw_handler) NULL, /* SIOCSIWRETRY */
|
|
(iw_handler) NULL, /* SIOCGIWRETRY */
|
|
(iw_handler) rt_ioctl_siwencode, /* SIOCSIWENCODE */
|
|
(iw_handler) rt_ioctl_giwencode, /* SIOCGIWENCODE */
|
|
(iw_handler) NULL, /* SIOCSIWPOWER */
|
|
(iw_handler) NULL, /* SIOCGIWPOWER */
|
|
(iw_handler) NULL, /* -- hole -- */
|
|
(iw_handler) NULL, /* -- hole -- */
|
|
(iw_handler) rt_ioctl_siwgenie, /* SIOCSIWGENIE */
|
|
(iw_handler) rt_ioctl_giwgenie, /* SIOCGIWGENIE */
|
|
(iw_handler) rt_ioctl_siwauth, /* SIOCSIWAUTH */
|
|
(iw_handler) rt_ioctl_giwauth, /* SIOCGIWAUTH */
|
|
(iw_handler) rt_ioctl_siwencodeext, /* SIOCSIWENCODEEXT */
|
|
(iw_handler) rt_ioctl_giwencodeext, /* SIOCGIWENCODEEXT */
|
|
(iw_handler) rt_ioctl_siwpmksa, /* SIOCSIWPMKSA */
|
|
};
|
|
|
|
const struct iw_handler_def rt28xx_iw_handler_def = {
|
|
.standard = (iw_handler *) rt_handler,
|
|
.num_standard = sizeof(rt_handler) / sizeof(iw_handler),
|
|
#if IW_HANDLER_VERSION >= 7
|
|
.get_wireless_stats = rt28xx_get_wireless_stats,
|
|
#endif
|
|
};
|
|
|
|
int rt28xx_sta_ioctl(IN struct net_device *net_dev,
|
|
IN OUT struct ifreq *rq, int cmd)
|
|
{
|
|
struct os_cookie *pObj;
|
|
struct rt_rtmp_adapter *pAd = NULL;
|
|
struct iwreq *wrq = (struct iwreq *)rq;
|
|
BOOLEAN StateMachineTouched = FALSE;
|
|
int Status = NDIS_STATUS_SUCCESS;
|
|
|
|
GET_PAD_FROM_NET_DEV(pAd, net_dev);
|
|
|
|
pObj = (struct os_cookie *)pAd->OS_Cookie;
|
|
|
|
/*check if the interface is down */
|
|
if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE)) {
|
|
{
|
|
DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
|
|
return -ENETDOWN;
|
|
}
|
|
}
|
|
|
|
{ /* determine this ioctl command is comming from which interface. */
|
|
pObj->ioctl_if_type = INT_MAIN;
|
|
pObj->ioctl_if = MAIN_MBSSID;
|
|
}
|
|
|
|
switch (cmd) {
|
|
case SIOCGIFHWADDR:
|
|
DBGPRINT(RT_DEBUG_TRACE, ("IOCTL::SIOCGIFHWADDR\n"));
|
|
memcpy(wrq->u.name, pAd->CurrentAddress, ETH_ALEN);
|
|
break;
|
|
case SIOCGIWNAME:
|
|
{
|
|
char *name = &wrq->u.name[0];
|
|
rt_ioctl_giwname(net_dev, NULL, name, NULL);
|
|
break;
|
|
}
|
|
case SIOCGIWESSID: /*Get ESSID */
|
|
{
|
|
struct iw_point *essid = &wrq->u.essid;
|
|
rt_ioctl_giwessid(net_dev, NULL, essid, essid->pointer);
|
|
break;
|
|
}
|
|
case SIOCSIWESSID: /*Set ESSID */
|
|
{
|
|
struct iw_point *essid = &wrq->u.essid;
|
|
rt_ioctl_siwessid(net_dev, NULL, essid, essid->pointer);
|
|
break;
|
|
}
|
|
case SIOCSIWNWID: /* set network id (the cell) */
|
|
case SIOCGIWNWID: /* get network id */
|
|
Status = -EOPNOTSUPP;
|
|
break;
|
|
case SIOCSIWFREQ: /*set channel/frequency (Hz) */
|
|
{
|
|
struct iw_freq *freq = &wrq->u.freq;
|
|
rt_ioctl_siwfreq(net_dev, NULL, freq, NULL);
|
|
break;
|
|
}
|
|
case SIOCGIWFREQ: /* get channel/frequency (Hz) */
|
|
{
|
|
struct iw_freq *freq = &wrq->u.freq;
|
|
rt_ioctl_giwfreq(net_dev, NULL, freq, NULL);
|
|
break;
|
|
}
|
|
case SIOCSIWNICKN: /*set node name/nickname */
|
|
{
|
|
/*struct iw_point *data=&wrq->u.data; */
|
|
/*rt_ioctl_siwnickn(net_dev, NULL, data, NULL); */
|
|
break;
|
|
}
|
|
case SIOCGIWNICKN: /*get node name/nickname */
|
|
{
|
|
struct iw_point *erq = NULL;
|
|
erq = &wrq->u.data;
|
|
erq->length = strlen((char *)pAd->nickname);
|
|
Status =
|
|
copy_to_user(erq->pointer, pAd->nickname,
|
|
erq->length);
|
|
if (Status)
|
|
Status = -EFAULT;
|
|
break;
|
|
}
|
|
case SIOCGIWRATE: /*get default bit rate (bps) */
|
|
rt_ioctl_giwrate(net_dev, NULL, &wrq->u, NULL);
|
|
break;
|
|
case SIOCSIWRATE: /*set default bit rate (bps) */
|
|
rt_ioctl_siwrate(net_dev, NULL, &wrq->u, NULL);
|
|
break;
|
|
case SIOCGIWRTS: /* get RTS/CTS threshold (bytes) */
|
|
{
|
|
struct iw_param *rts = &wrq->u.rts;
|
|
rt_ioctl_giwrts(net_dev, NULL, rts, NULL);
|
|
break;
|
|
}
|
|
case SIOCSIWRTS: /*set RTS/CTS threshold (bytes) */
|
|
{
|
|
struct iw_param *rts = &wrq->u.rts;
|
|
rt_ioctl_siwrts(net_dev, NULL, rts, NULL);
|
|
break;
|
|
}
|
|
case SIOCGIWFRAG: /*get fragmentation thr (bytes) */
|
|
{
|
|
struct iw_param *frag = &wrq->u.frag;
|
|
rt_ioctl_giwfrag(net_dev, NULL, frag, NULL);
|
|
break;
|
|
}
|
|
case SIOCSIWFRAG: /*set fragmentation thr (bytes) */
|
|
{
|
|
struct iw_param *frag = &wrq->u.frag;
|
|
rt_ioctl_siwfrag(net_dev, NULL, frag, NULL);
|
|
break;
|
|
}
|
|
case SIOCGIWENCODE: /*get encoding token & mode */
|
|
{
|
|
struct iw_point *erq = &wrq->u.encoding;
|
|
if (erq)
|
|
rt_ioctl_giwencode(net_dev, NULL, erq,
|
|
erq->pointer);
|
|
break;
|
|
}
|
|
case SIOCSIWENCODE: /*set encoding token & mode */
|
|
{
|
|
struct iw_point *erq = &wrq->u.encoding;
|
|
if (erq)
|
|
rt_ioctl_siwencode(net_dev, NULL, erq,
|
|
erq->pointer);
|
|
break;
|
|
}
|
|
case SIOCGIWAP: /*get access point MAC addresses */
|
|
{
|
|
struct sockaddr *ap_addr = &wrq->u.ap_addr;
|
|
rt_ioctl_giwap(net_dev, NULL, ap_addr,
|
|
ap_addr->sa_data);
|
|
break;
|
|
}
|
|
case SIOCSIWAP: /*set access point MAC addresses */
|
|
{
|
|
struct sockaddr *ap_addr = &wrq->u.ap_addr;
|
|
rt_ioctl_siwap(net_dev, NULL, ap_addr,
|
|
ap_addr->sa_data);
|
|
break;
|
|
}
|
|
case SIOCGIWMODE: /*get operation mode */
|
|
{
|
|
__u32 *mode = &wrq->u.mode;
|
|
rt_ioctl_giwmode(net_dev, NULL, mode, NULL);
|
|
break;
|
|
}
|
|
case SIOCSIWMODE: /*set operation mode */
|
|
{
|
|
__u32 *mode = &wrq->u.mode;
|
|
rt_ioctl_siwmode(net_dev, NULL, mode, NULL);
|
|
break;
|
|
}
|
|
case SIOCGIWSENS: /*get sensitivity (dBm) */
|
|
case SIOCSIWSENS: /*set sensitivity (dBm) */
|
|
case SIOCGIWPOWER: /*get Power Management settings */
|
|
case SIOCSIWPOWER: /*set Power Management settings */
|
|
case SIOCGIWTXPOW: /*get transmit power (dBm) */
|
|
case SIOCSIWTXPOW: /*set transmit power (dBm) */
|
|
case SIOCGIWRANGE: /*Get range of parameters */
|
|
case SIOCGIWRETRY: /*get retry limits and lifetime */
|
|
case SIOCSIWRETRY: /*set retry limits and lifetime */
|
|
case RT_PRIV_IOCTL:
|
|
case RT_PRIV_IOCTL_EXT:
|
|
case RTPRIV_IOCTL_SET:
|
|
case RTPRIV_IOCTL_GSITESURVEY:
|
|
case SIOCGIWPRIV:
|
|
Status = -EOPNOTSUPP;
|
|
break;
|
|
case SIOCETHTOOL:
|
|
break;
|
|
default:
|
|
DBGPRINT(RT_DEBUG_ERROR,
|
|
("IOCTL::unknown IOCTL's cmd = 0x%08x\n", cmd));
|
|
Status = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
if (StateMachineTouched) /* Upper layer sent a MLME-related operations */
|
|
RTMP_MLME_HANDLER(pAd);
|
|
|
|
return Status;
|
|
}
|
|
|
|
/*
|
|
==========================================================================
|
|
Description:
|
|
Set SSID
|
|
Return:
|
|
TRUE if all parameters are OK, FALSE otherwise
|
|
==========================================================================
|
|
*/
|
|
int Set_SSID_Proc(struct rt_rtmp_adapter *pAdapter, char *arg)
|
|
{
|
|
struct rt_ndis_802_11_ssid Ssid, *pSsid = NULL;
|
|
BOOLEAN StateMachineTouched = FALSE;
|
|
int success = TRUE;
|
|
|
|
if (strlen(arg) <= MAX_LEN_OF_SSID) {
|
|
NdisZeroMemory(&Ssid, sizeof(struct rt_ndis_802_11_ssid));
|
|
if (strlen(arg) != 0) {
|
|
NdisMoveMemory(Ssid.Ssid, arg, strlen(arg));
|
|
Ssid.SsidLength = strlen(arg);
|
|
} else /*ANY ssid */
|
|
{
|
|
Ssid.SsidLength = 0;
|
|
memcpy(Ssid.Ssid, "", 0);
|
|
pAdapter->StaCfg.BssType = BSS_INFRA;
|
|
pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
|
|
pAdapter->StaCfg.WepStatus =
|
|
Ndis802_11EncryptionDisabled;
|
|
}
|
|
pSsid = &Ssid;
|
|
|
|
if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE) {
|
|
RTMP_MLME_RESET_STATE_MACHINE(pAdapter);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("MLME busy, reset MLME state machine!\n"));
|
|
}
|
|
|
|
if ((pAdapter->StaCfg.WpaPassPhraseLen >= 8) &&
|
|
(pAdapter->StaCfg.WpaPassPhraseLen <= 64)) {
|
|
char passphrase_str[65] = { 0 };
|
|
u8 keyMaterial[40];
|
|
|
|
RTMPMoveMemory(passphrase_str,
|
|
pAdapter->StaCfg.WpaPassPhrase,
|
|
pAdapter->StaCfg.WpaPassPhraseLen);
|
|
RTMPZeroMemory(pAdapter->StaCfg.PMK, 32);
|
|
if (pAdapter->StaCfg.WpaPassPhraseLen == 64) {
|
|
AtoH((char *)pAdapter->StaCfg.WpaPassPhrase,
|
|
pAdapter->StaCfg.PMK, 32);
|
|
} else {
|
|
PasswordHash((char *)pAdapter->StaCfg.
|
|
WpaPassPhrase, Ssid.Ssid,
|
|
Ssid.SsidLength, keyMaterial);
|
|
NdisMoveMemory(pAdapter->StaCfg.PMK,
|
|
keyMaterial, 32);
|
|
}
|
|
}
|
|
|
|
pAdapter->MlmeAux.CurrReqIsFromNdis = TRUE;
|
|
pAdapter->StaCfg.bScanReqIsFromWebUI = FALSE;
|
|
pAdapter->bConfigChanged = TRUE;
|
|
|
|
MlmeEnqueue(pAdapter,
|
|
MLME_CNTL_STATE_MACHINE,
|
|
OID_802_11_SSID,
|
|
sizeof(struct rt_ndis_802_11_ssid), (void *) pSsid);
|
|
|
|
StateMachineTouched = TRUE;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Set_SSID_Proc::(Len=%d,Ssid=%s)\n", Ssid.SsidLength,
|
|
Ssid.Ssid));
|
|
} else
|
|
success = FALSE;
|
|
|
|
if (StateMachineTouched) /* Upper layer sent a MLME-related operations */
|
|
RTMP_MLME_HANDLER(pAdapter);
|
|
|
|
return success;
|
|
}
|
|
|
|
/*
|
|
==========================================================================
|
|
Description:
|
|
Set Network Type(Infrastructure/Adhoc mode)
|
|
Return:
|
|
TRUE if all parameters are OK, FALSE otherwise
|
|
==========================================================================
|
|
*/
|
|
int Set_NetworkType_Proc(struct rt_rtmp_adapter *pAdapter, char *arg)
|
|
{
|
|
u32 Value = 0;
|
|
|
|
if (strcmp(arg, "Adhoc") == 0) {
|
|
if (pAdapter->StaCfg.BssType != BSS_ADHOC) {
|
|
/* Config has changed */
|
|
pAdapter->bConfigChanged = TRUE;
|
|
if (MONITOR_ON(pAdapter)) {
|
|
RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG,
|
|
STANORMAL);
|
|
RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value);
|
|
Value &= (~0x80);
|
|
RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value);
|
|
OPSTATUS_CLEAR_FLAG(pAdapter,
|
|
fOP_STATUS_MEDIA_STATE_CONNECTED);
|
|
pAdapter->StaCfg.bAutoReconnect = TRUE;
|
|
LinkDown(pAdapter, FALSE);
|
|
}
|
|
if (INFRA_ON(pAdapter)) {
|
|
/*BOOLEAN Cancelled; */
|
|
/* Set the AutoReconnectSsid to prevent it reconnect to old SSID */
|
|
/* Since calling this indicate user don't want to connect to that SSID anymore. */
|
|
pAdapter->MlmeAux.AutoReconnectSsidLen = 32;
|
|
NdisZeroMemory(pAdapter->MlmeAux.
|
|
AutoReconnectSsid,
|
|
pAdapter->MlmeAux.
|
|
AutoReconnectSsidLen);
|
|
|
|
LinkDown(pAdapter, FALSE);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("NDIS_STATUS_MEDIA_DISCONNECT Event BB!\n"));
|
|
}
|
|
}
|
|
pAdapter->StaCfg.BssType = BSS_ADHOC;
|
|
pAdapter->net_dev->type = pAdapter->StaCfg.OriDevType;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("===>Set_NetworkType_Proc::(AD-HOC)\n"));
|
|
} else if (strcmp(arg, "Infra") == 0) {
|
|
if (pAdapter->StaCfg.BssType != BSS_INFRA) {
|
|
/* Config has changed */
|
|
pAdapter->bConfigChanged = TRUE;
|
|
if (MONITOR_ON(pAdapter)) {
|
|
RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG,
|
|
STANORMAL);
|
|
RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value);
|
|
Value &= (~0x80);
|
|
RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value);
|
|
OPSTATUS_CLEAR_FLAG(pAdapter,
|
|
fOP_STATUS_MEDIA_STATE_CONNECTED);
|
|
pAdapter->StaCfg.bAutoReconnect = TRUE;
|
|
LinkDown(pAdapter, FALSE);
|
|
}
|
|
if (ADHOC_ON(pAdapter)) {
|
|
/* Set the AutoReconnectSsid to prevent it reconnect to old SSID */
|
|
/* Since calling this indicate user don't want to connect to that SSID anymore. */
|
|
pAdapter->MlmeAux.AutoReconnectSsidLen = 32;
|
|
NdisZeroMemory(pAdapter->MlmeAux.
|
|
AutoReconnectSsid,
|
|
pAdapter->MlmeAux.
|
|
AutoReconnectSsidLen);
|
|
|
|
LinkDown(pAdapter, FALSE);
|
|
}
|
|
}
|
|
pAdapter->StaCfg.BssType = BSS_INFRA;
|
|
pAdapter->net_dev->type = pAdapter->StaCfg.OriDevType;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("===>Set_NetworkType_Proc::(INFRA)\n"));
|
|
} else if (strcmp(arg, "Monitor") == 0) {
|
|
u8 bbpValue = 0;
|
|
BCN_TIME_CFG_STRUC csr;
|
|
OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_INFRA_ON);
|
|
OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_ADHOC_ON);
|
|
OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED);
|
|
/* disable all periodic state machine */
|
|
pAdapter->StaCfg.bAutoReconnect = FALSE;
|
|
/* reset all mlme state machine */
|
|
RTMP_MLME_RESET_STATE_MACHINE(pAdapter);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("fOP_STATUS_MEDIA_STATE_CONNECTED \n"));
|
|
if (pAdapter->CommonCfg.CentralChannel == 0) {
|
|
if (pAdapter->CommonCfg.PhyMode == PHY_11AN_MIXED)
|
|
pAdapter->CommonCfg.CentralChannel = 36;
|
|
else
|
|
pAdapter->CommonCfg.CentralChannel = 6;
|
|
} else
|
|
N_ChannelCheck(pAdapter);
|
|
|
|
if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED &&
|
|
pAdapter->CommonCfg.RegTransmitSetting.field.BW == BW_40 &&
|
|
pAdapter->CommonCfg.RegTransmitSetting.field.EXTCHA ==
|
|
EXTCHA_ABOVE) {
|
|
/* 40MHz ,control channel at lower */
|
|
RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4,
|
|
&bbpValue);
|
|
bbpValue &= (~0x18);
|
|
bbpValue |= 0x10;
|
|
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4,
|
|
bbpValue);
|
|
pAdapter->CommonCfg.BBPCurrentBW = BW_40;
|
|
/* RX : control channel at lower */
|
|
RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R3,
|
|
&bbpValue);
|
|
bbpValue &= (~0x20);
|
|
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R3,
|
|
bbpValue);
|
|
|
|
RTMP_IO_READ32(pAdapter, TX_BAND_CFG, &Value);
|
|
Value &= 0xfffffffe;
|
|
RTMP_IO_WRITE32(pAdapter, TX_BAND_CFG, Value);
|
|
pAdapter->CommonCfg.CentralChannel =
|
|
pAdapter->CommonCfg.Channel + 2;
|
|
AsicSwitchChannel(pAdapter,
|
|
pAdapter->CommonCfg.CentralChannel,
|
|
FALSE);
|
|
AsicLockChannel(pAdapter,
|
|
pAdapter->CommonCfg.CentralChannel);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("BW_40 ,control_channel(%d), CentralChannel(%d) \n",
|
|
pAdapter->CommonCfg.Channel,
|
|
pAdapter->CommonCfg.CentralChannel));
|
|
} else if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED
|
|
&& pAdapter->CommonCfg.RegTransmitSetting.field.BW ==
|
|
BW_40
|
|
&& pAdapter->CommonCfg.RegTransmitSetting.field.
|
|
EXTCHA == EXTCHA_BELOW) {
|
|
/* 40MHz ,control channel at upper */
|
|
RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4,
|
|
&bbpValue);
|
|
bbpValue &= (~0x18);
|
|
bbpValue |= 0x10;
|
|
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4,
|
|
bbpValue);
|
|
pAdapter->CommonCfg.BBPCurrentBW = BW_40;
|
|
RTMP_IO_READ32(pAdapter, TX_BAND_CFG, &Value);
|
|
Value |= 0x1;
|
|
RTMP_IO_WRITE32(pAdapter, TX_BAND_CFG, Value);
|
|
|
|
RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R3,
|
|
&bbpValue);
|
|
bbpValue |= (0x20);
|
|
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R3,
|
|
bbpValue);
|
|
pAdapter->CommonCfg.CentralChannel =
|
|
pAdapter->CommonCfg.Channel - 2;
|
|
AsicSwitchChannel(pAdapter,
|
|
pAdapter->CommonCfg.CentralChannel,
|
|
FALSE);
|
|
AsicLockChannel(pAdapter,
|
|
pAdapter->CommonCfg.CentralChannel);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("BW_40 ,control_channel(%d), CentralChannel(%d) \n",
|
|
pAdapter->CommonCfg.Channel,
|
|
pAdapter->CommonCfg.CentralChannel));
|
|
} else {
|
|
/* 20MHz */
|
|
RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4,
|
|
&bbpValue);
|
|
bbpValue &= (~0x18);
|
|
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4,
|
|
bbpValue);
|
|
pAdapter->CommonCfg.BBPCurrentBW = BW_20;
|
|
AsicSwitchChannel(pAdapter, pAdapter->CommonCfg.Channel,
|
|
FALSE);
|
|
AsicLockChannel(pAdapter, pAdapter->CommonCfg.Channel);
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("BW_20, Channel(%d)\n",
|
|
pAdapter->CommonCfg.Channel));
|
|
}
|
|
/* Enable Rx with promiscuous reception */
|
|
RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG, 0x3);
|
|
/* ASIC supporsts sniffer function with replacing RSSI with timestamp. */
|
|
/*RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value); */
|
|
/*Value |= (0x80); */
|
|
/*RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value); */
|
|
/* disable sync */
|
|
RTMP_IO_READ32(pAdapter, BCN_TIME_CFG, &csr.word);
|
|
csr.field.bBeaconGen = 0;
|
|
csr.field.bTBTTEnable = 0;
|
|
csr.field.TsfSyncMode = 0;
|
|
RTMP_IO_WRITE32(pAdapter, BCN_TIME_CFG, csr.word);
|
|
|
|
pAdapter->StaCfg.BssType = BSS_MONITOR;
|
|
pAdapter->net_dev->type = ARPHRD_IEEE80211_PRISM; /*ARPHRD_IEEE80211; // IEEE80211 */
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("===>Set_NetworkType_Proc::(MONITOR)\n"));
|
|
}
|
|
/* Reset Ralink supplicant to not use, it will be set to start when UI set PMK key */
|
|
pAdapter->StaCfg.WpaState = SS_NOTUSE;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Set_NetworkType_Proc::(NetworkType=%d)\n",
|
|
pAdapter->StaCfg.BssType));
|
|
|
|
return TRUE;
|
|
}
|