diff options
author | Daniel Baumann <daniel.baumann@progress-linux.org> | 2024-04-11 08:27:49 +0000 |
---|---|---|
committer | Daniel Baumann <daniel.baumann@progress-linux.org> | 2024-04-11 08:27:49 +0000 |
commit | ace9429bb58fd418f0c81d4c2835699bddf6bde6 (patch) | |
tree | b2d64bc10158fdd5497876388cd68142ca374ed3 /drivers/staging/ks7010 | |
parent | Initial commit. (diff) | |
download | linux-ace9429bb58fd418f0c81d4c2835699bddf6bde6.tar.xz linux-ace9429bb58fd418f0c81d4c2835699bddf6bde6.zip |
Adding upstream version 6.6.15.upstream/6.6.15
Signed-off-by: Daniel Baumann <daniel.baumann@progress-linux.org>
Diffstat (limited to 'drivers/staging/ks7010')
-rw-r--r-- | drivers/staging/ks7010/Kconfig | 14 | ||||
-rw-r--r-- | drivers/staging/ks7010/Makefile | 4 | ||||
-rw-r--r-- | drivers/staging/ks7010/TODO | 36 | ||||
-rw-r--r-- | drivers/staging/ks7010/eap_packet.h | 70 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks7010_sdio.c | 1143 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks_hostif.c | 2312 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks_hostif.h | 617 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks_wlan.h | 567 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks_wlan_ioctl.h | 61 | ||||
-rw-r--r-- | drivers/staging/ks7010/ks_wlan_net.c | 2676 |
10 files changed, 7500 insertions, 0 deletions
diff --git a/drivers/staging/ks7010/Kconfig b/drivers/staging/ks7010/Kconfig new file mode 100644 index 0000000000..8ea6c09286 --- /dev/null +++ b/drivers/staging/ks7010/Kconfig @@ -0,0 +1,14 @@ +# SPDX-License-Identifier: GPL-2.0 +config KS7010 + tristate "KeyStream KS7010 SDIO support" + depends on MMC && WIRELESS + select WIRELESS_EXT + select WEXT_PRIV + select FW_LOADER + select CRYPTO + select CRYPTO_HASH + select CRYPTO_MICHAEL_MIC + help + This is a driver for KeyStream KS7010 based SDIO WIFI cards. It is + found on at least later Spectec SDW-821 (FCC-ID "S2Y-WLAN-11G-K" only, + sadly not FCC-ID "S2Y-WLAN-11B-G") and Spectec SDW-823 microSD cards. diff --git a/drivers/staging/ks7010/Makefile b/drivers/staging/ks7010/Makefile new file mode 100644 index 0000000000..009851a323 --- /dev/null +++ b/drivers/staging/ks7010/Makefile @@ -0,0 +1,4 @@ +# SPDX-License-Identifier: GPL-2.0 +obj-$(CONFIG_KS7010) += ks7010.o + +ks7010-y := ks_hostif.o ks_wlan_net.o ks7010_sdio.o diff --git a/drivers/staging/ks7010/TODO b/drivers/staging/ks7010/TODO new file mode 100644 index 0000000000..80c97543b9 --- /dev/null +++ b/drivers/staging/ks7010/TODO @@ -0,0 +1,36 @@ +KS7010 Linux driver +=================== + +This driver is based on source code from the Ben Nanonote extra repository [1] +which is based on the original v007 release from Renesas [2]. Some more +background info about the chipset can be found here [3] and here [4]. Thank +you to all which already participated in cleaning up the driver so far! + +[1] http://projects.qi-hardware.com/index.php/p/openwrt-packages/source/tree/master/ks7010/src +[2] http://downloads.qi-hardware.com/software/ks7010_sdio_v007.tar.bz2 +[3] http://en.qi-hardware.com/wiki/Ben_NanoNote_Wi-Fi +[4] https://wikidevi.com/wiki/Renesas + +TODO +---- + +First a few words what not to do (at least not blindly): + +- don't be overly strict with the 80 char limit. Only if it REALLY makes the + code more readable + +Now the TODOs: + +- fix codechecker warnings (checkpatch, sparse, smatch). But PLEASE make sure + that you are not only silencing the warning but really fixing code. You + should understand the change you submit. +- fix the 'card removal' event when card is inserted when booting +- check what other upstream wireless mechanisms can be used instead of the + custom ones here +- Switch to use LIB80211. +- Switch to use MAC80211. +- Switch to use CFG80211. + +Please send any patches to: +Greg Kroah-Hartman <gregkh@linuxfoundation.org> +Linux Driver Project Developer List <driverdev-devel@linuxdriverproject.org> diff --git a/drivers/staging/ks7010/eap_packet.h b/drivers/staging/ks7010/eap_packet.h new file mode 100644 index 0000000000..1eee774319 --- /dev/null +++ b/drivers/staging/ks7010/eap_packet.h @@ -0,0 +1,70 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#ifndef EAP_PACKET_H +#define EAP_PACKET_H + +#include <linux/compiler.h> +#include <linux/bitops.h> +#include <uapi/linux/if_ether.h> + +struct ether_hdr { + unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ + unsigned char h_source[ETH_ALEN]; /* source ether addr */ + unsigned char h_dest_snap; + unsigned char h_source_snap; + unsigned char h_command; + unsigned char h_vendor_id[3]; + __be16 h_proto; /* packet type ID field */ + /* followed by length octets of data */ +} __packed; + +#define ETHER_HDR_SIZE sizeof(struct ether_hdr) + +struct ieee802_1x_hdr { + unsigned char version; + unsigned char type; + unsigned short length; + /* followed by length octets of data */ +} __packed; + +enum { + IEEE802_1X_TYPE_EAP_PACKET = 0, + IEEE802_1X_TYPE_EAPOL_START = 1, + IEEE802_1X_TYPE_EAPOL_LOGOFF = 2, + IEEE802_1X_TYPE_EAPOL_KEY = 3, + IEEE802_1X_TYPE_EAPOL_ENCAPSULATED_ASF_ALERT = 4 +}; + +#define WPA_NONCE_LEN 32 +#define WPA_REPLAY_COUNTER_LEN 8 + +struct wpa_eapol_key { + unsigned char type; + __be16 key_info; + unsigned short key_length; + unsigned char replay_counter[WPA_REPLAY_COUNTER_LEN]; + unsigned char key_nonce[WPA_NONCE_LEN]; + unsigned char key_iv[16]; + unsigned char key_rsc[8]; + unsigned char key_id[8]; /* Reserved in IEEE 802.11i/RSN */ + unsigned char key_mic[16]; + unsigned short key_data_length; + /* followed by key_data_length bytes of key_data */ +} __packed; + +#define WPA_KEY_INFO_TYPE_MASK GENMASK(2, 0) +#define WPA_KEY_INFO_TYPE_HMAC_MD5_RC4 BIT(0) +#define WPA_KEY_INFO_TYPE_HMAC_SHA1_AES BIT(1) +#define WPA_KEY_INFO_KEY_TYPE BIT(3) /* 1 = Pairwise, 0 = Group key */ +/* bit4..5 is used in WPA, but is reserved in IEEE 802.11i/RSN */ +#define WPA_KEY_INFO_KEY_INDEX_MASK GENMASK(5, 4) +#define WPA_KEY_INFO_KEY_INDEX_SHIFT 4 +#define WPA_KEY_INFO_INSTALL BIT(6) /* pairwise */ +#define WPA_KEY_INFO_TXRX BIT(6) /* group */ +#define WPA_KEY_INFO_ACK BIT(7) +#define WPA_KEY_INFO_MIC BIT(8) +#define WPA_KEY_INFO_SECURE BIT(9) +#define WPA_KEY_INFO_ERROR BIT(10) +#define WPA_KEY_INFO_REQUEST BIT(11) +#define WPA_KEY_INFO_ENCR_KEY_DATA BIT(12) /* IEEE 802.11i/RSN only */ + +#endif /* EAP_PACKET_H */ diff --git a/drivers/staging/ks7010/ks7010_sdio.c b/drivers/staging/ks7010/ks7010_sdio.c new file mode 100644 index 0000000000..9fb118e77a --- /dev/null +++ b/drivers/staging/ks7010/ks7010_sdio.c @@ -0,0 +1,1143 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for KeyStream, KS7010 based SDIO cards. + * + * Copyright (C) 2006-2008 KeyStream Corp. + * Copyright (C) 2009 Renesas Technology Corp. + * Copyright (C) 2016 Sang Engineering, Wolfram Sang + */ + +#include <linux/atomic.h> +#include <linux/firmware.h> +#include <linux/jiffies.h> +#include <linux/mmc/card.h> +#include <linux/mmc/sdio_func.h> +#include <linux/module.h> +#include <linux/workqueue.h> +#include "ks_wlan.h" +#include "ks_hostif.h" + +#define ROM_FILE "ks7010sd.rom" + +/* SDIO KeyStream vendor and device */ +#define SDIO_VENDOR_ID_KS_CODE_A 0x005b +#define SDIO_VENDOR_ID_KS_CODE_B 0x0023 + +/* Older sources suggest earlier versions were named 7910 or 79xx */ +#define SDIO_DEVICE_ID_KS_7010 0x7910 + +/* Read/Write Status Register */ +#define READ_STATUS_REG 0x000000 +#define WRITE_STATUS_REG 0x00000C +enum reg_status_type { + REG_STATUS_BUSY, + REG_STATUS_IDLE +}; + +/* Read Index Register */ +#define READ_INDEX_REG 0x000004 + +/* Read Data Size Register */ +#define READ_DATA_SIZE_REG 0x000008 + +/* Write Index Register */ +#define WRITE_INDEX_REG 0x000010 + +/* + * Write Status/Read Data Size Register + * for network packet (less than 2048 bytes data) + */ +#define WSTATUS_RSIZE_REG 0x000014 + +/* Write Status Register value */ +#define WSTATUS_MASK 0x80 + +/* Read Data Size Register value [10:4] */ +#define RSIZE_MASK 0x7F + +/* ARM to SD interrupt Enable */ +#define INT_ENABLE_REG 0x000020 +/* ARM to SD interrupt Pending */ +#define INT_PENDING_REG 0x000024 + +#define INT_GCR_B BIT(7) +#define INT_GCR_A BIT(6) +#define INT_WRITE_STATUS BIT(5) +#define INT_WRITE_INDEX BIT(4) +#define INT_WRITE_SIZE BIT(3) +#define INT_READ_STATUS BIT(2) +#define INT_READ_INDEX BIT(1) +#define INT_READ_SIZE BIT(0) + +/* General Communication Register A */ +#define GCR_A_REG 0x000028 +enum gen_com_reg_a { + GCR_A_INIT, + GCR_A_REMAP, + GCR_A_RUN +}; + +/* General Communication Register B */ +#define GCR_B_REG 0x00002C +enum gen_com_reg_b { + GCR_B_ACTIVE, + GCR_B_DOZE +}; + +/* Wakeup Register */ +#define WAKEUP_REG 0x008018 +#define WAKEUP_REQ 0x5a + +/* AHB Data Window 0x010000-0x01FFFF */ +#define DATA_WINDOW 0x010000 +#define WINDOW_SIZE (64 * 1024) + +#define KS7010_IRAM_ADDRESS 0x06000000 + +#define KS7010_IO_BLOCK_SIZE 512 + +/** + * struct ks_sdio_card - SDIO device data. + * + * Structure is used as the &struct sdio_func private data. + * + * @func: Pointer to the SDIO function device. + * @priv: Pointer to the &struct net_device private data. + */ +struct ks_sdio_card { + struct sdio_func *func; + struct ks_wlan_private *priv; +}; + +static struct sdio_func *ks7010_to_func(struct ks_wlan_private *priv) +{ + struct ks_sdio_card *ks_sdio = priv->if_hw; + + return ks_sdio->func; +} + +/* Read single byte from device address into byte (CMD52) */ +static int ks7010_sdio_readb(struct ks_wlan_private *priv, + u32 address, u8 *byte) +{ + struct sdio_func *func = ks7010_to_func(priv); + int ret; + + *byte = sdio_readb(func, address, &ret); + + return ret; +} + +/* Read length bytes from device address into buffer (CMD53) */ +static int ks7010_sdio_read(struct ks_wlan_private *priv, u32 address, + u8 *buffer, unsigned int length) +{ + struct sdio_func *func = ks7010_to_func(priv); + + return sdio_memcpy_fromio(func, buffer, address, length); +} + +/* Write single byte to device address (CMD52) */ +static int ks7010_sdio_writeb(struct ks_wlan_private *priv, + u32 address, u8 byte) +{ + struct sdio_func *func = ks7010_to_func(priv); + int ret; + + sdio_writeb(func, byte, address, &ret); + + return ret; +} + +/* Write length bytes to device address from buffer (CMD53) */ +static int ks7010_sdio_write(struct ks_wlan_private *priv, u32 address, + u8 *buffer, unsigned int length) +{ + struct sdio_func *func = ks7010_to_func(priv); + + return sdio_memcpy_toio(func, address, buffer, length); +} + +static void ks_wlan_hw_sleep_doze_request(struct ks_wlan_private *priv) +{ + int ret; + + /* clear request */ + atomic_set(&priv->sleepstatus.doze_request, 0); + + if (atomic_read(&priv->sleepstatus.status) == 0) { + ret = ks7010_sdio_writeb(priv, GCR_B_REG, GCR_B_DOZE); + if (ret) { + netdev_err(priv->net_dev, "write GCR_B_REG\n"); + goto set_sleep_mode; + } + atomic_set(&priv->sleepstatus.status, 1); + priv->last_doze = jiffies; + } + +set_sleep_mode: + priv->sleep_mode = atomic_read(&priv->sleepstatus.status); +} + +static void ks_wlan_hw_sleep_wakeup_request(struct ks_wlan_private *priv) +{ + int ret; + + /* clear request */ + atomic_set(&priv->sleepstatus.wakeup_request, 0); + + if (atomic_read(&priv->sleepstatus.status) == 1) { + ret = ks7010_sdio_writeb(priv, WAKEUP_REG, WAKEUP_REQ); + if (ret) { + netdev_err(priv->net_dev, "write WAKEUP_REG\n"); + goto set_sleep_mode; + } + atomic_set(&priv->sleepstatus.status, 0); + priv->last_wakeup = jiffies; + ++priv->wakeup_count; + } + +set_sleep_mode: + priv->sleep_mode = atomic_read(&priv->sleepstatus.status); +} + +void ks_wlan_hw_wakeup_request(struct ks_wlan_private *priv) +{ + int ret; + + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + ret = ks7010_sdio_writeb(priv, WAKEUP_REG, WAKEUP_REQ); + if (ret) + netdev_err(priv->net_dev, "write WAKEUP_REG\n"); + + priv->last_wakeup = jiffies; + ++priv->wakeup_count; + } +} + +static void _ks_wlan_hw_power_save(struct ks_wlan_private *priv) +{ + u8 byte; + int ret; + + if (priv->reg.power_mgmt == POWER_MGMT_ACTIVE) + return; + + if (priv->reg.operation_mode != MODE_INFRASTRUCTURE) + return; + + if (!is_connect_status(priv->connect_status)) + return; + + if (priv->dev_state != DEVICE_STATE_SLEEP) + return; + + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) + return; + + netdev_dbg(priv->net_dev, + "STATUS:\n" + "- psstatus.status = %d\n" + "- psstatus.confirm_wait = %d\n" + "- psstatus.snooze_guard = %d\n" + "- txq_count = %d\n", + atomic_read(&priv->psstatus.status), + atomic_read(&priv->psstatus.confirm_wait), + atomic_read(&priv->psstatus.snooze_guard), + txq_count(priv)); + + if (atomic_read(&priv->psstatus.confirm_wait) || + atomic_read(&priv->psstatus.snooze_guard) || + txq_has_space(priv)) { + queue_delayed_work(priv->wq, &priv->rw_dwork, 0); + return; + } + + ret = ks7010_sdio_readb(priv, INT_PENDING_REG, &byte); + if (ret) { + netdev_err(priv->net_dev, "read INT_PENDING_REG\n"); + goto queue_delayed_work; + } + if (byte) + goto queue_delayed_work; + + ret = ks7010_sdio_writeb(priv, GCR_B_REG, GCR_B_DOZE); + if (ret) { + netdev_err(priv->net_dev, "write GCR_B_REG\n"); + goto queue_delayed_work; + } + atomic_set(&priv->psstatus.status, PS_SNOOZE); + + return; + +queue_delayed_work: + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); +} + +int ks_wlan_hw_power_save(struct ks_wlan_private *priv) +{ + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); + return 0; +} + +static int enqueue_txdev(struct ks_wlan_private *priv, unsigned char *p, + unsigned long size, + void (*complete_handler)(struct ks_wlan_private *priv, + struct sk_buff *skb), + struct sk_buff *skb) +{ + struct tx_device_buffer *sp; + int ret; + + if (priv->dev_state < DEVICE_STATE_BOOT) { + ret = -EPERM; + goto err_complete; + } + + if ((TX_DEVICE_BUFF_SIZE - 1) <= txq_count(priv)) { + netdev_err(priv->net_dev, "tx buffer overflow\n"); + ret = -EOVERFLOW; + goto err_complete; + } + + sp = &priv->tx_dev.tx_dev_buff[priv->tx_dev.qtail]; + sp->sendp = p; + sp->size = size; + sp->complete_handler = complete_handler; + sp->skb = skb; + inc_txqtail(priv); + + return 0; + +err_complete: + kfree(p); + if (complete_handler) + (*complete_handler)(priv, skb); + + return ret; +} + +/* write data */ +static int write_to_device(struct ks_wlan_private *priv, u8 *buffer, + unsigned long size) +{ + struct hostif_hdr *hdr; + int ret; + + hdr = (struct hostif_hdr *)buffer; + + if (le16_to_cpu(hdr->event) < HIF_DATA_REQ || + le16_to_cpu(hdr->event) > HIF_REQ_MAX) { + netdev_err(priv->net_dev, "unknown event=%04X\n", hdr->event); + return 0; + } + + ret = ks7010_sdio_write(priv, DATA_WINDOW, buffer, size); + if (ret) { + netdev_err(priv->net_dev, "write DATA_WINDOW\n"); + return ret; + } + + ret = ks7010_sdio_writeb(priv, WRITE_STATUS_REG, REG_STATUS_BUSY); + if (ret) { + netdev_err(priv->net_dev, "write WRITE_STATUS_REG\n"); + return ret; + } + + return 0; +} + +static void tx_device_task(struct ks_wlan_private *priv) +{ + struct tx_device_buffer *sp; + int ret; + + if (!txq_has_space(priv) || + atomic_read(&priv->psstatus.status) == PS_SNOOZE) + return; + + sp = &priv->tx_dev.tx_dev_buff[priv->tx_dev.qhead]; + if (priv->dev_state >= DEVICE_STATE_BOOT) { + ret = write_to_device(priv, sp->sendp, sp->size); + if (ret) { + netdev_err(priv->net_dev, + "write_to_device error !!(%d)\n", ret); + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); + return; + } + } + kfree(sp->sendp); + if (sp->complete_handler) /* TX Complete */ + (*sp->complete_handler)(priv, sp->skb); + inc_txqhead(priv); + + if (txq_has_space(priv)) + queue_delayed_work(priv->wq, &priv->rw_dwork, 0); +} + +int ks_wlan_hw_tx(struct ks_wlan_private *priv, void *p, unsigned long size, + void (*complete_handler)(struct ks_wlan_private *priv, + struct sk_buff *skb), + struct sk_buff *skb) +{ + int result; + struct hostif_hdr *hdr; + + hdr = (struct hostif_hdr *)p; + + if (le16_to_cpu(hdr->event) < HIF_DATA_REQ || + le16_to_cpu(hdr->event) > HIF_REQ_MAX) { + netdev_err(priv->net_dev, "unknown event=%04X\n", hdr->event); + return 0; + } + + /* add event to hostt buffer */ + priv->hostt.buff[priv->hostt.qtail] = le16_to_cpu(hdr->event); + priv->hostt.qtail = (priv->hostt.qtail + 1) % SME_EVENT_BUFF_SIZE; + + spin_lock(&priv->tx_dev.tx_dev_lock); + result = enqueue_txdev(priv, p, size, complete_handler, skb); + spin_unlock(&priv->tx_dev.tx_dev_lock); + + if (txq_has_space(priv)) + queue_delayed_work(priv->wq, &priv->rw_dwork, 0); + + return result; +} + +static void rx_event_task(struct tasklet_struct *t) +{ + struct ks_wlan_private *priv = from_tasklet(priv, t, rx_bh_task); + struct rx_device_buffer *rp; + + if (rxq_has_space(priv) && priv->dev_state >= DEVICE_STATE_BOOT) { + rp = &priv->rx_dev.rx_dev_buff[priv->rx_dev.qhead]; + hostif_receive(priv, rp->data, rp->size); + inc_rxqhead(priv); + + if (rxq_has_space(priv)) + tasklet_schedule(&priv->rx_bh_task); + } +} + +static void ks_wlan_hw_rx(struct ks_wlan_private *priv, size_t size) +{ + int ret; + struct rx_device_buffer *rx_buffer; + struct hostif_hdr *hdr; + u16 event = 0; + + /* receive data */ + if (rxq_count(priv) >= (RX_DEVICE_BUFF_SIZE - 1)) { + netdev_err(priv->net_dev, "rx buffer overflow\n"); + return; + } + rx_buffer = &priv->rx_dev.rx_dev_buff[priv->rx_dev.qtail]; + + ret = ks7010_sdio_read(priv, DATA_WINDOW, &rx_buffer->data[0], + hif_align_size(size)); + if (ret) + return; + + /* length check */ + if (size > 2046 || size == 0) { +#ifdef DEBUG + print_hex_dump_bytes("INVALID DATA dump: ", + DUMP_PREFIX_OFFSET, + rx_buffer->data, 32); +#endif + ret = ks7010_sdio_writeb(priv, READ_STATUS_REG, + REG_STATUS_IDLE); + if (ret) + netdev_err(priv->net_dev, "write READ_STATUS_REG\n"); + + /* length check fail */ + return; + } + + hdr = (struct hostif_hdr *)&rx_buffer->data[0]; + rx_buffer->size = le16_to_cpu(hdr->size) + sizeof(hdr->size); + event = le16_to_cpu(hdr->event); + inc_rxqtail(priv); + + ret = ks7010_sdio_writeb(priv, READ_STATUS_REG, REG_STATUS_IDLE); + if (ret) + netdev_err(priv->net_dev, "write READ_STATUS_REG\n"); + + if (atomic_read(&priv->psstatus.confirm_wait) && is_hif_conf(event)) { + netdev_dbg(priv->net_dev, "IS_HIF_CONF true !!\n"); + atomic_dec(&priv->psstatus.confirm_wait); + } + + tasklet_schedule(&priv->rx_bh_task); +} + +static void ks7010_rw_function(struct work_struct *work) +{ + struct ks_wlan_private *priv = container_of(work, + struct ks_wlan_private, + rw_dwork.work); + struct sdio_func *func = ks7010_to_func(priv); + u8 byte; + int ret; + + /* wait after DOZE */ + if (time_after(priv->last_doze + msecs_to_jiffies(30), jiffies)) { + netdev_dbg(priv->net_dev, "wait after DOZE\n"); + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); + return; + } + + /* wait after WAKEUP */ + while (time_after(priv->last_wakeup + msecs_to_jiffies(30), jiffies)) { + netdev_dbg(priv->net_dev, "wait after WAKEUP\n"); + dev_info(&func->dev, "wake: %lu %lu\n", + priv->last_wakeup + msecs_to_jiffies(30), jiffies); + msleep(30); + } + + sdio_claim_host(func); + + /* power save wakeup */ + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + if (txq_has_space(priv)) { + ks_wlan_hw_wakeup_request(priv); + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); + } + goto release_host; + } + + /* sleep mode doze */ + if (atomic_read(&priv->sleepstatus.doze_request) == 1) { + ks_wlan_hw_sleep_doze_request(priv); + goto release_host; + } + /* sleep mode wakeup */ + if (atomic_read(&priv->sleepstatus.wakeup_request) == 1) { + ks_wlan_hw_sleep_wakeup_request(priv); + goto release_host; + } + + /* read (WriteStatus/ReadDataSize FN1:00_0014) */ + ret = ks7010_sdio_readb(priv, WSTATUS_RSIZE_REG, &byte); + if (ret) { + netdev_err(priv->net_dev, "read WSTATUS_RSIZE_REG psstatus=%d\n", + atomic_read(&priv->psstatus.status)); + goto release_host; + } + + if (byte & RSIZE_MASK) { /* Read schedule */ + ks_wlan_hw_rx(priv, (size_t)((byte & RSIZE_MASK) << 4)); + } + if ((byte & WSTATUS_MASK)) + tx_device_task(priv); + + _ks_wlan_hw_power_save(priv); + +release_host: + sdio_release_host(func); +} + +static void ks_sdio_interrupt(struct sdio_func *func) +{ + int ret; + struct ks_sdio_card *card; + struct ks_wlan_private *priv; + u8 status, rsize, byte; + + card = sdio_get_drvdata(func); + priv = card->priv; + + if (priv->dev_state < DEVICE_STATE_BOOT) + goto queue_delayed_work; + + ret = ks7010_sdio_readb(priv, INT_PENDING_REG, &status); + if (ret) { + netdev_err(priv->net_dev, "read INT_PENDING_REG\n"); + goto queue_delayed_work; + } + + /* schedule task for interrupt status */ + /* bit7 -> Write General Communication B register */ + /* read (General Communication B register) */ + /* bit5 -> Write Status Idle */ + /* bit2 -> Read Status Busy */ + if (status & INT_GCR_B || + atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + ret = ks7010_sdio_readb(priv, GCR_B_REG, &byte); + if (ret) { + netdev_err(priv->net_dev, "read GCR_B_REG\n"); + goto queue_delayed_work; + } + if (byte == GCR_B_ACTIVE) { + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + atomic_set(&priv->psstatus.status, PS_WAKEUP); + priv->wakeup_count = 0; + } + complete(&priv->psstatus.wakeup_wait); + } + } + + do { + /* read (WriteStatus/ReadDataSize FN1:00_0014) */ + ret = ks7010_sdio_readb(priv, WSTATUS_RSIZE_REG, &byte); + if (ret) { + netdev_err(priv->net_dev, "read WSTATUS_RSIZE_REG\n"); + goto queue_delayed_work; + } + rsize = byte & RSIZE_MASK; + if (rsize != 0) /* Read schedule */ + ks_wlan_hw_rx(priv, (size_t)(rsize << 4)); + + if (byte & WSTATUS_MASK) { + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + if (txq_has_space(priv)) { + ks_wlan_hw_wakeup_request(priv); + queue_delayed_work(priv->wq, + &priv->rw_dwork, 1); + return; + } + } else { + tx_device_task(priv); + } + } + } while (rsize); + +queue_delayed_work: + queue_delayed_work(priv->wq, &priv->rw_dwork, 0); +} + +static int trx_device_init(struct ks_wlan_private *priv) +{ + priv->tx_dev.qhead = 0; + priv->tx_dev.qtail = 0; + + priv->rx_dev.qhead = 0; + priv->rx_dev.qtail = 0; + + spin_lock_init(&priv->tx_dev.tx_dev_lock); + spin_lock_init(&priv->rx_dev.rx_dev_lock); + + tasklet_setup(&priv->rx_bh_task, rx_event_task); + + return 0; +} + +static void trx_device_exit(struct ks_wlan_private *priv) +{ + struct tx_device_buffer *sp; + + /* tx buffer clear */ + while (txq_has_space(priv)) { + sp = &priv->tx_dev.tx_dev_buff[priv->tx_dev.qhead]; + kfree(sp->sendp); + if (sp->complete_handler) /* TX Complete */ + (*sp->complete_handler)(priv, sp->skb); + inc_txqhead(priv); + } + + tasklet_kill(&priv->rx_bh_task); +} + +static int ks7010_sdio_update_index(struct ks_wlan_private *priv, u32 index) +{ + int ret; + unsigned char *data_buf; + + data_buf = kmemdup(&index, sizeof(u32), GFP_KERNEL); + if (!data_buf) + return -ENOMEM; + + ret = ks7010_sdio_write(priv, WRITE_INDEX_REG, data_buf, sizeof(index)); + if (ret) + goto err_free_data_buf; + + ret = ks7010_sdio_write(priv, READ_INDEX_REG, data_buf, sizeof(index)); + if (ret) + goto err_free_data_buf; + + return 0; + +err_free_data_buf: + kfree(data_buf); + + return ret; +} + +#define ROM_BUFF_SIZE (64 * 1024) +static int ks7010_sdio_data_compare(struct ks_wlan_private *priv, u32 address, + u8 *data, unsigned int size) +{ + int ret; + u8 *read_buf; + + read_buf = kmalloc(ROM_BUFF_SIZE, GFP_KERNEL); + if (!read_buf) + return -ENOMEM; + + ret = ks7010_sdio_read(priv, address, read_buf, size); + if (ret) + goto err_free_read_buf; + + if (memcmp(data, read_buf, size) != 0) { + ret = -EIO; + netdev_err(priv->net_dev, "data compare error (%d)\n", ret); + goto err_free_read_buf; + } + + return 0; + +err_free_read_buf: + kfree(read_buf); + + return ret; +} + +static int ks7010_copy_firmware(struct ks_wlan_private *priv, + const struct firmware *fw_entry) +{ + unsigned int length; + unsigned int size; + unsigned int offset; + unsigned int n = 0; + u8 *rom_buf; + int ret; + + rom_buf = kmalloc(ROM_BUFF_SIZE, GFP_KERNEL); + if (!rom_buf) + return -ENOMEM; + + length = fw_entry->size; + + do { + if (length >= ROM_BUFF_SIZE) { + size = ROM_BUFF_SIZE; + length = length - ROM_BUFF_SIZE; + } else { + size = length; + length = 0; + } + if (size == 0) + break; + + memcpy(rom_buf, fw_entry->data + n, size); + + offset = n; + ret = ks7010_sdio_update_index(priv, + KS7010_IRAM_ADDRESS + offset); + if (ret) + goto free_rom_buf; + + ret = ks7010_sdio_write(priv, DATA_WINDOW, rom_buf, size); + if (ret) + goto free_rom_buf; + + ret = ks7010_sdio_data_compare(priv, + DATA_WINDOW, rom_buf, size); + if (ret) + goto free_rom_buf; + + n += size; + + } while (size); + + ret = ks7010_sdio_writeb(priv, GCR_A_REG, GCR_A_REMAP); + +free_rom_buf: + kfree(rom_buf); + return ret; +} + +static int ks7010_upload_firmware(struct ks_sdio_card *card) +{ + struct ks_wlan_private *priv = card->priv; + struct sdio_func *func = ks7010_to_func(priv); + unsigned int n; + u8 byte = 0; + int ret; + const struct firmware *fw_entry = NULL; + + sdio_claim_host(func); + + /* Firmware running ? */ + ret = ks7010_sdio_readb(priv, GCR_A_REG, &byte); + if (ret) + goto release_host; + if (byte == GCR_A_RUN) { + netdev_dbg(priv->net_dev, "MAC firmware running ...\n"); + ret = -EBUSY; + goto release_host; + } + + ret = request_firmware(&fw_entry, ROM_FILE, + &func->dev); + if (ret) + goto release_host; + + ret = ks7010_copy_firmware(priv, fw_entry); + if (ret) + goto release_firmware; + + /* Firmware running check */ + for (n = 0; n < 50; ++n) { + usleep_range(10000, 11000); /* wait_ms(10); */ + ret = ks7010_sdio_readb(priv, GCR_A_REG, &byte); + if (ret) + goto release_firmware; + + if (byte == GCR_A_RUN) + break; + } + if ((50) <= n) { + netdev_err(priv->net_dev, "firmware can't start\n"); + ret = -EIO; + goto release_firmware; + } + + ret = 0; + + release_firmware: + release_firmware(fw_entry); + release_host: + sdio_release_host(func); + + return ret; +} + +static void ks7010_sme_enqueue_events(struct ks_wlan_private *priv) +{ + static const u16 init_events[] = { + SME_GET_EEPROM_CKSUM, SME_STOP_REQUEST, + SME_RTS_THRESHOLD_REQUEST, SME_FRAGMENTATION_THRESHOLD_REQUEST, + SME_WEP_INDEX_REQUEST, SME_WEP_KEY1_REQUEST, + SME_WEP_KEY2_REQUEST, SME_WEP_KEY3_REQUEST, + SME_WEP_KEY4_REQUEST, SME_WEP_FLAG_REQUEST, + SME_RSN_ENABLED_REQUEST, SME_MODE_SET_REQUEST, + SME_START_REQUEST + }; + int ev; + + for (ev = 0; ev < ARRAY_SIZE(init_events); ev++) + hostif_sme_enqueue(priv, init_events[ev]); +} + +static void ks7010_card_init(struct ks_wlan_private *priv) +{ + init_completion(&priv->confirm_wait); + + /* get mac address & firmware version */ + hostif_sme_enqueue(priv, SME_START); + + if (!wait_for_completion_interruptible_timeout + (&priv->confirm_wait, 5 * HZ)) { + netdev_dbg(priv->net_dev, "wait time out!! SME_START\n"); + } + + if (priv->mac_address_valid && priv->version_size != 0) + priv->dev_state = DEVICE_STATE_PREINIT; + + ks7010_sme_enqueue_events(priv); + + if (!wait_for_completion_interruptible_timeout + (&priv->confirm_wait, 5 * HZ)) { + netdev_dbg(priv->net_dev, "wait time out!! wireless parameter set\n"); + } + + if (priv->dev_state >= DEVICE_STATE_PREINIT) { + netdev_dbg(priv->net_dev, "DEVICE READY!!\n"); + priv->dev_state = DEVICE_STATE_READY; + } +} + +static void ks7010_init_defaults(struct ks_wlan_private *priv) +{ + priv->reg.tx_rate = TX_RATE_AUTO; + priv->reg.preamble = LONG_PREAMBLE; + priv->reg.power_mgmt = POWER_MGMT_ACTIVE; + priv->reg.scan_type = ACTIVE_SCAN; + priv->reg.beacon_lost_count = 20; + priv->reg.rts = 2347UL; + priv->reg.fragment = 2346UL; + priv->reg.phy_type = D_11BG_COMPATIBLE_MODE; + priv->reg.cts_mode = CTS_MODE_FALSE; + 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; +} + +static int ks7010_sdio_setup_irqs(struct sdio_func *func) +{ + int ret; + + /* interrupt disable */ + sdio_writeb(func, 0, INT_ENABLE_REG, &ret); + if (ret) + goto irq_error; + + sdio_writeb(func, 0xff, INT_PENDING_REG, &ret); + if (ret) + goto irq_error; + + /* setup interrupt handler */ + ret = sdio_claim_irq(func, ks_sdio_interrupt); + +irq_error: + return ret; +} + +static void ks7010_sdio_init_irqs(struct sdio_func *func, + struct ks_wlan_private *priv) +{ + u8 byte; + int ret; + + /* + * interrupt setting + * clear Interrupt status write + * (ARMtoSD_InterruptPending FN1:00_0024) + */ + sdio_claim_host(func); + ret = ks7010_sdio_writeb(priv, INT_PENDING_REG, 0xff); + sdio_release_host(func); + if (ret) + netdev_err(priv->net_dev, "write INT_PENDING_REG\n"); + + /* enable ks7010sdio interrupt */ + byte = (INT_GCR_B | INT_READ_STATUS | INT_WRITE_STATUS); + sdio_claim_host(func); + ret = ks7010_sdio_writeb(priv, INT_ENABLE_REG, byte); + sdio_release_host(func); + if (ret) + netdev_err(priv->net_dev, "write INT_ENABLE_REG\n"); +} + +static void ks7010_private_init(struct ks_wlan_private *priv, + struct ks_sdio_card *card, + struct net_device *netdev) +{ + /* private memory initialize */ + priv->if_hw = card; + + priv->dev_state = DEVICE_STATE_PREBOOT; + priv->net_dev = netdev; + priv->firmware_version[0] = '\0'; + priv->version_size = 0; + priv->last_doze = jiffies; + priv->last_wakeup = jiffies; + memset(&priv->nstats, 0, sizeof(priv->nstats)); + memset(&priv->wstats, 0, sizeof(priv->wstats)); + + /* sleep mode */ + atomic_set(&priv->sleepstatus.status, 0); + atomic_set(&priv->sleepstatus.doze_request, 0); + atomic_set(&priv->sleepstatus.wakeup_request, 0); + + trx_device_init(priv); + hostif_init(priv); + ks_wlan_net_start(netdev); + ks7010_init_defaults(priv); +} + +static int ks7010_sdio_probe(struct sdio_func *func, + const struct sdio_device_id *device) +{ + struct ks_wlan_private *priv = NULL; + struct net_device *netdev = NULL; + struct ks_sdio_card *card; + int ret; + + card = kzalloc(sizeof(*card), GFP_KERNEL); + if (!card) + return -ENOMEM; + + card->func = func; + + sdio_claim_host(func); + + ret = sdio_set_block_size(func, KS7010_IO_BLOCK_SIZE); + if (ret) + goto err_free_card; + + dev_dbg(&card->func->dev, "multi_block=%d sdio_set_block_size()=%d %d\n", + func->card->cccr.multi_block, func->cur_blksize, ret); + + ret = sdio_enable_func(func); + if (ret) + goto err_free_card; + + ret = ks7010_sdio_setup_irqs(func); + if (ret) + goto err_disable_func; + + sdio_release_host(func); + + sdio_set_drvdata(func, card); + + dev_dbg(&card->func->dev, "class = 0x%X, vendor = 0x%X, device = 0x%X\n", + func->class, func->vendor, func->device); + + /* private memory allocate */ + netdev = alloc_etherdev(sizeof(*priv)); + if (!netdev) { + dev_err(&card->func->dev, "Unable to alloc new net device\n"); + goto err_release_irq; + } + + ret = dev_alloc_name(netdev, "wlan%d"); + if (ret < 0) { + dev_err(&card->func->dev, "Couldn't get name!\n"); + goto err_free_netdev; + } + + priv = netdev_priv(netdev); + + card->priv = priv; + SET_NETDEV_DEV(netdev, &card->func->dev); + + ks7010_private_init(priv, card, netdev); + + ret = ks7010_upload_firmware(card); + if (ret) { + netdev_err(priv->net_dev, + "firmware load failed !! ret = %d\n", ret); + goto err_free_netdev; + } + + ks7010_sdio_init_irqs(func, priv); + + priv->dev_state = DEVICE_STATE_BOOT; + + priv->wq = alloc_workqueue("wq", WQ_MEM_RECLAIM, 1); + if (!priv->wq) { + netdev_err(priv->net_dev, "create_workqueue failed !!\n"); + goto err_free_netdev; + } + + INIT_DELAYED_WORK(&priv->rw_dwork, ks7010_rw_function); + ks7010_card_init(priv); + + ret = register_netdev(priv->net_dev); + if (ret) + goto err_destroy_wq; + + return 0; + + err_destroy_wq: + destroy_workqueue(priv->wq); + err_free_netdev: + free_netdev(netdev); + err_release_irq: + sdio_claim_host(func); + sdio_release_irq(func); + err_disable_func: + sdio_disable_func(func); + err_free_card: + sdio_release_host(func); + sdio_set_drvdata(func, NULL); + kfree(card); + + return -ENODEV; +} + +/* send stop request to MAC */ +static int send_stop_request(struct sdio_func *func) +{ + struct hostif_stop_request *pp; + struct ks_sdio_card *card; + size_t size; + + card = sdio_get_drvdata(func); + + pp = kzalloc(hif_align_size(sizeof(*pp)), GFP_KERNEL); + if (!pp) + return -ENOMEM; + + size = sizeof(*pp) - sizeof(pp->header.size); + pp->header.size = cpu_to_le16(size); + pp->header.event = cpu_to_le16(HIF_STOP_REQ); + + sdio_claim_host(func); + write_to_device(card->priv, (u8 *)pp, hif_align_size(sizeof(*pp))); + sdio_release_host(func); + + kfree(pp); + return 0; +} + +static void ks7010_sdio_remove(struct sdio_func *func) +{ + int ret; + struct ks_sdio_card *card; + struct ks_wlan_private *priv; + + card = sdio_get_drvdata(func); + + if (!card) + return; + + priv = card->priv; + if (!priv) + goto err_free_card; + + ks_wlan_net_stop(priv->net_dev); + + /* interrupt disable */ + sdio_claim_host(func); + sdio_writeb(func, 0, INT_ENABLE_REG, &ret); + sdio_writeb(func, 0xff, INT_PENDING_REG, &ret); + sdio_release_host(func); + + ret = send_stop_request(func); + if (ret) /* memory allocation failure */ + goto err_free_card; + + if (priv->wq) + destroy_workqueue(priv->wq); + + hostif_exit(priv); + + unregister_netdev(priv->net_dev); + + trx_device_exit(priv); + free_netdev(priv->net_dev); + card->priv = NULL; + + sdio_claim_host(func); + sdio_release_irq(func); + sdio_disable_func(func); + sdio_release_host(func); +err_free_card: + sdio_set_drvdata(func, NULL); + kfree(card); +} + +static const struct sdio_device_id ks7010_sdio_ids[] = { + {SDIO_DEVICE(SDIO_VENDOR_ID_KS_CODE_A, SDIO_DEVICE_ID_KS_7010)}, + {SDIO_DEVICE(SDIO_VENDOR_ID_KS_CODE_B, SDIO_DEVICE_ID_KS_7010)}, + { /* all zero */ } +}; +MODULE_DEVICE_TABLE(sdio, ks7010_sdio_ids); + +static struct sdio_driver ks7010_sdio_driver = { + .name = "ks7010_sdio", + .id_table = ks7010_sdio_ids, + .probe = ks7010_sdio_probe, + .remove = ks7010_sdio_remove, +}; + +module_driver(ks7010_sdio_driver, sdio_register_driver, sdio_unregister_driver); +MODULE_AUTHOR("Sang Engineering, Qi-Hardware, KeyStream"); +MODULE_DESCRIPTION("Driver for KeyStream KS7010 based SDIO cards"); +MODULE_LICENSE("GPL v2"); +MODULE_FIRMWARE(ROM_FILE); diff --git a/drivers/staging/ks7010/ks_hostif.c b/drivers/staging/ks7010/ks_hostif.c new file mode 100644 index 0000000000..af3825578d --- /dev/null +++ b/drivers/staging/ks7010/ks_hostif.c @@ -0,0 +1,2312 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for KeyStream wireless LAN cards. + * + * Copyright (C) 2005-2008 KeyStream Corp. + * Copyright (C) 2009 Renesas Technology Corp. + */ + +#include <crypto/hash.h> +#include <linux/circ_buf.h> +#include <linux/if_arp.h> +#include <net/iw_handler.h> +#include <uapi/linux/llc.h> +#include "eap_packet.h" +#include "ks_wlan.h" +#include "ks_hostif.h" + +#define MICHAEL_MIC_KEY_LEN 8 +#define MICHAEL_MIC_LEN 8 + +static inline void inc_smeqhead(struct ks_wlan_private *priv) +{ + priv->sme_i.qhead = (priv->sme_i.qhead + 1) % SME_EVENT_BUFF_SIZE; +} + +static inline void inc_smeqtail(struct ks_wlan_private *priv) +{ + priv->sme_i.qtail = (priv->sme_i.qtail + 1) % SME_EVENT_BUFF_SIZE; +} + +static inline unsigned int cnt_smeqbody(struct ks_wlan_private *priv) +{ + return CIRC_CNT_TO_END(priv->sme_i.qhead, priv->sme_i.qtail, + SME_EVENT_BUFF_SIZE); +} + +static inline u8 get_byte(struct ks_wlan_private *priv) +{ + u8 data; + + data = *priv->rxp++; + /* length check in advance ! */ + --(priv->rx_size); + return data; +} + +static inline u16 get_word(struct ks_wlan_private *priv) +{ + u16 data; + + data = (get_byte(priv) & 0xff); + data |= ((get_byte(priv) << 8) & 0xff00); + return data; +} + +static inline u32 get_dword(struct ks_wlan_private *priv) +{ + u32 data; + + data = (get_byte(priv) & 0xff); + data |= ((get_byte(priv) << 8) & 0x0000ff00); + data |= ((get_byte(priv) << 16) & 0x00ff0000); + data |= ((get_byte(priv) << 24) & 0xff000000); + return data; +} + +static void ks_wlan_hw_wakeup_task(struct work_struct *work) +{ + struct ks_wlan_private *priv; + int ps_status; + long time_left; + + priv = container_of(work, struct ks_wlan_private, wakeup_work); + ps_status = atomic_read(&priv->psstatus.status); + + if (ps_status == PS_SNOOZE) { + ks_wlan_hw_wakeup_request(priv); + time_left = wait_for_completion_interruptible_timeout(&priv->psstatus.wakeup_wait, + msecs_to_jiffies(20)); + if (time_left <= 0) { + netdev_dbg(priv->net_dev, "wake up timeout or interrupted !!!\n"); + schedule_work(&priv->wakeup_work); + return; + } + } +} + +static void ks_wlan_do_power_save(struct ks_wlan_private *priv) +{ + if (is_connect_status(priv->connect_status)) + hostif_sme_enqueue(priv, SME_POW_MNGMT_REQUEST); + else + priv->dev_state = DEVICE_STATE_READY; +} + +static +int get_current_ap(struct ks_wlan_private *priv, struct link_ap_info *ap_info) +{ + struct local_ap *ap; + union iwreq_data wrqu; + struct net_device *netdev = priv->net_dev; + u8 size; + + ap = &priv->current_ap; + + if (is_disconnect_status(priv->connect_status)) { + memset(ap, 0, sizeof(struct local_ap)); + return -EPERM; + } + + ether_addr_copy(ap->bssid, ap_info->bssid); + memcpy(ap->ssid.body, priv->reg.ssid.body, + priv->reg.ssid.size); + ap->ssid.size = priv->reg.ssid.size; + memcpy(ap->rate_set.body, ap_info->rate_set.body, + ap_info->rate_set.size); + ap->rate_set.size = ap_info->rate_set.size; + if (ap_info->ext_rate_set.size != 0) { + memcpy(&ap->rate_set.body[ap->rate_set.size], + ap_info->ext_rate_set.body, + ap_info->ext_rate_set.size); + ap->rate_set.size += ap_info->ext_rate_set.size; + } + ap->channel = ap_info->ds_parameter.channel; + ap->rssi = ap_info->rssi; + ap->sq = ap_info->sq; + ap->noise = ap_info->noise; + ap->capability = le16_to_cpu(ap_info->capability); + size = (ap_info->rsn.size <= RSN_IE_BODY_MAX) ? + ap_info->rsn.size : RSN_IE_BODY_MAX; + if ((ap_info->rsn_mode & RSN_MODE_WPA2) && + (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2)) { + ap->rsn_ie.id = RSN_INFO_ELEM_ID; + ap->rsn_ie.size = size; + memcpy(ap->rsn_ie.body, ap_info->rsn.body, size); + } else if ((ap_info->rsn_mode & RSN_MODE_WPA) && + (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA)) { + ap->wpa_ie.id = WPA_INFO_ELEM_ID; + ap->wpa_ie.size = size; + memcpy(ap->wpa_ie.body, ap_info->rsn.body, size); + } else { + ap->rsn_ie.id = 0; + ap->rsn_ie.size = 0; + ap->wpa_ie.id = 0; + ap->wpa_ie.size = 0; + } + + wrqu.data.length = 0; + wrqu.data.flags = 0; + wrqu.ap_addr.sa_family = ARPHRD_ETHER; + if (is_connect_status(priv->connect_status)) { + ether_addr_copy(wrqu.ap_addr.sa_data, priv->current_ap.bssid); + netdev_dbg(priv->net_dev, + "IWEVENT: connect bssid=%pM\n", + wrqu.ap_addr.sa_data); + wireless_send_event(netdev, SIOCGIWAP, &wrqu, NULL); + } + netdev_dbg(priv->net_dev, "Link AP\n" + "- bssid=%pM\n" + "- essid=%s\n" + "- rate_set=%02X,%02X,%02X,%02X,%02X,%02X,%02X,%02X\n" + "- channel=%d\n" + "- rssi=%d\n" + "- sq=%d\n" + "- capability=%04X\n" + "- rsn.mode=%d\n" + "- rsn.size=%d\n" + "- ext_rate_set_size=%d\n" + "- rate_set_size=%d\n", + ap->bssid, + &ap->ssid.body[0], + ap->rate_set.body[0], ap->rate_set.body[1], + ap->rate_set.body[2], ap->rate_set.body[3], + ap->rate_set.body[4], ap->rate_set.body[5], + ap->rate_set.body[6], ap->rate_set.body[7], + ap->channel, ap->rssi, ap->sq, ap->capability, + ap_info->rsn_mode, ap_info->rsn.size, + ap_info->ext_rate_set.size, ap_info->rate_set.size); + + return 0; +} + +static u8 read_ie(unsigned char *bp, u8 max, u8 *body) +{ + u8 size = (*(bp + 1) <= max) ? *(bp + 1) : max; + + memcpy(body, bp + 2, size); + return size; +} + +static int +michael_mic(u8 *key, u8 *data, unsigned int len, u8 priority, u8 *result) +{ + u8 pad_data[4] = { priority, 0, 0, 0 }; + struct crypto_shash *tfm = NULL; + struct shash_desc *desc = NULL; + int ret; + + tfm = crypto_alloc_shash("michael_mic", 0, 0); + if (IS_ERR(tfm)) { + ret = PTR_ERR(tfm); + goto err; + } + + ret = crypto_shash_setkey(tfm, key, MICHAEL_MIC_KEY_LEN); + if (ret < 0) + goto err_free_tfm; + + desc = kmalloc(sizeof(*desc) + crypto_shash_descsize(tfm), GFP_KERNEL); + if (!desc) { + ret = -ENOMEM; + goto err_free_tfm; + } + + desc->tfm = tfm; + + ret = crypto_shash_init(desc); + if (ret < 0) + goto err_free_desc; + + // Compute the MIC value + /* + * IEEE802.11i page 47 + * Figure 43g TKIP MIC processing format + * +--+--+--------+--+----+--+--+--+--+--+--+--+--+ + * |6 |6 |1 |3 |M |1 |1 |1 |1 |1 |1 |1 |1 | Octet + * +--+--+--------+--+----+--+--+--+--+--+--+--+--+ + * |DA|SA|Priority|0 |Data|M0|M1|M2|M3|M4|M5|M6|M7| + * +--+--+--------+--+----+--+--+--+--+--+--+--+--+ + */ + + ret = crypto_shash_update(desc, data, 12); + if (ret < 0) + goto err_free_desc; + + ret = crypto_shash_update(desc, pad_data, 4); + if (ret < 0) + goto err_free_desc; + + ret = crypto_shash_finup(desc, data + 12, len - 12, result); + +err_free_desc: + kfree_sensitive(desc); + +err_free_tfm: + crypto_free_shash(tfm); + +err: + return ret; +} + +static +int get_ap_information(struct ks_wlan_private *priv, struct ap_info *ap_info, + struct local_ap *ap) +{ + unsigned char *bp; + int bsize, offset; + + memset(ap, 0, sizeof(struct local_ap)); + + ether_addr_copy(ap->bssid, ap_info->bssid); + ap->rssi = ap_info->rssi; + ap->sq = ap_info->sq; + ap->noise = ap_info->noise; + ap->capability = le16_to_cpu(ap_info->capability); + ap->channel = ap_info->ch_info; + + bp = ap_info->body; + bsize = le16_to_cpu(ap_info->body_size); + offset = 0; + + while (bsize > offset) { + switch (*bp) { /* Information Element ID */ + case WLAN_EID_SSID: + ap->ssid.size = read_ie(bp, IEEE80211_MAX_SSID_LEN, + ap->ssid.body); + break; + case WLAN_EID_SUPP_RATES: + case WLAN_EID_EXT_SUPP_RATES: + if ((*(bp + 1) + ap->rate_set.size) <= + RATE_SET_MAX_SIZE) { + memcpy(&ap->rate_set.body[ap->rate_set.size], + bp + 2, *(bp + 1)); + ap->rate_set.size += *(bp + 1); + } else { + memcpy(&ap->rate_set.body[ap->rate_set.size], + bp + 2, + RATE_SET_MAX_SIZE - ap->rate_set.size); + ap->rate_set.size += + (RATE_SET_MAX_SIZE - ap->rate_set.size); + } + break; + case WLAN_EID_RSN: + ap->rsn_ie.id = *bp; + ap->rsn_ie.size = read_ie(bp, RSN_IE_BODY_MAX, + ap->rsn_ie.body); + break; + case WLAN_EID_VENDOR_SPECIFIC: /* WPA */ + /* WPA OUI check */ + if (memcmp(bp + 2, CIPHER_ID_WPA_WEP40, 4) == 0) { + ap->wpa_ie.id = *bp; + ap->wpa_ie.size = read_ie(bp, RSN_IE_BODY_MAX, + ap->wpa_ie.body); + } + break; + case WLAN_EID_DS_PARAMS: + case WLAN_EID_FH_PARAMS: + case WLAN_EID_CF_PARAMS: + case WLAN_EID_TIM: + case WLAN_EID_IBSS_PARAMS: + case WLAN_EID_COUNTRY: + case WLAN_EID_ERP_INFO: + break; + default: + netdev_err(priv->net_dev, + "unknown Element ID=%d\n", *bp); + break; + } + + offset += 2; /* id & size field */ + offset += *(bp + 1); /* +size offset */ + bp += (*(bp + 1) + 2); /* pointer update */ + } + + return 0; +} + +static +int hostif_data_indication_wpa(struct ks_wlan_private *priv, + unsigned short auth_type) +{ + struct ether_hdr *eth_hdr; + unsigned short eth_proto; + unsigned char recv_mic[MICHAEL_MIC_LEN]; + char buf[128]; + unsigned long now; + struct mic_failure *mic_failure; + u8 mic[MICHAEL_MIC_LEN]; + union iwreq_data wrqu; + unsigned int key_index = auth_type - 1; + struct wpa_key *key = &priv->wpa.key[key_index]; + + eth_hdr = (struct ether_hdr *)(priv->rxp); + eth_proto = ntohs(eth_hdr->h_proto); + + if (eth_hdr->h_dest_snap != eth_hdr->h_source_snap) { + netdev_err(priv->net_dev, "invalid data format\n"); + priv->nstats.rx_errors++; + return -EINVAL; + } + if (((auth_type == TYPE_PMK1 && + priv->wpa.pairwise_suite == IW_AUTH_CIPHER_TKIP) || + (auth_type == TYPE_GMK1 && + priv->wpa.group_suite == IW_AUTH_CIPHER_TKIP) || + (auth_type == TYPE_GMK2 && + priv->wpa.group_suite == IW_AUTH_CIPHER_TKIP)) && + key->key_len) { + int ret; + + netdev_dbg(priv->net_dev, "TKIP: protocol=%04X: size=%u\n", + eth_proto, priv->rx_size); + /* MIC save */ + memcpy(&recv_mic[0], + (priv->rxp) + ((priv->rx_size) - sizeof(recv_mic)), + sizeof(recv_mic)); + priv->rx_size = priv->rx_size - sizeof(recv_mic); + + ret = michael_mic(key->rx_mic_key, priv->rxp, priv->rx_size, + 0, mic); + if (ret < 0) + return ret; + if (memcmp(mic, recv_mic, sizeof(mic)) != 0) { + now = jiffies; + mic_failure = &priv->wpa.mic_failure; + /* MIC FAILURE */ + if (mic_failure->last_failure_time && + (now - mic_failure->last_failure_time) / HZ >= 60) { + mic_failure->failure = 0; + } + netdev_err(priv->net_dev, "MIC FAILURE\n"); + if (mic_failure->failure == 0) { + mic_failure->failure = 1; + mic_failure->counter = 0; + } else if (mic_failure->failure == 1) { + mic_failure->failure = 2; + mic_failure->counter = + (u16)((now - mic_failure->last_failure_time) / HZ); + /* range 1-60 */ + if (!mic_failure->counter) + mic_failure->counter = 1; + } + priv->wpa.mic_failure.last_failure_time = now; + + /* needed parameters: count, keyid, key type, TSC */ + sprintf(buf, + "MLME-MICHAELMICFAILURE.indication(keyid=%d %scast addr=%pM)", + key_index, + eth_hdr->h_dest[0] & 0x01 ? "broad" : "uni", + eth_hdr->h_source); + memset(&wrqu, 0, sizeof(wrqu)); + wrqu.data.length = strlen(buf); + wireless_send_event(priv->net_dev, IWEVCUSTOM, &wrqu, + buf); + return -EINVAL; + } + } + return 0; +} + +static +void hostif_data_indication(struct ks_wlan_private *priv) +{ + unsigned int rx_ind_size; /* indicate data size */ + struct sk_buff *skb; + u16 auth_type; + unsigned char temp[256]; + struct ether_hdr *eth_hdr; + struct ieee802_1x_hdr *aa1x_hdr; + size_t size; + int ret; + + /* min length check */ + if (priv->rx_size <= ETH_HLEN) { + priv->nstats.rx_errors++; + return; + } + + auth_type = get_word(priv); /* AuthType */ + get_word(priv); /* Reserve Area */ + + eth_hdr = (struct ether_hdr *)(priv->rxp); + + /* source address check */ + if (ether_addr_equal(&priv->eth_addr[0], eth_hdr->h_source)) { + netdev_err(priv->net_dev, "invalid : source is own mac address !!\n"); + netdev_err(priv->net_dev, "eth_hdrernet->h_dest=%pM\n", eth_hdr->h_source); + priv->nstats.rx_errors++; + return; + } + + /* for WPA */ + if (auth_type != TYPE_DATA && priv->wpa.rsn_enabled) { + ret = hostif_data_indication_wpa(priv, auth_type); + if (ret) + return; + } + + if ((priv->connect_status & FORCE_DISCONNECT) || + priv->wpa.mic_failure.failure == 2) { + return; + } + + /* check 13th byte at rx data */ + switch (*(priv->rxp + 12)) { + case LLC_SAP_SNAP: + rx_ind_size = priv->rx_size - 6; + skb = dev_alloc_skb(rx_ind_size); + if (!skb) { + priv->nstats.rx_dropped++; + return; + } + netdev_dbg(priv->net_dev, "SNAP, rx_ind_size = %d\n", + rx_ind_size); + + size = ETH_ALEN * 2; + skb_put_data(skb, priv->rxp, size); + + /* (SNAP+UI..) skip */ + + size = rx_ind_size - (ETH_ALEN * 2); + skb_put_data(skb, ð_hdr->h_proto, size); + + aa1x_hdr = (struct ieee802_1x_hdr *)(priv->rxp + ETHER_HDR_SIZE); + break; + case LLC_SAP_NETBEUI: + rx_ind_size = (priv->rx_size + 2); + skb = dev_alloc_skb(rx_ind_size); + if (!skb) { + priv->nstats.rx_dropped++; + return; + } + netdev_dbg(priv->net_dev, "NETBEUI/NetBIOS rx_ind_size=%d\n", + rx_ind_size); + + /* 8802/FDDI MAC copy */ + skb_put_data(skb, priv->rxp, 12); + + /* NETBEUI size add */ + temp[0] = (((rx_ind_size - 12) >> 8) & 0xff); + temp[1] = ((rx_ind_size - 12) & 0xff); + skb_put_data(skb, temp, 2); + + /* copy after Type */ + skb_put_data(skb, priv->rxp + 12, rx_ind_size - 14); + + aa1x_hdr = (struct ieee802_1x_hdr *)(priv->rxp + 14); + break; + default: /* other rx data */ + netdev_err(priv->net_dev, "invalid data format\n"); + priv->nstats.rx_errors++; + return; + } + + if (aa1x_hdr->type == IEEE802_1X_TYPE_EAPOL_KEY && + priv->wpa.rsn_enabled) + atomic_set(&priv->psstatus.snooze_guard, 1); + + /* rx indication */ + skb->dev = priv->net_dev; + skb->protocol = eth_type_trans(skb, skb->dev); + priv->nstats.rx_packets++; + priv->nstats.rx_bytes += rx_ind_size; + netif_rx(skb); +} + +static +void hostif_mib_get_confirm(struct ks_wlan_private *priv) +{ + struct net_device *dev = priv->net_dev; + u32 mib_status; + u32 mib_attribute; + + mib_status = get_dword(priv); + mib_attribute = get_dword(priv); + get_word(priv); /* mib_val_size */ + get_word(priv); /* mib_val_type */ + + if (mib_status) { + netdev_err(priv->net_dev, "attribute=%08X, status=%08X\n", + mib_attribute, mib_status); + return; + } + + switch (mib_attribute) { + case DOT11_MAC_ADDRESS: + hostif_sme_enqueue(priv, SME_GET_MAC_ADDRESS); + ether_addr_copy(priv->eth_addr, priv->rxp); + priv->mac_address_valid = true; + eth_hw_addr_set(dev, priv->eth_addr); + netdev_info(dev, "MAC ADDRESS = %pM\n", priv->eth_addr); + break; + case DOT11_PRODUCT_VERSION: + priv->version_size = priv->rx_size; + memcpy(priv->firmware_version, priv->rxp, priv->rx_size); + priv->firmware_version[priv->rx_size] = '\0'; + netdev_info(dev, "firmware ver. = %s\n", + priv->firmware_version); + hostif_sme_enqueue(priv, SME_GET_PRODUCT_VERSION); + /* wake_up_interruptible_all(&priv->confirm_wait); */ + complete(&priv->confirm_wait); + break; + case LOCAL_GAIN: + memcpy(&priv->gain, priv->rxp, sizeof(priv->gain)); + netdev_dbg(priv->net_dev, "tx_mode=%d, rx_mode=%d, tx_gain=%d, rx_gain=%d\n", + priv->gain.tx_mode, priv->gain.rx_mode, + priv->gain.tx_gain, priv->gain.rx_gain); + break; + case LOCAL_EEPROM_SUM: + memcpy(&priv->eeprom_sum, priv->rxp, sizeof(priv->eeprom_sum)); + if (priv->eeprom_sum.type != 0 && + priv->eeprom_sum.type != 1) { + netdev_err(dev, "LOCAL_EEPROM_SUM error!\n"); + return; + } + priv->eeprom_checksum = (priv->eeprom_sum.type == 0) ? + EEPROM_CHECKSUM_NONE : + (priv->eeprom_sum.result == 0) ? + EEPROM_NG : EEPROM_OK; + break; + default: + netdev_err(priv->net_dev, "mib_attribute=%08x\n", + (unsigned int)mib_attribute); + break; + } +} + +static +void hostif_mib_set_confirm(struct ks_wlan_private *priv) +{ + u32 mib_status; + u32 mib_attribute; + + mib_status = get_dword(priv); + mib_attribute = get_dword(priv); + + if (mib_status) { + /* in case of error */ + netdev_err(priv->net_dev, "error :: attribute=%08X, status=%08X\n", + mib_attribute, mib_status); + } + + switch (mib_attribute) { + case DOT11_RTS_THRESHOLD: + hostif_sme_enqueue(priv, SME_RTS_THRESHOLD_CONFIRM); + break; + case DOT11_FRAGMENTATION_THRESHOLD: + hostif_sme_enqueue(priv, SME_FRAGMENTATION_THRESHOLD_CONFIRM); + break; + case DOT11_WEP_DEFAULT_KEY_ID: + if (!priv->wpa.wpa_enabled) + hostif_sme_enqueue(priv, SME_WEP_INDEX_CONFIRM); + break; + case DOT11_WEP_DEFAULT_KEY_VALUE1: + if (priv->wpa.rsn_enabled) + hostif_sme_enqueue(priv, SME_SET_PMK_TSC); + else + hostif_sme_enqueue(priv, SME_WEP_KEY1_CONFIRM); + break; + case DOT11_WEP_DEFAULT_KEY_VALUE2: + if (priv->wpa.rsn_enabled) + hostif_sme_enqueue(priv, SME_SET_GMK1_TSC); + else + hostif_sme_enqueue(priv, SME_WEP_KEY2_CONFIRM); + break; + case DOT11_WEP_DEFAULT_KEY_VALUE3: + if (priv->wpa.rsn_enabled) + hostif_sme_enqueue(priv, SME_SET_GMK2_TSC); + else + hostif_sme_enqueue(priv, SME_WEP_KEY3_CONFIRM); + break; + case DOT11_WEP_DEFAULT_KEY_VALUE4: + if (!priv->wpa.rsn_enabled) + hostif_sme_enqueue(priv, SME_WEP_KEY4_CONFIRM); + break; + case DOT11_PRIVACY_INVOKED: + if (!priv->wpa.rsn_enabled) + hostif_sme_enqueue(priv, SME_WEP_FLAG_CONFIRM); + break; + case DOT11_RSN_ENABLED: + hostif_sme_enqueue(priv, SME_RSN_ENABLED_CONFIRM); + break; + case LOCAL_RSN_MODE: + hostif_sme_enqueue(priv, SME_RSN_MODE_CONFIRM); + break; + case LOCAL_MULTICAST_ADDRESS: + hostif_sme_enqueue(priv, SME_MULTICAST_REQUEST); + break; + case LOCAL_MULTICAST_FILTER: + hostif_sme_enqueue(priv, SME_MULTICAST_CONFIRM); + break; + case LOCAL_CURRENTADDRESS: + priv->mac_address_valid = true; + break; + case DOT11_RSN_CONFIG_MULTICAST_CIPHER: + hostif_sme_enqueue(priv, SME_RSN_MCAST_CONFIRM); + break; + case DOT11_RSN_CONFIG_UNICAST_CIPHER: + hostif_sme_enqueue(priv, SME_RSN_UCAST_CONFIRM); + break; + case DOT11_RSN_CONFIG_AUTH_SUITE: + hostif_sme_enqueue(priv, SME_RSN_AUTH_CONFIRM); + break; + case DOT11_GMK1_TSC: + if (atomic_read(&priv->psstatus.snooze_guard)) + atomic_set(&priv->psstatus.snooze_guard, 0); + break; + case DOT11_GMK2_TSC: + if (atomic_read(&priv->psstatus.snooze_guard)) + atomic_set(&priv->psstatus.snooze_guard, 0); + break; + case DOT11_PMK_TSC: + case LOCAL_PMK: + case LOCAL_GAIN: + case LOCAL_WPS_ENABLE: + case LOCAL_WPS_PROBE_REQ: + case LOCAL_REGION: + default: + break; + } +} + +static +void hostif_power_mgmt_confirm(struct ks_wlan_private *priv) +{ + if (priv->reg.power_mgmt > POWER_MGMT_ACTIVE && + priv->reg.operation_mode == MODE_INFRASTRUCTURE) { + atomic_set(&priv->psstatus.confirm_wait, 0); + priv->dev_state = DEVICE_STATE_SLEEP; + ks_wlan_hw_power_save(priv); + } else { + priv->dev_state = DEVICE_STATE_READY; + } +} + +static +void hostif_sleep_confirm(struct ks_wlan_private *priv) +{ + atomic_set(&priv->sleepstatus.doze_request, 1); + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); +} + +static +void hostif_start_confirm(struct ks_wlan_private *priv) +{ + union iwreq_data wrqu; + + wrqu.data.length = 0; + wrqu.data.flags = 0; + wrqu.ap_addr.sa_family = ARPHRD_ETHER; + if (is_connect_status(priv->connect_status)) { + eth_zero_addr(wrqu.ap_addr.sa_data); + wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL); + } + netdev_dbg(priv->net_dev, " scan_ind_count=%d\n", priv->scan_ind_count); + hostif_sme_enqueue(priv, SME_START_CONFIRM); +} + +static +void hostif_connect_indication(struct ks_wlan_private *priv) +{ + u16 connect_code; + unsigned int tmp = 0; + unsigned int old_status = priv->connect_status; + struct net_device *netdev = priv->net_dev; + union iwreq_data wrqu0; + + connect_code = get_word(priv); + + switch (connect_code) { + case RESULT_CONNECT: + if (!(priv->connect_status & FORCE_DISCONNECT)) + netif_carrier_on(netdev); + tmp = FORCE_DISCONNECT & priv->connect_status; + priv->connect_status = tmp + CONNECT_STATUS; + break; + case RESULT_DISCONNECT: + netif_carrier_off(netdev); + tmp = FORCE_DISCONNECT & priv->connect_status; + priv->connect_status = tmp + DISCONNECT_STATUS; + break; + default: + netdev_dbg(priv->net_dev, "unknown connect_code=%d :: scan_ind_count=%d\n", + connect_code, priv->scan_ind_count); + netif_carrier_off(netdev); + tmp = FORCE_DISCONNECT & priv->connect_status; + priv->connect_status = tmp + DISCONNECT_STATUS; + break; + } + + get_current_ap(priv, (struct link_ap_info *)priv->rxp); + if (is_connect_status(priv->connect_status) && + is_disconnect_status(old_status)) { + /* for power save */ + atomic_set(&priv->psstatus.snooze_guard, 0); + atomic_set(&priv->psstatus.confirm_wait, 0); + } + ks_wlan_do_power_save(priv); + + wrqu0.data.length = 0; + wrqu0.data.flags = 0; + wrqu0.ap_addr.sa_family = ARPHRD_ETHER; + if (is_disconnect_status(priv->connect_status) && + is_connect_status(old_status)) { + eth_zero_addr(wrqu0.ap_addr.sa_data); + netdev_dbg(priv->net_dev, "disconnect :: scan_ind_count=%d\n", + priv->scan_ind_count); + wireless_send_event(netdev, SIOCGIWAP, &wrqu0, NULL); + } + priv->scan_ind_count = 0; +} + +static +void hostif_scan_indication(struct ks_wlan_private *priv) +{ + int i; + struct ap_info *ap_info; + + netdev_dbg(priv->net_dev, + "scan_ind_count = %d\n", priv->scan_ind_count); + ap_info = (struct ap_info *)(priv->rxp); + + if (priv->scan_ind_count) { + /* bssid check */ + for (i = 0; i < priv->aplist.size; i++) { + u8 *bssid = priv->aplist.ap[i].bssid; + + if (ether_addr_equal(ap_info->bssid, bssid)) + continue; + + if (ap_info->frame_type == IEEE80211_STYPE_PROBE_RESP) + get_ap_information(priv, ap_info, + &priv->aplist.ap[i]); + return; + } + } + priv->scan_ind_count++; + if (priv->scan_ind_count < LOCAL_APLIST_MAX + 1) { + netdev_dbg(priv->net_dev, " scan_ind_count=%d :: aplist.size=%d\n", + priv->scan_ind_count, priv->aplist.size); + get_ap_information(priv, (struct ap_info *)(priv->rxp), + &priv->aplist.ap[priv->scan_ind_count - 1]); + priv->aplist.size = priv->scan_ind_count; + } else { + netdev_dbg(priv->net_dev, " count over :: scan_ind_count=%d\n", + priv->scan_ind_count); + } +} + +static +void hostif_stop_confirm(struct ks_wlan_private *priv) +{ + unsigned int tmp = 0; + unsigned int old_status = priv->connect_status; + struct net_device *netdev = priv->net_dev; + union iwreq_data wrqu0; + + if (priv->dev_state == DEVICE_STATE_SLEEP) + priv->dev_state = DEVICE_STATE_READY; + + /* disconnect indication */ + if (is_connect_status(priv->connect_status)) { + netif_carrier_off(netdev); + tmp = FORCE_DISCONNECT & priv->connect_status; + priv->connect_status = tmp | DISCONNECT_STATUS; + netdev_info(netdev, "IWEVENT: disconnect\n"); + + wrqu0.data.length = 0; + wrqu0.data.flags = 0; + wrqu0.ap_addr.sa_family = ARPHRD_ETHER; + if (is_disconnect_status(priv->connect_status) && + is_connect_status(old_status)) { + eth_zero_addr(wrqu0.ap_addr.sa_data); + netdev_info(netdev, "IWEVENT: disconnect\n"); + wireless_send_event(netdev, SIOCGIWAP, &wrqu0, NULL); + } + priv->scan_ind_count = 0; + } + + hostif_sme_enqueue(priv, SME_STOP_CONFIRM); +} + +static +void hostif_ps_adhoc_set_confirm(struct ks_wlan_private *priv) +{ + priv->infra_status = 0; /* infrastructure mode cancel */ + hostif_sme_enqueue(priv, SME_MODE_SET_CONFIRM); +} + +static +void hostif_infrastructure_set_confirm(struct ks_wlan_private *priv) +{ + get_word(priv); /* result_code */ + priv->infra_status = 1; /* infrastructure mode set */ + hostif_sme_enqueue(priv, SME_MODE_SET_CONFIRM); +} + +static +void hostif_adhoc_set_confirm(struct ks_wlan_private *priv) +{ + priv->infra_status = 1; /* infrastructure mode set */ + hostif_sme_enqueue(priv, SME_MODE_SET_CONFIRM); +} + +static +void hostif_associate_indication(struct ks_wlan_private *priv) +{ + struct association_request *assoc_req; + struct association_response *assoc_resp; + unsigned char *pb; + union iwreq_data wrqu; + char buf[IW_CUSTOM_MAX]; + char *pbuf = &buf[0]; + int i; + + static const char associnfo_leader0[] = "ASSOCINFO(ReqIEs="; + static const char associnfo_leader1[] = " RespIEs="; + + assoc_req = (struct association_request *)(priv->rxp); + assoc_resp = (struct association_response *)(assoc_req + 1); + pb = (unsigned char *)(assoc_resp + 1); + + memset(&wrqu, 0, sizeof(wrqu)); + memcpy(pbuf, associnfo_leader0, sizeof(associnfo_leader0) - 1); + wrqu.data.length += sizeof(associnfo_leader0) - 1; + pbuf += sizeof(associnfo_leader0) - 1; + + for (i = 0; i < le16_to_cpu(assoc_req->req_ies_size); i++) + pbuf += sprintf(pbuf, "%02x", *(pb + i)); + wrqu.data.length += (le16_to_cpu(assoc_req->req_ies_size)) * 2; + + memcpy(pbuf, associnfo_leader1, sizeof(associnfo_leader1) - 1); + wrqu.data.length += sizeof(associnfo_leader1) - 1; + pbuf += sizeof(associnfo_leader1) - 1; + + pb += le16_to_cpu(assoc_req->req_ies_size); + for (i = 0; i < le16_to_cpu(assoc_resp->resp_ies_size); i++) + pbuf += sprintf(pbuf, "%02x", *(pb + i)); + wrqu.data.length += (le16_to_cpu(assoc_resp->resp_ies_size)) * 2; + + pbuf += sprintf(pbuf, ")"); + wrqu.data.length += 1; + + wireless_send_event(priv->net_dev, IWEVCUSTOM, &wrqu, buf); +} + +static +void hostif_bss_scan_confirm(struct ks_wlan_private *priv) +{ + u32 result_code; + struct net_device *dev = priv->net_dev; + union iwreq_data wrqu; + + result_code = get_dword(priv); + netdev_dbg(priv->net_dev, "result=%d :: scan_ind_count=%d\n", + result_code, priv->scan_ind_count); + + priv->sme_i.sme_flag &= ~SME_AP_SCAN; + hostif_sme_enqueue(priv, SME_BSS_SCAN_CONFIRM); + + wrqu.data.length = 0; + wrqu.data.flags = 0; + wireless_send_event(dev, SIOCGIWSCAN, &wrqu, NULL); + priv->scan_ind_count = 0; +} + +static +void hostif_phy_information_confirm(struct ks_wlan_private *priv) +{ + struct iw_statistics *wstats = &priv->wstats; + u8 rssi, signal; + u8 link_speed; + u32 transmitted_frame_count, received_fragment_count; + u32 failed_count, fcs_error_count; + + rssi = get_byte(priv); + signal = get_byte(priv); + get_byte(priv); /* noise */ + link_speed = get_byte(priv); + transmitted_frame_count = get_dword(priv); + received_fragment_count = get_dword(priv); + failed_count = get_dword(priv); + fcs_error_count = get_dword(priv); + + netdev_dbg(priv->net_dev, "phyinfo confirm rssi=%d signal=%d\n", + rssi, signal); + priv->current_rate = (link_speed & RATE_MASK); + wstats->qual.qual = signal; + wstats->qual.level = 256 - rssi; + wstats->qual.noise = 0; /* invalid noise value */ + wstats->qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM; + + netdev_dbg(priv->net_dev, "\n rssi=%u\n" + " signal=%u\n" + " link_speed=%ux500Kbps\n" + " transmitted_frame_count=%u\n" + " received_fragment_count=%u\n" + " failed_count=%u\n" + " fcs_error_count=%u\n", + rssi, signal, link_speed, transmitted_frame_count, + received_fragment_count, failed_count, fcs_error_count); + /* wake_up_interruptible_all(&priv->confirm_wait); */ + complete(&priv->confirm_wait); +} + +static +void hostif_mic_failure_confirm(struct ks_wlan_private *priv) +{ + netdev_dbg(priv->net_dev, "mic_failure=%u\n", + priv->wpa.mic_failure.failure); + hostif_sme_enqueue(priv, SME_MIC_FAILURE_CONFIRM); +} + +static +void hostif_event_check(struct ks_wlan_private *priv) +{ + u16 event; + + event = get_word(priv); + switch (event) { + case HIF_DATA_IND: + hostif_data_indication(priv); + break; + case HIF_MIB_GET_CONF: + hostif_mib_get_confirm(priv); + break; + case HIF_MIB_SET_CONF: + hostif_mib_set_confirm(priv); + break; + case HIF_POWER_MGMT_CONF: + hostif_power_mgmt_confirm(priv); + break; + case HIF_SLEEP_CONF: + hostif_sleep_confirm(priv); + break; + case HIF_START_CONF: + hostif_start_confirm(priv); + break; + case HIF_CONNECT_IND: + hostif_connect_indication(priv); + break; + case HIF_STOP_CONF: + hostif_stop_confirm(priv); + break; + case HIF_PS_ADH_SET_CONF: + hostif_ps_adhoc_set_confirm(priv); + break; + case HIF_INFRA_SET_CONF: + case HIF_INFRA_SET2_CONF: + hostif_infrastructure_set_confirm(priv); + break; + case HIF_ADH_SET_CONF: + case HIF_ADH_SET2_CONF: + hostif_adhoc_set_confirm(priv); + break; + case HIF_ASSOC_INFO_IND: + hostif_associate_indication(priv); + break; + case HIF_MIC_FAILURE_CONF: + hostif_mic_failure_confirm(priv); + break; + case HIF_SCAN_CONF: + hostif_bss_scan_confirm(priv); + break; + case HIF_PHY_INFO_CONF: + case HIF_PHY_INFO_IND: + hostif_phy_information_confirm(priv); + break; + case HIF_SCAN_IND: + hostif_scan_indication(priv); + break; + case HIF_AP_SET_CONF: + default: + netdev_err(priv->net_dev, "undefined event[%04X]\n", event); + /* wake_up_all(&priv->confirm_wait); */ + complete(&priv->confirm_wait); + break; + } + + /* add event to hostt buffer */ + priv->hostt.buff[priv->hostt.qtail] = event; + priv->hostt.qtail = (priv->hostt.qtail + 1) % SME_EVENT_BUFF_SIZE; +} + +/* allocate size bytes, set header size and event */ +static void *hostif_generic_request(size_t size, int event) +{ + struct hostif_hdr *p; + + p = kzalloc(hif_align_size(size), GFP_ATOMIC); + if (!p) + return NULL; + + p->size = cpu_to_le16(size - sizeof(p->size)); + p->event = cpu_to_le16(event); + + return p; +} + +int hostif_data_request(struct ks_wlan_private *priv, struct sk_buff *skb) +{ + unsigned int skb_len = 0; + unsigned char *buffer = NULL; + unsigned int length = 0; + struct hostif_data_request *pp; + unsigned char *p; + unsigned short eth_proto; + struct ether_hdr *eth_hdr; + unsigned short keyinfo = 0; + struct ieee802_1x_hdr *aa1x_hdr; + struct wpa_eapol_key *eap_key; + struct ethhdr *eth; + size_t size; + int ret; + + skb_len = skb->len; + if (skb_len > ETH_FRAME_LEN) { + netdev_err(priv->net_dev, "bad length skb_len=%d\n", skb_len); + ret = -EOVERFLOW; + goto err_kfree_skb; + } + + if (is_disconnect_status(priv->connect_status) || + (priv->connect_status & FORCE_DISCONNECT) || + priv->wpa.mic_failure.stop) { + if (netif_queue_stopped(priv->net_dev)) + netif_wake_queue(priv->net_dev); + + dev_kfree_skb(skb); + + return 0; + } + + /* power save wakeup */ + if (atomic_read(&priv->psstatus.status) == PS_SNOOZE) { + if (!netif_queue_stopped(priv->net_dev)) + netif_stop_queue(priv->net_dev); + } + + size = sizeof(*pp) + 6 + skb_len + 8; + pp = kmalloc(hif_align_size(size), GFP_ATOMIC); + if (!pp) { + ret = -ENOMEM; + goto err_kfree_skb; + } + + p = (unsigned char *)pp->data; + + buffer = skb->data; + length = skb->len; + + /* skb check */ + eth = (struct ethhdr *)skb->data; + if (!ether_addr_equal(&priv->eth_addr[0], eth->h_source)) { + netdev_err(priv->net_dev, + "Invalid mac address: ethernet->h_source=%pM\n", + eth->h_source); + ret = -ENXIO; + goto err_kfree; + } + + /* dest and src MAC address copy */ + size = ETH_ALEN * 2; + memcpy(p, buffer, size); + p += size; + buffer += size; + length -= size; + + /* EtherType/Length check */ + if (*(buffer + 1) + (*buffer << 8) > 1500) { + /* ProtocolEAP = *(buffer+1) + (*buffer << 8); */ + /* SAP/CTL/OUI(6 byte) add */ + *p++ = 0xAA; /* DSAP */ + *p++ = 0xAA; /* SSAP */ + *p++ = 0x03; /* CTL */ + *p++ = 0x00; /* OUI ("000000") */ + *p++ = 0x00; /* OUI ("000000") */ + *p++ = 0x00; /* OUI ("000000") */ + skb_len += 6; + } else { + /* Length(2 byte) delete */ + buffer += 2; + length -= 2; + skb_len -= 2; + } + + /* pp->data copy */ + memcpy(p, buffer, length); + + p += length; + + /* for WPA */ + eth_hdr = (struct ether_hdr *)&pp->data[0]; + eth_proto = ntohs(eth_hdr->h_proto); + + /* for MIC FAILURE REPORT check */ + if (eth_proto == ETH_P_PAE && + priv->wpa.mic_failure.failure > 0) { + aa1x_hdr = (struct ieee802_1x_hdr *)(eth_hdr + 1); + if (aa1x_hdr->type == IEEE802_1X_TYPE_EAPOL_KEY) { + eap_key = (struct wpa_eapol_key *)(aa1x_hdr + 1); + keyinfo = ntohs(eap_key->key_info); + } + } + + if (priv->wpa.rsn_enabled && priv->wpa.key[0].key_len) { + /* no encryption */ + if (eth_proto == ETH_P_PAE && + priv->wpa.key[1].key_len == 0 && + priv->wpa.key[2].key_len == 0 && + priv->wpa.key[3].key_len == 0) { + pp->auth_type = cpu_to_le16(TYPE_AUTH); + } else { + if (priv->wpa.pairwise_suite == IW_AUTH_CIPHER_TKIP) { + u8 mic[MICHAEL_MIC_LEN]; + + ret = michael_mic(priv->wpa.key[0].tx_mic_key, + &pp->data[0], skb_len, + 0, mic); + if (ret < 0) + goto err_kfree; + + memcpy(p, mic, sizeof(mic)); + length += sizeof(mic); + skb_len += sizeof(mic); + p += sizeof(mic); + pp->auth_type = + cpu_to_le16(TYPE_DATA); + } else if (priv->wpa.pairwise_suite == + IW_AUTH_CIPHER_CCMP) { + pp->auth_type = + cpu_to_le16(TYPE_DATA); + } + } + } else { + if (eth_proto == ETH_P_PAE) + pp->auth_type = cpu_to_le16(TYPE_AUTH); + else + pp->auth_type = cpu_to_le16(TYPE_DATA); + } + + /* header value set */ + pp->header.size = + cpu_to_le16((sizeof(*pp) - sizeof(pp->header.size) + skb_len)); + pp->header.event = cpu_to_le16(HIF_DATA_REQ); + + /* tx request */ + ret = ks_wlan_hw_tx(priv, pp, hif_align_size(sizeof(*pp) + skb_len), + send_packet_complete, skb); + + /* MIC FAILURE REPORT check */ + if (eth_proto == ETH_P_PAE && + priv->wpa.mic_failure.failure > 0) { + if (keyinfo & WPA_KEY_INFO_ERROR && + keyinfo & WPA_KEY_INFO_REQUEST) { + netdev_err(priv->net_dev, + "MIC ERROR Report SET : %04X\n", keyinfo); + hostif_sme_enqueue(priv, SME_MIC_FAILURE_REQUEST); + } + if (priv->wpa.mic_failure.failure == 2) + priv->wpa.mic_failure.stop = 1; + } + + return ret; + +err_kfree: + kfree(pp); +err_kfree_skb: + dev_kfree_skb(skb); + + return ret; +} + +static inline void ps_confirm_wait_inc(struct ks_wlan_private *priv) +{ + if (atomic_read(&priv->psstatus.status) > PS_ACTIVE_SET) + atomic_inc(&priv->psstatus.confirm_wait); +} + +static inline void send_request_to_device(struct ks_wlan_private *priv, + void *data, size_t size) +{ + ps_confirm_wait_inc(priv); + ks_wlan_hw_tx(priv, data, size, NULL, NULL); +} + +static void hostif_mib_get_request(struct ks_wlan_private *priv, + u32 mib_attribute) +{ + struct hostif_mib_get_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_MIB_GET_REQ); + if (!pp) + return; + + pp->mib_attribute = cpu_to_le32(mib_attribute); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static void hostif_mib_set_request(struct ks_wlan_private *priv, + enum mib_attribute attr, + enum mib_data_type type, + void *data, size_t size) +{ + struct hostif_mib_set_request_t *pp; + + if (priv->dev_state < DEVICE_STATE_BOOT) + return; + + pp = hostif_generic_request(sizeof(*pp), HIF_MIB_SET_REQ); + if (!pp) + return; + + pp->mib_attribute = cpu_to_le32(attr); + pp->mib_value.size = cpu_to_le16(size); + pp->mib_value.type = cpu_to_le16(type); + memcpy(&pp->mib_value.body, data, size); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp) + size)); +} + +static inline void hostif_mib_set_request_int(struct ks_wlan_private *priv, + enum mib_attribute attr, int val) +{ + __le32 v = cpu_to_le32(val); + size_t size = sizeof(v); + + hostif_mib_set_request(priv, attr, MIB_VALUE_TYPE_INT, &v, size); +} + +static inline void hostif_mib_set_request_bool(struct ks_wlan_private *priv, + enum mib_attribute attr, + bool val) +{ + __le32 v = cpu_to_le32(val); + size_t size = sizeof(v); + + hostif_mib_set_request(priv, attr, MIB_VALUE_TYPE_BOOL, &v, size); +} + +static inline void hostif_mib_set_request_ostring(struct ks_wlan_private *priv, + enum mib_attribute attr, + void *data, size_t size) +{ + hostif_mib_set_request(priv, attr, MIB_VALUE_TYPE_OSTRING, data, size); +} + +static +void hostif_start_request(struct ks_wlan_private *priv, unsigned char mode) +{ + struct hostif_start_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_START_REQ); + if (!pp) + return; + + pp->mode = cpu_to_le16(mode); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); + + priv->aplist.size = 0; + priv->scan_ind_count = 0; +} + +static __le16 ks_wlan_cap(struct ks_wlan_private *priv) +{ + u16 capability = 0x0000; + + if (priv->reg.preamble == SHORT_PREAMBLE) + capability |= WLAN_CAPABILITY_SHORT_PREAMBLE; + + capability &= ~(WLAN_CAPABILITY_PBCC); /* pbcc not support */ + + if (priv->reg.phy_type != D_11B_ONLY_MODE) { + capability |= WLAN_CAPABILITY_SHORT_SLOT_TIME; + capability &= ~(WLAN_CAPABILITY_DSSS_OFDM); + } + + return cpu_to_le16(capability); +} + +static void init_request(struct ks_wlan_private *priv, + struct hostif_request *req) +{ + req->phy_type = cpu_to_le16(priv->reg.phy_type); + req->cts_mode = cpu_to_le16(priv->reg.cts_mode); + req->scan_type = cpu_to_le16(priv->reg.scan_type); + req->rate_set.size = priv->reg.rate_set.size; + req->capability = ks_wlan_cap(priv); + memcpy(&req->rate_set.body[0], &priv->reg.rate_set.body[0], + priv->reg.rate_set.size); +} + +static +void hostif_ps_adhoc_set_request(struct ks_wlan_private *priv) +{ + struct hostif_ps_adhoc_set_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_PS_ADH_SET_REQ); + if (!pp) + return; + + init_request(priv, &pp->request); + pp->channel = cpu_to_le16(priv->reg.channel); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_infrastructure_set_request(struct ks_wlan_private *priv, int event) +{ + struct hostif_infrastructure_set_request *pp; + + pp = hostif_generic_request(sizeof(*pp), event); + if (!pp) + return; + + init_request(priv, &pp->request); + pp->ssid.size = priv->reg.ssid.size; + memcpy(&pp->ssid.body[0], &priv->reg.ssid.body[0], priv->reg.ssid.size); + pp->beacon_lost_count = + cpu_to_le16(priv->reg.beacon_lost_count); + pp->auth_type = cpu_to_le16(priv->reg.authenticate_type); + + pp->channel_list.body[0] = 1; + pp->channel_list.body[1] = 8; + pp->channel_list.body[2] = 2; + pp->channel_list.body[3] = 9; + pp->channel_list.body[4] = 3; + pp->channel_list.body[5] = 10; + pp->channel_list.body[6] = 4; + pp->channel_list.body[7] = 11; + pp->channel_list.body[8] = 5; + pp->channel_list.body[9] = 12; + pp->channel_list.body[10] = 6; + pp->channel_list.body[11] = 13; + pp->channel_list.body[12] = 7; + if (priv->reg.phy_type == D_11G_ONLY_MODE) { + pp->channel_list.size = 13; + } else { + pp->channel_list.body[13] = 14; + pp->channel_list.size = 14; + } + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_adhoc_set_request(struct ks_wlan_private *priv) +{ + struct hostif_adhoc_set_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_ADH_SET_REQ); + if (!pp) + return; + + init_request(priv, &pp->request); + pp->channel = cpu_to_le16(priv->reg.channel); + pp->ssid.size = priv->reg.ssid.size; + memcpy(&pp->ssid.body[0], &priv->reg.ssid.body[0], priv->reg.ssid.size); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_adhoc_set2_request(struct ks_wlan_private *priv) +{ + struct hostif_adhoc_set2_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_ADH_SET_REQ); + if (!pp) + return; + + init_request(priv, &pp->request); + pp->ssid.size = priv->reg.ssid.size; + memcpy(&pp->ssid.body[0], &priv->reg.ssid.body[0], priv->reg.ssid.size); + + pp->channel_list.body[0] = priv->reg.channel; + pp->channel_list.size = 1; + memcpy(pp->bssid, priv->reg.bssid, ETH_ALEN); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_stop_request(struct ks_wlan_private *priv) +{ + struct hostif_stop_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_STOP_REQ); + if (!pp) + return; + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_phy_information_request(struct ks_wlan_private *priv) +{ + struct hostif_phy_information_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_PHY_INFO_REQ); + if (!pp) + return; + + if (priv->reg.phy_info_timer) { + pp->type = cpu_to_le16(TIME_TYPE); + pp->time = cpu_to_le16(priv->reg.phy_info_timer); + } else { + pp->type = cpu_to_le16(NORMAL_TYPE); + pp->time = cpu_to_le16(0); + } + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_power_mgmt_request(struct ks_wlan_private *priv, + u32 mode, u32 wake_up, u32 receive_dtims) +{ + struct hostif_power_mgmt_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_POWER_MGMT_REQ); + if (!pp) + return; + + pp->mode = cpu_to_le32(mode); + pp->wake_up = cpu_to_le32(wake_up); + pp->receive_dtims = cpu_to_le32(receive_dtims); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +static +void hostif_sleep_request(struct ks_wlan_private *priv, + enum sleep_mode_type mode) +{ + struct hostif_sleep_request *pp; + + if (mode == SLP_SLEEP) { + pp = hostif_generic_request(sizeof(*pp), HIF_SLEEP_REQ); + if (!pp) + return; + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); + } else if (mode == SLP_ACTIVE) { + atomic_set(&priv->sleepstatus.wakeup_request, 1); + queue_delayed_work(priv->wq, &priv->rw_dwork, 1); + } else { + netdev_err(priv->net_dev, "invalid mode %ld\n", (long)mode); + return; + } +} + +static +void hostif_bss_scan_request(struct ks_wlan_private *priv, + unsigned long scan_type, u8 *scan_ssid, + u8 scan_ssid_len) +{ + struct hostif_bss_scan_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_SCAN_REQ); + if (!pp) + return; + + pp->scan_type = scan_type; + + pp->ch_time_min = cpu_to_le32(110); /* default value */ + pp->ch_time_max = cpu_to_le32(130); /* default value */ + pp->channel_list.body[0] = 1; + pp->channel_list.body[1] = 8; + pp->channel_list.body[2] = 2; + pp->channel_list.body[3] = 9; + pp->channel_list.body[4] = 3; + pp->channel_list.body[5] = 10; + pp->channel_list.body[6] = 4; + pp->channel_list.body[7] = 11; + pp->channel_list.body[8] = 5; + pp->channel_list.body[9] = 12; + pp->channel_list.body[10] = 6; + pp->channel_list.body[11] = 13; + pp->channel_list.body[12] = 7; + if (priv->reg.phy_type == D_11G_ONLY_MODE) { + pp->channel_list.size = 13; + } else { + pp->channel_list.body[13] = 14; + pp->channel_list.size = 14; + } + pp->ssid.size = 0; + + /* specified SSID SCAN */ + if (scan_ssid_len > 0 && scan_ssid_len <= 32) { + pp->ssid.size = scan_ssid_len; + memcpy(&pp->ssid.body[0], scan_ssid, scan_ssid_len); + } + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); + + priv->aplist.size = 0; + priv->scan_ind_count = 0; +} + +static +void hostif_mic_failure_request(struct ks_wlan_private *priv, + u16 failure_count, u16 timer) +{ + struct hostif_mic_failure_request *pp; + + pp = hostif_generic_request(sizeof(*pp), HIF_MIC_FAILURE_REQ); + if (!pp) + return; + + pp->failure_count = cpu_to_le16(failure_count); + pp->timer = cpu_to_le16(timer); + + send_request_to_device(priv, pp, hif_align_size(sizeof(*pp))); +} + +/* Device I/O Receive indicate */ +static void devio_rec_ind(struct ks_wlan_private *priv, unsigned char *p, + unsigned int size) +{ + if (!priv->is_device_open) + return; + + spin_lock(&priv->dev_read_lock); + priv->dev_data[atomic_read(&priv->rec_count)] = p; + priv->dev_size[atomic_read(&priv->rec_count)] = size; + + if (atomic_read(&priv->event_count) != DEVICE_STOCK_COUNT) { + /* rx event count inc */ + atomic_inc(&priv->event_count); + } + atomic_inc(&priv->rec_count); + if (atomic_read(&priv->rec_count) == DEVICE_STOCK_COUNT) + atomic_set(&priv->rec_count, 0); + + wake_up_interruptible_all(&priv->devread_wait); + + spin_unlock(&priv->dev_read_lock); +} + +void hostif_receive(struct ks_wlan_private *priv, unsigned char *p, + unsigned int size) +{ + devio_rec_ind(priv, p, size); + + priv->rxp = p; + priv->rx_size = size; + + if (get_word(priv) == priv->rx_size) + hostif_event_check(priv); +} + +static void hostif_sme_set_wep(struct ks_wlan_private *priv, int type) +{ + switch (type) { + case SME_WEP_INDEX_REQUEST: + hostif_mib_set_request_int(priv, DOT11_WEP_DEFAULT_KEY_ID, + priv->reg.wep_index); + break; + case SME_WEP_KEY1_REQUEST: + if (priv->wpa.wpa_enabled) + return; + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE1, + &priv->reg.wep_key[0].val[0], + priv->reg.wep_key[0].size); + break; + case SME_WEP_KEY2_REQUEST: + if (priv->wpa.wpa_enabled) + return; + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE2, + &priv->reg.wep_key[1].val[0], + priv->reg.wep_key[1].size); + break; + case SME_WEP_KEY3_REQUEST: + if (priv->wpa.wpa_enabled) + return; + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE3, + &priv->reg.wep_key[2].val[0], + priv->reg.wep_key[2].size); + break; + case SME_WEP_KEY4_REQUEST: + if (priv->wpa.wpa_enabled) + return; + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE4, + &priv->reg.wep_key[3].val[0], + priv->reg.wep_key[3].size); + break; + case SME_WEP_FLAG_REQUEST: + hostif_mib_set_request_bool(priv, DOT11_PRIVACY_INVOKED, + priv->reg.privacy_invoked); + break; + } +} + +struct wpa_suite { + __le16 size; + unsigned char suite[4][CIPHER_ID_LEN]; +} __packed; + +struct rsn_mode { + __le32 rsn_mode; + __le16 rsn_capability; +} __packed; + +static void hostif_sme_set_rsn(struct ks_wlan_private *priv, int type) +{ + struct wpa_suite wpa_suite; + struct rsn_mode rsn_mode; + size_t size; + u32 mode; + const u8 *buf = NULL; + + memset(&wpa_suite, 0, sizeof(wpa_suite)); + + switch (type) { + case SME_RSN_UCAST_REQUEST: + wpa_suite.size = cpu_to_le16(1); + switch (priv->wpa.pairwise_suite) { + case IW_AUTH_CIPHER_NONE: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_NONE : CIPHER_ID_WPA_NONE; + break; + case IW_AUTH_CIPHER_WEP40: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_WEP40 : CIPHER_ID_WPA_WEP40; + break; + case IW_AUTH_CIPHER_TKIP: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_TKIP : CIPHER_ID_WPA_TKIP; + break; + case IW_AUTH_CIPHER_CCMP: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_CCMP : CIPHER_ID_WPA_CCMP; + break; + case IW_AUTH_CIPHER_WEP104: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_WEP104 : CIPHER_ID_WPA_WEP104; + break; + } + + if (buf) + memcpy(&wpa_suite.suite[0][0], buf, CIPHER_ID_LEN); + size = sizeof(wpa_suite.size) + + (CIPHER_ID_LEN * le16_to_cpu(wpa_suite.size)); + hostif_mib_set_request_ostring(priv, + DOT11_RSN_CONFIG_UNICAST_CIPHER, + &wpa_suite, size); + break; + case SME_RSN_MCAST_REQUEST: + switch (priv->wpa.group_suite) { + case IW_AUTH_CIPHER_NONE: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_NONE : CIPHER_ID_WPA_NONE; + break; + case IW_AUTH_CIPHER_WEP40: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_WEP40 : CIPHER_ID_WPA_WEP40; + break; + case IW_AUTH_CIPHER_TKIP: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_TKIP : CIPHER_ID_WPA_TKIP; + break; + case IW_AUTH_CIPHER_CCMP: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_CCMP : CIPHER_ID_WPA_CCMP; + break; + case IW_AUTH_CIPHER_WEP104: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + CIPHER_ID_WPA2_WEP104 : CIPHER_ID_WPA_WEP104; + break; + } + if (buf) + memcpy(&wpa_suite.suite[0][0], buf, CIPHER_ID_LEN); + hostif_mib_set_request_ostring(priv, + DOT11_RSN_CONFIG_MULTICAST_CIPHER, + &wpa_suite.suite[0][0], + CIPHER_ID_LEN); + break; + case SME_RSN_AUTH_REQUEST: + wpa_suite.size = cpu_to_le16(1); + switch (priv->wpa.key_mgmt_suite) { + case IW_AUTH_KEY_MGMT_802_1X: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + KEY_MGMT_ID_WPA2_1X : KEY_MGMT_ID_WPA_1X; + break; + case IW_AUTH_KEY_MGMT_PSK: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + KEY_MGMT_ID_WPA2_PSK : KEY_MGMT_ID_WPA_PSK; + break; + case 0: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + KEY_MGMT_ID_WPA2_NONE : KEY_MGMT_ID_WPA_NONE; + break; + case 4: + buf = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + KEY_MGMT_ID_WPA2_WPANONE : + KEY_MGMT_ID_WPA_WPANONE; + break; + } + + if (buf) + memcpy(&wpa_suite.suite[0][0], buf, KEY_MGMT_ID_LEN); + size = sizeof(wpa_suite.size) + + (KEY_MGMT_ID_LEN * le16_to_cpu(wpa_suite.size)); + hostif_mib_set_request_ostring(priv, + DOT11_RSN_CONFIG_AUTH_SUITE, + &wpa_suite, size); + break; + case SME_RSN_ENABLED_REQUEST: + hostif_mib_set_request_bool(priv, DOT11_RSN_ENABLED, + priv->wpa.rsn_enabled); + break; + case SME_RSN_MODE_REQUEST: + mode = (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA2) ? + RSN_MODE_WPA2 : + (priv->wpa.version == IW_AUTH_WPA_VERSION_WPA) ? + RSN_MODE_WPA : RSN_MODE_NONE; + rsn_mode.rsn_mode = cpu_to_le32(mode); + rsn_mode.rsn_capability = cpu_to_le16(0); + hostif_mib_set_request_ostring(priv, LOCAL_RSN_MODE, + &rsn_mode, sizeof(rsn_mode)); + break; + } +} + +static +void hostif_sme_mode_setup(struct ks_wlan_private *priv) +{ + unsigned char rate_size; + unsigned char rate_octet[RATE_SET_MAX_SIZE]; + int i = 0; + + /* rate setting if rate segging is auto for changing phy_type (#94) */ + if (priv->reg.tx_rate == TX_RATE_FULL_AUTO) { + if (priv->reg.phy_type == D_11B_ONLY_MODE) { + 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.rate_set.size = 4; + } else { /* D_11G_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ + 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.rate_set.size = 12; + } + } + + /* rate mask by phy setting */ + if (priv->reg.phy_type == D_11B_ONLY_MODE) { + for (i = 0; i < priv->reg.rate_set.size; i++) { + if (!is_11b_rate(priv->reg.rate_set.body[i])) + break; + + if ((priv->reg.rate_set.body[i] & RATE_MASK) >= TX_RATE_5M) { + rate_octet[i] = priv->reg.rate_set.body[i] & + RATE_MASK; + } else { + rate_octet[i] = priv->reg.rate_set.body[i]; + } + } + + } else { /* D_11G_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ + for (i = 0; i < priv->reg.rate_set.size; i++) { + if (!is_11bg_rate(priv->reg.rate_set.body[i])) + break; + + if (is_ofdm_ext_rate(priv->reg.rate_set.body[i])) { + rate_octet[i] = priv->reg.rate_set.body[i] & + RATE_MASK; + } else { + rate_octet[i] = priv->reg.rate_set.body[i]; + } + } + } + rate_size = i; + if (rate_size == 0) { + if (priv->reg.phy_type == D_11G_ONLY_MODE) + rate_octet[0] = TX_RATE_6M | BASIC_RATE; + else + rate_octet[0] = TX_RATE_2M | BASIC_RATE; + rate_size = 1; + } + + /* rate set update */ + priv->reg.rate_set.size = rate_size; + memcpy(&priv->reg.rate_set.body[0], &rate_octet[0], rate_size); + + switch (priv->reg.operation_mode) { + case MODE_PSEUDO_ADHOC: + hostif_ps_adhoc_set_request(priv); + break; + case MODE_INFRASTRUCTURE: + if (!is_valid_ether_addr((u8 *)priv->reg.bssid)) { + hostif_infrastructure_set_request(priv, + HIF_INFRA_SET_REQ); + } else { + hostif_infrastructure_set_request(priv, + HIF_INFRA_SET2_REQ); + netdev_dbg(priv->net_dev, + "Infra bssid = %pM\n", priv->reg.bssid); + } + break; + case MODE_ADHOC: + if (!is_valid_ether_addr((u8 *)priv->reg.bssid)) { + hostif_adhoc_set_request(priv); + } else { + hostif_adhoc_set2_request(priv); + netdev_dbg(priv->net_dev, + "Adhoc bssid = %pM\n", priv->reg.bssid); + } + break; + default: + break; + } +} + +static +void hostif_sme_multicast_set(struct ks_wlan_private *priv) +{ + struct net_device *dev = priv->net_dev; + int mc_count; + struct netdev_hw_addr *ha; + char set_address[NIC_MAX_MCAST_LIST * ETH_ALEN]; + int i = 0; + + spin_lock(&priv->multicast_spin); + + memset(set_address, 0, NIC_MAX_MCAST_LIST * ETH_ALEN); + + if (dev->flags & IFF_PROMISC) { + hostif_mib_set_request_int(priv, LOCAL_MULTICAST_FILTER, + MCAST_FILTER_PROMISC); + goto spin_unlock; + } + + if ((netdev_mc_count(dev) > NIC_MAX_MCAST_LIST) || + (dev->flags & IFF_ALLMULTI)) { + hostif_mib_set_request_int(priv, LOCAL_MULTICAST_FILTER, + MCAST_FILTER_MCASTALL); + goto spin_unlock; + } + + if (priv->sme_i.sme_flag & SME_MULTICAST) { + mc_count = netdev_mc_count(dev); + netdev_for_each_mc_addr(ha, dev) { + ether_addr_copy(&set_address[i * ETH_ALEN], ha->addr); + i++; + } + priv->sme_i.sme_flag &= ~SME_MULTICAST; + hostif_mib_set_request_ostring(priv, LOCAL_MULTICAST_ADDRESS, + &set_address[0], + ETH_ALEN * mc_count); + } else { + priv->sme_i.sme_flag |= SME_MULTICAST; + hostif_mib_set_request_int(priv, LOCAL_MULTICAST_FILTER, + MCAST_FILTER_MCAST); + } + +spin_unlock: + spin_unlock(&priv->multicast_spin); +} + +static void hostif_sme_power_mgmt_set(struct ks_wlan_private *priv) +{ + u32 mode, wake_up, receive_dtims; + + if (priv->reg.power_mgmt != POWER_MGMT_SAVE1 && + priv->reg.power_mgmt != POWER_MGMT_SAVE2) { + mode = POWER_ACTIVE; + wake_up = 0; + receive_dtims = 0; + } else { + mode = (priv->reg.operation_mode == MODE_INFRASTRUCTURE) ? + POWER_SAVE : POWER_ACTIVE; + wake_up = 0; + receive_dtims = (priv->reg.operation_mode == MODE_INFRASTRUCTURE && + priv->reg.power_mgmt == POWER_MGMT_SAVE2); + } + + hostif_power_mgmt_request(priv, mode, wake_up, receive_dtims); +} + +static void hostif_sme_sleep_set(struct ks_wlan_private *priv) +{ + if (priv->sleep_mode != SLP_SLEEP && + priv->sleep_mode != SLP_ACTIVE) + return; + + hostif_sleep_request(priv, priv->sleep_mode); +} + +static +void hostif_sme_set_key(struct ks_wlan_private *priv, int type) +{ + switch (type) { + case SME_SET_FLAG: + hostif_mib_set_request_bool(priv, DOT11_PRIVACY_INVOKED, + priv->reg.privacy_invoked); + break; + case SME_SET_TXKEY: + hostif_mib_set_request_int(priv, DOT11_WEP_DEFAULT_KEY_ID, + priv->wpa.txkey); + break; + case SME_SET_KEY1: + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE1, + &priv->wpa.key[0].key_val[0], + priv->wpa.key[0].key_len); + break; + case SME_SET_KEY2: + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE2, + &priv->wpa.key[1].key_val[0], + priv->wpa.key[1].key_len); + break; + case SME_SET_KEY3: + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE3, + &priv->wpa.key[2].key_val[0], + priv->wpa.key[2].key_len); + break; + case SME_SET_KEY4: + hostif_mib_set_request_ostring(priv, + DOT11_WEP_DEFAULT_KEY_VALUE4, + &priv->wpa.key[3].key_val[0], + priv->wpa.key[3].key_len); + break; + case SME_SET_PMK_TSC: + hostif_mib_set_request_ostring(priv, DOT11_PMK_TSC, + &priv->wpa.key[0].rx_seq[0], + WPA_RX_SEQ_LEN); + break; + case SME_SET_GMK1_TSC: + hostif_mib_set_request_ostring(priv, DOT11_GMK1_TSC, + &priv->wpa.key[1].rx_seq[0], + WPA_RX_SEQ_LEN); + break; + case SME_SET_GMK2_TSC: + hostif_mib_set_request_ostring(priv, DOT11_GMK2_TSC, + &priv->wpa.key[2].rx_seq[0], + WPA_RX_SEQ_LEN); + break; + } +} + +static +void hostif_sme_set_pmksa(struct ks_wlan_private *priv) +{ + struct pmk_cache { + __le16 size; + struct { + u8 bssid[ETH_ALEN]; + u8 pmkid[IW_PMKID_LEN]; + } __packed list[PMK_LIST_MAX]; + } __packed pmkcache; + struct pmk *pmk; + size_t size; + int i = 0; + + list_for_each_entry(pmk, &priv->pmklist.head, list) { + if (i >= PMK_LIST_MAX) + break; + ether_addr_copy(pmkcache.list[i].bssid, pmk->bssid); + memcpy(pmkcache.list[i].pmkid, pmk->pmkid, IW_PMKID_LEN); + i++; + } + pmkcache.size = cpu_to_le16(priv->pmklist.size); + size = sizeof(priv->pmklist.size) + + ((ETH_ALEN + IW_PMKID_LEN) * priv->pmklist.size); + hostif_mib_set_request_ostring(priv, LOCAL_PMK, &pmkcache, size); +} + +/* execute sme */ +static void hostif_sme_execute(struct ks_wlan_private *priv, int event) +{ + u16 failure; + + switch (event) { + case SME_START: + if (priv->dev_state == DEVICE_STATE_BOOT) + hostif_mib_get_request(priv, DOT11_MAC_ADDRESS); + break; + case SME_MULTICAST_REQUEST: + hostif_sme_multicast_set(priv); + break; + case SME_MACADDRESS_SET_REQUEST: + hostif_mib_set_request_ostring(priv, LOCAL_CURRENTADDRESS, + &priv->eth_addr[0], ETH_ALEN); + break; + case SME_BSS_SCAN_REQUEST: + hostif_bss_scan_request(priv, priv->reg.scan_type, + priv->scan_ssid, priv->scan_ssid_len); + break; + case SME_POW_MNGMT_REQUEST: + hostif_sme_power_mgmt_set(priv); + break; + case SME_PHY_INFO_REQUEST: + hostif_phy_information_request(priv); + break; + case SME_MIC_FAILURE_REQUEST: + failure = priv->wpa.mic_failure.failure; + if (failure != 1 && failure != 2) { + netdev_err(priv->net_dev, + "SME_MIC_FAILURE_REQUEST: failure count=%u error?\n", + failure); + return; + } + hostif_mic_failure_request(priv, failure - 1, (failure == 1) ? + 0 : priv->wpa.mic_failure.counter); + break; + case SME_MIC_FAILURE_CONFIRM: + if (priv->wpa.mic_failure.failure == 2) { + if (priv->wpa.mic_failure.stop) + priv->wpa.mic_failure.stop = 0; + priv->wpa.mic_failure.failure = 0; + hostif_start_request(priv, priv->reg.operation_mode); + } + break; + case SME_GET_MAC_ADDRESS: + if (priv->dev_state == DEVICE_STATE_BOOT) + hostif_mib_get_request(priv, DOT11_PRODUCT_VERSION); + break; + case SME_GET_PRODUCT_VERSION: + if (priv->dev_state == DEVICE_STATE_BOOT) + priv->dev_state = DEVICE_STATE_PREINIT; + break; + case SME_STOP_REQUEST: + hostif_stop_request(priv); + break; + case SME_RTS_THRESHOLD_REQUEST: + hostif_mib_set_request_int(priv, DOT11_RTS_THRESHOLD, + priv->reg.rts); + break; + case SME_FRAGMENTATION_THRESHOLD_REQUEST: + hostif_mib_set_request_int(priv, DOT11_FRAGMENTATION_THRESHOLD, + priv->reg.fragment); + break; + case SME_WEP_INDEX_REQUEST: + case SME_WEP_KEY1_REQUEST: + case SME_WEP_KEY2_REQUEST: + case SME_WEP_KEY3_REQUEST: + case SME_WEP_KEY4_REQUEST: + case SME_WEP_FLAG_REQUEST: + hostif_sme_set_wep(priv, event); + break; + case SME_RSN_UCAST_REQUEST: + case SME_RSN_MCAST_REQUEST: + case SME_RSN_AUTH_REQUEST: + case SME_RSN_ENABLED_REQUEST: + case SME_RSN_MODE_REQUEST: + hostif_sme_set_rsn(priv, event); + break; + case SME_SET_FLAG: + case SME_SET_TXKEY: + case SME_SET_KEY1: + case SME_SET_KEY2: + case SME_SET_KEY3: + case SME_SET_KEY4: + case SME_SET_PMK_TSC: + case SME_SET_GMK1_TSC: + case SME_SET_GMK2_TSC: + hostif_sme_set_key(priv, event); + break; + case SME_SET_PMKSA: + hostif_sme_set_pmksa(priv); + break; + case SME_WPS_ENABLE_REQUEST: + hostif_mib_set_request_int(priv, LOCAL_WPS_ENABLE, + priv->wps.wps_enabled); + break; + case SME_WPS_PROBE_REQUEST: + hostif_mib_set_request_ostring(priv, LOCAL_WPS_PROBE_REQ, + priv->wps.ie, priv->wps.ielen); + break; + case SME_MODE_SET_REQUEST: + hostif_sme_mode_setup(priv); + break; + case SME_SET_GAIN: + hostif_mib_set_request_ostring(priv, LOCAL_GAIN, + &priv->gain, sizeof(priv->gain)); + break; + case SME_GET_GAIN: + hostif_mib_get_request(priv, LOCAL_GAIN); + break; + case SME_GET_EEPROM_CKSUM: + priv->eeprom_checksum = EEPROM_FW_NOT_SUPPORT; /* initialize */ + hostif_mib_get_request(priv, LOCAL_EEPROM_SUM); + break; + case SME_START_REQUEST: + hostif_start_request(priv, priv->reg.operation_mode); + break; + case SME_START_CONFIRM: + /* for power save */ + atomic_set(&priv->psstatus.snooze_guard, 0); + atomic_set(&priv->psstatus.confirm_wait, 0); + if (priv->dev_state == DEVICE_STATE_PREINIT) + priv->dev_state = DEVICE_STATE_INIT; + /* wake_up_interruptible_all(&priv->confirm_wait); */ + complete(&priv->confirm_wait); + break; + case SME_SLEEP_REQUEST: + hostif_sme_sleep_set(priv); + break; + case SME_SET_REGION: + hostif_mib_set_request_int(priv, LOCAL_REGION, priv->region); + break; + case SME_MULTICAST_CONFIRM: + case SME_BSS_SCAN_CONFIRM: + case SME_POW_MNGMT_CONFIRM: + case SME_PHY_INFO_CONFIRM: + case SME_STOP_CONFIRM: + case SME_RTS_THRESHOLD_CONFIRM: + case SME_FRAGMENTATION_THRESHOLD_CONFIRM: + case SME_WEP_INDEX_CONFIRM: + case SME_WEP_KEY1_CONFIRM: + case SME_WEP_KEY2_CONFIRM: + case SME_WEP_KEY3_CONFIRM: + case SME_WEP_KEY4_CONFIRM: + case SME_WEP_FLAG_CONFIRM: + case SME_RSN_UCAST_CONFIRM: + case SME_RSN_MCAST_CONFIRM: + case SME_RSN_AUTH_CONFIRM: + case SME_RSN_ENABLED_CONFIRM: + case SME_RSN_MODE_CONFIRM: + case SME_MODE_SET_CONFIRM: + case SME_TERMINATE: + default: + break; + } +} + +static void hostif_sme_work(struct work_struct *work) +{ + struct ks_wlan_private *priv; + + priv = container_of(work, struct ks_wlan_private, sme_work); + + if (priv->dev_state < DEVICE_STATE_BOOT) + return; + + if (cnt_smeqbody(priv) <= 0) + return; + + hostif_sme_execute(priv, priv->sme_i.event_buff[priv->sme_i.qhead]); + inc_smeqhead(priv); + if (cnt_smeqbody(priv) > 0) + schedule_work(&priv->sme_work); +} + +/* send to Station Management Entity module */ +void hostif_sme_enqueue(struct ks_wlan_private *priv, u16 event) +{ + /* enqueue sme event */ + if (cnt_smeqbody(priv) < (SME_EVENT_BUFF_SIZE - 1)) { + priv->sme_i.event_buff[priv->sme_i.qtail] = event; + inc_smeqtail(priv); + } else { + /* in case of buffer overflow */ + netdev_err(priv->net_dev, "sme queue buffer overflow\n"); + } + + schedule_work(&priv->sme_work); +} + +static inline void hostif_aplist_init(struct ks_wlan_private *priv) +{ + size_t size = LOCAL_APLIST_MAX * sizeof(struct local_ap); + + priv->aplist.size = 0; + memset(&priv->aplist.ap[0], 0, size); +} + +static inline void hostif_status_init(struct ks_wlan_private *priv) +{ + priv->infra_status = 0; + priv->current_rate = 4; + priv->connect_status = DISCONNECT_STATUS; +} + +static inline void hostif_sme_init(struct ks_wlan_private *priv) +{ + priv->sme_i.sme_status = SME_IDLE; + priv->sme_i.qhead = 0; + priv->sme_i.qtail = 0; + spin_lock_init(&priv->sme_i.sme_spin); + priv->sme_i.sme_flag = 0; + INIT_WORK(&priv->sme_work, hostif_sme_work); +} + +static inline void hostif_wpa_init(struct ks_wlan_private *priv) +{ + memset(&priv->wpa, 0, sizeof(priv->wpa)); + priv->wpa.rsn_enabled = false; + priv->wpa.mic_failure.failure = 0; + priv->wpa.mic_failure.last_failure_time = 0; + priv->wpa.mic_failure.stop = 0; +} + +static inline void hostif_power_save_init(struct ks_wlan_private *priv) +{ + atomic_set(&priv->psstatus.status, PS_NONE); + atomic_set(&priv->psstatus.confirm_wait, 0); + atomic_set(&priv->psstatus.snooze_guard, 0); + init_completion(&priv->psstatus.wakeup_wait); + INIT_WORK(&priv->wakeup_work, ks_wlan_hw_wakeup_task); +} + +static inline void hostif_pmklist_init(struct ks_wlan_private *priv) +{ + int i; + + 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); +} + +static inline void hostif_counters_init(struct ks_wlan_private *priv) +{ + priv->dev_count = 0; + atomic_set(&priv->event_count, 0); + atomic_set(&priv->rec_count, 0); +} + +int hostif_init(struct ks_wlan_private *priv) +{ + hostif_aplist_init(priv); + hostif_status_init(priv); + + spin_lock_init(&priv->multicast_spin); + spin_lock_init(&priv->dev_read_lock); + init_waitqueue_head(&priv->devread_wait); + + hostif_counters_init(priv); + hostif_power_save_init(priv); + hostif_wpa_init(priv); + hostif_pmklist_init(priv); + hostif_sme_init(priv); + + return 0; +} + +void hostif_exit(struct ks_wlan_private *priv) +{ + cancel_work_sync(&priv->sme_work); +} diff --git a/drivers/staging/ks7010/ks_hostif.h b/drivers/staging/ks7010/ks_hostif.h new file mode 100644 index 0000000000..c62a494ed6 --- /dev/null +++ b/drivers/staging/ks7010/ks_hostif.h @@ -0,0 +1,617 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Driver for KeyStream wireless LAN + * + * Copyright (c) 2005-2008 KeyStream Corp. + * Copyright (C) 2009 Renesas Technology Corp. + */ + +#ifndef _KS_HOSTIF_H_ +#define _KS_HOSTIF_H_ + +#include <linux/compiler.h> +#include <linux/ieee80211.h> + +/* + * HOST-MAC I/F events + */ +#define HIF_DATA_REQ 0xE001 +#define HIF_DATA_IND 0xE801 +#define HIF_MIB_GET_REQ 0xE002 +#define HIF_MIB_GET_CONF 0xE802 +#define HIF_MIB_SET_REQ 0xE003 +#define HIF_MIB_SET_CONF 0xE803 +#define HIF_POWER_MGMT_REQ 0xE004 +#define HIF_POWER_MGMT_CONF 0xE804 +#define HIF_START_REQ 0xE005 +#define HIF_START_CONF 0xE805 +#define HIF_CONNECT_IND 0xE806 +#define HIF_STOP_REQ 0xE006 +#define HIF_STOP_CONF 0xE807 +#define HIF_PS_ADH_SET_REQ 0xE007 +#define HIF_PS_ADH_SET_CONF 0xE808 +#define HIF_INFRA_SET_REQ 0xE008 +#define HIF_INFRA_SET_CONF 0xE809 +#define HIF_ADH_SET_REQ 0xE009 +#define HIF_ADH_SET_CONF 0xE80A +#define HIF_AP_SET_REQ 0xE00A +#define HIF_AP_SET_CONF 0xE80B +#define HIF_ASSOC_INFO_IND 0xE80C +#define HIF_MIC_FAILURE_REQ 0xE00B +#define HIF_MIC_FAILURE_CONF 0xE80D +#define HIF_SCAN_REQ 0xE00C +#define HIF_SCAN_CONF 0xE80E +#define HIF_PHY_INFO_REQ 0xE00D +#define HIF_PHY_INFO_CONF 0xE80F +#define HIF_SLEEP_REQ 0xE00E +#define HIF_SLEEP_CONF 0xE810 +#define HIF_PHY_INFO_IND 0xE811 +#define HIF_SCAN_IND 0xE812 +#define HIF_INFRA_SET2_REQ 0xE00F +#define HIF_INFRA_SET2_CONF 0xE813 +#define HIF_ADH_SET2_REQ 0xE010 +#define HIF_ADH_SET2_CONF 0xE814 + +#define HIF_REQ_MAX 0xE010 + +/* + * HOST-MAC I/F data structure + * Byte alignment Little Endian + */ + +struct hostif_hdr { + __le16 size; + __le16 event; +} __packed; + +struct hostif_data_request { + struct hostif_hdr header; + __le16 auth_type; +#define TYPE_DATA 0x0000 +#define TYPE_AUTH 0x0001 + __le16 reserved; + u8 data[]; +} __packed; + +#define TYPE_PMK1 0x0001 +#define TYPE_GMK1 0x0002 +#define TYPE_GMK2 0x0003 + +#define CHANNEL_LIST_MAX_SIZE 14 +struct channel_list { + u8 size; + u8 body[CHANNEL_LIST_MAX_SIZE]; + u8 pad; +} __packed; + +/** + * enum mib_attribute - Management Information Base attribute + * Attribute value used for accessing and updating MIB + * + * @DOT11_MAC_ADDRESS: MAC Address (R) + * @DOT11_PRODUCT_VERSION: FirmWare Version (R) + * @DOT11_RTS_THRESHOLD: RTS Threshold (R/W) + * @DOT11_FRAGMENTATION_THRESHOLD: Fragment Threshold (R/W) + * @DOT11_PRIVACY_INVOKED: WEP ON/OFF (W) + * @DOT11_WEP_DEFAULT_KEY_ID: WEP Index (W) + * @DOT11_WEP_DEFAULT_KEY_VALUE1: WEP Key#1(TKIP AES: PairwiseTemporalKey) (W) + * @DOT11_WEP_DEFAULT_KEY_VALUE2: WEP Key#2(TKIP AES: GroupKey1) (W) + * @DOT11_WEP_DEFAULT_KEY_VALUE3: WEP Key#3(TKIP AES: GroupKey2) (W) + * @DOT11_WEP_DEFAULT_KEY_VALUE4: WEP Key#4 (W) + * @DOT11_WEP_LIST: WEP LIST + * @DOT11_DESIRED_SSID: SSID + * @DOT11_CURRENT_CHANNEL: channel set + * @DOT11_OPERATION_RATE_SET: rate set + * @LOCAL_AP_SEARCH_INTERVAL: AP search interval (R/W) + * @LOCAL_CURRENTADDRESS: MAC Address change (W) + * @LOCAL_MULTICAST_ADDRESS: Multicast Address (W) + * @LOCAL_MULTICAST_FILTER: Multicast Address Filter enable/disable (W) + * @LOCAL_SEARCHED_AP_LIST: AP list (R) + * @LOCAL_LINK_AP_STATUS: Link AP status (R) + * @LOCAL_PACKET_STATISTICS: tx,rx packets statistics + * @LOCAL_AP_SCAN_LIST_TYPE_SET: AP_SCAN_LIST_TYPE + * @DOT11_RSN_ENABLED: WPA enable/disable (W) + * @LOCAL_RSN_MODE: RSN mode WPA/WPA2 (W) + * @DOT11_RSN_CONFIG_MULTICAST_CIPHER: GroupKeyCipherSuite (W) + * @DOT11_RSN_CONFIG_UNICAST_CIPHER: PairwiseKeyCipherSuite (W) + * @DOT11_RSN_CONFIG_AUTH_SUITE: AuthenticationKeyManagementSuite (W) + * @DOT11_RSN_CONFIG_VERSION: RSN version (W) + * @LOCAL_RSN_CONFIG_ALL: RSN CONFIG ALL (W) + * @DOT11_PMK_TSC: PMK_TSC (W) + * @DOT11_GMK1_TSC: GMK1_TSC (W) + * @DOT11_GMK2_TSC: GMK2_TSC (W) + * @DOT11_GMK3_TSC: GMK3_TSC + * @LOCAL_PMK: Pairwise Master Key cache (W) + * @LOCAL_REGION: Region setting + * @LOCAL_WPS_ENABLE: WiFi Protected Setup + * @LOCAL_WPS_PROBE_REQ: WPS Probe Request + * @LOCAL_GAIN: Carrer sense threshold for demo ato show + * @LOCAL_EEPROM_SUM: EEPROM checksum information + */ +enum mib_attribute { + DOT11_MAC_ADDRESS = 0x21010100, + DOT11_PRODUCT_VERSION = 0x31024100, + DOT11_RTS_THRESHOLD = 0x21020100, + DOT11_FRAGMENTATION_THRESHOLD = 0x21050100, + DOT11_PRIVACY_INVOKED = 0x15010100, + DOT11_WEP_DEFAULT_KEY_ID = 0x15020100, + DOT11_WEP_DEFAULT_KEY_VALUE1 = 0x13020101, + DOT11_WEP_DEFAULT_KEY_VALUE2 = 0x13020102, + DOT11_WEP_DEFAULT_KEY_VALUE3 = 0x13020103, + DOT11_WEP_DEFAULT_KEY_VALUE4 = 0x13020104, + DOT11_WEP_LIST = 0x13020100, + DOT11_DESIRED_SSID = 0x11090100, + DOT11_CURRENT_CHANNEL = 0x45010100, + DOT11_OPERATION_RATE_SET = 0x11110100, + LOCAL_AP_SEARCH_INTERVAL = 0xF1010100, + LOCAL_CURRENTADDRESS = 0xF1050100, + LOCAL_MULTICAST_ADDRESS = 0xF1060100, + LOCAL_MULTICAST_FILTER = 0xF1060200, + LOCAL_SEARCHED_AP_LIST = 0xF1030100, + LOCAL_LINK_AP_STATUS = 0xF1040100, + LOCAL_PACKET_STATISTICS = 0xF1020100, + LOCAL_AP_SCAN_LIST_TYPE_SET = 0xF1030200, + DOT11_RSN_ENABLED = 0x15070100, + LOCAL_RSN_MODE = 0x56010100, + DOT11_RSN_CONFIG_MULTICAST_CIPHER = 0x51040100, + DOT11_RSN_CONFIG_UNICAST_CIPHER = 0x52020100, + DOT11_RSN_CONFIG_AUTH_SUITE = 0x53020100, + DOT11_RSN_CONFIG_VERSION = 0x51020100, + LOCAL_RSN_CONFIG_ALL = 0x5F010100, + DOT11_PMK_TSC = 0x55010100, + DOT11_GMK1_TSC = 0x55010101, + DOT11_GMK2_TSC = 0x55010102, + DOT11_GMK3_TSC = 0x55010103, + LOCAL_PMK = 0x58010100, + LOCAL_REGION = 0xF10A0100, + LOCAL_WPS_ENABLE = 0xF10B0100, + LOCAL_WPS_PROBE_REQ = 0xF10C0100, + LOCAL_GAIN = 0xF10D0100, + LOCAL_EEPROM_SUM = 0xF10E0100 +}; + +struct hostif_mib_get_request { + struct hostif_hdr header; + __le32 mib_attribute; +} __packed; + +/** + * enum mib_data_type - Message Information Base data type. + * @MIB_VALUE_TYPE_NULL: NULL type + * @MIB_VALUE_TYPE_INT: INTEGER type + * @MIB_VALUE_TYPE_BOOL: BOOL type + * @MIB_VALUE_TYPE_COUNT32: unused + * @MIB_VALUE_TYPE_OSTRING: Chunk of memory + */ +enum mib_data_type { + MIB_VALUE_TYPE_NULL = 0, + MIB_VALUE_TYPE_INT, + MIB_VALUE_TYPE_BOOL, + MIB_VALUE_TYPE_COUNT32, + MIB_VALUE_TYPE_OSTRING +}; + +struct hostif_mib_value { + __le16 size; + __le16 type; + u8 body[]; +} __packed; + +struct hostif_mib_get_confirm_t { + struct hostif_hdr header; + __le32 mib_status; +#define MIB_SUCCESS 0 +#define MIB_INVALID 1 +#define MIB_READ_ONLY 2 +#define MIB_WRITE_ONLY 3 + __le32 mib_attribute; + struct hostif_mib_value mib_value; +} __packed; + +struct hostif_mib_set_request_t { + struct hostif_hdr header; + __le32 mib_attribute; + struct hostif_mib_value mib_value; +} __packed; + +struct hostif_power_mgmt_request { + struct hostif_hdr header; + __le32 mode; +#define POWER_ACTIVE 1 +#define POWER_SAVE 2 + __le32 wake_up; +#define SLEEP_FALSE 0 +#define SLEEP_TRUE 1 /* not used */ + __le32 receive_dtims; +#define DTIM_FALSE 0 +#define DTIM_TRUE 1 +} __packed; + +enum power_mgmt_mode_type { + POWER_MGMT_ACTIVE, + POWER_MGMT_SAVE1, + POWER_MGMT_SAVE2 +}; + +#define RESULT_SUCCESS 0 +#define RESULT_INVALID_PARAMETERS 1 +#define RESULT_NOT_SUPPORTED 2 +/* #define RESULT_ALREADY_RUNNING 3 */ +#define RESULT_ALREADY_RUNNING 7 + +struct hostif_start_request { + struct hostif_hdr header; + __le16 mode; +#define MODE_PSEUDO_ADHOC 0 +#define MODE_INFRASTRUCTURE 1 +#define MODE_AP 2 /* not used */ +#define MODE_ADHOC 3 +} __packed; + +struct ssid { + u8 size; + u8 body[IEEE80211_MAX_SSID_LEN]; + u8 ssid_pad; +} __packed; + +#define RATE_SET_MAX_SIZE 16 +struct rate_set8 { + u8 size; + u8 body[8]; + u8 rate_pad; +} __packed; + +struct fh_parms { + __le16 dwell_time; + u8 hop_set; + u8 hop_pattern; + u8 hop_index; +} __packed; + +struct ds_parms { + u8 channel; +} __packed; + +struct cf_parms { + u8 count; + u8 period; + __le16 max_duration; + __le16 dur_remaining; +} __packed; + +struct ibss_parms { + __le16 atim_window; +} __packed; + +struct rsn_t { + u8 size; +#define RSN_BODY_SIZE 64 + u8 body[RSN_BODY_SIZE]; +} __packed; + +struct erp_params_t { + u8 erp_info; +} __packed; + +struct rate_set16 { + u8 size; + u8 body[16]; + u8 rate_pad; +} __packed; + +struct ap_info { + u8 bssid[6]; /* +00 */ + u8 rssi; /* +06 */ + u8 sq; /* +07 */ + u8 noise; /* +08 */ + u8 pad0; /* +09 */ + __le16 beacon_period; /* +10 */ + __le16 capability; /* +12 */ + u8 frame_type; /* +14 */ + u8 ch_info; /* +15 */ + __le16 body_size; /* +16 */ + u8 body[1024]; /* +18 */ + /* +1032 */ +} __packed; + +struct link_ap_info { + u8 bssid[6]; /* +00 */ + u8 rssi; /* +06 */ + u8 sq; /* +07 */ + u8 noise; /* +08 */ + u8 pad0; /* +09 */ + __le16 beacon_period; /* +10 */ + __le16 capability; /* +12 */ + struct rate_set8 rate_set; /* +14 */ + struct fh_parms fh_parameter; /* +24 */ + struct ds_parms ds_parameter; /* +29 */ + struct cf_parms cf_parameter; /* +30 */ + struct ibss_parms ibss_parameter; /* +36 */ + struct erp_params_t erp_parameter; /* +38 */ + u8 pad1; /* +39 */ + struct rate_set8 ext_rate_set; /* +40 */ + u8 DTIM_period; /* +50 */ + u8 rsn_mode; /* +51 */ +#define RSN_MODE_NONE 0 +#define RSN_MODE_WPA 1 +#define RSN_MODE_WPA2 2 + struct { + u8 size; /* +52 */ + u8 body[128]; /* +53 */ + } __packed rsn; +} __packed; + +#define RESULT_CONNECT 0 +#define RESULT_DISCONNECT 1 + +struct hostif_stop_request { + struct hostif_hdr header; +} __packed; + +#define D_11B_ONLY_MODE 0 +#define D_11G_ONLY_MODE 1 +#define D_11BG_COMPATIBLE_MODE 2 +#define D_11A_ONLY_MODE 3 + +#define CTS_MODE_FALSE 0 +#define CTS_MODE_TRUE 1 + +struct hostif_request { + __le16 phy_type; + __le16 cts_mode; + __le16 scan_type; + __le16 capability; + struct rate_set16 rate_set; +} __packed; + +/** + * struct hostif_ps_adhoc_set_request - pseudo adhoc mode + * @capability: bit5 : preamble + * bit6 : pbcc - Not supported always 0 + * bit10 : ShortSlotTime + * bit13 : DSSS-OFDM - Not supported always 0 + */ +struct hostif_ps_adhoc_set_request { + struct hostif_hdr header; + struct hostif_request request; + __le16 channel; +} __packed; + +#define AUTH_TYPE_OPEN_SYSTEM 0 +#define AUTH_TYPE_SHARED_KEY 1 + +/** + * struct hostif_infrastructure_set_request + * @capability: bit5 : preamble + * bit6 : pbcc - Not supported always 0 + * bit10 : ShortSlotTime + * bit13 : DSSS-OFDM - Not supported always 0 + */ +struct hostif_infrastructure_set_request { + struct hostif_hdr header; + struct hostif_request request; + struct ssid ssid; + __le16 beacon_lost_count; + __le16 auth_type; + struct channel_list channel_list; + u8 bssid[ETH_ALEN]; +} __packed; + +/** + * struct hostif_adhoc_set_request + * @capability: bit5 : preamble + * bit6 : pbcc - Not supported always 0 + * bit10 : ShortSlotTime + * bit13 : DSSS-OFDM - Not supported always 0 + */ +struct hostif_adhoc_set_request { + struct hostif_hdr header; + struct hostif_request request; + struct ssid ssid; + __le16 channel; +} __packed; + +/** + * struct hostif_adhoc_set2_request + * @capability: bit5 : preamble + * bit6 : pbcc - Not supported always 0 + * bit10 : ShortSlotTime + * bit13 : DSSS-OFDM - Not supported always 0 + */ +struct hostif_adhoc_set2_request { + struct hostif_hdr header; + struct hostif_request request; + __le16 reserved; + struct ssid ssid; + struct channel_list channel_list; + u8 bssid[ETH_ALEN]; +} __packed; + +struct association_request { + u8 type; + u8 pad; + __le16 capability; + __le16 listen_interval; + u8 ap_address[6]; + __le16 req_ies_size; +} __packed; + +struct association_response { + u8 type; + u8 pad; + __le16 capability; + __le16 status; + __le16 association_id; + __le16 resp_ies_size; +} __packed; + +struct hostif_bss_scan_request { + struct hostif_hdr header; + u8 scan_type; +#define ACTIVE_SCAN 0 +#define PASSIVE_SCAN 1 + u8 pad[3]; + __le32 ch_time_min; + __le32 ch_time_max; + struct channel_list channel_list; + struct ssid ssid; +} __packed; + +struct hostif_phy_information_request { + struct hostif_hdr header; + __le16 type; +#define NORMAL_TYPE 0 +#define TIME_TYPE 1 + __le16 time; /* unit 100ms */ +} __packed; + +enum sleep_mode_type { + SLP_ACTIVE, + SLP_SLEEP +}; + +struct hostif_sleep_request { + struct hostif_hdr header; +} __packed; + +struct hostif_mic_failure_request { + struct hostif_hdr header; + __le16 failure_count; + __le16 timer; +} __packed; + +#define BASIC_RATE 0x80 +#define RATE_MASK 0x7F + +#define TX_RATE_AUTO 0xff +#define TX_RATE_1M_FIXED 0 +#define TX_RATE_2M_FIXED 1 +#define TX_RATE_1_2M_AUTO 2 +#define TX_RATE_5M_FIXED 3 +#define TX_RATE_11M_FIXED 4 + +#define TX_RATE_FULL_AUTO 0 +#define TX_RATE_11_AUTO 1 +#define TX_RATE_11B_AUTO 2 +#define TX_RATE_11BG_AUTO 3 +#define TX_RATE_MANUAL_AUTO 4 +#define TX_RATE_FIXED 5 + +/* 11b rate */ +#define TX_RATE_1M ((u8)(10 / 5)) /* 11b 11g basic rate */ +#define TX_RATE_2M ((u8)(20 / 5)) /* 11b 11g basic rate */ +#define TX_RATE_5M ((u8)(55 / 5)) /* 11g basic rate */ +#define TX_RATE_11M ((u8)(110 / 5)) /* 11g basic rate */ + +/* 11g rate */ +#define TX_RATE_6M ((u8)(60 / 5)) /* 11g basic rate */ +#define TX_RATE_12M ((u8)(120 / 5)) /* 11g basic rate */ +#define TX_RATE_24M ((u8)(240 / 5)) /* 11g basic rate */ +#define TX_RATE_9M ((u8)(90 / 5)) +#define TX_RATE_18M ((u8)(180 / 5)) +#define TX_RATE_36M ((u8)(360 / 5)) +#define TX_RATE_48M ((u8)(480 / 5)) +#define TX_RATE_54M ((u8)(540 / 5)) + +static inline bool is_11b_rate(u8 rate) +{ + return (((rate & RATE_MASK) == TX_RATE_1M) || + ((rate & RATE_MASK) == TX_RATE_2M) || + ((rate & RATE_MASK) == TX_RATE_5M) || + ((rate & RATE_MASK) == TX_RATE_11M)); +} + +static inline bool is_ofdm_rate(u8 rate) +{ + return (((rate & RATE_MASK) == TX_RATE_6M) || + ((rate & RATE_MASK) == TX_RATE_12M) || + ((rate & RATE_MASK) == TX_RATE_24M) || + ((rate & RATE_MASK) == TX_RATE_9M) || + ((rate & RATE_MASK) == TX_RATE_18M) || + ((rate & RATE_MASK) == TX_RATE_36M) || + ((rate & RATE_MASK) == TX_RATE_48M) || + ((rate & RATE_MASK) == TX_RATE_54M)); +} + +static inline bool is_11bg_rate(u8 rate) +{ + return (is_11b_rate(rate) || is_ofdm_rate(rate)); +} + +static inline bool is_ofdm_ext_rate(u8 rate) +{ + return (((rate & RATE_MASK) == TX_RATE_9M) || + ((rate & RATE_MASK) == TX_RATE_18M) || + ((rate & RATE_MASK) == TX_RATE_36M) || + ((rate & RATE_MASK) == TX_RATE_48M) || + ((rate & RATE_MASK) == TX_RATE_54M)); +} + +enum connect_status_type { + CONNECT_STATUS, + DISCONNECT_STATUS +}; + +enum preamble_type { + LONG_PREAMBLE, + SHORT_PREAMBLE +}; + +enum multicast_filter_type { + MCAST_FILTER_MCAST, + MCAST_FILTER_MCASTALL, + MCAST_FILTER_PROMISC, +}; + +#define NIC_MAX_MCAST_LIST 32 + +#define HIF_EVENT_MASK 0xE800 + +static inline bool is_hif_ind(unsigned short event) +{ + return (((event & HIF_EVENT_MASK) == HIF_EVENT_MASK) && + (((event & ~HIF_EVENT_MASK) == 0x0001) || + ((event & ~HIF_EVENT_MASK) == 0x0006) || + ((event & ~HIF_EVENT_MASK) == 0x000C) || + ((event & ~HIF_EVENT_MASK) == 0x0011) || + ((event & ~HIF_EVENT_MASK) == 0x0012))); +} + +static inline bool is_hif_conf(unsigned short event) +{ + return (((event & HIF_EVENT_MASK) == HIF_EVENT_MASK) && + ((event & ~HIF_EVENT_MASK) > 0x0000) && + ((event & ~HIF_EVENT_MASK) < 0x0012) && + !is_hif_ind(event)); +} + +#ifdef __KERNEL__ + +#include "ks_wlan.h" + +/* function prototype */ +int hostif_data_request(struct ks_wlan_private *priv, struct sk_buff *skb); +void hostif_receive(struct ks_wlan_private *priv, unsigned char *p, + unsigned int size); +void hostif_sme_enqueue(struct ks_wlan_private *priv, u16 event); +int hostif_init(struct ks_wlan_private *priv); +void hostif_exit(struct ks_wlan_private *priv); +int ks_wlan_hw_tx(struct ks_wlan_private *priv, void *p, unsigned long size, + void (*complete_handler)(struct ks_wlan_private *priv, + struct sk_buff *skb), + struct sk_buff *skb); +void send_packet_complete(struct ks_wlan_private *priv, struct sk_buff *skb); + +void ks_wlan_hw_wakeup_request(struct ks_wlan_private *priv); +int ks_wlan_hw_power_save(struct ks_wlan_private *priv); + +#define KS7010_SIZE_ALIGNMENT 32 + +static inline size_t hif_align_size(size_t size) +{ + return ALIGN(size, KS7010_SIZE_ALIGNMENT); +} + +#endif /* __KERNEL__ */ + +#endif /* _KS_HOSTIF_H_ */ diff --git a/drivers/staging/ks7010/ks_wlan.h b/drivers/staging/ks7010/ks_wlan.h new file mode 100644 index 0000000000..3e9a91b513 --- /dev/null +++ b/drivers/staging/ks7010/ks_wlan.h @@ -0,0 +1,567 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Driver for KeyStream IEEE802.11 b/g wireless LAN cards. + * + * Copyright (C) 2006-2008 KeyStream Corp. + * Copyright (C) 2009 Renesas Technology Corp. + */ + +#ifndef _KS_WLAN_H +#define _KS_WLAN_H + +#include <linux/atomic.h> +#include <linux/circ_buf.h> +#include <linux/completion.h> +#include <linux/netdevice.h> +#include <linux/sched.h> +#include <linux/spinlock.h> +#include <linux/wireless.h> + +struct ks_wlan_parameter { + u8 operation_mode; + u8 channel; + u8 tx_rate; + struct { + u8 size; + u8 body[16]; + } rate_set; + u8 bssid[ETH_ALEN]; + struct { + u8 size; + u8 body[32 + 1]; + } ssid; + u8 preamble; + u8 power_mgmt; + u32 scan_type; +#define BEACON_LOST_COUNT_MAX 65535 + u32 beacon_lost_count; + u32 rts; + u32 fragment; + u32 privacy_invoked; + u32 wep_index; + struct { + u8 size; + u8 val[13 * 2 + 1]; + } wep_key[4]; + u16 authenticate_type; + u16 phy_type; + u16 cts_mode; + u16 phy_info_timer; +}; + +enum { + DEVICE_STATE_OFF = 0, /* this means hw_unavailable is != 0 */ + DEVICE_STATE_PREBOOT, /* we are in a pre-boot state (empty RAM) */ + DEVICE_STATE_BOOT, /* boot state (fw upload, run fw) */ + DEVICE_STATE_PREINIT, /* pre-init state */ + DEVICE_STATE_INIT, /* init state (restore MIB backup to device) */ + DEVICE_STATE_READY, /* driver&device are in operational state */ + DEVICE_STATE_SLEEP /* device in sleep mode */ +}; + +/* SME flag */ +#define SME_MODE_SET BIT(0) +#define SME_RTS BIT(1) +#define SME_FRAG BIT(2) +#define SME_WEP_FLAG BIT(3) +#define SME_WEP_INDEX BIT(4) +#define SME_WEP_VAL1 BIT(5) +#define SME_WEP_VAL2 BIT(6) +#define SME_WEP_VAL3 BIT(7) +#define SME_WEP_VAL4 BIT(8) +#define SME_WEP_VAL_MASK GENMASK(8, 5) +#define SME_RSN BIT(9) +#define SME_RSN_MULTICAST BIT(10) +#define SME_RSN_UNICAST BIT(11) +#define SME_RSN_AUTH BIT(12) + +#define SME_AP_SCAN BIT(13) +#define SME_MULTICAST BIT(14) + +/* SME Event */ +enum { + SME_START, + + SME_MULTICAST_REQUEST, + SME_MACADDRESS_SET_REQUEST, + SME_BSS_SCAN_REQUEST, + SME_SET_FLAG, + SME_SET_TXKEY, + SME_SET_KEY1, + SME_SET_KEY2, + SME_SET_KEY3, + SME_SET_KEY4, + SME_SET_PMK_TSC, + SME_SET_GMK1_TSC, + SME_SET_GMK2_TSC, + SME_SET_GMK3_TSC, + SME_SET_PMKSA, + SME_POW_MNGMT_REQUEST, + SME_PHY_INFO_REQUEST, + SME_MIC_FAILURE_REQUEST, + SME_GET_MAC_ADDRESS, + SME_GET_PRODUCT_VERSION, + SME_STOP_REQUEST, + SME_RTS_THRESHOLD_REQUEST, + SME_FRAGMENTATION_THRESHOLD_REQUEST, + SME_WEP_INDEX_REQUEST, + SME_WEP_KEY1_REQUEST, + SME_WEP_KEY2_REQUEST, + SME_WEP_KEY3_REQUEST, + SME_WEP_KEY4_REQUEST, + SME_WEP_FLAG_REQUEST, + SME_RSN_UCAST_REQUEST, + SME_RSN_MCAST_REQUEST, + SME_RSN_AUTH_REQUEST, + SME_RSN_ENABLED_REQUEST, + SME_RSN_MODE_REQUEST, + SME_WPS_ENABLE_REQUEST, + SME_WPS_PROBE_REQUEST, + SME_SET_GAIN, + SME_GET_GAIN, + SME_SLEEP_REQUEST, + SME_SET_REGION, + SME_MODE_SET_REQUEST, + SME_START_REQUEST, + SME_GET_EEPROM_CKSUM, + + SME_MIC_FAILURE_CONFIRM, + SME_START_CONFIRM, + + SME_MULTICAST_CONFIRM, + SME_BSS_SCAN_CONFIRM, + SME_GET_CURRENT_AP, + SME_POW_MNGMT_CONFIRM, + SME_PHY_INFO_CONFIRM, + SME_STOP_CONFIRM, + SME_RTS_THRESHOLD_CONFIRM, + SME_FRAGMENTATION_THRESHOLD_CONFIRM, + SME_WEP_INDEX_CONFIRM, + SME_WEP_KEY1_CONFIRM, + SME_WEP_KEY2_CONFIRM, + SME_WEP_KEY3_CONFIRM, + SME_WEP_KEY4_CONFIRM, + SME_WEP_FLAG_CONFIRM, + SME_RSN_UCAST_CONFIRM, + SME_RSN_MCAST_CONFIRM, + SME_RSN_AUTH_CONFIRM, + SME_RSN_ENABLED_CONFIRM, + SME_RSN_MODE_CONFIRM, + SME_MODE_SET_CONFIRM, + SME_SLEEP_CONFIRM, + + SME_RSN_SET_CONFIRM, + SME_WEP_SET_CONFIRM, + SME_TERMINATE, + + SME_EVENT_SIZE +}; + +/* SME Status */ +enum { + SME_IDLE, + SME_SETUP, + SME_DISCONNECT, + SME_CONNECT +}; + +#define SME_EVENT_BUFF_SIZE 128 + +struct sme_info { + int sme_status; + int event_buff[SME_EVENT_BUFF_SIZE]; + unsigned int qhead; + unsigned int qtail; + spinlock_t sme_spin; + unsigned long sme_flag; +}; + +struct hostt { + int buff[SME_EVENT_BUFF_SIZE]; + unsigned int qhead; + unsigned int qtail; +}; + +#define RSN_IE_BODY_MAX 64 +struct rsn_ie { + u8 id; /* 0xdd = WPA or 0x30 = RSN */ + u8 size; /* max ? 255 ? */ + u8 body[RSN_IE_BODY_MAX]; +} __packed; + +#define WPA_INFO_ELEM_ID 0xdd +#define RSN_INFO_ELEM_ID 0x30 + +#define WPS_IE_BODY_MAX 255 +struct wps_ie { + u8 id; /* 221 'dd <len> 00 50 F2 04' */ + u8 size; /* max ? 255 ? */ + u8 body[WPS_IE_BODY_MAX]; +} __packed; + +struct local_ap { + u8 bssid[6]; + u8 rssi; + u8 sq; + struct { + u8 size; + u8 body[32]; + u8 ssid_pad; + } ssid; + struct { + u8 size; + u8 body[16]; + u8 rate_pad; + } rate_set; + u16 capability; + u8 channel; + u8 noise; + struct rsn_ie wpa_ie; + struct rsn_ie rsn_ie; + struct wps_ie wps_ie; +}; + +#define LOCAL_APLIST_MAX 31 +#define LOCAL_CURRENT_AP LOCAL_APLIST_MAX +struct local_aplist { + int size; + struct local_ap ap[LOCAL_APLIST_MAX + 1]; +}; + +struct local_gain { + u8 tx_mode; + u8 rx_mode; + u8 tx_gain; + u8 rx_gain; +}; + +struct local_eeprom_sum { + u8 type; + u8 result; +}; + +enum { + EEPROM_OK, + EEPROM_CHECKSUM_NONE, + EEPROM_FW_NOT_SUPPORT, + EEPROM_NG, +}; + +/* Power Save Status */ +enum { + PS_NONE, + PS_ACTIVE_SET, + PS_SAVE_SET, + PS_CONF_WAIT, + PS_SNOOZE, + PS_WAKEUP +}; + +struct power_save_status { + atomic_t status; /* initialvalue 0 */ + struct completion wakeup_wait; + atomic_t confirm_wait; + atomic_t snooze_guard; +}; + +struct sleep_status { + atomic_t status; /* initialvalue 0 */ + atomic_t doze_request; + atomic_t wakeup_request; +}; + +/* WPA */ +struct scan_ext { + unsigned int flag; + char ssid[IW_ESSID_MAX_SIZE + 1]; +}; + +#define CIPHER_ID_WPA_NONE "\x00\x50\xf2\x00" +#define CIPHER_ID_WPA_WEP40 "\x00\x50\xf2\x01" +#define CIPHER_ID_WPA_TKIP "\x00\x50\xf2\x02" +#define CIPHER_ID_WPA_CCMP "\x00\x50\xf2\x04" +#define CIPHER_ID_WPA_WEP104 "\x00\x50\xf2\x05" + +#define CIPHER_ID_WPA2_NONE "\x00\x0f\xac\x00" +#define CIPHER_ID_WPA2_WEP40 "\x00\x0f\xac\x01" +#define CIPHER_ID_WPA2_TKIP "\x00\x0f\xac\x02" +#define CIPHER_ID_WPA2_CCMP "\x00\x0f\xac\x04" +#define CIPHER_ID_WPA2_WEP104 "\x00\x0f\xac\x05" + +#define CIPHER_ID_LEN 4 + +enum { + KEY_MGMT_802_1X, + KEY_MGMT_PSK, + KEY_MGMT_WPANONE, +}; + +#define KEY_MGMT_ID_WPA_NONE "\x00\x50\xf2\x00" +#define KEY_MGMT_ID_WPA_1X "\x00\x50\xf2\x01" +#define KEY_MGMT_ID_WPA_PSK "\x00\x50\xf2\x02" +#define KEY_MGMT_ID_WPA_WPANONE "\x00\x50\xf2\xff" + +#define KEY_MGMT_ID_WPA2_NONE "\x00\x0f\xac\x00" +#define KEY_MGMT_ID_WPA2_1X "\x00\x0f\xac\x01" +#define KEY_MGMT_ID_WPA2_PSK "\x00\x0f\xac\x02" +#define KEY_MGMT_ID_WPA2_WPANONE "\x00\x0f\xac\xff" + +#define KEY_MGMT_ID_LEN 4 + +#define MIC_KEY_SIZE 8 + +struct wpa_key { + u32 ext_flags; /* IW_ENCODE_EXT_xxx */ + u8 tx_seq[IW_ENCODE_SEQ_MAX_SIZE]; /* LSB first */ + u8 rx_seq[IW_ENCODE_SEQ_MAX_SIZE]; /* LSB first */ + struct sockaddr addr; /* ff:ff:ff:ff:ff:ff for broadcast/multicast + * (group) keys or unicast address for + * individual keys + */ + u16 alg; + u16 key_len; /* WEP: 5 or 13, TKIP: 32, CCMP: 16 */ + u8 key_val[IW_ENCODING_TOKEN_MAX]; + u8 tx_mic_key[MIC_KEY_SIZE]; + u8 rx_mic_key[MIC_KEY_SIZE]; +}; + +#define WPA_KEY_INDEX_MAX 4 +#define WPA_RX_SEQ_LEN 6 + +struct mic_failure { + u16 failure; /* MIC Failure counter 0 or 1 or 2 */ + u16 counter; /* 1sec counter 0-60 */ + u32 last_failure_time; + int stop; +}; + +struct wpa_status { + int wpa_enabled; + bool rsn_enabled; + int version; + int pairwise_suite; /* unicast cipher */ + int group_suite; /* multicast cipher */ + int key_mgmt_suite; + int auth_alg; + int txkey; + struct wpa_key key[WPA_KEY_INDEX_MAX]; + struct scan_ext scan_ext; + struct mic_failure mic_failure; +}; + +#include <linux/list.h> +#define PMK_LIST_MAX 8 +struct pmk_list { + u16 size; + struct list_head head; + struct pmk { + struct list_head list; + u8 bssid[ETH_ALEN]; + u8 pmkid[IW_PMKID_LEN]; + } pmk[PMK_LIST_MAX]; +}; + +struct wps_status { + int wps_enabled; + int ielen; + u8 ie[255]; +}; + +/* Tx Device struct */ +#define TX_DEVICE_BUFF_SIZE 1024 + +struct ks_wlan_private; + +/** + * struct tx_device_buffer - Queue item for the tx queue. + * @sendp: Pointer to the send request data. + * @size: Size of @sendp data. + * @complete_handler: Function called once data write to device is complete. + * @arg1: First argument to @complete_handler. + * @arg2: Second argument to @complete_handler. + */ +struct tx_device_buffer { + unsigned char *sendp; + unsigned int size; + void (*complete_handler)(struct ks_wlan_private *priv, + struct sk_buff *skb); + struct sk_buff *skb; +}; + +/** + * struct tx_device - Tx buffer queue. + * @tx_device_buffer: Queue buffer. + * @qhead: Head of tx queue. + * @qtail: Tail of tx queue. + * @tx_dev_lock: Queue lock. + */ +struct tx_device { + struct tx_device_buffer tx_dev_buff[TX_DEVICE_BUFF_SIZE]; + unsigned int qhead; + unsigned int qtail; + spinlock_t tx_dev_lock; /* protect access to the queue */ +}; + +/* Rx Device struct */ +#define RX_DATA_SIZE (2 + 2 + 2347 + 1) +#define RX_DEVICE_BUFF_SIZE 32 + +/** + * struct rx_device_buffer - Queue item for the rx queue. + * @data: rx data. + * @size: Size of @data. + */ +struct rx_device_buffer { + unsigned char data[RX_DATA_SIZE]; + unsigned int size; +}; + +/** + * struct rx_device - Rx buffer queue. + * @rx_device_buffer: Queue buffer. + * @qhead: Head of rx queue. + * @qtail: Tail of rx queue. + * @rx_dev_lock: Queue lock. + */ +struct rx_device { + struct rx_device_buffer rx_dev_buff[RX_DEVICE_BUFF_SIZE]; + unsigned int qhead; + unsigned int qtail; + spinlock_t rx_dev_lock; /* protect access to the queue */ +}; + +struct ks_wlan_private { + /* hardware information */ + void *if_hw; + struct workqueue_struct *wq; + struct delayed_work rw_dwork; + struct tasklet_struct rx_bh_task; + + struct net_device *net_dev; + struct net_device_stats nstats; + struct iw_statistics wstats; + + struct completion confirm_wait; + + /* trx device & sme */ + struct tx_device tx_dev; + struct rx_device rx_dev; + struct sme_info sme_i; + u8 *rxp; + unsigned int rx_size; + struct work_struct sme_work; + struct work_struct wakeup_work; + int scan_ind_count; + + unsigned char eth_addr[ETH_ALEN]; + + struct local_aplist aplist; + struct local_ap current_ap; + struct power_save_status psstatus; + struct sleep_status sleepstatus; + struct wpa_status wpa; + struct pmk_list pmklist; + /* wireless parameter */ + struct ks_wlan_parameter reg; + u8 current_rate; + + char nick[IW_ESSID_MAX_SIZE + 1]; + + spinlock_t multicast_spin; + + spinlock_t dev_read_lock; + wait_queue_head_t devread_wait; + + unsigned int need_commit; /* for ioctl */ + + /* DeviceIoControl */ + bool is_device_open; + atomic_t event_count; + atomic_t rec_count; + int dev_count; +#define DEVICE_STOCK_COUNT 20 + unsigned char *dev_data[DEVICE_STOCK_COUNT]; + int dev_size[DEVICE_STOCK_COUNT]; + + /* ioctl : IOCTL_FIRMWARE_VERSION */ + unsigned char firmware_version[128 + 1]; + int version_size; + + bool mac_address_valid; + + int dev_state; + + struct sk_buff *skb; + unsigned int cur_rx; /* Index into the Rx buffer of next Rx pkt. */ +#define FORCE_DISCONNECT 0x80000000 +#define CONNECT_STATUS_MASK 0x7FFFFFFF + u32 connect_status; + int infra_status; + u8 scan_ssid_len; + u8 scan_ssid[IW_ESSID_MAX_SIZE + 1]; + struct local_gain gain; + struct wps_status wps; + u8 sleep_mode; + + u8 region; + struct local_eeprom_sum eeprom_sum; + u8 eeprom_checksum; + + struct hostt hostt; + + unsigned long last_doze; + unsigned long last_wakeup; + + unsigned int wakeup_count; /* for detect wakeup loop */ +}; + +static inline void inc_txqhead(struct ks_wlan_private *priv) +{ + priv->tx_dev.qhead = (priv->tx_dev.qhead + 1) % TX_DEVICE_BUFF_SIZE; +} + +static inline void inc_txqtail(struct ks_wlan_private *priv) +{ + priv->tx_dev.qtail = (priv->tx_dev.qtail + 1) % TX_DEVICE_BUFF_SIZE; +} + +static inline bool txq_has_space(struct ks_wlan_private *priv) +{ + return (CIRC_SPACE(priv->tx_dev.qhead, priv->tx_dev.qtail, + TX_DEVICE_BUFF_SIZE) > 0); +} + +static inline void inc_rxqhead(struct ks_wlan_private *priv) +{ + priv->rx_dev.qhead = (priv->rx_dev.qhead + 1) % RX_DEVICE_BUFF_SIZE; +} + +static inline void inc_rxqtail(struct ks_wlan_private *priv) +{ + priv->rx_dev.qtail = (priv->rx_dev.qtail + 1) % RX_DEVICE_BUFF_SIZE; +} + +static inline bool rxq_has_space(struct ks_wlan_private *priv) +{ + return (CIRC_SPACE(priv->rx_dev.qhead, priv->rx_dev.qtail, + RX_DEVICE_BUFF_SIZE) > 0); +} + +static inline unsigned int txq_count(struct ks_wlan_private *priv) +{ + return CIRC_CNT_TO_END(priv->tx_dev.qhead, priv->tx_dev.qtail, + TX_DEVICE_BUFF_SIZE); +} + +static inline unsigned int rxq_count(struct ks_wlan_private *priv) +{ + return CIRC_CNT_TO_END(priv->rx_dev.qhead, priv->rx_dev.qtail, + RX_DEVICE_BUFF_SIZE); +} + +int ks_wlan_net_start(struct net_device *dev); +int ks_wlan_net_stop(struct net_device *dev); +bool is_connect_status(u32 status); +bool is_disconnect_status(u32 status); + +#endif /* _KS_WLAN_H */ diff --git a/drivers/staging/ks7010/ks_wlan_ioctl.h b/drivers/staging/ks7010/ks_wlan_ioctl.h new file mode 100644 index 0000000000..97c7d95de4 --- /dev/null +++ b/drivers/staging/ks7010/ks_wlan_ioctl.h @@ -0,0 +1,61 @@ +/* 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. + */ + +#ifndef _KS_WLAN_IOCTL_H +#define _KS_WLAN_IOCTL_H + +#include <linux/wireless.h> +/* The low order bit identify a SET (0) or a GET (1) ioctl. */ + +/* (SIOCIWFIRSTPRIV + 0) */ +/* former KS_WLAN_GET_DRIVER_VERSION (SIOCIWFIRSTPRIV + 1) */ +/* (SIOCIWFIRSTPRIV + 2) */ +#define KS_WLAN_GET_FIRM_VERSION (SIOCIWFIRSTPRIV + 3) +#define KS_WLAN_SET_WPS_ENABLE (SIOCIWFIRSTPRIV + 4) +#define KS_WLAN_GET_WPS_ENABLE (SIOCIWFIRSTPRIV + 5) +#define KS_WLAN_SET_WPS_PROBE_REQ (SIOCIWFIRSTPRIV + 6) +#define KS_WLAN_GET_EEPROM_CKSUM (SIOCIWFIRSTPRIV + 7) +#define KS_WLAN_SET_PREAMBLE (SIOCIWFIRSTPRIV + 8) +#define KS_WLAN_GET_PREAMBLE (SIOCIWFIRSTPRIV + 9) +#define KS_WLAN_SET_POWER_SAVE (SIOCIWFIRSTPRIV + 10) +#define KS_WLAN_GET_POWER_SAVE (SIOCIWFIRSTPRIV + 11) +#define KS_WLAN_SET_SCAN_TYPE (SIOCIWFIRSTPRIV + 12) +#define KS_WLAN_GET_SCAN_TYPE (SIOCIWFIRSTPRIV + 13) +#define KS_WLAN_SET_RX_GAIN (SIOCIWFIRSTPRIV + 14) +#define KS_WLAN_GET_RX_GAIN (SIOCIWFIRSTPRIV + 15) +#define KS_WLAN_HOSTT (SIOCIWFIRSTPRIV + 16) /* unused */ +//#define KS_WLAN_SET_REGION (SIOCIWFIRSTPRIV + 17) +#define KS_WLAN_SET_BEACON_LOST (SIOCIWFIRSTPRIV + 18) +#define KS_WLAN_GET_BEACON_LOST (SIOCIWFIRSTPRIV + 19) + +#define KS_WLAN_SET_TX_GAIN (SIOCIWFIRSTPRIV + 20) +#define KS_WLAN_GET_TX_GAIN (SIOCIWFIRSTPRIV + 21) + +/* for KS7010 */ +#define KS_WLAN_SET_PHY_TYPE (SIOCIWFIRSTPRIV + 22) +#define KS_WLAN_GET_PHY_TYPE (SIOCIWFIRSTPRIV + 23) +#define KS_WLAN_SET_CTS_MODE (SIOCIWFIRSTPRIV + 24) +#define KS_WLAN_GET_CTS_MODE (SIOCIWFIRSTPRIV + 25) +/* (SIOCIWFIRSTPRIV + 26) */ +/* (SIOCIWFIRSTPRIV + 27) */ +#define KS_WLAN_SET_SLEEP_MODE (SIOCIWFIRSTPRIV + 28) /* sleep mode */ +#define KS_WLAN_GET_SLEEP_MODE (SIOCIWFIRSTPRIV + 29) /* sleep mode */ +/* (SIOCIWFIRSTPRIV + 30) */ +/* (SIOCIWFIRSTPRIV + 31) */ + +#ifdef __KERNEL__ + +#include "ks_wlan.h" +#include <linux/netdevice.h> + +int ks_wlan_setup_parameter(struct ks_wlan_private *priv, + unsigned int commit_flag); + +#endif /* __KERNEL__ */ + +#endif /* _KS_WLAN_IOCTL_H */ 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; +} |