From c8fea8d38011ede78e3f86d774886e32272973bb Mon Sep 17 00:00:00 2001
From: Felix Fietkau <nbd@openwrt.org>
Date: Sat, 30 Dec 2006 18:47:07 +0000
Subject: add d80211 from a recent wireless-dev checkout
SVN-Revision: 5939
---
package/d80211/src/ieee80211_ioctl.c | 3243 ++++++++++++++++++++++++++++++++++
1 file changed, 3243 insertions(+)
create mode 100644 package/d80211/src/ieee80211_ioctl.c
(limited to 'package/d80211/src/ieee80211_ioctl.c')
diff --git a/package/d80211/src/ieee80211_ioctl.c b/package/d80211/src/ieee80211_ioctl.c
new file mode 100644
index 0000000000..c74b4318df
--- /dev/null
+++ b/package/d80211/src/ieee80211_ioctl.c
@@ -0,0 +1,3243 @@
+/*
+ * Copyright 2002-2005, Instant802 Networks, Inc.
+ * Copyright 2005-2006, Devicescape Software, Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/netdevice.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+#include <linux/skbuff.h>
+#include <linux/etherdevice.h>
+#include <linux/if_arp.h>
+#include <linux/wireless.h>
+#include <net/iw_handler.h>
+#include <asm/uaccess.h>
+
+#include <net/d80211.h>
+#include <net/d80211_mgmt.h>
+#include "ieee80211_i.h"
+#include "hostapd_ioctl.h"
+#include "ieee80211_rate.h"
+#include "wpa.h"
+#include "aes_ccm.h"
+
+
+static int ieee80211_regdom = 0x10; /* FCC */
+module_param(ieee80211_regdom, int, 0444);
+MODULE_PARM_DESC(ieee80211_regdom, "IEEE 802.11 regulatory domain; 64=MKK");
+
+/*
+ * If firmware is upgraded by the vendor, additional channels can be used based
+ * on the new Japanese regulatory rules. This is indicated by setting
+ * ieee80211_japan_5ghz module parameter to one when loading the 80211 kernel
+ * module.
+ */
+static int ieee80211_japan_5ghz /* = 0 */;
+module_param(ieee80211_japan_5ghz, int, 0444);
+MODULE_PARM_DESC(ieee80211_japan_5ghz, "Vendor-updated firmware for 5 GHz");
+
+
+static int ieee80211_ioctl_set_beacon(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len,
+ int flag)
+{
+ struct ieee80211_sub_if_data *sdata;
+ struct ieee80211_if_ap *ap;
+ u8 **b_head, **b_tail;
+ int *b_head_len, *b_tail_len;
+ int len;
+
+ len = ((char *) param->u.beacon.data - (char *) param) +
+ param->u.beacon.head_len + param->u.beacon.tail_len;
+
+ if (param_len > len)
+ param_len = len;
+ else if (param_len != len)
+ return -EINVAL;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type != IEEE80211_IF_TYPE_AP)
+ return -EINVAL;
+ ap = &sdata->u.ap;
+
+ switch (flag) {
+ case 0:
+ b_head = &ap->beacon_head;
+ b_tail = &ap->beacon_tail;
+ b_head_len = &ap->beacon_head_len;
+ b_tail_len = &ap->beacon_tail_len;
+ break;
+ default:
+ printk(KERN_DEBUG "%s: unknown beacon flag %d\n",
+ dev->name, flag);
+ return -EINVAL;
+ }
+
+ kfree(*b_head);
+ kfree(*b_tail);
+ *b_head = NULL;
+ *b_tail = NULL;
+
+ *b_head_len = param->u.beacon.head_len;
+ *b_tail_len = param->u.beacon.tail_len;
+
+ *b_head = kmalloc(*b_head_len, GFP_KERNEL);
+ if (*b_head)
+ memcpy(*b_head, param->u.beacon.data, *b_head_len);
+ else {
+ printk(KERN_DEBUG "%s: failed to allocate beacon_head\n",
+ dev->name);
+ return -ENOMEM;
+ }
+
+ if (*b_tail_len > 0) {
+ *b_tail = kmalloc(*b_tail_len, GFP_KERNEL);
+ if (*b_tail)
+ memcpy(*b_tail, param->u.beacon.data + (*b_head_len),
+ (*b_tail_len));
+ else {
+ printk(KERN_DEBUG "%s: failed to allocate "
+ "beacon_tail\n", dev->name);
+ return -ENOMEM;
+ }
+ }
+
+ return ieee80211_if_config_beacon(dev);
+}
+
+
+static int ieee80211_ioctl_get_hw_features(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ u8 *pos = param->u.hw_features.data;
+ int left = param_len - (pos - (u8 *) param);
+ int mode, i;
+ struct hostapd_ioctl_hw_modes_hdr *hdr;
+ struct ieee80211_rate_data *rate;
+ struct ieee80211_channel_data *chan;
+
+ param->u.hw_features.flags = 0;
+ if (local->hw.flags & IEEE80211_HW_DATA_NULLFUNC_ACK)
+ param->u.hw_features.flags |= HOSTAP_HW_FLAG_NULLFUNC_OK;
+
+ param->u.hw_features.num_modes = local->hw.num_modes;
+ for (mode = 0; mode < local->hw.num_modes; mode++) {
+ int clen, rlen;
+ struct ieee80211_hw_modes *m = &local->hw.modes[mode];
+ clen = m->num_channels * sizeof(struct ieee80211_channel_data);
+ rlen = m->num_rates * sizeof(struct ieee80211_rate_data);
+ if (left < sizeof(*hdr) + clen + rlen)
+ return -E2BIG;
+ left -= sizeof(*hdr) + clen + rlen;
+
+ hdr = (struct hostapd_ioctl_hw_modes_hdr *) pos;
+ hdr->mode = m->mode;
+ hdr->num_channels = m->num_channels;
+ hdr->num_rates = m->num_rates;
+
+ pos = (u8 *) (hdr + 1);
+ chan = (struct ieee80211_channel_data *) pos;
+ for (i = 0; i < m->num_channels; i++) {
+ chan[i].chan = m->channels[i].chan;
+ chan[i].freq = m->channels[i].freq;
+ chan[i].flag = m->channels[i].flag;
+ }
+ pos += clen;
+
+ rate = (struct ieee80211_rate_data *) pos;
+ for (i = 0; i < m->num_rates; i++) {
+ rate[i].rate = m->rates[i].rate;
+ rate[i].flags = m->rates[i].flags;
+ }
+ pos += rlen;
+ }
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_scan(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ if (!local->ops->passive_scan)
+ return -EOPNOTSUPP;
+
+ if ((param->u.scan.now == 1) && (local->scan.in_scan == 1))
+ return -EBUSY;
+
+ if (param->u.scan.our_mode_only >= 0)
+ local->scan.our_mode_only = param->u.scan.our_mode_only;
+ if (param->u.scan.interval >= 0)
+ local->scan.interval = param->u.scan.interval;
+ if (param->u.scan.listen >= 0)
+ local->scan.time = param->u.scan.listen;
+ if (param->u.scan.channel > 0)
+ local->scan.channel = param->u.scan.channel;
+ if (param->u.scan.now == 1) {
+ local->scan.in_scan = 0;
+ mod_timer(&local->scan.timer, jiffies);
+ }
+
+ param->u.scan.our_mode_only = local->scan.our_mode_only;
+ param->u.scan.interval = local->scan.interval;
+ param->u.scan.listen = local->scan.time;
+ if (local->scan.in_scan == 1)
+ param->u.scan.last_rx = -1;
+ else {
+ param->u.scan.last_rx = local->scan.rx_packets;
+ local->scan.rx_packets = -1;
+ }
+ param->u.scan.channel = local->hw.modes[local->scan.mode_idx].
+ channels[local->scan.chan_idx].chan;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_flush(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ sta_info_flush(local, NULL);
+ return 0;
+}
+
+
+/* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
+struct iapp_layer2_update {
+ u8 da[ETH_ALEN]; /* broadcast */
+ u8 sa[ETH_ALEN]; /* STA addr */
+ __be16 len; /* 6 */
+ u8 dsap; /* 0 */
+ u8 ssap; /* 0 */
+ u8 control;
+ u8 xid_info[3];
+} __attribute__ ((packed));
+
+static void ieee80211_send_layer2_update(struct net_device *dev,
+ const u8 *addr)
+{
+ struct iapp_layer2_update *msg;
+ struct sk_buff *skb;
+
+ /* Send Level 2 Update Frame to update forwarding tables in layer 2
+ * bridge devices */
+
+ skb = dev_alloc_skb(sizeof(*msg));
+ if (!skb)
+ return;
+ msg = (struct iapp_layer2_update *) skb_put(skb, sizeof(*msg));
+
+ /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
+ * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */
+
+ memset(msg->da, 0xff, ETH_ALEN);
+ memcpy(msg->sa, addr, ETH_ALEN);
+ msg->len = htons(6);
+ msg->dsap = 0;
+ msg->ssap = 0x01; /* NULL LSAP, CR Bit: Response */
+ msg->control = 0xaf; /* XID response lsb.1111F101.
+ * F=0 (no poll command; unsolicited frame) */
+ msg->xid_info[0] = 0x81; /* XID format identifier */
+ msg->xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */
+ msg->xid_info[2] = 0; /* XID sender's receive window size (RW) */
+
+ skb->dev = dev;
+ skb->protocol = eth_type_trans(skb, dev);
+ memset(skb->cb, 0, sizeof(skb->cb));
+ netif_rx(skb);
+}
+
+
+static int ieee80211_ioctl_add_sta(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+ u32 rates;
+ int i, j;
+ struct ieee80211_sub_if_data *sdata;
+ int add_key_entry = 1;
+
+ /* Prevent a race with changing the rate control algorithm */
+ if (!netif_running(dev))
+ return -ENETDOWN;
+
+ sta = sta_info_get(local, param->sta_addr);
+
+ if (!sta) {
+ sta = sta_info_add(local, dev, param->sta_addr, GFP_KERNEL);
+ if (!sta)
+ return -ENOMEM;
+ }
+
+ if (sta->dev != dev) {
+ /* Binding STA to a new interface, so remove all references to
+ * the old BSS. */
+ sta_info_remove_aid_ptr(sta);
+ }
+
+ /* TODO
+ * We "steal" the device in case someone owns it
+ * This will hurt WDS links and such when we have a
+ * WDS link and a client associating from the same station
+ */
+ sta->dev = dev;
+ sdata = IEEE80211_DEV_TO_SUB_IF(sta->dev);
+
+ sta->flags |= WLAN_STA_AUTH | WLAN_STA_ASSOC;
+ sta->aid = param->u.add_sta.aid;
+ if (sta->aid > IEEE80211_MAX_AID)
+ sta->aid = 0;
+ sta->listen_interval = param->u.add_sta.listen_interval;
+
+ rates = 0;
+ for (i = 0; i < sizeof(param->u.add_sta.supp_rates); i++) {
+ int rate = (param->u.add_sta.supp_rates[i] & 0x7f) * 5;
+ if (local->hw.conf.phymode == MODE_ATHEROS_TURBO ||
+ local->hw.conf.phymode == MODE_ATHEROS_TURBOG)
+ rate *= 2;
+ for (j = 0; j < local->num_curr_rates; j++) {
+ if (local->curr_rates[j].rate == rate)
+ rates |= BIT(j);
+ }
+
+ }
+ sta->supp_rates = rates;
+
+ rate_control_rate_init(sta, local);
+
+ if (param->u.add_sta.wds_flags & 0x01)
+ sta->flags |= WLAN_STA_WDS;
+ else
+ sta->flags &= ~WLAN_STA_WDS;
+
+ if (add_key_entry && !sta->key && !sdata->default_key &&
+ local->ops->set_key) {
+ struct ieee80211_key_conf conf;
+ /* Add key cache entry with NULL key type because this may used
+ * for TX filtering. */
+ memset(&conf, 0, sizeof(conf));
+ conf.hw_key_idx = HW_KEY_IDX_INVALID;
+ conf.alg = ALG_NULL;
+ conf.flags |= IEEE80211_KEY_FORCE_SW_ENCRYPT;
+ if (local->ops->set_key(local_to_hw(local), SET_KEY,
+ sta->addr, &conf, sta->aid)) {
+ sta->key_idx_compression = HW_KEY_IDX_INVALID;
+ } else {
+ sta->key_idx_compression = conf.hw_key_idx;
+ }
+ }
+
+ sta_info_put(sta);
+
+ if (sdata->type == IEEE80211_IF_TYPE_AP ||
+ sdata->type == IEEE80211_IF_TYPE_VLAN)
+ ieee80211_send_layer2_update(dev, param->sta_addr);
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_remove_sta(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+
+ sta = sta_info_get(local, param->sta_addr);
+ if (sta) {
+ sta_info_put(sta);
+ sta_info_free(sta, 1);
+ }
+
+ return sta ? 0 : -ENOENT;
+}
+
+
+static int ieee80211_ioctl_get_dot11counterstable(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_low_level_stats stats;
+
+ memset(&stats, 0, sizeof(stats));
+ if (local->ops->get_stats)
+ local->ops->get_stats(local_to_hw(local), &stats);
+ param->u.dot11CountersTable.dot11TransmittedFragmentCount =
+ local->dot11TransmittedFragmentCount;
+ param->u.dot11CountersTable.dot11MulticastTransmittedFrameCount =
+ local->dot11MulticastTransmittedFrameCount;
+ param->u.dot11CountersTable.dot11ReceivedFragmentCount =
+ local->dot11ReceivedFragmentCount;
+ param->u.dot11CountersTable.dot11MulticastReceivedFrameCount =
+ local->dot11MulticastReceivedFrameCount;
+ param->u.dot11CountersTable.dot11TransmittedFrameCount =
+ local->dot11TransmittedFrameCount;
+ param->u.dot11CountersTable.dot11FCSErrorCount =
+ stats.dot11FCSErrorCount;
+ param->u.dot11CountersTable.dot11ACKFailureCount =
+ stats.dot11ACKFailureCount;
+ param->u.dot11CountersTable.dot11RTSFailureCount =
+ stats.dot11RTSFailureCount;
+ param->u.dot11CountersTable.dot11RTSSuccessCount =
+ stats.dot11RTSSuccessCount;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_get_info_sta(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+
+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) {
+ struct ieee80211_sub_if_data *sdata;
+ struct net_device_stats *stats;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ stats = ieee80211_dev_stats(local->mdev);
+ param->u.get_info_sta.rx_bytes = stats->rx_bytes;
+ param->u.get_info_sta.tx_bytes = stats->tx_bytes;
+ /* go through all STAs and get STA with lowest max. rate */
+ param->u.get_info_sta.current_tx_rate =
+ local->curr_rates[sta_info_min_txrate_get(local)].rate;
+ return 0;
+ }
+
+ sta = sta_info_get(local, param->sta_addr);
+
+ if (!sta)
+ return -ENOENT;
+
+ param->u.get_info_sta.inactive_msec =
+ jiffies_to_msecs(jiffies - sta->last_rx);
+ param->u.get_info_sta.rx_packets = sta->rx_packets;
+ param->u.get_info_sta.tx_packets = sta->tx_packets;
+ param->u.get_info_sta.rx_bytes = sta->rx_bytes;
+ param->u.get_info_sta.tx_bytes = sta->tx_bytes;
+ param->u.get_info_sta.channel_use = sta->channel_use;
+ param->u.get_info_sta.flags = sta->flags;
+ if (sta->txrate >= 0 && sta->txrate < local->num_curr_rates)
+ param->u.get_info_sta.current_tx_rate =
+ local->curr_rates[sta->txrate].rate;
+ param->u.get_info_sta.num_ps_buf_frames =
+ skb_queue_len(&sta->ps_tx_buf);
+ param->u.get_info_sta.tx_retry_failed = sta->tx_retry_failed;
+ param->u.get_info_sta.tx_retry_count = sta->tx_retry_count;
+ param->u.get_info_sta.last_rssi = sta->last_rssi;
+ param->u.get_info_sta.last_ack_rssi = sta->last_ack_rssi[2];
+
+ sta_info_put(sta);
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_flags_sta(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+
+ sta = sta_info_get(local, param->sta_addr);
+ if (sta) {
+ sta->flags |= param->u.set_flags_sta.flags_or;
+ sta->flags &= param->u.set_flags_sta.flags_and;
+ if (local->ops->set_port_auth &&
+ (param->u.set_flags_sta.flags_or & WLAN_STA_AUTHORIZED) &&
+ local->ops->set_port_auth(local_to_hw(local), sta->addr, 1))
+ printk(KERN_DEBUG "%s: failed to set low-level driver "
+ "PAE state (authorized) for " MAC_FMT "\n",
+ dev->name, MAC_ARG(sta->addr));
+ if (local->ops->set_port_auth &&
+ !(param->u.set_flags_sta.flags_and & WLAN_STA_AUTHORIZED) &&
+ local->ops->set_port_auth(local_to_hw(local), sta->addr, 0))
+ printk(KERN_DEBUG "%s: failed to set low-level driver "
+ "PAE state (unauthorized) for " MAC_FMT "\n",
+ dev->name, MAC_ARG(sta->addr));
+ sta_info_put(sta);
+ }
+
+ return sta ? 0 : -ENOENT;
+}
+
+
+int ieee80211_set_hw_encryption(struct net_device *dev,
+ struct sta_info *sta, u8 addr[ETH_ALEN],
+ struct ieee80211_key *key)
+{
+ struct ieee80211_key_conf *keyconf = NULL;
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int rc = 0;
+
+ /* default to sw encryption; this will be cleared by low-level
+ * driver if the hw supports requested encryption */
+ if (key)
+ key->force_sw_encrypt = 1;
+
+ if (key && local->ops->set_key &&
+ (keyconf = ieee80211_key_data2conf(local, key))) {
+ if (local->ops->set_key(local_to_hw(local), SET_KEY, addr,
+ keyconf, sta ? sta->aid : 0)) {
+ rc = HOSTAP_CRYPT_ERR_KEY_SET_FAILED;
+ key->force_sw_encrypt = 1;
+ key->hw_key_idx = HW_KEY_IDX_INVALID;
+ } else {
+ key->force_sw_encrypt =
+ !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
+ key->hw_key_idx =
+ keyconf->hw_key_idx;
+
+ }
+ }
+ kfree(keyconf);
+
+ return rc;
+}
+
+
+static int ieee80211_set_encryption(struct net_device *dev, u8 *sta_addr,
+ int idx, int alg, int set_tx_key, int *err,
+ const u8 *_key, size_t key_len)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int ret = 0;
+ struct sta_info *sta;
+ struct ieee80211_key *key, *old_key;
+ int try_hwaccel = 1;
+ struct ieee80211_key_conf *keyconf;
+ struct ieee80211_sub_if_data *sdata;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ if (sta_addr[0] == 0xff && sta_addr[1] == 0xff &&
+ sta_addr[2] == 0xff && sta_addr[3] == 0xff &&
+ sta_addr[4] == 0xff && sta_addr[5] == 0xff) {
+ sta = NULL;
+ if (idx >= NUM_DEFAULT_KEYS) {
+ printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d\n",
+ dev->name, idx);
+ return -EINVAL;
+ }
+ key = sdata->keys[idx];
+
+ /* Disable hwaccel for default keys when the interface is not
+ * the default one.
+ * TODO: consider adding hwaccel support for these; at least
+ * Atheros key cache should be able to handle this since AP is
+ * only transmitting frames with default keys. */
+ /* FIX: hw key cache can be used when only one virtual
+ * STA is associated with each AP. If more than one STA
+ * is associated to the same AP, software encryption
+ * must be used. This should be done automatically
+ * based on configured station devices. For the time
+ * being, this can be only set at compile time. */
+ /* FIXME: There is no more anything like "default
+ * interface". We should try hwaccel if there is just one
+ * interface - for now, hwaccel is unconditionaly
+ * disabled. */
+ try_hwaccel = 0;
+ } else {
+ set_tx_key = 0;
+ if (idx != 0) {
+ printk(KERN_DEBUG "%s: set_encrypt - non-zero idx for "
+ "individual key\n", dev->name);
+ return -EINVAL;
+ }
+
+ sta = sta_info_get(local, sta_addr);
+ if (!sta) {
+ if (err)
+ *err = HOSTAP_CRYPT_ERR_UNKNOWN_ADDR;
+#ifdef CONFIG_D80211_VERBOSE_DEBUG
+ printk(KERN_DEBUG "%s: set_encrypt - unknown addr "
+ MAC_FMT "\n",
+ dev->name, MAC_ARG(sta_addr));
+#endif /* CONFIG_D80211_VERBOSE_DEBUG */
+
+ return -ENOENT;
+ }
+
+ key = sta->key;
+ }
+
+ /* FIX:
+ * Cannot configure default hwaccel keys with WEP algorithm, if
+ * any of the virtual interfaces is using static WEP
+ * configuration because hwaccel would otherwise try to decrypt
+ * these frames.
+ *
+ * For now, just disable WEP hwaccel for broadcast when there is
+ * possibility of conflict with default keys. This can maybe later be
+ * optimized by using non-default keys (at least with Atheros ar521x).
+ */
+ if (!sta && alg == ALG_WEP && !local->default_wep_only &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS &&
+ sdata->type != IEEE80211_IF_TYPE_AP) {
+ try_hwaccel = 0;
+ }
+
+ if (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP) {
+ /* Software encryption cannot be used with devices that hide
+ * encryption from the host system, so always try to use
+ * hardware acceleration with such devices. */
+ try_hwaccel = 1;
+ }
+
+ if ((local->hw.flags & IEEE80211_HW_NO_TKIP_WMM_HWACCEL) &&
+ alg == ALG_TKIP) {
+ if (sta && (sta->flags & WLAN_STA_WME)) {
+ /* Hardware does not support hwaccel with TKIP when using WMM.
+ */
+ try_hwaccel = 0;
+ }
+ else if (sdata->type == IEEE80211_IF_TYPE_STA) {
+ sta = sta_info_get(local, sdata->u.sta.bssid);
+ if (sta) {
+ if (sta->flags & WLAN_STA_WME) {
+ try_hwaccel = 0;
+ }
+ sta_info_put(sta);
+ sta = NULL;
+ }
+ }
+ }
+
+ if (alg == ALG_NONE) {
+ keyconf = NULL;
+ if (try_hwaccel && key && local->ops->set_key &&
+ (keyconf = ieee80211_key_data2conf(local, key)) != NULL &&
+ local->ops->set_key(local_to_hw(local), DISABLE_KEY,
+ sta_addr, keyconf, sta ? sta->aid : 0)) {
+ if (err)
+ *err = HOSTAP_CRYPT_ERR_KEY_SET_FAILED;
+ printk(KERN_DEBUG "%s: set_encrypt - low-level disable"
+ " failed\n", dev->name);
+ ret = -EINVAL;
+ }
+ kfree(keyconf);
+
+ if (key && sdata->default_key == key) {
+ ieee80211_key_sysfs_remove_default(sdata);
+ sdata->default_key = NULL;
+ }
+ ieee80211_key_sysfs_remove(key);
+ if (sta)
+ sta->key = NULL;
+ else
+ sdata->keys[idx] = NULL;
+ ieee80211_key_free(key);
+ key = NULL;
+ } else {
+ old_key = key;
+ key = ieee80211_key_alloc(sta ? NULL : sdata, idx, key_len,
+ GFP_KERNEL);
+ if (!key) {
+ ret = -ENOMEM;
+ goto err_out;
+ }
+
+ /* default to sw encryption; low-level driver sets these if the
+ * requested encryption is supported */
+ key->hw_key_idx = HW_KEY_IDX_INVALID;
+ key->force_sw_encrypt = 1;
+
+ key->alg = alg;
+ key->keyidx = idx;
+ key->keylen = key_len;
+ memcpy(key->key, _key, key_len);
+ if (set_tx_key)
+ key->default_tx_key = 1;
+
+ if (alg == ALG_CCMP) {
+ /* Initialize AES key state here as an optimization
+ * so that it does not need to be initialized for every
+ * packet. */
+ key->u.ccmp.tfm = ieee80211_aes_key_setup_encrypt(
+ key->key);
+ if (!key->u.ccmp.tfm) {
+ ret = -ENOMEM;
+ goto err_free;
+ }
+ }
+
+ if (old_key && sdata->default_key == old_key) {
+ ieee80211_key_sysfs_remove_default(sdata);
+ sdata->default_key = NULL;
+ }
+ ieee80211_key_sysfs_remove(old_key);
+ if (sta)
+ sta->key = key;
+ else
+ sdata->keys[idx] = key;
+ ieee80211_key_free(old_key);
+ if (sta)
+ key->kobj.parent = &sta->kobj;
+ ret = ieee80211_key_sysfs_add(key);
+ if (ret)
+ goto err_null;
+
+ if (try_hwaccel &&
+ (alg == ALG_WEP || alg == ALG_TKIP || alg == ALG_CCMP)) {
+ int e = ieee80211_set_hw_encryption(dev, sta, sta_addr,
+ key);
+ if (err)
+ *err = e;
+ }
+ }
+
+ if (set_tx_key || (!sta && !sdata->default_key && key)) {
+ sdata->default_key = key;
+ if (ieee80211_key_sysfs_add_default(sdata))
+ printk(KERN_WARNING "%s: cannot create symlink to "
+ "default key\n", dev->name);
+ if (local->ops->set_key_idx &&
+ local->ops->set_key_idx(local_to_hw(local), idx))
+ printk(KERN_DEBUG "%s: failed to set TX key idx for "
+ "low-level driver\n", dev->name);
+ }
+
+ if (sta)
+ sta_info_put(sta);
+
+ return 0;
+
+err_null:
+ if (sta)
+ sta->key = NULL;
+ else
+ sdata->keys[idx] = NULL;
+err_free:
+ ieee80211_key_free(key);
+err_out:
+ if (sta)
+ sta_info_put(sta);
+ return ret;
+}
+
+
+static int ieee80211_ioctl_set_encryption(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ int alg;
+
+ param->u.crypt.err = 0;
+ param->u.crypt.alg[HOSTAP_CRYPT_ALG_NAME_LEN - 1] = '\0';
+
+ if (param_len <
+ (int) ((char *) param->u.crypt.key - (char *) param) +
+ param->u.crypt.key_len) {
+ printk(KERN_DEBUG "%s: set_encrypt - invalid param_lem\n",
+ dev->name);
+ return -EINVAL;
+ }
+
+ if (strcmp(param->u.crypt.alg, "none") == 0)
+ alg = ALG_NONE;
+ else if (strcmp(param->u.crypt.alg, "WEP") == 0)
+ alg = ALG_WEP;
+ else if (strcmp(param->u.crypt.alg, "TKIP") == 0) {
+ if (param->u.crypt.key_len != ALG_TKIP_KEY_LEN) {
+ printk(KERN_DEBUG "%s: set_encrypt - invalid TKIP key "
+ "length %d\n", dev->name,
+ param->u.crypt.key_len);
+ return -EINVAL;
+ }
+ alg = ALG_TKIP;
+ } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) {
+ if (param->u.crypt.key_len != ALG_CCMP_KEY_LEN) {
+ printk(KERN_DEBUG "%s: set_encrypt - invalid CCMP key "
+ "length %d\n", dev->name,
+ param->u.crypt.key_len);
+ return -EINVAL;
+ }
+ alg = ALG_CCMP;
+ } else {
+ param->u.crypt.err = HOSTAP_CRYPT_ERR_UNKNOWN_ALG;
+ printk(KERN_DEBUG "%s: set_encrypt - unknown alg\n",
+ dev->name);
+ return -EINVAL;
+ }
+
+ return ieee80211_set_encryption(
+ dev, param->sta_addr,
+ param->u.crypt.idx, alg,
+ param->u.crypt.flags & HOSTAP_CRYPT_FLAG_SET_TX_KEY,
+ ¶m->u.crypt.err, param->u.crypt.key,
+ param->u.crypt.key_len);
+}
+
+
+static int ieee80211_ioctl_get_encryption(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int ret = 0;
+ struct sta_info *sta;
+ struct ieee80211_key **key;
+ int max_key_len;
+ struct ieee80211_sub_if_data *sdata;
+ u8 *pos;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ param->u.crypt.err = 0;
+
+ max_key_len = param_len -
+ (int) ((char *) param->u.crypt.key - (char *) param);
+ if (max_key_len < 0)
+ return -EINVAL;
+
+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) {
+ sta = NULL;
+ if (param->u.crypt.idx > NUM_DEFAULT_KEYS) {
+ param->u.crypt.idx = sdata->default_key ?
+ sdata->default_key->keyidx : 0;
+ return 0;
+ } else
+ key = &sdata->keys[param->u.crypt.idx];
+ } else {
+ sta = sta_info_get(local, param->sta_addr);
+ if (!sta) {
+ param->u.crypt.err = HOSTAP_CRYPT_ERR_UNKNOWN_ADDR;
+ return -EINVAL;
+ }
+
+ key = &sta->key;
+ }
+
+ memset(param->u.crypt.seq_counter, 0, HOSTAP_SEQ_COUNTER_SIZE);
+ if (!*key) {
+ memcpy(param->u.crypt.alg, "none", 5);
+ param->u.crypt.key_len = 0;
+ param->u.crypt.idx = 0xff;
+ } else {
+ switch ((*key)->alg) {
+ case ALG_WEP:
+ memcpy(param->u.crypt.alg, "WEP", 4);
+ break;
+ case ALG_TKIP:
+ {
+ u32 iv32;
+ u16 iv16;
+
+ memcpy(param->u.crypt.alg, "TKIP", 5);
+ if (local->ops->get_sequence_counter) {
+ /* Get transmit counter from low level driver */
+ if (local->ops->get_sequence_counter(
+ local_to_hw(local),
+ param->sta_addr,
+ (*key)->keyidx,
+ IEEE80211_SEQ_COUNTER_TX,
+ &iv32,
+ &iv16)) {
+ /* Error getting value from device */
+ return -EIO;
+ }
+ } else {
+ /* Get it from our own local data */
+ iv32 = (*key)->u.tkip.iv32;
+ iv16 = (*key)->u.tkip.iv16;
+ }
+ pos = param->u.crypt.seq_counter;
+ *pos++ = iv16 & 0xff;
+ *pos++ = (iv16 >> 8) & 0xff;
+ *pos++ = iv32 & 0xff;
+ *pos++ = (iv32 >> 8) & 0xff;
+ *pos++ = (iv32 >> 16) & 0xff;
+ *pos++ = (iv32 >> 24) & 0xff;
+ break;
+ }
+ case ALG_CCMP:
+ {
+ u8 *pn;
+ memcpy(param->u.crypt.alg, "CCMP", 5);
+ pos = param->u.crypt.seq_counter;
+ pn = (*key)->u.ccmp.tx_pn;
+ *pos++ = pn[5];
+ *pos++ = pn[4];
+ *pos++ = pn[3];
+ *pos++ = pn[2];
+ *pos++ = pn[1];
+ *pos++ = pn[0];
+ break;
+ }
+ default:
+ memcpy(param->u.crypt.alg, "unknown", 8);
+ break;
+ }
+
+ if (max_key_len < (*key)->keylen)
+ ret = -E2BIG;
+ else {
+ param->u.crypt.key_len = (*key)->keylen;
+ memcpy(param->u.crypt.key, (*key)->key,
+ (*key)->keylen);
+ }
+ }
+
+ if (sta)
+ sta_info_put(sta);
+
+ return ret;
+}
+
+
+#ifdef CONFIG_HOSTAPD_WPA_TESTING
+static int ieee80211_ioctl_wpa_trigger(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+
+ if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
+ param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
+ param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) {
+ local->wpa_trigger = param->u.wpa_trigger.trigger;
+ return 0;
+ }
+
+ sta = sta_info_get(local, param->sta_addr);
+ if (!sta) {
+ printk(KERN_DEBUG "%s: wpa_trigger - unknown addr\n",
+ dev->name);
+ return -EINVAL;
+ }
+
+ sta->wpa_trigger = param->u.wpa_trigger.trigger;
+
+ sta_info_put(sta);
+ return 0;
+}
+#endif /* CONFIG_HOSTAPD_WPA_TESTING */
+
+
+static int ieee80211_ioctl_set_rate_sets(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ u16 *pos = (u16 *) param->u.set_rate_sets.data;
+ int left = param_len - ((u8 *) pos - (u8 *) param);
+ int i, mode, num_supp, num_basic, *supp, *basic, *prev;
+
+ mode = param->u.set_rate_sets.mode;
+ num_supp = param->u.set_rate_sets.num_supported_rates;
+ num_basic = param->u.set_rate_sets.num_basic_rates;
+
+ if (left < (num_supp + num_basic) * 2) {
+ printk(KERN_WARNING "%s: invalid length in hostapd set rate "
+ "sets ioctl (%d != %d)\n", dev->name, left,
+ (num_supp + num_basic) * 2);
+ return -EINVAL;
+ }
+
+ supp = (int *) kmalloc((num_supp + 1) * sizeof(int), GFP_KERNEL);
+ basic = (int *) kmalloc((num_basic + 1) * sizeof(int), GFP_KERNEL);
+
+ if (!supp || !basic) {
+ kfree(supp);
+ kfree(basic);
+ return -ENOMEM;
+ }
+
+ for (i = 0; i < num_supp; i++)
+ supp[i] = *pos++;
+ supp[i] = -1;
+
+ for (i = 0; i < num_basic; i++)
+ basic[i] = *pos++;
+ basic[i] = -1;
+
+ if (num_supp == 0) {
+ kfree(supp);
+ supp = NULL;
+ }
+
+ if (num_basic == 0) {
+ kfree(basic);
+ basic = NULL;
+ }
+
+ prev = local->supp_rates[mode];
+ local->supp_rates[mode] = supp;
+ kfree(prev);
+
+ prev = local->basic_rates[mode];
+ local->basic_rates[mode] = basic;
+ kfree(prev);
+
+ if (mode == local->hw.conf.phymode) {
+ /* TODO: should update STA TX rates and remove STAs if they
+ * do not have any remaining supported rates after the change
+ */
+ ieee80211_prepare_rates(local);
+ }
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_add_if(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ u8 *pos = param->u.if_info.data;
+ int left = param_len - ((u8 *) pos - (u8 *) param);
+ struct net_device *new_dev;
+ int res;
+ struct hostapd_if_wds *wds;
+ struct hostapd_if_bss *bss;
+
+ printk(KERN_WARNING "PRISM2_HOSTAPD_ADD_IF ioctl is deprecated!");
+ switch (param->u.if_info.type) {
+ case HOSTAP_IF_WDS:
+ wds = (struct hostapd_if_wds *) param->u.if_info.data;
+
+ if (left < sizeof(struct hostapd_if_wds))
+ return -EPROTO;
+
+ res = ieee80211_if_add(dev, param->u.if_info.name, 0, &new_dev);
+ if (res)
+ return res;
+ ieee80211_if_set_type(new_dev, IEEE80211_IF_TYPE_WDS);
+ res = ieee80211_if_update_wds(new_dev, wds->remote_addr);
+ if (res)
+ __ieee80211_if_del(dev->ieee80211_ptr,
+ IEEE80211_DEV_TO_SUB_IF(new_dev));
+ return res;
+ case HOSTAP_IF_VLAN:
+ if (left < sizeof(struct hostapd_if_vlan))
+ return -EPROTO;
+
+ res = ieee80211_if_add(dev, param->u.if_info.name, 0, &new_dev);
+ if (res)
+ return res;
+ ieee80211_if_set_type(new_dev, IEEE80211_IF_TYPE_VLAN);
+#if 0
+ res = ieee80211_if_update_vlan(new_dev, vlan->id);
+ if (res)
+ __ieee80211_if_del(dev->ieee80211_ptr,
+ IEEE80211_DEV_TO_SUB_IF(new_dev));
+#endif
+ return res;
+ case HOSTAP_IF_BSS:
+ bss = (struct hostapd_if_bss *) param->u.if_info.data;
+
+ if (left < sizeof(struct hostapd_if_bss))
+ return -EPROTO;
+
+ res = ieee80211_if_add(dev, param->u.if_info.name, 0, &new_dev);
+ if (res)
+ return res;
+ ieee80211_if_set_type(new_dev, IEEE80211_IF_TYPE_AP);
+ memcpy(new_dev->dev_addr, bss->bssid, ETH_ALEN);
+ return 0;
+ case HOSTAP_IF_STA:
+ if (left < sizeof(struct hostapd_if_sta))
+ return -EPROTO;
+
+ res = ieee80211_if_add(dev, param->u.if_info.name, 0, &new_dev);
+ if (res)
+ return res;
+ ieee80211_if_set_type(new_dev, IEEE80211_IF_TYPE_STA);
+ return 0;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static int ieee80211_ioctl_remove_if(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ unsigned int type;
+
+ switch (param->u.if_info.type) {
+ case HOSTAP_IF_WDS:
+ type = IEEE80211_IF_TYPE_WDS;
+ break;
+ case HOSTAP_IF_VLAN:
+ type = IEEE80211_IF_TYPE_VLAN;
+ break;
+ case HOSTAP_IF_BSS:
+ type = IEEE80211_IF_TYPE_AP;
+ break;
+ case HOSTAP_IF_STA:
+ type = IEEE80211_IF_TYPE_STA;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return ieee80211_if_remove(dev, param->u.if_info.name, type);
+}
+
+static int ieee80211_ioctl_update_if(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ u8 *pos = param->u.if_info.data;
+ int left = param_len - ((u8 *) pos - (u8 *) param);
+
+ if (param->u.if_info.type == HOSTAP_IF_WDS) {
+ struct hostapd_if_wds *wds =
+ (struct hostapd_if_wds *) param->u.if_info.data;
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct net_device *wds_dev = NULL;
+ struct ieee80211_sub_if_data *sdata;
+
+ if (left < sizeof(struct ieee80211_if_wds))
+ return -EPROTO;
+
+ list_for_each_entry(sdata, &local->sub_if_list, list) {
+ if (strcmp(param->u.if_info.name,
+ sdata->dev->name) == 0) {
+ wds_dev = sdata->dev;
+ break;
+ }
+ }
+
+ if (!wds_dev || sdata->type != IEEE80211_IF_TYPE_WDS)
+ return -ENODEV;
+
+ return ieee80211_if_update_wds(wds_dev, wds->remote_addr);
+ } else {
+ return -EOPNOTSUPP;
+ }
+}
+
+
+static int ieee80211_ioctl_flush_ifs(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ ieee80211_if_flush(dev);
+ return 0;
+}
+
+
+static int ieee80211_ioctl_scan_req(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ u8 *pos = param->u.scan_req.ssid;
+ int left = param_len - ((u8 *) pos - (u8 *) param);
+ int len = param->u.scan_req.ssid_len;
+
+ if (local->user_space_mlme)
+ return -EOPNOTSUPP;
+
+ if (!netif_running(dev))
+ return -ENETDOWN;
+
+ if (left < len || len > IEEE80211_MAX_SSID_LEN)
+ return -EINVAL;
+
+ return ieee80211_sta_req_scan(dev, pos, len);
+}
+
+
+static int ieee80211_ioctl_sta_get_state(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_sub_if_data *sdata;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ return -EINVAL;
+ param->u.sta_get_state.state = sdata->u.sta.state;
+ return 0;
+}
+
+
+static int ieee80211_ioctl_mlme(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata;
+
+ if (local->user_space_mlme)
+ return -EOPNOTSUPP;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ return -EINVAL;
+ switch (param->u.mlme.cmd) {
+ case MLME_STA_DEAUTH:
+ return ieee80211_sta_deauthenticate(dev, param->u.mlme.reason_code);
+ case MLME_STA_DISASSOC:
+ return ieee80211_sta_disassociate(dev, param->u.mlme.reason_code);
+ }
+ return 0;
+}
+
+
+static int ieee80211_ioctl_get_load_stats(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ param->u.get_load_stats.channel_use = local->channel_use;
+/* if (param->u.get_load_stats.flags & LOAD_STATS_CLEAR)
+ local->channel_use = 0; */ /* now it's not raw counter */
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_sta_vlan(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct sta_info *sta;
+
+ sta = sta_info_get(local, param->sta_addr);
+ if (sta) {
+ struct net_device *new_vlan_dev;
+ new_vlan_dev =
+ dev_get_by_name(param->u.set_sta_vlan.vlan_name);
+ if (new_vlan_dev) {
+#if 0
+ printk("%s: Station " MAC_FMT " moved to vlan: %s\n",
+ dev->name, MAC_ARG(param->sta_addr),
+ new_vlan_dev->name);
+#endif
+ if (sta->dev != new_vlan_dev) {
+ ieee80211_send_layer2_update(new_vlan_dev,
+ sta->addr);
+ }
+ sta->dev = new_vlan_dev;
+ sta->vlan_id = param->u.set_sta_vlan.vlan_id;
+ dev_put(new_vlan_dev);
+ }
+ sta_info_put(sta);
+ }
+
+ return sta ? 0 : -ENOENT;
+}
+
+
+static int ieee80211_set_gen_ie(struct net_device *dev, u8 *ie, size_t len)
+{
+ struct ieee80211_sub_if_data *sdata;
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ if (local->user_space_mlme)
+ return -EOPNOTSUPP;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS)
+ return ieee80211_sta_set_extra_ie(dev, ie, len);
+
+ if (sdata->type == IEEE80211_IF_TYPE_AP) {
+ kfree(sdata->u.ap.generic_elem);
+ sdata->u.ap.generic_elem = kmalloc(len, GFP_KERNEL);
+ if (!sdata->u.ap.generic_elem)
+ return -ENOMEM;
+ memcpy(sdata->u.ap.generic_elem, ie, len);
+ sdata->u.ap.generic_elem_len = len;
+ return ieee80211_if_config(dev);
+ }
+ return -EOPNOTSUPP;
+}
+
+
+static int
+ieee80211_ioctl_set_generic_info_elem(struct net_device *dev,
+ struct prism2_hostapd_param *param,
+ int param_len)
+{
+ u8 *pos = param->u.set_generic_info_elem.data;
+ int left = param_len - ((u8 *) pos - (u8 *) param);
+ int len = param->u.set_generic_info_elem.len;
+
+ if (left < len)
+ return -EINVAL;
+
+ return ieee80211_set_gen_ie(dev, pos, len);
+}
+
+
+static int ieee80211_ioctl_set_regulatory_domain(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_conf *conf = &local->hw.conf;
+ conf->regulatory_domain = param->u.set_regulatory_domain.rd;
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_radio_enabled(struct net_device *dev,
+ int val)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_conf *conf = &local->hw.conf;
+
+ conf->radio_enabled = val;
+ return ieee80211_hw_config(dev->ieee80211_ptr);
+}
+
+static int
+ieee80211_ioctl_set_tx_queue_params(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_tx_queue_params qparam;
+
+ if (!local->ops->conf_tx) {
+ printk(KERN_DEBUG "%s: low-level driver does not support TX "
+ "queue configuration\n", dev->name);
+ return -EOPNOTSUPP;
+ }
+
+ memset(&qparam, 0, sizeof(qparam));
+ qparam.aifs = param->u.tx_queue_params.aifs;
+ qparam.cw_min = param->u.tx_queue_params.cw_min;
+ qparam.cw_max = param->u.tx_queue_params.cw_max;
+ qparam.burst_time = param->u.tx_queue_params.burst_time;
+
+ return local->ops->conf_tx(local_to_hw(local),
+ param->u.tx_queue_params.queue,
+ &qparam);
+}
+
+
+static int ieee80211_ioctl_get_tx_stats(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_tx_queue_stats stats;
+ int ret, i;
+
+ if (!local->ops->get_tx_stats)
+ return -EOPNOTSUPP;
+
+ memset(&stats, 0, sizeof(stats));
+ ret = local->ops->get_tx_stats(local_to_hw(local), &stats);
+ if (ret)
+ return ret;
+
+ for (i = 0; i < 4; i++) {
+ param->u.get_tx_stats.data[i].len = stats.data[i].len;
+ param->u.get_tx_stats.data[i].limit = stats.data[i].limit;
+ param->u.get_tx_stats.data[i].count = stats.data[i].count;
+ }
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_channel_flag(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_hw_modes *mode = NULL;
+ struct ieee80211_channel *chan = NULL;
+ int i;
+
+ for (i = 0; i < local->hw.num_modes; i++) {
+ mode = &local->hw.modes[i];
+ if (mode->mode == param->u.set_channel_flag.mode)
+ break;
+ mode = NULL;
+ }
+
+ if (!mode)
+ return -ENOENT;
+
+ for (i = 0; i < mode->num_channels; i++) {
+ chan = &mode->channels[i];
+ if (chan->chan == param->u.set_channel_flag.chan)
+ break;
+ chan = NULL;
+ }
+
+ if (!chan)
+ return -ENOENT;
+
+ chan->flag = param->u.set_channel_flag.flag;
+ chan->power_level = param->u.set_channel_flag.power_level;
+ chan->antenna_max = param->u.set_channel_flag.antenna_max;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_quiet_params(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_conf *conf = &local->hw.conf;
+
+ conf->quiet_duration = param->u.quiet.duration;
+ conf->quiet_offset = param->u.quiet.offset;
+ conf->quiet_period = param->u.quiet.period;
+ return 0;
+}
+
+
+static int ieee80211_ioctl_set_radar_params(struct net_device *dev,
+ struct prism2_hostapd_param *param)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_conf *conf = &local->hw.conf;
+
+ conf->radar_firpwr_threshold = param->u.radar.radar_firpwr_threshold;
+ conf->radar_rssi_threshold = param->u.radar.radar_rssi_threshold;
+ conf->pulse_height_threshold = param->u.radar.pulse_height_threshold;
+ conf->pulse_rssi_threshold = param->u.radar.pulse_rssi_threshold;
+ conf->pulse_inband_threshold = param->u.radar.pulse_inband_threshold;
+ return 0;
+}
+
+
+static int ieee80211_ioctl_priv_hostapd(struct net_device *dev,
+ struct iw_point *p)
+{
+ struct prism2_hostapd_param *param;
+ int ret = 0;
+
+ if (p->length < sizeof(struct prism2_hostapd_param) ||
+ p->length > PRISM2_HOSTAPD_MAX_BUF_SIZE || !p->pointer) {
+ printk(KERN_DEBUG "%s: hostapd ioctl: ptr=%p len=%d min=%d "
+ "max=%d\n", dev->name, p->pointer, p->length,
+ (int)sizeof(struct prism2_hostapd_param),
+ PRISM2_HOSTAPD_MAX_BUF_SIZE);
+ return -EINVAL;
+ }
+
+ param = (struct prism2_hostapd_param *) kmalloc(p->length, GFP_KERNEL);
+ if (!param)
+ return -ENOMEM;
+
+ if (copy_from_user(param, p->pointer, p->length)) {
+ ret = -EFAULT;
+ goto out;
+ }
+
+ switch (param->cmd) {
+ case PRISM2_HOSTAPD_FLUSH:
+ ret = ieee80211_ioctl_flush(dev, param);
+ break;
+ case PRISM2_HOSTAPD_ADD_STA:
+ ret = ieee80211_ioctl_add_sta(dev, param);
+ break;
+ case PRISM2_HOSTAPD_REMOVE_STA:
+ ret = ieee80211_ioctl_remove_sta(dev, param);
+ break;
+ case PRISM2_HOSTAPD_GET_INFO_STA:
+ ret = ieee80211_ioctl_get_info_sta(dev, param);
+ break;
+ case PRISM2_SET_ENCRYPTION:
+ ret = ieee80211_ioctl_set_encryption(dev, param, p->length);
+ break;
+ case PRISM2_GET_ENCRYPTION:
+ ret = ieee80211_ioctl_get_encryption(dev, param, p->length);
+ break;
+ case PRISM2_HOSTAPD_SET_FLAGS_STA:
+ ret = ieee80211_ioctl_set_flags_sta(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_BEACON:
+ ret = ieee80211_ioctl_set_beacon(dev, param, p->length, 0);
+ break;
+ case PRISM2_HOSTAPD_GET_HW_FEATURES:
+ ret = ieee80211_ioctl_get_hw_features(dev, param, p->length);
+ break;
+ case PRISM2_HOSTAPD_SCAN:
+ ret = ieee80211_ioctl_scan(dev, param);
+ break;
+#ifdef CONFIG_HOSTAPD_WPA_TESTING
+ case PRISM2_HOSTAPD_WPA_TRIGGER:
+ ret = ieee80211_ioctl_wpa_trigger(dev, param);
+ break;
+#endif /* CONFIG_HOSTAPD_WPA_TESTING */
+ case PRISM2_HOSTAPD_SET_RATE_SETS:
+ ret = ieee80211_ioctl_set_rate_sets(dev, param, p->length);
+ break;
+ case PRISM2_HOSTAPD_ADD_IF:
+ ret = ieee80211_ioctl_add_if(dev, param, p->length);
+ break;
+ case PRISM2_HOSTAPD_REMOVE_IF:
+ ret = ieee80211_ioctl_remove_if(dev, param);
+ break;
+ case PRISM2_HOSTAPD_GET_DOT11COUNTERSTABLE:
+ ret = ieee80211_ioctl_get_dot11counterstable(dev, param);
+ break;
+ case PRISM2_HOSTAPD_GET_LOAD_STATS:
+ ret = ieee80211_ioctl_get_load_stats(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_STA_VLAN:
+ ret = ieee80211_ioctl_set_sta_vlan(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_GENERIC_INFO_ELEM:
+ ret = ieee80211_ioctl_set_generic_info_elem(dev, param,
+ p->length);
+ break;
+ case PRISM2_HOSTAPD_SET_CHANNEL_FLAG:
+ ret = ieee80211_ioctl_set_channel_flag(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_REGULATORY_DOMAIN:
+ ret = ieee80211_ioctl_set_regulatory_domain(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_TX_QUEUE_PARAMS:
+ ret = ieee80211_ioctl_set_tx_queue_params(dev, param);
+ break;
+ case PRISM2_HOSTAPD_GET_TX_STATS:
+ ret = ieee80211_ioctl_get_tx_stats(dev, param);
+ break;
+ case PRISM2_HOSTAPD_UPDATE_IF:
+ ret = ieee80211_ioctl_update_if(dev, param, p->length);
+ break;
+ case PRISM2_HOSTAPD_SCAN_REQ:
+ ret = ieee80211_ioctl_scan_req(dev, param, p->length);
+ break;
+ case PRISM2_STA_GET_STATE:
+ ret = ieee80211_ioctl_sta_get_state(dev, param);
+ break;
+ case PRISM2_HOSTAPD_MLME:
+ ret = ieee80211_ioctl_mlme(dev, param);
+ break;
+ case PRISM2_HOSTAPD_FLUSH_IFS:
+ ret = ieee80211_ioctl_flush_ifs(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_RADAR_PARAMS:
+ ret = ieee80211_ioctl_set_radar_params(dev, param);
+ break;
+ case PRISM2_HOSTAPD_SET_QUIET_PARAMS:
+ ret = ieee80211_ioctl_set_quiet_params(dev, param);
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+
+ if (copy_to_user(p->pointer, param, p->length))
+ ret = -EFAULT;
+
+ out:
+ kfree(param);
+
+ return ret;
+}
+
+
+static int ieee80211_ioctl_giwname(struct net_device *dev,
+ struct iw_request_info *info,
+ char *name, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ switch (local->hw.conf.phymode) {
+ case MODE_IEEE80211A:
+ strcpy(name, "IEEE 802.11a");
+ break;
+ case MODE_IEEE80211B:
+ strcpy(name, "IEEE 802.11b");
+ break;
+ case MODE_IEEE80211G:
+ strcpy(name, "IEEE 802.11g");
+ break;
+ case MODE_ATHEROS_TURBO:
+ strcpy(name, "5GHz Turbo");
+ break;
+ default:
+ strcpy(name, "IEEE 802.11");
+ break;
+ }
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_giwrange(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *extra)
+{
+ struct iw_range *range = (struct iw_range *) extra;
+
+ data->length = sizeof(struct iw_range);
+ memset(range, 0, sizeof(struct iw_range));
+
+ range->we_version_compiled = WIRELESS_EXT;
+ range->we_version_source = 14;
+ range->retry_capa = IW_RETRY_LIMIT;
+ range->retry_flags = IW_RETRY_LIMIT;
+ range->min_retry = 0;
+ range->max_retry = 255;
+ range->min_rts = 0;
+ range->max_rts = 2347;
+ range->min_frag = 256;
+ range->max_frag = 2346;
+
+ range->max_qual.qual = 100;
+ range->max_qual.level = 146; /* set floor at -110 dBm (146 - 256) */
+ range->max_qual.noise = 146;
+ range->max_qual.updated = IW_QUAL_ALL_UPDATED;
+
+ range->avg_qual.qual = 50;
+ range->avg_qual.level = 0;
+ range->avg_qual.noise = 0;
+ range->avg_qual.updated = IW_QUAL_ALL_UPDATED;
+
+ return 0;
+}
+
+
+struct ieee80211_channel_range {
+ short start_freq;
+ short end_freq;
+ unsigned char power_level;
+ unsigned char antenna_max;
+};
+
+static const struct ieee80211_channel_range ieee80211_fcc_channels[] = {
+ { 2412, 2462, 27, 6 } /* IEEE 802.11b/g, channels 1..11 */,
+ { 5180, 5240, 17, 6 } /* IEEE 802.11a, channels 36..48 */,
+ { 5260, 5320, 23, 6 } /* IEEE 802.11a, channels 52..64 */,
+ { 5745, 5825, 30, 6 } /* IEEE 802.11a, channels 149..165, outdoor */,
+ { 0 }
+};
+
+static const struct ieee80211_channel_range ieee80211_mkk_channels[] = {
+ { 2412, 2472, 20, 6 } /* IEEE 802.11b/g, channels 1..13 */,
+ { 5170, 5240, 20, 6 } /* IEEE 802.11a, channels 34..48 */,
+ { 5260, 5320, 20, 6 } /* IEEE 802.11a, channels 52..64 */,
+ { 0 }
+};
+
+
+static const struct ieee80211_channel_range *channel_range =
+ ieee80211_fcc_channels;
+
+
+static void ieee80211_unmask_channel(struct net_device *dev, int mode,
+ struct ieee80211_channel *chan)
+{
+ int i;
+
+ chan->flag = 0;
+
+ if (ieee80211_regdom == 64 &&
+ (mode == MODE_ATHEROS_TURBO || mode == MODE_ATHEROS_TURBOG)) {
+ /* Do not allow Turbo modes in Japan. */
+ return;
+ }
+
+ for (i = 0; channel_range[i].start_freq; i++) {
+ const struct ieee80211_channel_range *r = &channel_range[i];
+ if (r->start_freq <= chan->freq && r->end_freq >= chan->freq) {
+ if (ieee80211_regdom == 64 && !ieee80211_japan_5ghz &&
+ chan->freq >= 5260 && chan->freq <= 5320) {
+ /*
+ * Skip new channels in Japan since the
+ * firmware was not marked having been upgraded
+ * by the vendor.
+ */
+ continue;
+ }
+
+ if (ieee80211_regdom == 0x10 &&
+ (chan->freq == 5190 || chan->freq == 5210 ||
+ chan->freq == 5230)) {
+ /* Skip MKK channels when in FCC domain. */
+ continue;
+ }
+
+ chan->flag |= IEEE80211_CHAN_W_SCAN |
+ IEEE80211_CHAN_W_ACTIVE_SCAN |
+ IEEE80211_CHAN_W_IBSS;
+ chan->power_level = r->power_level;
+ chan->antenna_max = r->antenna_max;
+
+ if (ieee80211_regdom == 64 &&
+ (chan->freq == 5170 || chan->freq == 5190 ||
+ chan->freq == 5210 || chan->freq == 5230)) {
+ /*
+ * New regulatory rules in Japan have backwards
+ * compatibility with old channels in 5.15-5.25
+ * GHz band, but the station is not allowed to
+ * use active scan on these old channels.
+ */
+ chan->flag &= ~IEEE80211_CHAN_W_ACTIVE_SCAN;
+ }
+
+ if (ieee80211_regdom == 64 &&
+ (chan->freq == 5260 || chan->freq == 5280 ||
+ chan->freq == 5300 || chan->freq == 5320)) {
+ /*
+ * IBSS is not allowed on 5.25-5.35 GHz band
+ * due to radar detection requirements.
+ */
+ chan->flag &= ~IEEE80211_CHAN_W_IBSS;
+ }
+
+ break;
+ }
+ }
+}
+
+
+static int ieee80211_unmask_channels(struct net_device *dev)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int m, c;
+
+ for (m = 0; m < local->hw.num_modes; m++) {
+ struct ieee80211_hw_modes *mode = &local->hw.modes[m];
+ for (c = 0; c < mode->num_channels; c++) {
+ ieee80211_unmask_channel(dev, mode->mode,
+ &mode->channels[c]);
+ }
+ }
+ return 0;
+}
+
+
+int ieee80211_init_client(struct net_device *dev)
+{
+ if (ieee80211_regdom == 0x40)
+ channel_range = ieee80211_mkk_channels;
+ ieee80211_unmask_channels(dev);
+ return 0;
+}
+
+
+static int ieee80211_ioctl_siwmode(struct net_device *dev,
+ struct iw_request_info *info,
+ __u32 *mode, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ int type;
+
+ if (sdata->type == IEEE80211_IF_TYPE_VLAN)
+ return -EOPNOTSUPP;
+ if (netif_running(dev))
+ return -EBUSY;
+
+ switch (*mode) {
+ case IW_MODE_MASTER:
+ type = IEEE80211_IF_TYPE_AP;
+ break;
+ case IW_MODE_INFRA:
+ type = IEEE80211_IF_TYPE_STA;
+ break;
+ case IW_MODE_ADHOC:
+ type = IEEE80211_IF_TYPE_IBSS;
+ break;
+ case IW_MODE_MONITOR:
+ type = IEEE80211_IF_TYPE_MNTR;
+ break;
+ case IW_MODE_REPEAT:
+ type = IEEE80211_IF_TYPE_WDS;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ if (type != sdata->type) {
+ ieee80211_if_reinit(dev);
+ ieee80211_if_set_type(dev, type);
+ }
+ return 0;
+}
+
+
+static int ieee80211_ioctl_giwmode(struct net_device *dev,
+ struct iw_request_info *info,
+ __u32 *mode, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ switch (sdata->type) {
+ case IEEE80211_IF_TYPE_AP:
+ *mode = IW_MODE_MASTER;
+ break;
+ case IEEE80211_IF_TYPE_STA:
+ *mode = IW_MODE_INFRA;
+ break;
+ case IEEE80211_IF_TYPE_IBSS:
+ *mode = IW_MODE_ADHOC;
+ break;
+ case IEEE80211_IF_TYPE_MNTR:
+ *mode = IW_MODE_MONITOR;
+ break;
+ case IEEE80211_IF_TYPE_WDS:
+ *mode = IW_MODE_REPEAT;
+ break;
+ case IEEE80211_IF_TYPE_VLAN:
+ *mode = IW_MODE_SECOND; /* FIXME */
+ break;
+ default:
+ *mode = IW_MODE_AUTO;
+ break;
+ }
+ return 0;
+}
+
+
+int ieee80211_ioctl_siwfreq(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_freq *freq, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int m, c, nfreq, set = 0;
+
+ /* freq->e == 0: freq->m = channel; otherwise freq = m * 10^e */
+ if (freq->e == 0)
+ nfreq = -1;
+ else {
+ int i, div = 1000000;
+ for (i = 0; i < freq->e; i++)
+ div /= 10;
+ if (div > 0)
+ nfreq = freq->m / div;
+ else
+ return -EINVAL;
+ }
+
+ for (m = 0; m < local->hw.num_modes; m++) {
+ struct ieee80211_hw_modes *mode = &local->hw.modes[m];
+ for (c = 0; c < mode->num_channels; c++) {
+ struct ieee80211_channel *chan = &mode->channels[c];
+ if (chan->flag & IEEE80211_CHAN_W_SCAN &&
+ ((freq->e == 0 && chan->chan == freq->m) ||
+ (freq->e > 0 && nfreq == chan->freq)) &&
+ (local->enabled_modes & (1 << mode->mode))) {
+ /* Use next_mode as the mode preference to
+ * resolve non-unique channel numbers. */
+ if (set && mode->mode != local->next_mode)
+ continue;
+
+ local->hw.conf.channel = chan->chan;
+ local->hw.conf.channel_val = chan->val;
+ local->hw.conf.power_level = chan->power_level;
+ local->hw.conf.freq = chan->freq;
+ local->hw.conf.phymode = mode->mode;
+ local->hw.conf.antenna_max = chan->antenna_max;
+ set++;
+ }
+ }
+ }
+
+ if (set) {
+ local->sta_scanning = 0; /* Abort possible scan */
+ return ieee80211_hw_config(local);
+ }
+
+ return -EINVAL;
+}
+
+
+static int ieee80211_ioctl_giwfreq(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_freq *freq, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ /* TODO: in station mode (Managed/Ad-hoc) might need to poll low-level
+ * driver for the current channel with firmware-based management */
+
+ freq->m = local->hw.conf.freq;
+ freq->e = 6;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_siwessid(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *ssid)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata;
+ size_t len = data->length;
+
+ /* iwconfig uses nul termination in SSID.. */
+ if (len > 0 && ssid[len - 1] == '\0')
+ len--;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ if (local->user_space_mlme) {
+ if (len > IEEE80211_MAX_SSID_LEN)
+ return -EINVAL;
+ memcpy(sdata->u.sta.ssid, ssid, len);
+ sdata->u.sta.ssid_len = len;
+ return 0;
+ }
+ return ieee80211_sta_set_ssid(dev, ssid, len);
+ }
+
+ if (sdata->type == IEEE80211_IF_TYPE_AP) {
+ memcpy(sdata->u.ap.ssid, ssid, len);
+ memset(sdata->u.ap.ssid + len, 0,
+ IEEE80211_MAX_SSID_LEN - len);
+ sdata->u.ap.ssid_len = len;
+ return ieee80211_if_config(dev);
+ }
+ return -EOPNOTSUPP;
+}
+
+
+static int ieee80211_ioctl_giwessid(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *ssid)
+{
+ size_t len;
+
+ struct ieee80211_sub_if_data *sdata;
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ int res = ieee80211_sta_get_ssid(dev, ssid, &len);
+ if (res == 0) {
+ data->length = len;
+ data->flags = 1;
+ } else
+ data->flags = 0;
+ return res;
+ }
+
+ if (sdata->type == IEEE80211_IF_TYPE_AP) {
+ len = sdata->u.ap.ssid_len;
+ if (len > IW_ESSID_MAX_SIZE)
+ len = IW_ESSID_MAX_SIZE;
+ memcpy(ssid, sdata->u.ap.ssid, len);
+ data->length = len;
+ data->flags = 1;
+ return 0;
+ }
+ return -EOPNOTSUPP;
+}
+
+
+static int ieee80211_ioctl_siwap(struct net_device *dev,
+ struct iw_request_info *info,
+ struct sockaddr *ap_addr, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ if (local->user_space_mlme) {
+ memcpy(sdata->u.sta.bssid, (u8 *) &ap_addr->sa_data,
+ ETH_ALEN);
+ return 0;
+ }
+ return ieee80211_sta_set_bssid(dev, (u8 *) &ap_addr->sa_data);
+ } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
+ if (memcmp(sdata->u.wds.remote_addr, (u8 *) &ap_addr->sa_data,
+ ETH_ALEN) == 0)
+ return 0;
+ return ieee80211_if_update_wds(dev, (u8 *) &ap_addr->sa_data);
+ }
+
+ return -EOPNOTSUPP;
+}
+
+
+static int ieee80211_ioctl_giwap(struct net_device *dev,
+ struct iw_request_info *info,
+ struct sockaddr *ap_addr, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ ap_addr->sa_family = ARPHRD_ETHER;
+ memcpy(&ap_addr->sa_data, sdata->u.sta.bssid, ETH_ALEN);
+ return 0;
+ } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
+ ap_addr->sa_family = ARPHRD_ETHER;
+ memcpy(&ap_addr->sa_data, sdata->u.wds.remote_addr, ETH_ALEN);
+ return 0;
+ }
+
+ return -EOPNOTSUPP;
+}
+
+
+static int ieee80211_ioctl_siwscan(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ u8 *ssid = NULL;
+ size_t ssid_len = 0;
+
+ if (!netif_running(dev))
+ return -ENETDOWN;
+
+ if (local->scan_flags & IEEE80211_SCAN_MATCH_SSID) {
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ ssid = sdata->u.sta.ssid;
+ ssid_len = sdata->u.sta.ssid_len;
+ } else if (sdata == IEEE80211_IF_TYPE_AP) {
+ ssid = sdata->u.ap.ssid;
+ ssid_len = sdata->u.ap.ssid_len;
+ } else
+ return -EINVAL;
+ }
+ return ieee80211_sta_req_scan(dev, ssid, ssid_len);
+}
+
+
+static int ieee80211_ioctl_giwscan(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *extra)
+{
+ int res;
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ if (local->sta_scanning)
+ return -EAGAIN;
+ res = ieee80211_sta_scan_results(dev, extra, data->length);
+ if (res >= 0) {
+ data->length = res;
+ return 0;
+ }
+ data->length = 0;
+ return res;
+}
+
+
+static int ieee80211_ioctl_siwrts(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *rts, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ if (rts->disabled)
+ local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
+ else if (rts->value < 0 || rts->value > IEEE80211_MAX_RTS_THRESHOLD)
+ return -EINVAL;
+ else
+ local->rts_threshold = rts->value;
+
+ /* If the wlan card performs RTS/CTS in hardware/firmware,
+ * configure it here */
+
+ if (local->ops->set_rts_threshold)
+ local->ops->set_rts_threshold(local_to_hw(local),
+ local->rts_threshold);
+
+ return 0;
+}
+
+static int ieee80211_ioctl_giwrts(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *rts, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ rts->value = local->rts_threshold;
+ rts->disabled = (rts->value >= IEEE80211_MAX_RTS_THRESHOLD);
+ rts->fixed = 1;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_siwfrag(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *frag, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ if (frag->disabled)
+ local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
+ else if (frag->value < 256 ||
+ frag->value > IEEE80211_MAX_FRAG_THRESHOLD)
+ return -EINVAL;
+ else {
+ /* Fragment length must be even, so strip LSB. */
+ local->fragmentation_threshold = frag->value & ~0x1;
+ }
+
+ /* If the wlan card performs fragmentation in hardware/firmware,
+ * configure it here */
+
+ if (local->ops->set_frag_threshold)
+ local->ops->set_frag_threshold(
+ local_to_hw(local),
+ local->fragmentation_threshold);
+
+ return 0;
+}
+
+static int ieee80211_ioctl_giwfrag(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *frag, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ frag->value = local->fragmentation_threshold;
+ frag->disabled = (frag->value >= IEEE80211_MAX_RTS_THRESHOLD);
+ frag->fixed = 1;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_siwretry(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *retry, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ if (retry->disabled ||
+ (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
+ return -EINVAL;
+
+ if (retry->flags & IW_RETRY_MAX)
+ local->long_retry_limit = retry->value;
+ else if (retry->flags & IW_RETRY_MIN)
+ local->short_retry_limit = retry->value;
+ else {
+ local->long_retry_limit = retry->value;
+ local->short_retry_limit = retry->value;
+ }
+
+ if (local->ops->set_retry_limit) {
+ return local->ops->set_retry_limit(
+ local_to_hw(local),
+ local->short_retry_limit,
+ local->long_retry_limit);
+ }
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_giwretry(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *retry, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+
+ retry->disabled = 0;
+ if ((retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
+ return -EINVAL;
+ if (retry->flags & IW_RETRY_MAX) {
+ retry->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
+ retry->value = local->long_retry_limit;
+ } else {
+ retry->flags = IW_RETRY_LIMIT;
+ retry->value = local->short_retry_limit;
+ if (local->long_retry_limit != local->short_retry_limit)
+ retry->flags |= IW_RETRY_MIN;
+ }
+
+ return 0;
+}
+
+
+static void ieee80211_ioctl_unmask_channels(struct ieee80211_local *local)
+{
+ int m, c;
+
+ for (m = 0; m < local->hw.num_modes; m++) {
+ struct ieee80211_hw_modes *mode = &local->hw.modes[m];
+ for (c = 0; c < mode->num_channels; c++) {
+ struct ieee80211_channel *chan = &mode->channels[c];
+ chan->flag |= IEEE80211_CHAN_W_SCAN;
+ }
+ }
+}
+
+
+static int ieee80211_ioctl_test_mode(struct net_device *dev, int mode)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int ret = -EOPNOTSUPP;
+
+ if (mode == IEEE80211_TEST_UNMASK_CHANNELS) {
+ ieee80211_ioctl_unmask_channels(local);
+ ret = 0;
+ }
+
+ if (local->ops->test_mode)
+ ret = local->ops->test_mode(local_to_hw(local), mode);
+
+ return ret;
+}
+
+
+static int ieee80211_ioctl_clear_keys(struct net_device *dev)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_key_conf key;
+ int i;
+ u8 addr[ETH_ALEN];
+ struct ieee80211_key_conf *keyconf;
+ struct ieee80211_sub_if_data *sdata;
+ struct sta_info *sta;
+
+ memset(addr, 0xff, ETH_ALEN);
+ list_for_each_entry(sdata, &local->sub_if_list, list) {
+ for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
+ keyconf = NULL;
+ if (sdata->keys[i] &&
+ !sdata->keys[i]->force_sw_encrypt &&
+ local->ops->set_key &&
+ (keyconf = ieee80211_key_data2conf(local,
+ sdata->keys[i])))
+ local->ops->set_key(local_to_hw(local),
+ DISABLE_KEY, addr,
+ keyconf, 0);
+ kfree(keyconf);
+ ieee80211_key_free(sdata->keys[i]);
+ sdata->keys[i] = NULL;
+ }
+ sdata->default_key = NULL;
+ }
+
+ spin_lock_bh(&local->sta_lock);
+ list_for_each_entry(sta, &local->sta_list, list) {
+ keyconf = NULL;
+ if (sta->key && !sta->key->force_sw_encrypt &&
+ local->ops->set_key &&
+ (keyconf = ieee80211_key_data2conf(local, sta->key)))
+ local->ops->set_key(local_to_hw(local), DISABLE_KEY,
+ sta->addr, keyconf, sta->aid);
+ kfree(keyconf);
+ ieee80211_key_free(sta->key);
+ sta->key = NULL;
+ }
+ spin_unlock_bh(&local->sta_lock);
+
+ memset(&key, 0, sizeof(key));
+ if (local->ops->set_key &&
+ local->ops->set_key(local_to_hw(local), REMOVE_ALL_KEYS,
+ NULL, &key, 0))
+ printk(KERN_DEBUG "%s: failed to remove hwaccel keys\n",
+ dev->name);
+
+ return 0;
+}
+
+
+static int
+ieee80211_ioctl_force_unicast_rate(struct net_device *dev,
+ struct ieee80211_sub_if_data *sdata,
+ int rate)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int i;
+
+ if (sdata->type != IEEE80211_IF_TYPE_AP)
+ return -ENOENT;
+
+ if (rate == 0) {
+ sdata->u.ap.force_unicast_rateidx = -1;
+ return 0;
+ }
+
+ for (i = 0; i < local->num_curr_rates; i++) {
+ if (local->curr_rates[i].rate == rate) {
+ sdata->u.ap.force_unicast_rateidx = i;
+ return 0;
+ }
+ }
+ return -EINVAL;
+}
+
+
+static int
+ieee80211_ioctl_max_ratectrl_rate(struct net_device *dev,
+ struct ieee80211_sub_if_data *sdata,
+ int rate)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int i;
+
+ if (sdata->type != IEEE80211_IF_TYPE_AP)
+ return -ENOENT;
+
+ if (rate == 0) {
+ sdata->u.ap.max_ratectrl_rateidx = -1;
+ return 0;
+ }
+
+ for (i = 0; i < local->num_curr_rates; i++) {
+ if (local->curr_rates[i].rate == rate) {
+ sdata->u.ap.max_ratectrl_rateidx = i;
+ return 0;
+ }
+ }
+ return -EINVAL;
+}
+
+
+static void ieee80211_key_enable_hwaccel(struct ieee80211_local *local,
+ struct ieee80211_key *key)
+{
+ struct ieee80211_key_conf *keyconf;
+ u8 addr[ETH_ALEN];
+
+ if (!key || key->alg != ALG_WEP || !key->force_sw_encrypt ||
+ (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
+ return;
+
+ memset(addr, 0xff, ETH_ALEN);
+ keyconf = ieee80211_key_data2conf(local, key);
+ if (keyconf && local->ops->set_key &&
+ local->ops->set_key(local_to_hw(local),
+ SET_KEY, addr, keyconf, 0) == 0) {
+ key->force_sw_encrypt =
+ !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
+ key->hw_key_idx = keyconf->hw_key_idx;
+ }
+ kfree(keyconf);
+}
+
+
+static void ieee80211_key_disable_hwaccel(struct ieee80211_local *local,
+ struct ieee80211_key *key)
+{
+ struct ieee80211_key_conf *keyconf;
+ u8 addr[ETH_ALEN];
+
+ if (!key || key->alg != ALG_WEP || key->force_sw_encrypt ||
+ (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
+ return;
+
+ memset(addr, 0xff, ETH_ALEN);
+ keyconf = ieee80211_key_data2conf(local, key);
+ if (keyconf && local->ops->set_key)
+ local->ops->set_key(local_to_hw(local), DISABLE_KEY,
+ addr, keyconf, 0);
+ kfree(keyconf);
+ key->force_sw_encrypt = 1;
+}
+
+
+static int ieee80211_ioctl_default_wep_only(struct ieee80211_local *local,
+ int value)
+{
+ int i;
+ struct ieee80211_sub_if_data *sdata;
+
+ local->default_wep_only = value;
+ list_for_each_entry(sdata, &local->sub_if_list, list)
+ for (i = 0; i < NUM_DEFAULT_KEYS; i++)
+ if (value)
+ ieee80211_key_enable_hwaccel(local,
+ sdata->keys[i]);
+ else
+ ieee80211_key_disable_hwaccel(local,
+ sdata->keys[i]);
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_prism2_param(struct net_device *dev,
+ struct iw_request_info *info,
+ void *wrqu, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata;
+ int *i = (int *) extra;
+ int param = *i;
+ int value = *(i + 1);
+ int ret = 0;
+
+ if (!capable(CAP_NET_ADMIN))
+ return -EPERM;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ switch (param) {
+ case PRISM2_PARAM_HOST_ENCRYPT:
+ case PRISM2_PARAM_HOST_DECRYPT:
+ /* TODO: implement these; return success now to prevent
+ * hostapd from aborting */
+ break;
+
+ case PRISM2_PARAM_BEACON_INT:
+ local->hw.conf.beacon_int = value;
+ if (ieee80211_hw_config(local))
+ ret = -EINVAL;
+ break;
+
+ case PRISM2_PARAM_AP_BRIDGE_PACKETS:
+ local->bridge_packets = value;
+ break;
+
+ case PRISM2_PARAM_AP_AUTH_ALGS:
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ sdata->u.sta.auth_algs = value;
+ } else
+ ret = -EOPNOTSUPP;
+ break;
+
+ case PRISM2_PARAM_DTIM_PERIOD:
+ if (value < 1)
+ ret = -EINVAL;
+ else if (sdata->type != IEEE80211_IF_TYPE_AP)
+ ret = -ENOENT;
+ else
+ sdata->u.ap.dtim_period = value;
+ break;
+
+ case PRISM2_PARAM_IEEE_802_1X:
+ sdata->ieee802_1x = value;
+ if (local->ops->set_ieee8021x &&
+ local->ops->set_ieee8021x(local_to_hw(local), value))
+ printk(KERN_DEBUG "%s: failed to set IEEE 802.1X (%d) "
+ "for low-level driver\n", dev->name, value);
+ break;
+
+ case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
+ local->cts_protect_erp_frames = value;
+ break;
+
+ case PRISM2_PARAM_DROP_UNENCRYPTED:
+ sdata->drop_unencrypted = value;
+ break;
+
+ case PRISM2_PARAM_PREAMBLE:
+ local->short_preamble = value;
+ break;
+
+ case PRISM2_PARAM_STAT_TIME:
+ if (!local->stat_time && value) {
+ local->stat_timer.expires = jiffies + HZ * value / 100;
+ add_timer(&local->stat_timer);
+ } else if (local->stat_time && !value) {
+ del_timer_sync(&local->stat_timer);
+ }
+ local->stat_time = value;
+ break;
+ case PRISM2_PARAM_SHORT_SLOT_TIME:
+ if (value)
+ local->hw.conf.flags |= IEEE80211_CONF_SHORT_SLOT_TIME;
+ else
+ local->hw.conf.flags &= ~IEEE80211_CONF_SHORT_SLOT_TIME;
+ if (ieee80211_hw_config(local))
+ ret = -EINVAL;
+ break;
+
+ case PRISM2_PARAM_PRIVACY_INVOKED:
+ if (local->ops->set_privacy_invoked)
+ ret = local->ops->set_privacy_invoked(
+ local_to_hw(local), value);
+ break;
+
+ case PRISM2_PARAM_TEST_MODE:
+ ret = ieee80211_ioctl_test_mode(dev, value);
+ break;
+
+ case PRISM2_PARAM_NEXT_MODE:
+ local->next_mode = value;
+ break;
+
+ case PRISM2_PARAM_CLEAR_KEYS:
+ ret = ieee80211_ioctl_clear_keys(dev);
+ break;
+
+ case PRISM2_PARAM_RADIO_ENABLED:
+ ret = ieee80211_ioctl_set_radio_enabled(dev, value);
+ break;
+
+ case PRISM2_PARAM_ANTENNA_SEL:
+ local->hw.conf.antenna_sel = value;
+ if (ieee80211_hw_config(local))
+ ret = -EINVAL;
+ break;
+
+ case PRISM2_PARAM_ANTENNA_MODE:
+ local->hw.conf.antenna_mode = value;
+ if (ieee80211_hw_config(local))
+ ret = -EINVAL;
+ break;
+
+ case PRISM2_PARAM_BROADCAST_SSID:
+ if ((value < 0) || (value > 1))
+ ret = -EINVAL;
+ else if (value)
+ local->hw.conf.flags |= IEEE80211_CONF_SSID_HIDDEN;
+ else
+ local->hw.conf.flags &= ~IEEE80211_CONF_SSID_HIDDEN;
+ break;
+
+ case PRISM2_PARAM_STA_ANTENNA_SEL:
+ local->sta_antenna_sel = value;
+ break;
+
+ case PRISM2_PARAM_FORCE_UNICAST_RATE:
+ ret = ieee80211_ioctl_force_unicast_rate(dev, sdata, value);
+ break;
+
+ case PRISM2_PARAM_MAX_RATECTRL_RATE:
+ ret = ieee80211_ioctl_max_ratectrl_rate(dev, sdata, value);
+ break;
+
+ case PRISM2_PARAM_RATE_CTRL_NUM_UP:
+ local->rate_ctrl_num_up = value;
+ break;
+
+ case PRISM2_PARAM_RATE_CTRL_NUM_DOWN:
+ local->rate_ctrl_num_down = value;
+ break;
+
+ case PRISM2_PARAM_TX_POWER_REDUCTION:
+ if (value < 0)
+ ret = -EINVAL;
+ else
+ local->hw.conf.tx_power_reduction = value;
+ break;
+
+ case PRISM2_PARAM_EAPOL:
+ sdata->eapol = value;
+ break;
+
+ case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
+ local->key_tx_rx_threshold = value;
+ break;
+
+ case PRISM2_PARAM_KEY_INDEX:
+ if (value < 0 || value >= NUM_DEFAULT_KEYS)
+ ret = -EINVAL;
+ else if (!sdata->keys[value])
+ ret = -ENOENT;
+ else
+ sdata->default_key = sdata->keys[value];
+ break;
+
+ case PRISM2_PARAM_DEFAULT_WEP_ONLY:
+ ret = ieee80211_ioctl_default_wep_only(local, value);
+ break;
+
+ case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
+ local->wifi_wme_noack_test = value;
+ break;
+
+ case PRISM2_PARAM_ALLOW_BROADCAST_ALWAYS:
+ local->allow_broadcast_always = value;
+ break;
+
+ case PRISM2_PARAM_SCAN_FLAGS:
+ local->scan_flags = value;
+ break;
+
+ case PRISM2_PARAM_MIXED_CELL:
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ sdata->u.sta.mixed_cell = !!value;
+ break;
+
+ case PRISM2_PARAM_KEY_MGMT:
+ if (sdata->type != IEEE80211_IF_TYPE_STA)
+ ret = -EINVAL;
+ else
+ sdata->u.sta.key_mgmt = value;
+ break;
+
+ case PRISM2_PARAM_HW_MODES:
+ local->enabled_modes = value;
+ break;
+
+ case PRISM2_PARAM_CREATE_IBSS:
+ if (sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ sdata->u.sta.create_ibss = !!value;
+ break;
+ case PRISM2_PARAM_WMM_ENABLED:
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ sdata->u.sta.wmm_enabled = !!value;
+ break;
+ case PRISM2_PARAM_RADAR_DETECT:
+ local->hw.conf.radar_detect = value;
+ break;
+ case PRISM2_PARAM_SPECTRUM_MGMT:
+ local->hw.conf.spect_mgmt = value;
+ break;
+ case PRISM2_PARAM_MGMT_IF:
+ if (value == 1) {
+ if (!local->apdev)
+ ret = ieee80211_if_add_mgmt(local);
+ } else if (value == 0) {
+ if (local->apdev)
+ ieee80211_if_del_mgmt(local);
+ } else
+ ret = -EINVAL;
+ break;
+ case PRISM2_PARAM_USER_SPACE_MLME:
+ local->user_space_mlme = value;
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+
+ return ret;
+}
+
+
+static int ieee80211_ioctl_get_prism2_param(struct net_device *dev,
+ struct iw_request_info *info,
+ void *wrqu, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata;
+ int *param = (int *) extra;
+ int ret = 0;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ switch (*param) {
+ case PRISM2_PARAM_BEACON_INT:
+ *param = local->hw.conf.beacon_int;
+ break;
+
+ case PRISM2_PARAM_AP_BRIDGE_PACKETS:
+ *param = local->bridge_packets;
+ break;
+
+ case PRISM2_PARAM_AP_AUTH_ALGS:
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS) {
+ *param = sdata->u.sta.auth_algs;
+ } else
+ ret = -EOPNOTSUPP;
+ break;
+
+ case PRISM2_PARAM_DTIM_PERIOD:
+ if (sdata->type != IEEE80211_IF_TYPE_AP)
+ ret = -ENOENT;
+ else
+ *param = sdata->u.ap.dtim_period;
+ break;
+
+ case PRISM2_PARAM_IEEE_802_1X:
+ *param = sdata->ieee802_1x;
+ break;
+
+ case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
+ *param = local->cts_protect_erp_frames;
+ break;
+
+ case PRISM2_PARAM_DROP_UNENCRYPTED:
+ *param = sdata->drop_unencrypted;
+ break;
+
+ case PRISM2_PARAM_PREAMBLE:
+ *param = local->short_preamble;
+ break;
+
+ case PRISM2_PARAM_STAT_TIME:
+ *param = local->stat_time;
+ break;
+ case PRISM2_PARAM_SHORT_SLOT_TIME:
+ *param = !!(local->hw.conf.flags & IEEE80211_CONF_SHORT_SLOT_TIME);
+ break;
+
+ case PRISM2_PARAM_NEXT_MODE:
+ *param = local->next_mode;
+ break;
+
+ case PRISM2_PARAM_ANTENNA_SEL:
+ *param = local->hw.conf.antenna_sel;
+ break;
+
+ case PRISM2_PARAM_ANTENNA_MODE:
+ *param = local->hw.conf.antenna_mode;
+ break;
+
+ case PRISM2_PARAM_BROADCAST_SSID:
+ *param = !!(local->hw.conf.flags & IEEE80211_CONF_SSID_HIDDEN);
+ break;
+
+ case PRISM2_PARAM_STA_ANTENNA_SEL:
+ *param = local->sta_antenna_sel;
+ break;
+
+ case PRISM2_PARAM_RATE_CTRL_NUM_UP:
+ *param = local->rate_ctrl_num_up;
+ break;
+
+ case PRISM2_PARAM_RATE_CTRL_NUM_DOWN:
+ *param = local->rate_ctrl_num_down;
+ break;
+
+ case PRISM2_PARAM_TX_POWER_REDUCTION:
+ *param = local->hw.conf.tx_power_reduction;
+ break;
+
+ case PRISM2_PARAM_EAPOL:
+ *param = sdata->eapol;
+ break;
+
+ case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
+ *param = local->key_tx_rx_threshold;
+ break;
+
+ case PRISM2_PARAM_KEY_INDEX:
+ if (!sdata->default_key)
+ ret = -ENOENT;
+ else if (sdata->default_key == sdata->keys[0])
+ *param = 0;
+ else if (sdata->default_key == sdata->keys[1])
+ *param = 1;
+ else if (sdata->default_key == sdata->keys[2])
+ *param = 2;
+ else if (sdata->default_key == sdata->keys[3])
+ *param = 3;
+ else
+ ret = -ENOENT;
+ break;
+
+ case PRISM2_PARAM_DEFAULT_WEP_ONLY:
+ *param = local->default_wep_only;
+ break;
+
+ case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
+ *param = local->wifi_wme_noack_test;
+ break;
+
+ case PRISM2_PARAM_ALLOW_BROADCAST_ALWAYS:
+ *param = local->allow_broadcast_always;
+ break;
+
+ case PRISM2_PARAM_SCAN_FLAGS:
+ *param = local->scan_flags;
+ break;
+
+ case PRISM2_PARAM_HW_MODES:
+ *param = local->enabled_modes;
+ break;
+
+ case PRISM2_PARAM_CREATE_IBSS:
+ if (sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ *param = !!sdata->u.sta.create_ibss;
+ break;
+
+ case PRISM2_PARAM_MIXED_CELL:
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ *param = !!sdata->u.sta.mixed_cell;
+ break;
+
+ case PRISM2_PARAM_KEY_MGMT:
+ if (sdata->type != IEEE80211_IF_TYPE_STA)
+ ret = -EINVAL;
+ else
+ *param = sdata->u.sta.key_mgmt;
+ break;
+ case PRISM2_PARAM_WMM_ENABLED:
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ ret = -EINVAL;
+ else
+ *param = !!sdata->u.sta.wmm_enabled;
+ break;
+ case PRISM2_PARAM_MGMT_IF:
+ if (local->apdev)
+ *param = local->apdev->ifindex;
+ else
+ ret = -ENOENT;
+ break;
+ case PRISM2_PARAM_USER_SPACE_MLME:
+ *param = local->user_space_mlme;
+ break;
+
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+
+ return ret;
+}
+
+
+static int ieee80211_ioctl_test_param(struct net_device *dev,
+ struct iw_request_info *info,
+ void *wrqu, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ int *i = (int *) extra;
+ int param = *i;
+ int value = *(i + 1);
+
+ if (!capable(CAP_NET_ADMIN))
+ return -EPERM;
+
+ if (local->ops->test_param)
+ return local->ops->test_param(local_to_hw(local),
+ param, value);
+
+ return -EOPNOTSUPP;
+}
+
+
+static int ieee80211_ioctl_siwmlme(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata;
+ struct iw_mlme *mlme = (struct iw_mlme *) extra;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ if (sdata->type != IEEE80211_IF_TYPE_STA &&
+ sdata->type != IEEE80211_IF_TYPE_IBSS)
+ return -EINVAL;
+
+ switch (mlme->cmd) {
+ case IW_MLME_DEAUTH:
+ /* TODO: mlme->addr.sa_data */
+ return ieee80211_sta_deauthenticate(dev, mlme->reason_code);
+ case IW_MLME_DISASSOC:
+ /* TODO: mlme->addr.sa_data */
+ return ieee80211_sta_disassociate(dev, mlme->reason_code);
+ default:
+ return -EOPNOTSUPP;
+ }
+}
+
+
+static int ieee80211_ioctl_siwencode(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *erq, char *keybuf)
+{
+ struct ieee80211_sub_if_data *sdata;
+ int idx, i, alg = ALG_WEP;
+ u8 bcaddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ idx = erq->flags & IW_ENCODE_INDEX;
+ if (idx < 1 || idx > 4) {
+ idx = -1;
+ if (!sdata->default_key)
+ idx = 0;
+ else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
+ if (sdata->default_key == sdata->keys[i]) {
+ idx = i;
+ break;
+ }
+ }
+ if (idx < 0)
+ return -EINVAL;
+ } else
+ idx--;
+
+ if (erq->flags & IW_ENCODE_DISABLED)
+ alg = ALG_NONE;
+ else if (erq->length == 0) {
+ /* No key data - just set the default TX key index */
+ if (sdata->default_key != sdata->keys[idx]) {
+ if (sdata->default_key)
+ ieee80211_key_sysfs_remove_default(sdata);
+ sdata->default_key = sdata->keys[idx];
+ if (sdata->default_key)
+ ieee80211_key_sysfs_add_default(sdata);
+ }
+ return 0;
+ }
+
+ return ieee80211_set_encryption(
+ dev, bcaddr,
+ idx, alg,
+ !sdata->default_key,
+ NULL, keybuf, erq->length);
+}
+
+
+static int ieee80211_ioctl_giwencode(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *erq, char *key)
+{
+ struct ieee80211_sub_if_data *sdata;
+ int idx, i;
+
+ sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+
+ idx = erq->flags & IW_ENCODE_INDEX;
+ if (idx < 1 || idx > 4) {
+ idx = -1;
+ if (!sdata->default_key)
+ idx = 0;
+ else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
+ if (sdata->default_key == sdata->keys[i]) {
+ idx = i;
+ break;
+ }
+ }
+ if (idx < 0)
+ return -EINVAL;
+ } else
+ idx--;
+
+ erq->flags = idx + 1;
+
+ if (!sdata->keys[idx]) {
+ erq->length = 0;
+ erq->flags |= IW_ENCODE_DISABLED;
+ return 0;
+ }
+
+ memcpy(key, sdata->keys[idx]->key,
+ min((int)erq->length, sdata->keys[idx]->keylen));
+ erq->length = sdata->keys[idx]->keylen;
+ erq->flags |= IW_ENCODE_ENABLED;
+
+ return 0;
+}
+
+
+static int ieee80211_ioctl_siwgenie(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *data, char *extra)
+{
+ return ieee80211_set_gen_ie(dev, extra, data->length);
+}
+
+
+static int ieee80211_ioctl_siwauth(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *data, char *extra)
+{
+ struct ieee80211_local *local = dev->ieee80211_ptr;
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ int ret = 0;
+
+ switch (data->flags & IW_AUTH_INDEX) {
+ case IW_AUTH_WPA_VERSION:
+ case IW_AUTH_CIPHER_PAIRWISE:
+ case IW_AUTH_CIPHER_GROUP:
+ case IW_AUTH_WPA_ENABLED:
+ case IW_AUTH_RX_UNENCRYPTED_EAPOL:
+ break;
+ case IW_AUTH_KEY_MGMT:
+ if (sdata->type != IEEE80211_IF_TYPE_STA)
+ ret = -EINVAL;
+ else {
+ /*
+ * TODO: sdata->u.sta.key_mgmt does not match with WE18
+ * value completely; could consider modifying this to
+ * be closer to WE18. For now, this value is not really
+ * used for anything else than Privacy matching, so the
+ * current code here should be more or less OK.
+ */
+ if (data->value & IW_AUTH_KEY_MGMT_802_1X) {
+ sdata->u.sta.key_mgmt =
+ IEEE80211_KEY_MGMT_WPA_EAP;
+ } else if (data->value & IW_AUTH_KEY_MGMT_PSK) {
+ sdata->u.sta.key_mgmt =
+ IEEE80211_KEY_MGMT_WPA_PSK;
+ } else {
+ sdata->u.sta.key_mgmt =
+ IEEE80211_KEY_MGMT_NONE;
+ }
+ }
+ break;
+ case IW_AUTH_80211_AUTH_ALG:
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS)
+ sdata->u.sta.auth_algs = data->value;
+ else
+ ret = -EOPNOTSUPP;
+ break;
+ case IW_AUTH_PRIVACY_INVOKED:
+ if (local->ops->set_privacy_invoked)
+ ret = local->ops->set_privacy_invoked(
+ local_to_hw(local), data->value);
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+ return ret;
+}
+
+/* Get wireless statistics. Called by /proc/net/wireless and by SIOCGIWSTATS */
+static struct iw_statistics *ieee80211_get_wireless_stats(struct net_device *net_dev)
+{
+ struct ieee80211_local *local = net_dev->ieee80211_ptr;
+ struct iw_statistics * wstats = &local->wstats;
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(net_dev);
+ struct sta_info *sta;
+ static int tmp_level = 0;
+ static int tmp_qual = 0;
+
+ sta = sta_info_get(local, sdata->u.sta.bssid);
+ if (!sta) {
+ wstats->discard.fragment = 0;
+ wstats->discard.misc = 0;
+ wstats->qual.qual = 0;
+ wstats->qual.level = 0;
+ wstats->qual.noise = 0;
+ wstats->qual.updated = IW_QUAL_ALL_INVALID;
+ } else {
+ if (!tmp_level) { /* get initial values */
+ tmp_level = sta->last_signal;
+ tmp_qual = sta->last_rssi;
+ } else { /* smooth results */
+ tmp_level = (15 * tmp_level + sta->last_signal)/16;
+ tmp_qual = (15 * tmp_qual + sta->last_rssi)/16;
+ }
+ wstats->qual.level = tmp_level;
+ wstats->qual.qual = 100*tmp_qual/local->hw.maxssi;
+ wstats->qual.noise = sta->last_noise;
+ wstats->qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
+ }
+ return wstats;
+}
+
+static int ieee80211_ioctl_giwauth(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_param *data, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ int ret = 0;
+
+ switch (data->flags & IW_AUTH_INDEX) {
+ case IW_AUTH_80211_AUTH_ALG:
+ if (sdata->type == IEEE80211_IF_TYPE_STA ||
+ sdata->type == IEEE80211_IF_TYPE_IBSS)
+ data->value = sdata->u.sta.auth_algs;
+ else
+ ret = -EOPNOTSUPP;
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+ return ret;
+}
+
+
+static int ieee80211_ioctl_siwencodeext(struct net_device *dev,
+ struct iw_request_info *info,
+ struct iw_point *erq, char *extra)
+{
+ struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+ struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
+ int alg, idx, i;
+
+ switch (ext->alg) {
+ case IW_ENCODE_ALG_NONE:
+ alg = ALG_NONE;
+ break;
+ case IW_ENCODE_ALG_WEP:
+ alg = ALG_WEP;
+ break;
+ case IW_ENCODE_ALG_TKIP:
+ alg = ALG_TKIP;
+ break;
+ case IW_ENCODE_ALG_CCMP:
+ alg = ALG_CCMP;
+ break;
+ default:
+ return -EOPNOTSUPP;
+ }
+
+ if (erq->flags & IW_ENCODE_DISABLED)
+ alg = ALG_NONE;
+
+ idx = erq->flags & IW_ENCODE_INDEX;
+ if (idx < 1 || idx > 4) {
+ idx = -1;
+ if (!sdata->default_key)
+ idx = 0;
+ else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
+ if (sdata->default_key == sdata->keys[i]) {
+ idx = i;
+ break;
+ }
+ }
+ if (idx < 0)
+ return -EINVAL;
+ } else
+ idx--;
+
+ return ieee80211_set_encryption(dev, ext->addr.sa_data, idx, alg,
+ ext->ext_flags &
+ IW_ENCODE_EXT_SET_TX_KEY,
+ NULL, ext->key, ext->key_len);
+}
+
+
+static const struct iw_priv_args ieee80211_ioctl_priv[] = {
+ { PRISM2_IOCTL_PRISM2_PARAM,
+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "param" },
+ { PRISM2_IOCTL_GET_PRISM2_PARAM,
+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_param" },
+ { PRISM2_IOCTL_TEST_PARAM,
+ IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "test_param" },
+};
+
+
+int ieee80211_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
+{
+ struct iwreq *wrq = (struct iwreq *) rq;
+ int ret = 0;
+
+ switch (cmd) {
+ /* Private ioctls (iwpriv) that have not yet been converted
+ * into new wireless extensions API */
+ case PRISM2_IOCTL_TEST_PARAM:
+ ret = ieee80211_ioctl_test_param(dev, NULL, &wrq->u,
+ (char *) &wrq->u);
+ break;
+ case PRISM2_IOCTL_HOSTAPD:
+ if (!capable(CAP_NET_ADMIN)) ret = -EPERM;
+ else ret = ieee80211_ioctl_priv_hostapd(dev, &wrq->u.data);
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+
+ return ret;
+}
+
+
+/* Structures to export the Wireless Handlers */
+
+static const iw_handler ieee80211_handler[] =
+{
+ (iw_handler) NULL, /* SIOCSIWCOMMIT */
+ (iw_handler) ieee80211_ioctl_giwname, /* SIOCGIWNAME */
+ (iw_handler) NULL, /* SIOCSIWNWID */
+ (iw_handler) NULL, /* SIOCGIWNWID */
+ (iw_handler) ieee80211_ioctl_siwfreq, /* SIOCSIWFREQ */
+ (iw_handler) ieee80211_ioctl_giwfreq, /* SIOCGIWFREQ */
+ (iw_handler) ieee80211_ioctl_siwmode, /* SIOCSIWMODE */
+ (iw_handler) ieee80211_ioctl_giwmode, /* SIOCGIWMODE */
+ (iw_handler) NULL, /* SIOCSIWSENS */
+ (iw_handler) NULL, /* SIOCGIWSENS */
+ (iw_handler) NULL /* not used */, /* SIOCSIWRANGE */
+ (iw_handler) ieee80211_ioctl_giwrange, /* SIOCGIWRANGE */
+ (iw_handler) NULL /* not used */, /* SIOCSIWPRIV */
+ (iw_handler) NULL /* kernel code */, /* SIOCGIWPRIV */
+ (iw_handler) NULL /* not used */, /* SIOCSIWSTATS */
+ (iw_handler) NULL /* kernel code */, /* SIOCGIWSTATS */
+ iw_handler_set_spy, /* SIOCSIWSPY */
+ iw_handler_get_spy, /* SIOCGIWSPY */
+ iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
+ iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
+ (iw_handler) ieee80211_ioctl_siwap, /* SIOCSIWAP */
+ (iw_handler) ieee80211_ioctl_giwap, /* SIOCGIWAP */
+ (iw_handler) ieee80211_ioctl_siwmlme, /* SIOCSIWMLME */
+ (iw_handler) NULL, /* SIOCGIWAPLIST */
+ (iw_handler) ieee80211_ioctl_siwscan, /* SIOCSIWSCAN */
+ (iw_handler) ieee80211_ioctl_giwscan, /* SIOCGIWSCAN */
+ (iw_handler) ieee80211_ioctl_siwessid, /* SIOCSIWESSID */
+ (iw_handler) ieee80211_ioctl_giwessid, /* SIOCGIWESSID */
+ (iw_handler) NULL, /* SIOCSIWNICKN */
+ (iw_handler) NULL, /* SIOCGIWNICKN */
+ (iw_handler) NULL, /* -- hole -- */
+ (iw_handler) NULL, /* -- hole -- */
+ (iw_handler) NULL, /* SIOCSIWRATE */
+ (iw_handler) NULL, /* SIOCGIWRATE */
+ (iw_handler) ieee80211_ioctl_siwrts, /* SIOCSIWRTS */
+ (iw_handler) ieee80211_ioctl_giwrts, /* SIOCGIWRTS */
+ (iw_handler) ieee80211_ioctl_siwfrag, /* SIOCSIWFRAG */
+ (iw_handler) ieee80211_ioctl_giwfrag, /* SIOCGIWFRAG */
+ (iw_handler) NULL, /* SIOCSIWTXPOW */
+ (iw_handler) NULL, /* SIOCGIWTXPOW */
+ (iw_handler) ieee80211_ioctl_siwretry, /* SIOCSIWRETRY */
+ (iw_handler) ieee80211_ioctl_giwretry, /* SIOCGIWRETRY */
+ (iw_handler) ieee80211_ioctl_siwencode, /* SIOCSIWENCODE */
+ (iw_handler) ieee80211_ioctl_giwencode, /* SIOCGIWENCODE */
+ (iw_handler) NULL, /* SIOCSIWPOWER */
+ (iw_handler) NULL, /* SIOCGIWPOWER */
+ (iw_handler) NULL, /* -- hole -- */
+ (iw_handler) NULL, /* -- hole -- */
+ (iw_handler) ieee80211_ioctl_siwgenie, /* SIOCSIWGENIE */
+ (iw_handler) NULL, /* SIOCGIWGENIE */
+ (iw_handler) ieee80211_ioctl_siwauth, /* SIOCSIWAUTH */
+ (iw_handler) ieee80211_ioctl_giwauth, /* SIOCGIWAUTH */
+ (iw_handler) ieee80211_ioctl_siwencodeext, /* SIOCSIWENCODEEXT */
+ (iw_handler) NULL, /* SIOCGIWENCODEEXT */
+ (iw_handler) NULL, /* SIOCSIWPMKSA */
+ (iw_handler) NULL, /* -- hole -- */
+};
+
+static const iw_handler ieee80211_private_handler[] =
+{ /* SIOCIWFIRSTPRIV + */
+ (iw_handler) ieee80211_ioctl_prism2_param, /* 0 */
+ (iw_handler) ieee80211_ioctl_get_prism2_param, /* 1 */
+};
+
+const struct iw_handler_def ieee80211_iw_handler_def =
+{
+ .num_standard = sizeof(ieee80211_handler) / sizeof(iw_handler),
+ .num_private = sizeof(ieee80211_private_handler) /
+ sizeof(iw_handler),
+ .num_private_args = sizeof(ieee80211_ioctl_priv) /
+ sizeof(struct iw_priv_args),
+ .standard = (iw_handler *) ieee80211_handler,
+ .private = (iw_handler *) ieee80211_private_handler,
+ .private_args = (struct iw_priv_args *) ieee80211_ioctl_priv,
+ .get_wireless_stats = ieee80211_get_wireless_stats,
+};
+
+/* Wireless handlers for master interface */
+
+static const iw_handler ieee80211_master_handler[] =
+{
+ [SIOCGIWNAME - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwname,
+ [SIOCSIWFREQ - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_siwfreq,
+ [SIOCGIWFREQ - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwfreq,
+ [SIOCGIWRANGE - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwrange,
+ [SIOCSIWRTS - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_siwrts,
+ [SIOCGIWRTS - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwrts,
+ [SIOCSIWFRAG - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_siwfrag,
+ [SIOCGIWFRAG - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwfrag,
+ [SIOCSIWRETRY - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_siwretry,
+ [SIOCGIWRETRY - SIOCIWFIRST] = (iw_handler) ieee80211_ioctl_giwretry,
+};
+
+const struct iw_handler_def ieee80211_iw_master_handler_def =
+{
+ .num_standard = sizeof(ieee80211_master_handler) / sizeof(iw_handler),
+ .standard = ieee80211_master_handler,
+};
--
cgit v1.2.3