diff options
Diffstat (limited to 'drivers/staging/ks7010/ks_wlan_net.c')
-rw-r--r-- | drivers/staging/ks7010/ks_wlan_net.c | 2676 |
1 files changed, 2676 insertions, 0 deletions
diff --git a/drivers/staging/ks7010/ks_wlan_net.c b/drivers/staging/ks7010/ks_wlan_net.c new file mode 100644 index 0000000000..0fb97a79ad --- /dev/null +++ b/drivers/staging/ks7010/ks_wlan_net.c @@ -0,0 +1,2676 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for KeyStream 11b/g wireless LAN + * + * Copyright (C) 2005-2008 KeyStream Corp. + * Copyright (C) 2009 Renesas Technology Corp. + */ + +#include <linux/atomic.h> +#include <linux/completion.h> +#include <linux/if_arp.h> +#include <linux/netdevice.h> +#include <linux/timer.h> +#include <linux/uaccess.h> + +static int wep_on_off; +#define WEP_OFF 0 +#define WEP_ON_64BIT 1 +#define WEP_ON_128BIT 2 + +#include "ks_wlan.h" +#include "ks_hostif.h" +#include "ks_wlan_ioctl.h" + +/* Include Wireless Extension definition and check version */ +#include <linux/wireless.h> +#define WIRELESS_SPY /* enable iwspy support */ +#include <net/iw_handler.h> /* New driver API */ + +/* Frequency list (map channels to frequencies) */ +static const long frequency_list[] = { + 2412, 2417, 2422, 2427, 2432, 2437, 2442, + 2447, 2452, 2457, 2462, 2467, 2472, 2484 +}; + +/* A few details needed for WEP (Wireless Equivalent Privacy) */ +#define MAX_KEY_SIZE 13 /* 128 (?) bits */ +#define MIN_KEY_SIZE 5 /* 40 bits RC4 - WEP */ +struct wep_key { + u16 len; + u8 key[16]; /* 40-bit and 104-bit keys */ +}; + +/* + * function prototypes + */ +static int ks_wlan_open(struct net_device *dev); +static void ks_wlan_tx_timeout(struct net_device *dev, unsigned int txqueue); +static netdev_tx_t ks_wlan_start_xmit(struct sk_buff *skb, struct net_device *dev); +static int ks_wlan_close(struct net_device *dev); +static void ks_wlan_set_rx_mode(struct net_device *dev); +static struct net_device_stats *ks_wlan_get_stats(struct net_device *dev); +static int ks_wlan_set_mac_address(struct net_device *dev, void *addr); +static int ks_wlan_netdev_ioctl(struct net_device *dev, struct ifreq *rq, + int cmd); + +static atomic_t update_phyinfo; +static struct timer_list update_phyinfo_timer; +static +int ks_wlan_update_phy_information(struct ks_wlan_private *priv) +{ + struct iw_statistics *wstats = &priv->wstats; + + netdev_dbg(priv->net_dev, "in_interrupt = %ld\n", in_interrupt()); + + if (priv->dev_state < DEVICE_STATE_READY) + return -EBUSY; /* not finished initialize */ + + if (atomic_read(&update_phyinfo)) + return -EPERM; + + /* The status */ + wstats->status = priv->reg.operation_mode; /* Operation mode */ + + /* Signal quality and co. But where is the noise level ??? */ + hostif_sme_enqueue(priv, SME_PHY_INFO_REQUEST); + + /* interruptible_sleep_on_timeout(&priv->confirm_wait, HZ/2); */ + if (!wait_for_completion_interruptible_timeout + (&priv->confirm_wait, HZ / 2)) { + netdev_dbg(priv->net_dev, "wait time out!!\n"); + } + + atomic_inc(&update_phyinfo); + update_phyinfo_timer.expires = jiffies + HZ; /* 1sec */ + add_timer(&update_phyinfo_timer); + + return 0; +} + +static +void ks_wlan_update_phyinfo_timeout(struct timer_list *unused) +{ + pr_debug("in_interrupt = %ld\n", in_interrupt()); + atomic_set(&update_phyinfo, 0); +} + +int ks_wlan_setup_parameter(struct ks_wlan_private *priv, + unsigned int commit_flag) +{ + hostif_sme_enqueue(priv, SME_STOP_REQUEST); + + if (commit_flag & SME_RTS) + hostif_sme_enqueue(priv, SME_RTS_THRESHOLD_REQUEST); + if (commit_flag & SME_FRAG) + hostif_sme_enqueue(priv, SME_FRAGMENTATION_THRESHOLD_REQUEST); + + if (commit_flag & SME_WEP_INDEX) + hostif_sme_enqueue(priv, SME_WEP_INDEX_REQUEST); + if (commit_flag & SME_WEP_VAL1) + hostif_sme_enqueue(priv, SME_WEP_KEY1_REQUEST); + if (commit_flag & SME_WEP_VAL2) + hostif_sme_enqueue(priv, SME_WEP_KEY2_REQUEST); + if (commit_flag & SME_WEP_VAL3) + hostif_sme_enqueue(priv, SME_WEP_KEY3_REQUEST); + if (commit_flag & SME_WEP_VAL4) + hostif_sme_enqueue(priv, SME_WEP_KEY4_REQUEST); + if (commit_flag & SME_WEP_FLAG) + hostif_sme_enqueue(priv, SME_WEP_FLAG_REQUEST); + + if (commit_flag & SME_RSN) { + hostif_sme_enqueue(priv, SME_RSN_ENABLED_REQUEST); + hostif_sme_enqueue(priv, SME_RSN_MODE_REQUEST); + } + if (commit_flag & SME_RSN_MULTICAST) + hostif_sme_enqueue(priv, SME_RSN_MCAST_REQUEST); + if (commit_flag & SME_RSN_UNICAST) + hostif_sme_enqueue(priv, SME_RSN_UCAST_REQUEST); + if (commit_flag & SME_RSN_AUTH) + hostif_sme_enqueue(priv, SME_RSN_AUTH_REQUEST); + + hostif_sme_enqueue(priv, SME_MODE_SET_REQUEST); + + hostif_sme_enqueue(priv, SME_START_REQUEST); + + return 0; +} + +/* + * Initial Wireless Extension code for Ks_Wlannet driver by : + * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00 + * Conversion to new driver API by : + * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02 + * Javier also did a good amount of work here, adding some new extensions + * and fixing my code. Let's just say that without him this code just + * would not work at all... - Jean II + */ + +static int ks_wlan_get_name(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *cwrq, + char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (priv->dev_state < DEVICE_STATE_READY) + strscpy(cwrq->name, "NOT READY!", sizeof(cwrq->name)); + else if (priv->reg.phy_type == D_11B_ONLY_MODE) + strscpy(cwrq->name, "IEEE 802.11b", sizeof(cwrq->name)); + else if (priv->reg.phy_type == D_11G_ONLY_MODE) + strscpy(cwrq->name, "IEEE 802.11g", sizeof(cwrq->name)); + else + strscpy(cwrq->name, "IEEE 802.11b/g", sizeof(cwrq->name)); + + return 0; +} + +static int ks_wlan_set_freq(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *fwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int channel; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* If setting by frequency, convert to a channel */ + if ((fwrq->freq.e == 1) && + (fwrq->freq.m >= 241200000) && (fwrq->freq.m <= 248700000)) { + int f = fwrq->freq.m / 100000; + int c = 0; + + while ((c < 14) && (f != frequency_list[c])) + c++; + /* Hack to fall through... */ + fwrq->freq.e = 0; + fwrq->freq.m = c + 1; + } + /* Setting by channel number */ + if ((fwrq->freq.m > 1000) || (fwrq->freq.e > 0)) + return -EOPNOTSUPP; + + channel = fwrq->freq.m; + /* We should do a better check than that, + * based on the card capability !!! + */ + if ((channel < 1) || (channel > 14)) { + netdev_dbg(dev, "%s: New channel value of %d is invalid!\n", + dev->name, fwrq->freq.m); + return -EINVAL; + } + + /* Yes ! We can set it !!! */ + priv->reg.channel = (u8)(channel); + priv->need_commit |= SME_MODE_SET; + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_freq(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *fwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int f; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (is_connect_status(priv->connect_status)) + f = (int)priv->current_ap.channel; + else + f = (int)priv->reg.channel; + + fwrq->freq.m = frequency_list[f - 1] * 100000; + fwrq->freq.e = 1; + + return 0; +} + +static int ks_wlan_set_essid(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + size_t len; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* Check if we asked for `any' */ + if (!dwrq->essid.flags) { + /* Just send an empty SSID list */ + memset(priv->reg.ssid.body, 0, sizeof(priv->reg.ssid.body)); + priv->reg.ssid.size = 0; + } else { + len = dwrq->essid.length; + /* iwconfig uses nul termination in SSID.. */ + if (len > 0 && extra[len - 1] == '\0') + len--; + + /* Check the size of the string */ + if (len > IW_ESSID_MAX_SIZE) + return -EINVAL; + + /* Set the SSID */ + memset(priv->reg.ssid.body, 0, sizeof(priv->reg.ssid.body)); + memcpy(priv->reg.ssid.body, extra, len); + priv->reg.ssid.size = len; + } + /* Write it to the card */ + priv->need_commit |= SME_MODE_SET; + + ks_wlan_setup_parameter(priv, priv->need_commit); + priv->need_commit = 0; + return 0; +} + +static int ks_wlan_get_essid(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* Note : if dwrq->flags != 0, we should + * get the relevant SSID from the SSID list... + */ + if (priv->reg.ssid.size != 0) { + /* Get the current SSID */ + memcpy(extra, priv->reg.ssid.body, priv->reg.ssid.size); + + /* If none, we may want to get the one that was set */ + + /* Push it out ! */ + dwrq->essid.length = priv->reg.ssid.size; + dwrq->essid.flags = 1; /* active */ + } else { + dwrq->essid.length = 0; + dwrq->essid.flags = 0; /* ANY */ + } + + return 0; +} + +static int ks_wlan_set_wap(struct net_device *dev, struct iw_request_info *info, + union iwreq_data *awrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (priv->reg.operation_mode != MODE_ADHOC && + priv->reg.operation_mode != MODE_INFRASTRUCTURE) { + eth_zero_addr(priv->reg.bssid); + return -EOPNOTSUPP; + } + + ether_addr_copy(priv->reg.bssid, awrq->ap_addr.sa_data); + if (is_valid_ether_addr((u8 *)priv->reg.bssid)) + priv->need_commit |= SME_MODE_SET; + + netdev_dbg(dev, "bssid = %pM\n", priv->reg.bssid); + + /* Write it to the card */ + if (priv->need_commit) { + priv->need_commit |= SME_MODE_SET; + return -EINPROGRESS; /* Call commit handler */ + } + return 0; +} + +static int ks_wlan_get_wap(struct net_device *dev, struct iw_request_info *info, + union iwreq_data *awrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (is_connect_status(priv->connect_status)) + ether_addr_copy(awrq->ap_addr.sa_data, priv->current_ap.bssid); + else + eth_zero_addr(awrq->ap_addr.sa_data); + + awrq->ap_addr.sa_family = ARPHRD_ETHER; + + return 0; +} + +static int ks_wlan_set_nick(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* Check the size of the string */ + if (dwrq->data.length > 16 + 1) + return -E2BIG; + + memset(priv->nick, 0, sizeof(priv->nick)); + memcpy(priv->nick, extra, dwrq->data.length); + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_nick(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + strscpy(extra, priv->nick, 17); + dwrq->data.length = strlen(extra) + 1; + + return 0; +} + +static int ks_wlan_set_rate(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int i = 0; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (priv->reg.phy_type == D_11B_ONLY_MODE) { + if (vwrq->bitrate.fixed == 1) { + switch (vwrq->bitrate.value) { + case 11000000: + case 5500000: + priv->reg.rate_set.body[0] = + (u8)(vwrq->bitrate.value / 500000); + break; + case 2000000: + case 1000000: + priv->reg.rate_set.body[0] = + ((u8)(vwrq->bitrate.value / 500000)) | + BASIC_RATE; + break; + default: + return -EINVAL; + } + priv->reg.tx_rate = TX_RATE_FIXED; + priv->reg.rate_set.size = 1; + } else { /* vwrq->fixed == 0 */ + if (vwrq->bitrate.value > 0) { + switch (vwrq->bitrate.value) { + case 11000000: + priv->reg.rate_set.body[3] = + TX_RATE_11M; + i++; + fallthrough; + case 5500000: + priv->reg.rate_set.body[2] = TX_RATE_5M; + i++; + fallthrough; + case 2000000: + priv->reg.rate_set.body[1] = + TX_RATE_2M | BASIC_RATE; + i++; + fallthrough; + case 1000000: + priv->reg.rate_set.body[0] = + TX_RATE_1M | BASIC_RATE; + i++; + break; + default: + return -EINVAL; + } + priv->reg.tx_rate = TX_RATE_MANUAL_AUTO; + priv->reg.rate_set.size = i; + } else { + priv->reg.rate_set.body[3] = TX_RATE_11M; + priv->reg.rate_set.body[2] = TX_RATE_5M; + priv->reg.rate_set.body[1] = + TX_RATE_2M | BASIC_RATE; + priv->reg.rate_set.body[0] = + TX_RATE_1M | BASIC_RATE; + priv->reg.tx_rate = TX_RATE_FULL_AUTO; + priv->reg.rate_set.size = 4; + } + } + } else { /* D_11B_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ + if (vwrq->bitrate.fixed == 1) { + switch (vwrq->bitrate.value) { + case 54000000: + case 48000000: + case 36000000: + case 18000000: + case 9000000: + priv->reg.rate_set.body[0] = + (u8)(vwrq->bitrate.value / 500000); + break; + case 24000000: + case 12000000: + case 11000000: + case 6000000: + case 5500000: + case 2000000: + case 1000000: + priv->reg.rate_set.body[0] = + ((u8)(vwrq->bitrate.value / 500000)) | + BASIC_RATE; + break; + default: + return -EINVAL; + } + priv->reg.tx_rate = TX_RATE_FIXED; + priv->reg.rate_set.size = 1; + } else { /* vwrq->fixed == 0 */ + if (vwrq->bitrate.value > 0) { + switch (vwrq->bitrate.value) { + case 54000000: + priv->reg.rate_set.body[11] = + TX_RATE_54M; + i++; + fallthrough; + case 48000000: + priv->reg.rate_set.body[10] = + TX_RATE_48M; + i++; + fallthrough; + case 36000000: + priv->reg.rate_set.body[9] = + TX_RATE_36M; + i++; + fallthrough; + case 24000000: + case 18000000: + case 12000000: + case 11000000: + case 9000000: + case 6000000: + if (vwrq->bitrate.value == 24000000) { + priv->reg.rate_set.body[8] = + TX_RATE_18M; + i++; + priv->reg.rate_set.body[7] = + TX_RATE_9M; + i++; + priv->reg.rate_set.body[6] = + TX_RATE_24M | BASIC_RATE; + i++; + priv->reg.rate_set.body[5] = + TX_RATE_12M | BASIC_RATE; + i++; + priv->reg.rate_set.body[4] = + TX_RATE_6M | BASIC_RATE; + i++; + priv->reg.rate_set.body[3] = + TX_RATE_11M | BASIC_RATE; + i++; + } else if (vwrq->bitrate.value == 18000000) { + priv->reg.rate_set.body[7] = + TX_RATE_18M; + i++; + priv->reg.rate_set.body[6] = + TX_RATE_9M; + i++; + priv->reg.rate_set.body[5] = + TX_RATE_12M | BASIC_RATE; + i++; + priv->reg.rate_set.body[4] = + TX_RATE_6M | BASIC_RATE; + i++; + priv->reg.rate_set.body[3] = + TX_RATE_11M | BASIC_RATE; + i++; + } else if (vwrq->bitrate.value == 12000000) { + priv->reg.rate_set.body[6] = + TX_RATE_9M; + i++; + priv->reg.rate_set.body[5] = + TX_RATE_12M | BASIC_RATE; + i++; + priv->reg.rate_set.body[4] = + TX_RATE_6M | BASIC_RATE; + i++; + priv->reg.rate_set.body[3] = + TX_RATE_11M | BASIC_RATE; + i++; + } else if (vwrq->bitrate.value == 11000000) { + priv->reg.rate_set.body[5] = + TX_RATE_9M; + i++; + priv->reg.rate_set.body[4] = + TX_RATE_6M | BASIC_RATE; + i++; + priv->reg.rate_set.body[3] = + TX_RATE_11M | BASIC_RATE; + i++; + } else if (vwrq->bitrate.value == 9000000) { + priv->reg.rate_set.body[4] = + TX_RATE_9M; + i++; + priv->reg.rate_set.body[3] = + TX_RATE_6M | BASIC_RATE; + i++; + } else { /* vwrq->value == 6000000 */ + priv->reg.rate_set.body[3] = + TX_RATE_6M | BASIC_RATE; + i++; + } + fallthrough; + case 5500000: + priv->reg.rate_set.body[2] = + TX_RATE_5M | BASIC_RATE; + i++; + fallthrough; + case 2000000: + priv->reg.rate_set.body[1] = + TX_RATE_2M | BASIC_RATE; + i++; + fallthrough; + case 1000000: + priv->reg.rate_set.body[0] = + TX_RATE_1M | BASIC_RATE; + i++; + break; + default: + return -EINVAL; + } + priv->reg.tx_rate = TX_RATE_MANUAL_AUTO; + priv->reg.rate_set.size = i; + } else { + priv->reg.rate_set.body[11] = TX_RATE_54M; + priv->reg.rate_set.body[10] = TX_RATE_48M; + priv->reg.rate_set.body[9] = TX_RATE_36M; + priv->reg.rate_set.body[8] = TX_RATE_18M; + priv->reg.rate_set.body[7] = TX_RATE_9M; + priv->reg.rate_set.body[6] = + TX_RATE_24M | BASIC_RATE; + priv->reg.rate_set.body[5] = + TX_RATE_12M | BASIC_RATE; + priv->reg.rate_set.body[4] = + TX_RATE_6M | BASIC_RATE; + priv->reg.rate_set.body[3] = + TX_RATE_11M | BASIC_RATE; + priv->reg.rate_set.body[2] = + TX_RATE_5M | BASIC_RATE; + priv->reg.rate_set.body[1] = + TX_RATE_2M | BASIC_RATE; + priv->reg.rate_set.body[0] = + TX_RATE_1M | BASIC_RATE; + priv->reg.tx_rate = TX_RATE_FULL_AUTO; + priv->reg.rate_set.size = 12; + } + } + } + + priv->need_commit |= SME_MODE_SET; + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_rate(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + netdev_dbg(dev, "in_interrupt = %ld update_phyinfo = %d\n", + in_interrupt(), atomic_read(&update_phyinfo)); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (!atomic_read(&update_phyinfo)) + ks_wlan_update_phy_information(priv); + + vwrq->bitrate.value = ((priv->current_rate) & RATE_MASK) * 500000; + vwrq->bitrate.fixed = (priv->reg.tx_rate == TX_RATE_FIXED) ? 1 : 0; + + return 0; +} + +static int ks_wlan_set_rts(struct net_device *dev, struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int rthr = vwrq->rts.value; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (vwrq->rts.disabled) + rthr = 2347; + if ((rthr < 0) || (rthr > 2347)) + return -EINVAL; + + priv->reg.rts = rthr; + priv->need_commit |= SME_RTS; + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_rts(struct net_device *dev, struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + vwrq->rts.value = priv->reg.rts; + vwrq->rts.disabled = (vwrq->rts.value >= 2347); + vwrq->rts.fixed = 1; + + return 0; +} + +static int ks_wlan_set_frag(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int fthr = vwrq->frag.value; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (vwrq->frag.disabled) + fthr = 2346; + if ((fthr < 256) || (fthr > 2346)) + return -EINVAL; + + fthr &= ~0x1; /* Get an even value - is it really needed ??? */ + priv->reg.fragment = fthr; + priv->need_commit |= SME_FRAG; + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_frag(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + vwrq->frag.value = priv->reg.fragment; + vwrq->frag.disabled = (vwrq->frag.value >= 2346); + vwrq->frag.fixed = 1; + + return 0; +} + +static int ks_wlan_set_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (uwrq->mode != IW_MODE_ADHOC && + uwrq->mode != IW_MODE_INFRA) + return -EINVAL; + + priv->reg.operation_mode = (uwrq->mode == IW_MODE_ADHOC) ? + MODE_ADHOC : MODE_INFRASTRUCTURE; + priv->need_commit |= SME_MODE_SET; + + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* If not managed, assume it's ad-hoc */ + uwrq->mode = (priv->reg.operation_mode == MODE_INFRASTRUCTURE) ? + IW_MODE_INFRA : IW_MODE_ADHOC; + + return 0; +} + +static int ks_wlan_set_encode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_point *enc = &dwrq->encoding; + struct wep_key key; + int index = (enc->flags & IW_ENCODE_INDEX); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (enc->length > MAX_KEY_SIZE) + return -EINVAL; + + /* for SLEEP MODE */ + if ((index < 0) || (index > 4)) + return -EINVAL; + + index = (index == 0) ? priv->reg.wep_index : (index - 1); + + /* Is WEP supported ? */ + /* Basic checking: do we have a key to set ? */ + if (enc->length > 0) { + key.len = (enc->length > MIN_KEY_SIZE) ? + MAX_KEY_SIZE : MIN_KEY_SIZE; + priv->reg.privacy_invoked = 0x01; + priv->need_commit |= SME_WEP_FLAG; + wep_on_off = (enc->length > MIN_KEY_SIZE) ? + WEP_ON_128BIT : WEP_ON_64BIT; + /* Check if the key is not marked as invalid */ + if (enc->flags & IW_ENCODE_NOKEY) + return 0; + + /* Cleanup */ + memset(key.key, 0, MAX_KEY_SIZE); + /* Copy the key in the driver */ + if (copy_from_user(key.key, enc->pointer, enc->length)) { + key.len = 0; + return -EFAULT; + } + /* Send the key to the card */ + priv->reg.wep_key[index].size = key.len; + memcpy(&priv->reg.wep_key[index].val[0], &key.key[0], + priv->reg.wep_key[index].size); + priv->need_commit |= (SME_WEP_VAL1 << index); + priv->reg.wep_index = index; + priv->need_commit |= SME_WEP_INDEX; + } else { + if (enc->flags & IW_ENCODE_DISABLED) { + priv->reg.wep_key[0].size = 0; + priv->reg.wep_key[1].size = 0; + priv->reg.wep_key[2].size = 0; + priv->reg.wep_key[3].size = 0; + priv->reg.privacy_invoked = 0x00; + if (priv->reg.authenticate_type == AUTH_TYPE_SHARED_KEY) + priv->need_commit |= SME_MODE_SET; + + priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; + wep_on_off = WEP_OFF; + priv->need_commit |= SME_WEP_FLAG; + } else { + /* set_wep_key(priv, index, 0, 0, 1); xxx */ + if (priv->reg.wep_key[index].size == 0) + return -EINVAL; + priv->reg.wep_index = index; + priv->need_commit |= SME_WEP_INDEX; + } + } + + /* Commit the changes if needed */ + if (enc->flags & IW_ENCODE_MODE) + priv->need_commit |= SME_WEP_FLAG; + + if (enc->flags & IW_ENCODE_OPEN) { + if (priv->reg.authenticate_type == AUTH_TYPE_SHARED_KEY) + priv->need_commit |= SME_MODE_SET; + + priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; + } else if (enc->flags & IW_ENCODE_RESTRICTED) { + if (priv->reg.authenticate_type == AUTH_TYPE_OPEN_SYSTEM) + priv->need_commit |= SME_MODE_SET; + + priv->reg.authenticate_type = AUTH_TYPE_SHARED_KEY; + } + if (priv->need_commit) { + ks_wlan_setup_parameter(priv, priv->need_commit); + priv->need_commit = 0; + } + return 0; +} + +static int ks_wlan_get_encode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_point *enc = &dwrq->encoding; + int index = (enc->flags & IW_ENCODE_INDEX) - 1; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + enc->flags = IW_ENCODE_DISABLED; + + /* Check encryption mode */ + switch (priv->reg.authenticate_type) { + case AUTH_TYPE_OPEN_SYSTEM: + enc->flags = IW_ENCODE_OPEN; + break; + case AUTH_TYPE_SHARED_KEY: + enc->flags = IW_ENCODE_RESTRICTED; + break; + } + + /* Which key do we want ? -1 -> tx index */ + if ((index < 0) || (index >= 4)) + index = priv->reg.wep_index; + if (priv->reg.privacy_invoked) { + enc->flags &= ~IW_ENCODE_DISABLED; + /* dwrq->flags |= IW_ENCODE_NOKEY; */ + } + enc->flags |= index + 1; + /* Copy the key to the user buffer */ + if (index >= 0 && index < 4) { + enc->length = (priv->reg.wep_key[index].size <= 16) ? + priv->reg.wep_key[index].size : 0; + memcpy(extra, priv->reg.wep_key[index].val, enc->length); + } + + return 0; +} + +static int ks_wlan_get_range(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_range *range = (struct iw_range *)extra; + int i, k; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + dwrq->data.length = sizeof(struct iw_range); + memset(range, 0, sizeof(*range)); + range->min_nwid = 0x0000; + range->max_nwid = 0x0000; + range->num_channels = 14; + /* Should be based on cap_rid.country to give only + * what the current card support + */ + k = 0; + for (i = 0; i < 13; i++) { /* channel 1 -- 13 */ + range->freq[k].i = i + 1; /* List index */ + range->freq[k].m = frequency_list[i] * 100000; + range->freq[k++].e = 1; /* Values in table in MHz -> * 10^5 * 10 */ + } + range->num_frequency = k; + if (priv->reg.phy_type == D_11B_ONLY_MODE || + priv->reg.phy_type == D_11BG_COMPATIBLE_MODE) { /* channel 14 */ + range->freq[13].i = 14; /* List index */ + range->freq[13].m = frequency_list[13] * 100000; + range->freq[13].e = 1; /* Values in table in MHz -> * 10^5 * 10 */ + range->num_frequency = 14; + } + + /* Hum... Should put the right values there */ + range->max_qual.qual = 100; + range->max_qual.level = 256 - 128; /* 0 dBm? */ + range->max_qual.noise = 256 - 128; + range->sensitivity = 1; + + if (priv->reg.phy_type == D_11B_ONLY_MODE) { + range->bitrate[0] = 1e6; + range->bitrate[1] = 2e6; + range->bitrate[2] = 5.5e6; + range->bitrate[3] = 11e6; + range->num_bitrates = 4; + } else { /* D_11G_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ + range->bitrate[0] = 1e6; + range->bitrate[1] = 2e6; + range->bitrate[2] = 5.5e6; + range->bitrate[3] = 11e6; + + range->bitrate[4] = 6e6; + range->bitrate[5] = 9e6; + range->bitrate[6] = 12e6; + if (IW_MAX_BITRATES < 9) { + range->bitrate[7] = 54e6; + range->num_bitrates = 8; + } else { + range->bitrate[7] = 18e6; + range->bitrate[8] = 24e6; + range->bitrate[9] = 36e6; + range->bitrate[10] = 48e6; + range->bitrate[11] = 54e6; + + range->num_bitrates = 12; + } + } + + /* Set an indication of the max TCP throughput + * in bit/s that we can expect using this interface. + * May be use for QoS stuff... Jean II + */ + if (i > 2) + range->throughput = 5000 * 1000; + else + range->throughput = 1500 * 1000; + + range->min_rts = 0; + range->max_rts = 2347; + range->min_frag = 256; + range->max_frag = 2346; + + range->encoding_size[0] = 5; /* WEP: RC4 40 bits */ + range->encoding_size[1] = 13; /* WEP: RC4 ~128 bits */ + range->num_encoding_sizes = 2; + range->max_encoding_tokens = 4; + + /* power management not support */ + range->pmp_flags = IW_POWER_ON; + range->pmt_flags = IW_POWER_ON; + range->pm_capa = 0; + + /* Transmit Power - values are in dBm( or mW) */ + range->txpower[0] = -256; + range->num_txpower = 1; + range->txpower_capa = IW_TXPOW_DBM; + /* range->txpower_capa = IW_TXPOW_MWATT; */ + + range->we_version_source = 21; + range->we_version_compiled = WIRELESS_EXT; + + range->retry_capa = IW_RETRY_ON; + range->retry_flags = IW_RETRY_ON; + range->r_time_flags = IW_RETRY_ON; + + /* Experimental measurements - boundary 11/5.5 Mb/s + * + * Note : with or without the (local->rssi), results + * are somewhat different. - Jean II + */ + range->avg_qual.qual = 50; + range->avg_qual.level = 186; /* -70 dBm */ + range->avg_qual.noise = 0; + + /* Event capability (kernel + driver) */ + range->event_capa[0] = (IW_EVENT_CAPA_K_0 | + IW_EVENT_CAPA_MASK(SIOCGIWAP) | + IW_EVENT_CAPA_MASK(SIOCGIWSCAN)); + range->event_capa[1] = IW_EVENT_CAPA_K_1; + range->event_capa[4] = (IW_EVENT_CAPA_MASK(IWEVCUSTOM) | + IW_EVENT_CAPA_MASK(IWEVMICHAELMICFAILURE)); + + /* encode extension (WPA) capability */ + range->enc_capa = (IW_ENC_CAPA_WPA | + IW_ENC_CAPA_WPA2 | + IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP); + return 0; +} + +static int ks_wlan_set_power(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (vwrq->power.disabled) { + priv->reg.power_mgmt = POWER_MGMT_ACTIVE; + } else { + if (priv->reg.operation_mode != MODE_INFRASTRUCTURE) + return -EINVAL; + priv->reg.power_mgmt = POWER_MGMT_SAVE1; + } + + hostif_sme_enqueue(priv, SME_POW_MNGMT_REQUEST); + + return 0; +} + +static int ks_wlan_get_power(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + vwrq->power.disabled = (priv->reg.power_mgmt <= 0); + + return 0; +} + +static int ks_wlan_get_iwstats(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + vwrq->qual.qual = 0; /* not supported */ + vwrq->qual.level = priv->wstats.qual.level; + vwrq->qual.noise = 0; /* not supported */ + vwrq->qual.updated = 0; + + return 0; +} + +/* Note : this is deprecated in favor of IWSCAN */ +static int ks_wlan_get_aplist(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct sockaddr *address = (struct sockaddr *)extra; + struct iw_quality qual[LOCAL_APLIST_MAX]; + int i; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + for (i = 0; i < priv->aplist.size; i++) { + ether_addr_copy(address[i].sa_data, priv->aplist.ap[i].bssid); + address[i].sa_family = ARPHRD_ETHER; + qual[i].level = 256 - priv->aplist.ap[i].rssi; + qual[i].qual = priv->aplist.ap[i].sq; + qual[i].noise = 0; /* invalid noise value */ + qual[i].updated = 7; + } + if (i) { + dwrq->data.flags = 1; /* Should be define'd */ + memcpy(extra + sizeof(struct sockaddr) * i, + &qual, sizeof(struct iw_quality) * i); + } + dwrq->data.length = i; + + return 0; +} + +static int ks_wlan_set_scan(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_scan_req *req = NULL; + int len; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* specified SSID SCAN */ + if (wrqu->data.length == sizeof(struct iw_scan_req) && + wrqu->data.flags & IW_SCAN_THIS_ESSID) { + req = (struct iw_scan_req *)extra; + len = min_t(int, req->essid_len, IW_ESSID_MAX_SIZE); + priv->scan_ssid_len = len; + memcpy(priv->scan_ssid, req->essid, len); + } else { + priv->scan_ssid_len = 0; + } + + priv->sme_i.sme_flag |= SME_AP_SCAN; + hostif_sme_enqueue(priv, SME_BSS_SCAN_REQUEST); + + /* At this point, just return to the user. */ + + return 0; +} + +static char *ks_wlan_add_leader_event(const char *rsn_leader, char *end_buf, + char *current_ev, struct rsn_ie *rsn, + struct iw_event *iwe, + struct iw_request_info *info) +{ + char buffer[RSN_IE_BODY_MAX * 2 + 30]; + char *pbuf; + int i; + + pbuf = &buffer[0]; + memset(iwe, 0, sizeof(*iwe)); + iwe->cmd = IWEVCUSTOM; + memcpy(buffer, rsn_leader, sizeof(rsn_leader) - 1); + iwe->u.data.length += sizeof(rsn_leader) - 1; + pbuf += sizeof(rsn_leader) - 1; + pbuf += sprintf(pbuf, "%02x", rsn->id); + pbuf += sprintf(pbuf, "%02x", rsn->size); + iwe->u.data.length += 4; + + for (i = 0; i < rsn->size; i++) + pbuf += sprintf(pbuf, "%02x", rsn->body[i]); + + iwe->u.data.length += rsn->size * 2; + + return iwe_stream_add_point(info, current_ev, end_buf, iwe, &buffer[0]); +} + +/* + * Translate scan data returned from the card to a card independent + * format that the Wireless Tools will understand - Jean II + */ +static inline char *ks_wlan_translate_scan(struct net_device *dev, + struct iw_request_info *info, + char *current_ev, char *end_buf, + struct local_ap *ap) +{ + /* struct ks_wlan_private *priv = (struct ks_wlan_private *)dev->priv; */ + static const char rsn_leader[] = "rsn_ie="; + static const char wpa_leader[] = "wpa_ie="; + struct iw_event iwe; /* Temporary buffer */ + u16 capabilities; + char *current_val; /* For rates */ + int i; + + /* First entry *MUST* be the AP MAC address */ + iwe.cmd = SIOCGIWAP; + iwe.u.ap_addr.sa_family = ARPHRD_ETHER; + ether_addr_copy(iwe.u.ap_addr.sa_data, ap->bssid); + current_ev = iwe_stream_add_event(info, current_ev, + end_buf, &iwe, IW_EV_ADDR_LEN); + + /* Other entries will be displayed in the order we give them */ + + /* Add the ESSID */ + iwe.u.data.length = ap->ssid.size; + if (iwe.u.data.length > 32) + iwe.u.data.length = 32; + iwe.cmd = SIOCGIWESSID; + iwe.u.data.flags = 1; + current_ev = iwe_stream_add_point(info, current_ev, + end_buf, &iwe, ap->ssid.body); + + /* Add mode */ + iwe.cmd = SIOCGIWMODE; + capabilities = ap->capability; + if (capabilities & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS)) { + iwe.u.mode = (capabilities & WLAN_CAPABILITY_ESS) ? + IW_MODE_INFRA : IW_MODE_ADHOC; + current_ev = iwe_stream_add_event(info, current_ev, + end_buf, &iwe, IW_EV_UINT_LEN); + } + + /* Add frequency */ + iwe.cmd = SIOCGIWFREQ; + iwe.u.freq.m = ap->channel; + iwe.u.freq.m = frequency_list[iwe.u.freq.m - 1] * 100000; + iwe.u.freq.e = 1; + current_ev = iwe_stream_add_event(info, current_ev, + end_buf, &iwe, IW_EV_FREQ_LEN); + + /* Add quality statistics */ + iwe.cmd = IWEVQUAL; + iwe.u.qual.level = 256 - ap->rssi; + iwe.u.qual.qual = ap->sq; + iwe.u.qual.noise = 0; /* invalid noise value */ + current_ev = iwe_stream_add_event(info, current_ev, end_buf, + &iwe, IW_EV_QUAL_LEN); + + /* Add encryption capability */ + iwe.cmd = SIOCGIWENCODE; + iwe.u.data.flags = (capabilities & WLAN_CAPABILITY_PRIVACY) ? + (IW_ENCODE_ENABLED | IW_ENCODE_NOKEY) : + IW_ENCODE_DISABLED; + iwe.u.data.length = 0; + current_ev = iwe_stream_add_point(info, current_ev, end_buf, + &iwe, ap->ssid.body); + + /* + * Rate : stuffing multiple values in a single event + * require a bit more of magic - Jean II + */ + current_val = current_ev + IW_EV_LCP_LEN; + + iwe.cmd = SIOCGIWRATE; + + /* These two flags are ignored... */ + iwe.u.bitrate.fixed = 0; + iwe.u.bitrate.disabled = 0; + + /* Max 16 values */ + for (i = 0; i < 16; i++) { + /* NULL terminated */ + if (i >= ap->rate_set.size) + break; + /* Bit rate given in 500 kb/s units (+ 0x80) */ + iwe.u.bitrate.value = ((ap->rate_set.body[i] & 0x7f) * 500000); + /* Add new value to event */ + current_val = iwe_stream_add_value(info, current_ev, + current_val, end_buf, &iwe, + IW_EV_PARAM_LEN); + } + /* Check if we added any event */ + if ((current_val - current_ev) > IW_EV_LCP_LEN) + current_ev = current_val; + + if (ap->rsn_ie.id == RSN_INFO_ELEM_ID && ap->rsn_ie.size != 0) + current_ev = ks_wlan_add_leader_event(rsn_leader, end_buf, + current_ev, &ap->rsn_ie, + &iwe, info); + + if (ap->wpa_ie.id == WPA_INFO_ELEM_ID && ap->wpa_ie.size != 0) + current_ev = ks_wlan_add_leader_event(wpa_leader, end_buf, + current_ev, &ap->wpa_ie, + &iwe, info); + + /* + * The other data in the scan result are not really + * interesting, so for now drop it - Jean II + */ + return current_ev; +} + +static int ks_wlan_get_scan(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int i; + char *current_ev = extra; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (priv->sme_i.sme_flag & SME_AP_SCAN) + return -EAGAIN; + + if (priv->aplist.size == 0) { + /* Client error, no scan results... + * The caller need to restart the scan. + */ + return -ENODATA; + } + + /* Read and parse all entries */ + for (i = 0; i < priv->aplist.size; i++) { + if ((extra + dwrq->data.length) - current_ev <= IW_EV_ADDR_LEN) { + dwrq->data.length = 0; + return -E2BIG; + } + /* Translate to WE format this entry */ + current_ev = ks_wlan_translate_scan(dev, info, current_ev, + extra + dwrq->data.length, + &priv->aplist.ap[i]); + } + /* Length of data */ + dwrq->data.length = (current_ev - extra); + dwrq->data.flags = 0; + + return 0; +} + +/* called after a bunch of SET operations */ +static int ks_wlan_config_commit(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *zwrq, + char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (!priv->need_commit) + return 0; + + ks_wlan_setup_parameter(priv, priv->need_commit); + priv->need_commit = 0; + return 0; +} + +/* set association ie params */ +static int ks_wlan_set_genie(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + return 0; +// return -EOPNOTSUPP; +} + +static int ks_wlan_set_auth_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_param *param = &vwrq->param; + int index = (param->flags & IW_AUTH_INDEX); + int value = param->value; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + switch (index) { + case IW_AUTH_WPA_VERSION: /* 0 */ + switch (value) { + case IW_AUTH_WPA_VERSION_DISABLED: + priv->wpa.version = value; + if (priv->wpa.rsn_enabled) + priv->wpa.rsn_enabled = false; + priv->need_commit |= SME_RSN; + break; + case IW_AUTH_WPA_VERSION_WPA: + case IW_AUTH_WPA_VERSION_WPA2: + priv->wpa.version = value; + if (!(priv->wpa.rsn_enabled)) + priv->wpa.rsn_enabled = true; + priv->need_commit |= SME_RSN; + break; + default: + return -EOPNOTSUPP; + } + break; + case IW_AUTH_CIPHER_PAIRWISE: /* 1 */ + switch (value) { + case IW_AUTH_CIPHER_NONE: + if (priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x00; + priv->need_commit |= SME_WEP_FLAG; + } + break; + case IW_AUTH_CIPHER_WEP40: + case IW_AUTH_CIPHER_TKIP: + case IW_AUTH_CIPHER_CCMP: + case IW_AUTH_CIPHER_WEP104: + if (!priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x01; + priv->need_commit |= SME_WEP_FLAG; + } + priv->wpa.pairwise_suite = value; + priv->need_commit |= SME_RSN_UNICAST; + break; + default: + return -EOPNOTSUPP; + } + break; + case IW_AUTH_CIPHER_GROUP: /* 2 */ + switch (value) { + case IW_AUTH_CIPHER_NONE: + if (priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x00; + priv->need_commit |= SME_WEP_FLAG; + } + break; + case IW_AUTH_CIPHER_WEP40: + case IW_AUTH_CIPHER_TKIP: + case IW_AUTH_CIPHER_CCMP: + case IW_AUTH_CIPHER_WEP104: + if (!priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x01; + priv->need_commit |= SME_WEP_FLAG; + } + priv->wpa.group_suite = value; + priv->need_commit |= SME_RSN_MULTICAST; + break; + default: + return -EOPNOTSUPP; + } + break; + case IW_AUTH_KEY_MGMT: /* 3 */ + switch (value) { + case IW_AUTH_KEY_MGMT_802_1X: + case IW_AUTH_KEY_MGMT_PSK: + case 0: /* NONE or 802_1X_NO_WPA */ + case 4: /* WPA_NONE */ + priv->wpa.key_mgmt_suite = value; + priv->need_commit |= SME_RSN_AUTH; + break; + default: + return -EOPNOTSUPP; + } + break; + case IW_AUTH_80211_AUTH_ALG: /* 6 */ + switch (value) { + case IW_AUTH_ALG_OPEN_SYSTEM: + priv->wpa.auth_alg = value; + priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; + break; + case IW_AUTH_ALG_SHARED_KEY: + priv->wpa.auth_alg = value; + priv->reg.authenticate_type = AUTH_TYPE_SHARED_KEY; + break; + case IW_AUTH_ALG_LEAP: + default: + return -EOPNOTSUPP; + } + priv->need_commit |= SME_MODE_SET; + break; + case IW_AUTH_WPA_ENABLED: /* 7 */ + priv->wpa.wpa_enabled = value; + break; + case IW_AUTH_PRIVACY_INVOKED: /* 10 */ + if ((value && !priv->reg.privacy_invoked) || + (!value && priv->reg.privacy_invoked)) { + priv->reg.privacy_invoked = value ? 0x01 : 0x00; + priv->need_commit |= SME_WEP_FLAG; + } + break; + case IW_AUTH_RX_UNENCRYPTED_EAPOL: /* 4 */ + case IW_AUTH_TKIP_COUNTERMEASURES: /* 5 */ + case IW_AUTH_DROP_UNENCRYPTED: /* 8 */ + case IW_AUTH_ROAMING_CONTROL: /* 9 */ + default: + break; + } + + /* return -EINPROGRESS; */ + if (priv->need_commit) { + ks_wlan_setup_parameter(priv, priv->need_commit); + priv->need_commit = 0; + } + return 0; +} + +static int ks_wlan_get_auth_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *vwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_param *param = &vwrq->param; + int index = (param->flags & IW_AUTH_INDEX); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* WPA (not used ?? wpa_supplicant) */ + switch (index) { + case IW_AUTH_WPA_VERSION: + param->value = priv->wpa.version; + break; + case IW_AUTH_CIPHER_PAIRWISE: + param->value = priv->wpa.pairwise_suite; + break; + case IW_AUTH_CIPHER_GROUP: + param->value = priv->wpa.group_suite; + break; + case IW_AUTH_KEY_MGMT: + param->value = priv->wpa.key_mgmt_suite; + break; + case IW_AUTH_80211_AUTH_ALG: + param->value = priv->wpa.auth_alg; + break; + case IW_AUTH_WPA_ENABLED: + param->value = priv->wpa.rsn_enabled; + break; + case IW_AUTH_RX_UNENCRYPTED_EAPOL: /* OK??? */ + case IW_AUTH_TKIP_COUNTERMEASURES: + case IW_AUTH_DROP_UNENCRYPTED: + default: + /* return -EOPNOTSUPP; */ + break; + } + return 0; +} + +/* set encoding token & mode (WPA)*/ +static int ks_wlan_set_encode_ext(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_encode_ext *enc; + int index = dwrq->encoding.flags & IW_ENCODE_INDEX; + unsigned int commit = 0; + struct wpa_key *key; + + enc = (struct iw_encode_ext *)extra; + if (!enc) + return -EINVAL; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (index < 1 || index > 4) + return -EINVAL; + index--; + key = &priv->wpa.key[index]; + + if (dwrq->encoding.flags & IW_ENCODE_DISABLED) + key->key_len = 0; + + key->ext_flags = enc->ext_flags; + if (enc->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { + priv->wpa.txkey = index; + commit |= SME_WEP_INDEX; + } else if (enc->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { + memcpy(&key->rx_seq[0], &enc->rx_seq[0], IW_ENCODE_SEQ_MAX_SIZE); + } + + ether_addr_copy(&key->addr.sa_data[0], &enc->addr.sa_data[0]); + + switch (enc->alg) { + case IW_ENCODE_ALG_NONE: + if (priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x00; + commit |= SME_WEP_FLAG; + } + key->key_len = 0; + + break; + case IW_ENCODE_ALG_WEP: + case IW_ENCODE_ALG_CCMP: + if (!priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x01; + commit |= SME_WEP_FLAG; + } + if (enc->key_len) { + int key_len = clamp_val(enc->key_len, 0, IW_ENCODING_TOKEN_MAX); + + memcpy(&key->key_val[0], &enc->key[0], key_len); + key->key_len = key_len; + commit |= (SME_WEP_VAL1 << index); + } + break; + case IW_ENCODE_ALG_TKIP: + if (!priv->reg.privacy_invoked) { + priv->reg.privacy_invoked = 0x01; + commit |= SME_WEP_FLAG; + } + if (enc->key_len == 32) { + memcpy(&key->key_val[0], &enc->key[0], enc->key_len - 16); + key->key_len = enc->key_len - 16; + if (priv->wpa.key_mgmt_suite == 4) { /* WPA_NONE */ + memcpy(&key->tx_mic_key[0], &enc->key[16], 8); + memcpy(&key->rx_mic_key[0], &enc->key[16], 8); + } else { + memcpy(&key->tx_mic_key[0], &enc->key[16], 8); + memcpy(&key->rx_mic_key[0], &enc->key[24], 8); + } + commit |= (SME_WEP_VAL1 << index); + } + break; + default: + return -EINVAL; + } + key->alg = enc->alg; + + if (commit) { + if (commit & SME_WEP_INDEX) + hostif_sme_enqueue(priv, SME_SET_TXKEY); + if (commit & SME_WEP_VAL_MASK) + hostif_sme_enqueue(priv, SME_SET_KEY1 + index); + if (commit & SME_WEP_FLAG) + hostif_sme_enqueue(priv, SME_WEP_FLAG_REQUEST); + } + + return 0; +} + +/* get encoding token & mode (WPA)*/ +static int ks_wlan_get_encode_ext(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + /* WPA (not used ?? wpa_supplicant) + * struct ks_wlan_private *priv = (struct ks_wlan_private *)dev->priv; + * struct iw_encode_ext *enc; + * enc = (struct iw_encode_ext *)extra; + * int index = dwrq->flags & IW_ENCODE_INDEX; + * WPA (not used ?? wpa_supplicant) + */ + return 0; +} + +static int ks_wlan_set_pmksa(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_pmksa *pmksa; + int i; + struct pmk *pmk; + struct list_head *ptr; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (!extra) + return -EINVAL; + + pmksa = (struct iw_pmksa *)extra; + + switch (pmksa->cmd) { + case IW_PMKSA_ADD: + if (list_empty(&priv->pmklist.head)) { + for (i = 0; i < PMK_LIST_MAX; i++) { + pmk = &priv->pmklist.pmk[i]; + if (is_zero_ether_addr(pmk->bssid)) + break; + } + ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); + memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); + list_add(&pmk->list, &priv->pmklist.head); + priv->pmklist.size++; + break; + } + /* search cache data */ + list_for_each(ptr, &priv->pmklist.head) { + pmk = list_entry(ptr, struct pmk, list); + if (ether_addr_equal(pmksa->bssid.sa_data, pmk->bssid)) { + memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); + list_move(&pmk->list, &priv->pmklist.head); + break; + } + } + /* not find address. */ + if (ptr != &priv->pmklist.head) + break; + /* new cache data */ + if (priv->pmklist.size < PMK_LIST_MAX) { + for (i = 0; i < PMK_LIST_MAX; i++) { + pmk = &priv->pmklist.pmk[i]; + if (is_zero_ether_addr(pmk->bssid)) + break; + } + ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); + memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); + list_add(&pmk->list, &priv->pmklist.head); + priv->pmklist.size++; + } else { /* overwrite old cache data */ + pmk = list_entry(priv->pmklist.head.prev, struct pmk, + list); + ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); + memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); + list_move(&pmk->list, &priv->pmklist.head); + } + break; + case IW_PMKSA_REMOVE: + if (list_empty(&priv->pmklist.head)) + return -EINVAL; + /* search cache data */ + list_for_each(ptr, &priv->pmklist.head) { + pmk = list_entry(ptr, struct pmk, list); + if (ether_addr_equal(pmksa->bssid.sa_data, pmk->bssid)) { + eth_zero_addr(pmk->bssid); + memset(pmk->pmkid, 0, IW_PMKID_LEN); + list_del_init(&pmk->list); + break; + } + } + /* not find address. */ + if (ptr == &priv->pmklist.head) + return 0; + break; + case IW_PMKSA_FLUSH: + memset(&priv->pmklist, 0, sizeof(priv->pmklist)); + INIT_LIST_HEAD(&priv->pmklist.head); + for (i = 0; i < PMK_LIST_MAX; i++) + INIT_LIST_HEAD(&priv->pmklist.pmk[i].list); + break; + default: + return -EINVAL; + } + + hostif_sme_enqueue(priv, SME_SET_PMKSA); + return 0; +} + +static struct iw_statistics *ks_get_wireless_stats(struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_statistics *wstats = &priv->wstats; + + if (!atomic_read(&update_phyinfo)) + return (priv->dev_state < DEVICE_STATE_READY) ? NULL : wstats; + + /* + * Packets discarded in the wireless adapter due to wireless + * specific problems + */ + wstats->discard.nwid = 0; /* Rx invalid nwid */ + wstats->discard.code = 0; /* Rx invalid crypt */ + wstats->discard.fragment = 0; /* Rx invalid frag */ + wstats->discard.retries = 0; /* Tx excessive retries */ + wstats->discard.misc = 0; /* Invalid misc */ + wstats->miss.beacon = 0; /* Missed beacon */ + + return wstats; +} + +static int ks_wlan_set_stop_request(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (!(uwrq->mode)) + return -EINVAL; + + hostif_sme_enqueue(priv, SME_STOP_REQUEST); + return 0; +} + +#include <linux/ieee80211.h> +static int ks_wlan_set_mlme(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *dwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct iw_mlme *mlme = (struct iw_mlme *)extra; + union iwreq_data uwrq; + + uwrq.mode = 1; + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (mlme->cmd != IW_MLME_DEAUTH && + mlme->cmd != IW_MLME_DISASSOC) + return -EOPNOTSUPP; + + if (mlme->cmd == IW_MLME_DEAUTH && + mlme->reason_code == WLAN_REASON_MIC_FAILURE) + return 0; + + return ks_wlan_set_stop_request(dev, NULL, &uwrq, NULL); +} + +static int ks_wlan_get_firmware_version(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct iw_point *dwrq = &uwrq->data; + struct ks_wlan_private *priv = netdev_priv(dev); + + dwrq->length = priv->version_size + 1; + strscpy(extra, priv->firmware_version, dwrq->length); + return 0; +} + +static int ks_wlan_set_preamble(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + if (uwrq->mode != LONG_PREAMBLE && uwrq->mode != SHORT_PREAMBLE) + return -EINVAL; + + priv->reg.preamble = uwrq->mode; + priv->need_commit |= SME_MODE_SET; + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_preamble(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + uwrq->mode = priv->reg.preamble; + return 0; +} + +static int ks_wlan_set_power_mgmt(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (uwrq->mode != POWER_MGMT_ACTIVE && + uwrq->mode != POWER_MGMT_SAVE1 && + uwrq->mode != POWER_MGMT_SAVE2) + return -EINVAL; + + if ((uwrq->mode == POWER_MGMT_SAVE1 || uwrq->mode == POWER_MGMT_SAVE2) && + (priv->reg.operation_mode != MODE_INFRASTRUCTURE)) + return -EINVAL; + + priv->reg.power_mgmt = uwrq->mode; + hostif_sme_enqueue(priv, SME_POW_MNGMT_REQUEST); + + return 0; +} + +static int ks_wlan_get_power_mgmt(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* for SLEEP MODE */ + uwrq->mode = priv->reg.power_mgmt; + return 0; +} + +static int ks_wlan_set_scan_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + + if (uwrq->mode != ACTIVE_SCAN && uwrq->mode != PASSIVE_SCAN) + return -EINVAL; + + priv->reg.scan_type = uwrq->mode; + return 0; +} + +static int ks_wlan_get_scan_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->reg.scan_type; + return 0; +} + +static int ks_wlan_set_beacon_lost(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (uwrq->mode > BEACON_LOST_COUNT_MAX) + return -EINVAL; + + priv->reg.beacon_lost_count = uwrq->mode; + + if (priv->reg.operation_mode == MODE_INFRASTRUCTURE) { + priv->need_commit |= SME_MODE_SET; + return -EINPROGRESS; /* Call commit handler */ + } + + return 0; +} + +static int ks_wlan_get_beacon_lost(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->reg.beacon_lost_count; + return 0; +} + +static int ks_wlan_set_phy_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + if (uwrq->mode != D_11B_ONLY_MODE && + uwrq->mode != D_11G_ONLY_MODE && + uwrq->mode != D_11BG_COMPATIBLE_MODE) + return -EINVAL; + + /* for SLEEP MODE */ + priv->reg.phy_type = uwrq->mode; + priv->need_commit |= SME_MODE_SET; + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_phy_type(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->reg.phy_type; + return 0; +} + +static int ks_wlan_set_cts_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (uwrq->mode != CTS_MODE_FALSE && uwrq->mode != CTS_MODE_TRUE) + return -EINVAL; + + priv->reg.cts_mode = (uwrq->mode == CTS_MODE_FALSE) ? uwrq->mode : + (priv->reg.phy_type == D_11G_ONLY_MODE || + priv->reg.phy_type == D_11BG_COMPATIBLE_MODE) ? + uwrq->mode : !uwrq->mode; + + priv->need_commit |= SME_MODE_SET; + return -EINPROGRESS; /* Call commit handler */ +} + +static int ks_wlan_get_cts_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->reg.cts_mode; + return 0; +} + +static int ks_wlan_set_sleep_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (uwrq->mode != SLP_SLEEP && + uwrq->mode != SLP_ACTIVE) { + netdev_err(dev, "SET_SLEEP_MODE %d error\n", uwrq->mode); + return -EINVAL; + } + + priv->sleep_mode = uwrq->mode; + netdev_info(dev, "SET_SLEEP_MODE %d\n", priv->sleep_mode); + + if (uwrq->mode == SLP_SLEEP) + hostif_sme_enqueue(priv, SME_STOP_REQUEST); + + hostif_sme_enqueue(priv, SME_SLEEP_REQUEST); + + return 0; +} + +static int ks_wlan_get_sleep_mode(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + uwrq->mode = priv->sleep_mode; + + return 0; +} + +static int ks_wlan_set_wps_enable(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (uwrq->mode != 0 && uwrq->mode != 1) + return -EINVAL; + + priv->wps.wps_enabled = uwrq->mode; + hostif_sme_enqueue(priv, SME_WPS_ENABLE_REQUEST); + + return 0; +} + +static int ks_wlan_get_wps_enable(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->wps.wps_enabled; + netdev_info(dev, "return=%d\n", uwrq->mode); + + return 0; +} + +static int ks_wlan_set_wps_probe_req(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct iw_point *dwrq = &uwrq->data; + u8 *p = extra; + unsigned char len; + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + + /* length check */ + if (p[1] + 2 != dwrq->length || dwrq->length > 256) + return -EINVAL; + + priv->wps.ielen = p[1] + 2 + 1; /* IE header + IE + sizeof(len) */ + len = p[1] + 2; /* IE header + IE */ + + memcpy(priv->wps.ie, &len, sizeof(len)); + p = memcpy(priv->wps.ie + 1, p, len); + + netdev_dbg(dev, "%d(%#x): %02X %02X %02X %02X ... %02X %02X %02X\n", + priv->wps.ielen, priv->wps.ielen, p[0], p[1], p[2], p[3], + p[priv->wps.ielen - 3], p[priv->wps.ielen - 2], + p[priv->wps.ielen - 1]); + + hostif_sme_enqueue(priv, SME_WPS_PROBE_REQUEST); + + return 0; +} + +static int ks_wlan_set_tx_gain(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (uwrq->mode > 0xFF) + return -EINVAL; + + priv->gain.tx_gain = (u8)uwrq->mode; + priv->gain.tx_mode = (priv->gain.tx_gain < 0xFF) ? 1 : 0; + hostif_sme_enqueue(priv, SME_SET_GAIN); + return 0; +} + +static int ks_wlan_get_tx_gain(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->gain.tx_gain; + hostif_sme_enqueue(priv, SME_GET_GAIN); + return 0; +} + +static int ks_wlan_set_rx_gain(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + if (uwrq->mode > 0xFF) + return -EINVAL; + + priv->gain.rx_gain = (u8)uwrq->mode; + priv->gain.rx_mode = (priv->gain.rx_gain < 0xFF) ? 1 : 0; + hostif_sme_enqueue(priv, SME_SET_GAIN); + return 0; +} + +static int ks_wlan_get_rx_gain(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->sleep_mode == SLP_SLEEP) + return -EPERM; + /* for SLEEP MODE */ + uwrq->mode = priv->gain.rx_gain; + hostif_sme_enqueue(priv, SME_GET_GAIN); + return 0; +} + +static int ks_wlan_get_eeprom_cksum(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + uwrq->mode = priv->eeprom_checksum; + return 0; +} + +static void print_hif_event(struct net_device *dev, int event) +{ + switch (event) { + case HIF_DATA_REQ: + netdev_info(dev, "HIF_DATA_REQ\n"); + break; + case HIF_DATA_IND: + netdev_info(dev, "HIF_DATA_IND\n"); + break; + case HIF_MIB_GET_REQ: + netdev_info(dev, "HIF_MIB_GET_REQ\n"); + break; + case HIF_MIB_GET_CONF: + netdev_info(dev, "HIF_MIB_GET_CONF\n"); + break; + case HIF_MIB_SET_REQ: + netdev_info(dev, "HIF_MIB_SET_REQ\n"); + break; + case HIF_MIB_SET_CONF: + netdev_info(dev, "HIF_MIB_SET_CONF\n"); + break; + case HIF_POWER_MGMT_REQ: + netdev_info(dev, "HIF_POWER_MGMT_REQ\n"); + break; + case HIF_POWER_MGMT_CONF: + netdev_info(dev, "HIF_POWER_MGMT_CONF\n"); + break; + case HIF_START_REQ: + netdev_info(dev, "HIF_START_REQ\n"); + break; + case HIF_START_CONF: + netdev_info(dev, "HIF_START_CONF\n"); + break; + case HIF_CONNECT_IND: + netdev_info(dev, "HIF_CONNECT_IND\n"); + break; + case HIF_STOP_REQ: + netdev_info(dev, "HIF_STOP_REQ\n"); + break; + case HIF_STOP_CONF: + netdev_info(dev, "HIF_STOP_CONF\n"); + break; + case HIF_PS_ADH_SET_REQ: + netdev_info(dev, "HIF_PS_ADH_SET_REQ\n"); + break; + case HIF_PS_ADH_SET_CONF: + netdev_info(dev, "HIF_PS_ADH_SET_CONF\n"); + break; + case HIF_INFRA_SET_REQ: + netdev_info(dev, "HIF_INFRA_SET_REQ\n"); + break; + case HIF_INFRA_SET_CONF: + netdev_info(dev, "HIF_INFRA_SET_CONF\n"); + break; + case HIF_ADH_SET_REQ: + netdev_info(dev, "HIF_ADH_SET_REQ\n"); + break; + case HIF_ADH_SET_CONF: + netdev_info(dev, "HIF_ADH_SET_CONF\n"); + break; + case HIF_AP_SET_REQ: + netdev_info(dev, "HIF_AP_SET_REQ\n"); + break; + case HIF_AP_SET_CONF: + netdev_info(dev, "HIF_AP_SET_CONF\n"); + break; + case HIF_ASSOC_INFO_IND: + netdev_info(dev, "HIF_ASSOC_INFO_IND\n"); + break; + case HIF_MIC_FAILURE_REQ: + netdev_info(dev, "HIF_MIC_FAILURE_REQ\n"); + break; + case HIF_MIC_FAILURE_CONF: + netdev_info(dev, "HIF_MIC_FAILURE_CONF\n"); + break; + case HIF_SCAN_REQ: + netdev_info(dev, "HIF_SCAN_REQ\n"); + break; + case HIF_SCAN_CONF: + netdev_info(dev, "HIF_SCAN_CONF\n"); + break; + case HIF_PHY_INFO_REQ: + netdev_info(dev, "HIF_PHY_INFO_REQ\n"); + break; + case HIF_PHY_INFO_CONF: + netdev_info(dev, "HIF_PHY_INFO_CONF\n"); + break; + case HIF_SLEEP_REQ: + netdev_info(dev, "HIF_SLEEP_REQ\n"); + break; + case HIF_SLEEP_CONF: + netdev_info(dev, "HIF_SLEEP_CONF\n"); + break; + case HIF_PHY_INFO_IND: + netdev_info(dev, "HIF_PHY_INFO_IND\n"); + break; + case HIF_SCAN_IND: + netdev_info(dev, "HIF_SCAN_IND\n"); + break; + case HIF_INFRA_SET2_REQ: + netdev_info(dev, "HIF_INFRA_SET2_REQ\n"); + break; + case HIF_INFRA_SET2_CONF: + netdev_info(dev, "HIF_INFRA_SET2_CONF\n"); + break; + case HIF_ADH_SET2_REQ: + netdev_info(dev, "HIF_ADH_SET2_REQ\n"); + break; + case HIF_ADH_SET2_CONF: + netdev_info(dev, "HIF_ADH_SET2_CONF\n"); + } +} + +/* get host command history */ +static int ks_wlan_hostt(struct net_device *dev, struct iw_request_info *info, + union iwreq_data *uwrq, char *extra) +{ + int i, event; + struct ks_wlan_private *priv = netdev_priv(dev); + + for (i = 63; i >= 0; i--) { + event = + priv->hostt.buff[(priv->hostt.qtail - 1 - i) % + SME_EVENT_BUFF_SIZE]; + print_hif_event(dev, event); + } + return 0; +} + +/* Structures to export the Wireless Handlers */ + +static const struct iw_priv_args ks_wlan_private_args[] = { +/*{ cmd, set_args, get_args, name[16] } */ + {KS_WLAN_GET_FIRM_VERSION, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_CHAR | (128 + 1), "GetFirmwareVer"}, + {KS_WLAN_SET_WPS_ENABLE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetWPSEnable"}, + {KS_WLAN_GET_WPS_ENABLE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetW"}, + {KS_WLAN_SET_WPS_PROBE_REQ, IW_PRIV_TYPE_BYTE | 2047, IW_PRIV_TYPE_NONE, + "SetWPSProbeReq"}, + {KS_WLAN_SET_PREAMBLE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetPreamble"}, + {KS_WLAN_GET_PREAMBLE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPreamble"}, + {KS_WLAN_SET_POWER_SAVE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetPowerSave"}, + {KS_WLAN_GET_POWER_SAVE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPowerSave"}, + {KS_WLAN_SET_SCAN_TYPE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetScanType"}, + {KS_WLAN_GET_SCAN_TYPE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetScanType"}, + {KS_WLAN_SET_RX_GAIN, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetRxGain"}, + {KS_WLAN_GET_RX_GAIN, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetRxGain"}, + {KS_WLAN_HOSTT, IW_PRIV_TYPE_NONE, IW_PRIV_TYPE_CHAR | (128 + 1), + "hostt"}, + {KS_WLAN_SET_BEACON_LOST, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetBeaconLost"}, + {KS_WLAN_GET_BEACON_LOST, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetBeaconLost"}, + {KS_WLAN_SET_SLEEP_MODE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetSleepMode"}, + {KS_WLAN_GET_SLEEP_MODE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetSleepMode"}, + {KS_WLAN_SET_TX_GAIN, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetTxGain"}, + {KS_WLAN_GET_TX_GAIN, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetTxGain"}, + {KS_WLAN_SET_PHY_TYPE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetPhyType"}, + {KS_WLAN_GET_PHY_TYPE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPhyType"}, + {KS_WLAN_SET_CTS_MODE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + IW_PRIV_TYPE_NONE, "SetCtsMode"}, + {KS_WLAN_GET_CTS_MODE, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetCtsMode"}, + {KS_WLAN_GET_EEPROM_CKSUM, IW_PRIV_TYPE_NONE, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetChecksum"}, +}; + +static const iw_handler ks_wlan_handler[] = { + IW_HANDLER(SIOCSIWCOMMIT, ks_wlan_config_commit), + IW_HANDLER(SIOCGIWNAME, ks_wlan_get_name), + IW_HANDLER(SIOCSIWFREQ, ks_wlan_set_freq), + IW_HANDLER(SIOCGIWFREQ, ks_wlan_get_freq), + IW_HANDLER(SIOCSIWMODE, ks_wlan_set_mode), + IW_HANDLER(SIOCGIWMODE, ks_wlan_get_mode), + IW_HANDLER(SIOCGIWRANGE, ks_wlan_get_range), + IW_HANDLER(SIOCGIWSTATS, ks_wlan_get_iwstats), + IW_HANDLER(SIOCSIWAP, ks_wlan_set_wap), + IW_HANDLER(SIOCGIWAP, ks_wlan_get_wap), + IW_HANDLER(SIOCSIWMLME, ks_wlan_set_mlme), + IW_HANDLER(SIOCGIWAPLIST, ks_wlan_get_aplist), + IW_HANDLER(SIOCSIWSCAN, ks_wlan_set_scan), + IW_HANDLER(SIOCGIWSCAN, ks_wlan_get_scan), + IW_HANDLER(SIOCSIWESSID, ks_wlan_set_essid), + IW_HANDLER(SIOCGIWESSID, ks_wlan_get_essid), + IW_HANDLER(SIOCSIWNICKN, ks_wlan_set_nick), + IW_HANDLER(SIOCGIWNICKN, ks_wlan_get_nick), + IW_HANDLER(SIOCSIWRATE, ks_wlan_set_rate), + IW_HANDLER(SIOCGIWRATE, ks_wlan_get_rate), + IW_HANDLER(SIOCSIWRTS, ks_wlan_set_rts), + IW_HANDLER(SIOCGIWRTS, ks_wlan_get_rts), + IW_HANDLER(SIOCSIWFRAG, ks_wlan_set_frag), + IW_HANDLER(SIOCGIWFRAG, ks_wlan_get_frag), + IW_HANDLER(SIOCSIWENCODE, ks_wlan_set_encode), + IW_HANDLER(SIOCGIWENCODE, ks_wlan_get_encode), + IW_HANDLER(SIOCSIWPOWER, ks_wlan_set_power), + IW_HANDLER(SIOCGIWPOWER, ks_wlan_get_power), + IW_HANDLER(SIOCSIWGENIE, ks_wlan_set_genie), + IW_HANDLER(SIOCSIWAUTH, ks_wlan_set_auth_mode), + IW_HANDLER(SIOCGIWAUTH, ks_wlan_get_auth_mode), + IW_HANDLER(SIOCSIWENCODEEXT, ks_wlan_set_encode_ext), + IW_HANDLER(SIOCGIWENCODEEXT, ks_wlan_get_encode_ext), + IW_HANDLER(SIOCSIWPMKSA, ks_wlan_set_pmksa), +}; + +/* private_handler */ +static const iw_handler ks_wlan_private_handler[] = { + NULL, /* 0 */ + NULL, /* 1, KS_WLAN_GET_DRIVER_VERSION */ + NULL, /* 2 */ + ks_wlan_get_firmware_version, /* 3 KS_WLAN_GET_FIRM_VERSION */ + ks_wlan_set_wps_enable, /* 4 KS_WLAN_SET_WPS_ENABLE */ + ks_wlan_get_wps_enable, /* 5 KS_WLAN_GET_WPS_ENABLE */ + ks_wlan_set_wps_probe_req, /* 6 KS_WLAN_SET_WPS_PROBE_REQ */ + ks_wlan_get_eeprom_cksum, /* 7 KS_WLAN_GET_CONNECT */ + ks_wlan_set_preamble, /* 8 KS_WLAN_SET_PREAMBLE */ + ks_wlan_get_preamble, /* 9 KS_WLAN_GET_PREAMBLE */ + ks_wlan_set_power_mgmt, /* 10 KS_WLAN_SET_POWER_SAVE */ + ks_wlan_get_power_mgmt, /* 11 KS_WLAN_GET_POWER_SAVE */ + ks_wlan_set_scan_type, /* 12 KS_WLAN_SET_SCAN_TYPE */ + ks_wlan_get_scan_type, /* 13 KS_WLAN_GET_SCAN_TYPE */ + ks_wlan_set_rx_gain, /* 14 KS_WLAN_SET_RX_GAIN */ + ks_wlan_get_rx_gain, /* 15 KS_WLAN_GET_RX_GAIN */ + ks_wlan_hostt, /* 16 KS_WLAN_HOSTT */ + NULL, /* 17 */ + ks_wlan_set_beacon_lost, /* 18 KS_WLAN_SET_BECAN_LOST */ + ks_wlan_get_beacon_lost, /* 19 KS_WLAN_GET_BECAN_LOST */ + ks_wlan_set_tx_gain, /* 20 KS_WLAN_SET_TX_GAIN */ + ks_wlan_get_tx_gain, /* 21 KS_WLAN_GET_TX_GAIN */ + ks_wlan_set_phy_type, /* 22 KS_WLAN_SET_PHY_TYPE */ + ks_wlan_get_phy_type, /* 23 KS_WLAN_GET_PHY_TYPE */ + ks_wlan_set_cts_mode, /* 24 KS_WLAN_SET_CTS_MODE */ + ks_wlan_get_cts_mode, /* 25 KS_WLAN_GET_CTS_MODE */ + NULL, /* 26 */ + NULL, /* 27 */ + ks_wlan_set_sleep_mode, /* 28 KS_WLAN_SET_SLEEP_MODE */ + ks_wlan_get_sleep_mode, /* 29 KS_WLAN_GET_SLEEP_MODE */ + NULL, /* 30 */ + NULL, /* 31 */ +}; + +static const struct iw_handler_def ks_wlan_handler_def = { + .num_standard = ARRAY_SIZE(ks_wlan_handler), + .num_private = ARRAY_SIZE(ks_wlan_private_handler), + .num_private_args = ARRAY_SIZE(ks_wlan_private_args), + .standard = ks_wlan_handler, + .private = ks_wlan_private_handler, + .private_args = ks_wlan_private_args, + .get_wireless_stats = ks_get_wireless_stats, +}; + +static int ks_wlan_netdev_ioctl(struct net_device *dev, struct ifreq *rq, + int cmd) +{ + int ret; + struct iwreq *wrq = (struct iwreq *)rq; + + switch (cmd) { + case SIOCIWFIRSTPRIV + 20: /* KS_WLAN_SET_STOP_REQ */ + ret = ks_wlan_set_stop_request(dev, NULL, &wrq->u, NULL); + break; + // All other calls are currently unsupported + default: + ret = -EOPNOTSUPP; + } + + return ret; +} + +static +struct net_device_stats *ks_wlan_get_stats(struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->dev_state < DEVICE_STATE_READY) + return NULL; /* not finished initialize */ + + return &priv->nstats; +} + +static +int ks_wlan_set_mac_address(struct net_device *dev, void *addr) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + struct sockaddr *mac_addr = (struct sockaddr *)addr; + + if (netif_running(dev)) + return -EBUSY; + eth_hw_addr_set(dev, mac_addr->sa_data); + ether_addr_copy(priv->eth_addr, mac_addr->sa_data); + + priv->mac_address_valid = false; + hostif_sme_enqueue(priv, SME_MACADDRESS_SET_REQUEST); + netdev_info(dev, "ks_wlan: MAC ADDRESS = %pM\n", priv->eth_addr); + return 0; +} + +static +void ks_wlan_tx_timeout(struct net_device *dev, unsigned int txqueue) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + netdev_dbg(dev, "head(%d) tail(%d)!!\n", priv->tx_dev.qhead, + priv->tx_dev.qtail); + if (!netif_queue_stopped(dev)) + netif_stop_queue(dev); + priv->nstats.tx_errors++; + netif_wake_queue(dev); +} + +static +netdev_tx_t ks_wlan_start_xmit(struct sk_buff *skb, struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + int ret; + + netdev_dbg(dev, "in_interrupt()=%ld\n", in_interrupt()); + + if (!skb) { + netdev_err(dev, "ks_wlan: skb == NULL!!!\n"); + return 0; + } + if (priv->dev_state < DEVICE_STATE_READY) { + dev_kfree_skb(skb); + return 0; /* not finished initialize */ + } + + if (netif_running(dev)) + netif_stop_queue(dev); + + ret = hostif_data_request(priv, skb); + netif_trans_update(dev); + + if (ret) + netdev_err(dev, "hostif_data_request error: =%d\n", ret); + + return 0; +} + +void send_packet_complete(struct ks_wlan_private *priv, struct sk_buff *skb) +{ + priv->nstats.tx_packets++; + + if (netif_queue_stopped(priv->net_dev)) + netif_wake_queue(priv->net_dev); + + if (skb) { + priv->nstats.tx_bytes += skb->len; + dev_kfree_skb(skb); + } +} + +/* + * Set or clear the multicast filter for this adaptor. + * This routine is not state sensitive and need not be SMP locked. + */ +static +void ks_wlan_set_rx_mode(struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + if (priv->dev_state < DEVICE_STATE_READY) + return; /* not finished initialize */ + hostif_sme_enqueue(priv, SME_MULTICAST_REQUEST); +} + +static +int ks_wlan_open(struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + priv->cur_rx = 0; + + if (!priv->mac_address_valid) { + netdev_err(dev, "ks_wlan : %s Not READY !!\n", dev->name); + return -EBUSY; + } + netif_start_queue(dev); + + return 0; +} + +static +int ks_wlan_close(struct net_device *dev) +{ + netif_stop_queue(dev); + + return 0; +} + +/* Operational parameters that usually are not changed. */ +/* Time in jiffies before concluding the transmitter is hung. */ +#define TX_TIMEOUT (3 * HZ) +static const unsigned char dummy_addr[] = { + 0x00, 0x0b, 0xe3, 0x00, 0x00, 0x00 +}; + +static const struct net_device_ops ks_wlan_netdev_ops = { + .ndo_start_xmit = ks_wlan_start_xmit, + .ndo_open = ks_wlan_open, + .ndo_stop = ks_wlan_close, + .ndo_do_ioctl = ks_wlan_netdev_ioctl, + .ndo_set_mac_address = ks_wlan_set_mac_address, + .ndo_get_stats = ks_wlan_get_stats, + .ndo_tx_timeout = ks_wlan_tx_timeout, + .ndo_set_rx_mode = ks_wlan_set_rx_mode, +}; + +int ks_wlan_net_start(struct net_device *dev) +{ + struct ks_wlan_private *priv; + /* int rc; */ + + priv = netdev_priv(dev); + priv->mac_address_valid = false; + priv->is_device_open = true; + priv->need_commit = 0; + /* phy information update timer */ + atomic_set(&update_phyinfo, 0); + timer_setup(&update_phyinfo_timer, ks_wlan_update_phyinfo_timeout, 0); + + /* dummy address set */ + ether_addr_copy(priv->eth_addr, dummy_addr); + eth_hw_addr_set(dev, priv->eth_addr); + + /* The ks_wlan-specific entries in the device structure. */ + dev->netdev_ops = &ks_wlan_netdev_ops; + dev->wireless_handlers = &ks_wlan_handler_def; + dev->watchdog_timeo = TX_TIMEOUT; + + netif_carrier_off(dev); + + return 0; +} + +int ks_wlan_net_stop(struct net_device *dev) +{ + struct ks_wlan_private *priv = netdev_priv(dev); + + priv->is_device_open = false; + del_timer_sync(&update_phyinfo_timer); + + if (netif_running(dev)) + netif_stop_queue(dev); + + return 0; +} + +/** + * is_connect_status() - return true if status is 'connected' + * @status: high bit is used as FORCE_DISCONNECT, low bits used for + * connect status. + */ +bool is_connect_status(u32 status) +{ + return (status & CONNECT_STATUS_MASK) == CONNECT_STATUS; +} + +/** + * is_disconnect_status() - return true if status is 'disconnected' + * @status: high bit is used as FORCE_DISCONNECT, low bits used for + * disconnect status. + */ +bool is_disconnect_status(u32 status) +{ + return (status & CONNECT_STATUS_MASK) == DISCONNECT_STATUS; +} |