4ced3f74da
Ever since
commit e1b3ec1a2a
Author: Stanislaw Gruszka <sgruszka@redhat.com>
Date: Mon Mar 29 12:18:34 2010 +0200
mac80211: explicitly disable/enable QoS
mac80211 is telling drivers, in particular
iwlwifi, whether QoS is enabled or not.
However, this is only relevant for station mode,
since only then will any device send nullfunc
frames and need to know whether they should be
QoS frames or not. In other modes, there are
(currently) no frames the device is supposed to
send.
When you now consider virtual interfaces, it
becomes apparent that the current mechanism is
inadequate since it enables/disables QoS on a
global scale, where for nullfunc frames it has
to be on a per-interface scale.
Due to the above considerations, we can change
the way mac80211 advertises the QoS state to
drivers to only ever advertise it as "off" in
station mode, and make it a per-BSS setting.
Tested-by: Stanislaw Gruszka <sgruszka@redhat.com>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>
1658 lines
41 KiB
C
1658 lines
41 KiB
C
/*
|
|
* mac80211 configuration hooks for cfg80211
|
|
*
|
|
* Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
|
|
*
|
|
* This file is GPLv2 as found in COPYING.
|
|
*/
|
|
|
|
#include <linux/ieee80211.h>
|
|
#include <linux/nl80211.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <linux/slab.h>
|
|
#include <net/net_namespace.h>
|
|
#include <linux/rcupdate.h>
|
|
#include <net/cfg80211.h>
|
|
#include "ieee80211_i.h"
|
|
#include "driver-ops.h"
|
|
#include "cfg.h"
|
|
#include "rate.h"
|
|
#include "mesh.h"
|
|
|
|
static bool nl80211_type_check(enum nl80211_iftype type)
|
|
{
|
|
switch (type) {
|
|
case NL80211_IFTYPE_ADHOC:
|
|
case NL80211_IFTYPE_STATION:
|
|
case NL80211_IFTYPE_MONITOR:
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
case NL80211_IFTYPE_MESH_POINT:
|
|
#endif
|
|
case NL80211_IFTYPE_AP:
|
|
case NL80211_IFTYPE_AP_VLAN:
|
|
case NL80211_IFTYPE_WDS:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool nl80211_params_check(enum nl80211_iftype type,
|
|
struct vif_params *params)
|
|
{
|
|
if (!nl80211_type_check(type))
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
|
|
static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
|
|
enum nl80211_iftype type, u32 *flags,
|
|
struct vif_params *params)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct net_device *dev;
|
|
struct ieee80211_sub_if_data *sdata;
|
|
int err;
|
|
|
|
if (!nl80211_params_check(type, params))
|
|
return -EINVAL;
|
|
|
|
err = ieee80211_if_add(local, name, &dev, type, params);
|
|
if (err || type != NL80211_IFTYPE_MONITOR || !flags)
|
|
return err;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
sdata->u.mntr_flags = *flags;
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_del_iface(struct wiphy *wiphy, struct net_device *dev)
|
|
{
|
|
ieee80211_if_remove(IEEE80211_DEV_TO_SUB_IF(dev));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_change_iface(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
enum nl80211_iftype type, u32 *flags,
|
|
struct vif_params *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
int ret;
|
|
|
|
if (ieee80211_sdata_running(sdata))
|
|
return -EBUSY;
|
|
|
|
if (!nl80211_params_check(type, params))
|
|
return -EINVAL;
|
|
|
|
ret = ieee80211_if_change_type(sdata, type);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (ieee80211_vif_is_mesh(&sdata->vif) && params->mesh_id_len)
|
|
ieee80211_sdata_set_mesh_id(sdata,
|
|
params->mesh_id_len,
|
|
params->mesh_id);
|
|
|
|
if (type == NL80211_IFTYPE_AP_VLAN &&
|
|
params && params->use_4addr == 0)
|
|
rcu_assign_pointer(sdata->u.vlan.sta, NULL);
|
|
else if (type == NL80211_IFTYPE_STATION &&
|
|
params && params->use_4addr >= 0)
|
|
sdata->u.mgd.use_4addr = params->use_4addr;
|
|
|
|
if (sdata->vif.type == NL80211_IFTYPE_MONITOR && flags)
|
|
sdata->u.mntr_flags = *flags;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 key_idx, const u8 *mac_addr,
|
|
struct key_params *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct sta_info *sta = NULL;
|
|
enum ieee80211_key_alg alg;
|
|
struct ieee80211_key *key;
|
|
int err;
|
|
|
|
if (!netif_running(dev))
|
|
return -ENETDOWN;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
switch (params->cipher) {
|
|
case WLAN_CIPHER_SUITE_WEP40:
|
|
case WLAN_CIPHER_SUITE_WEP104:
|
|
alg = ALG_WEP;
|
|
break;
|
|
case WLAN_CIPHER_SUITE_TKIP:
|
|
alg = ALG_TKIP;
|
|
break;
|
|
case WLAN_CIPHER_SUITE_CCMP:
|
|
alg = ALG_CCMP;
|
|
break;
|
|
case WLAN_CIPHER_SUITE_AES_CMAC:
|
|
alg = ALG_AES_CMAC;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* reject WEP and TKIP keys if WEP failed to initialize */
|
|
if ((alg == ALG_WEP || alg == ALG_TKIP) &&
|
|
IS_ERR(sdata->local->wep_tx_tfm))
|
|
return -EINVAL;
|
|
|
|
key = ieee80211_key_alloc(alg, key_idx, params->key_len, params->key,
|
|
params->seq_len, params->seq);
|
|
if (!key)
|
|
return -ENOMEM;
|
|
|
|
mutex_lock(&sdata->local->sta_mtx);
|
|
|
|
if (mac_addr) {
|
|
sta = sta_info_get_bss(sdata, mac_addr);
|
|
if (!sta) {
|
|
ieee80211_key_free(key);
|
|
err = -ENOENT;
|
|
goto out_unlock;
|
|
}
|
|
}
|
|
|
|
ieee80211_key_link(key, sdata, sta);
|
|
|
|
err = 0;
|
|
out_unlock:
|
|
mutex_unlock(&sdata->local->sta_mtx);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 key_idx, const u8 *mac_addr)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct sta_info *sta;
|
|
int ret;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
mutex_lock(&sdata->local->sta_mtx);
|
|
|
|
if (mac_addr) {
|
|
ret = -ENOENT;
|
|
|
|
sta = sta_info_get_bss(sdata, mac_addr);
|
|
if (!sta)
|
|
goto out_unlock;
|
|
|
|
if (sta->key) {
|
|
ieee80211_key_free(sta->key);
|
|
WARN_ON(sta->key);
|
|
ret = 0;
|
|
}
|
|
|
|
goto out_unlock;
|
|
}
|
|
|
|
if (!sdata->keys[key_idx]) {
|
|
ret = -ENOENT;
|
|
goto out_unlock;
|
|
}
|
|
|
|
ieee80211_key_free(sdata->keys[key_idx]);
|
|
WARN_ON(sdata->keys[key_idx]);
|
|
|
|
ret = 0;
|
|
out_unlock:
|
|
mutex_unlock(&sdata->local->sta_mtx);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 key_idx, const u8 *mac_addr, void *cookie,
|
|
void (*callback)(void *cookie,
|
|
struct key_params *params))
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct sta_info *sta = NULL;
|
|
u8 seq[6] = {0};
|
|
struct key_params params;
|
|
struct ieee80211_key *key;
|
|
u32 iv32;
|
|
u16 iv16;
|
|
int err = -ENOENT;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
rcu_read_lock();
|
|
|
|
if (mac_addr) {
|
|
sta = sta_info_get_bss(sdata, mac_addr);
|
|
if (!sta)
|
|
goto out;
|
|
|
|
key = sta->key;
|
|
} else
|
|
key = sdata->keys[key_idx];
|
|
|
|
if (!key)
|
|
goto out;
|
|
|
|
memset(¶ms, 0, sizeof(params));
|
|
|
|
switch (key->conf.alg) {
|
|
case ALG_TKIP:
|
|
params.cipher = WLAN_CIPHER_SUITE_TKIP;
|
|
|
|
iv32 = key->u.tkip.tx.iv32;
|
|
iv16 = key->u.tkip.tx.iv16;
|
|
|
|
if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)
|
|
drv_get_tkip_seq(sdata->local,
|
|
key->conf.hw_key_idx,
|
|
&iv32, &iv16);
|
|
|
|
seq[0] = iv16 & 0xff;
|
|
seq[1] = (iv16 >> 8) & 0xff;
|
|
seq[2] = iv32 & 0xff;
|
|
seq[3] = (iv32 >> 8) & 0xff;
|
|
seq[4] = (iv32 >> 16) & 0xff;
|
|
seq[5] = (iv32 >> 24) & 0xff;
|
|
params.seq = seq;
|
|
params.seq_len = 6;
|
|
break;
|
|
case ALG_CCMP:
|
|
params.cipher = WLAN_CIPHER_SUITE_CCMP;
|
|
seq[0] = key->u.ccmp.tx_pn[5];
|
|
seq[1] = key->u.ccmp.tx_pn[4];
|
|
seq[2] = key->u.ccmp.tx_pn[3];
|
|
seq[3] = key->u.ccmp.tx_pn[2];
|
|
seq[4] = key->u.ccmp.tx_pn[1];
|
|
seq[5] = key->u.ccmp.tx_pn[0];
|
|
params.seq = seq;
|
|
params.seq_len = 6;
|
|
break;
|
|
case ALG_WEP:
|
|
if (key->conf.keylen == 5)
|
|
params.cipher = WLAN_CIPHER_SUITE_WEP40;
|
|
else
|
|
params.cipher = WLAN_CIPHER_SUITE_WEP104;
|
|
break;
|
|
case ALG_AES_CMAC:
|
|
params.cipher = WLAN_CIPHER_SUITE_AES_CMAC;
|
|
seq[0] = key->u.aes_cmac.tx_pn[5];
|
|
seq[1] = key->u.aes_cmac.tx_pn[4];
|
|
seq[2] = key->u.aes_cmac.tx_pn[3];
|
|
seq[3] = key->u.aes_cmac.tx_pn[2];
|
|
seq[4] = key->u.aes_cmac.tx_pn[1];
|
|
seq[5] = key->u.aes_cmac.tx_pn[0];
|
|
params.seq = seq;
|
|
params.seq_len = 6;
|
|
break;
|
|
}
|
|
|
|
params.key = key->conf.key;
|
|
params.key_len = key->conf.keylen;
|
|
|
|
callback(cookie, ¶ms);
|
|
err = 0;
|
|
|
|
out:
|
|
rcu_read_unlock();
|
|
return err;
|
|
}
|
|
|
|
static int ieee80211_config_default_key(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
u8 key_idx)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
ieee80211_set_default_key(sdata, key_idx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
u8 key_idx)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
|
|
rcu_read_lock();
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
ieee80211_set_default_mgmt_key(sdata, key_idx);
|
|
|
|
rcu_read_unlock();
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = sta->sdata;
|
|
|
|
sinfo->generation = sdata->local->sta_generation;
|
|
|
|
sinfo->filled = STATION_INFO_INACTIVE_TIME |
|
|
STATION_INFO_RX_BYTES |
|
|
STATION_INFO_TX_BYTES |
|
|
STATION_INFO_RX_PACKETS |
|
|
STATION_INFO_TX_PACKETS |
|
|
STATION_INFO_TX_BITRATE;
|
|
|
|
sinfo->inactive_time = jiffies_to_msecs(jiffies - sta->last_rx);
|
|
sinfo->rx_bytes = sta->rx_bytes;
|
|
sinfo->tx_bytes = sta->tx_bytes;
|
|
sinfo->rx_packets = sta->rx_packets;
|
|
sinfo->tx_packets = sta->tx_packets;
|
|
|
|
if ((sta->local->hw.flags & IEEE80211_HW_SIGNAL_DBM) ||
|
|
(sta->local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)) {
|
|
sinfo->filled |= STATION_INFO_SIGNAL;
|
|
sinfo->signal = (s8)sta->last_signal;
|
|
}
|
|
|
|
sinfo->txrate.flags = 0;
|
|
if (sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)
|
|
sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
|
|
if (sta->last_tx_rate.flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
|
|
sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
|
|
if (sta->last_tx_rate.flags & IEEE80211_TX_RC_SHORT_GI)
|
|
sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
|
|
|
|
if (!(sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)) {
|
|
struct ieee80211_supported_band *sband;
|
|
sband = sta->local->hw.wiphy->bands[
|
|
sta->local->hw.conf.channel->band];
|
|
sinfo->txrate.legacy =
|
|
sband->bitrates[sta->last_tx_rate.idx].bitrate;
|
|
} else
|
|
sinfo->txrate.mcs = sta->last_tx_rate.idx;
|
|
|
|
if (ieee80211_vif_is_mesh(&sdata->vif)) {
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
sinfo->filled |= STATION_INFO_LLID |
|
|
STATION_INFO_PLID |
|
|
STATION_INFO_PLINK_STATE;
|
|
|
|
sinfo->llid = le16_to_cpu(sta->llid);
|
|
sinfo->plid = le16_to_cpu(sta->plid);
|
|
sinfo->plink_state = sta->plink_state;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
|
|
static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
|
|
int idx, u8 *mac, struct station_info *sinfo)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct sta_info *sta;
|
|
int ret = -ENOENT;
|
|
|
|
rcu_read_lock();
|
|
|
|
sta = sta_info_get_by_idx(sdata, idx);
|
|
if (sta) {
|
|
ret = 0;
|
|
memcpy(mac, sta->sta.addr, ETH_ALEN);
|
|
sta_set_sinfo(sta, sinfo);
|
|
}
|
|
|
|
rcu_read_unlock();
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
|
|
int idx, struct survey_info *survey)
|
|
{
|
|
struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
|
|
|
|
return drv_get_survey(local, idx, survey);
|
|
}
|
|
|
|
static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *mac, struct station_info *sinfo)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct sta_info *sta;
|
|
int ret = -ENOENT;
|
|
|
|
rcu_read_lock();
|
|
|
|
sta = sta_info_get_bss(sdata, mac);
|
|
if (sta) {
|
|
ret = 0;
|
|
sta_set_sinfo(sta, sinfo);
|
|
}
|
|
|
|
rcu_read_unlock();
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* This handles both adding a beacon and setting new beacon info
|
|
*/
|
|
static int ieee80211_config_beacon(struct ieee80211_sub_if_data *sdata,
|
|
struct beacon_parameters *params)
|
|
{
|
|
struct beacon_data *new, *old;
|
|
int new_head_len, new_tail_len;
|
|
int size;
|
|
int err = -EINVAL;
|
|
|
|
old = sdata->u.ap.beacon;
|
|
|
|
/* head must not be zero-length */
|
|
if (params->head && !params->head_len)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* This is a kludge. beacon interval should really be part
|
|
* of the beacon information.
|
|
*/
|
|
if (params->interval &&
|
|
(sdata->vif.bss_conf.beacon_int != params->interval)) {
|
|
sdata->vif.bss_conf.beacon_int = params->interval;
|
|
ieee80211_bss_info_change_notify(sdata,
|
|
BSS_CHANGED_BEACON_INT);
|
|
}
|
|
|
|
/* Need to have a beacon head if we don't have one yet */
|
|
if (!params->head && !old)
|
|
return err;
|
|
|
|
/* sorry, no way to start beaconing without dtim period */
|
|
if (!params->dtim_period && !old)
|
|
return err;
|
|
|
|
/* new or old head? */
|
|
if (params->head)
|
|
new_head_len = params->head_len;
|
|
else
|
|
new_head_len = old->head_len;
|
|
|
|
/* new or old tail? */
|
|
if (params->tail || !old)
|
|
/* params->tail_len will be zero for !params->tail */
|
|
new_tail_len = params->tail_len;
|
|
else
|
|
new_tail_len = old->tail_len;
|
|
|
|
size = sizeof(*new) + new_head_len + new_tail_len;
|
|
|
|
new = kzalloc(size, GFP_KERNEL);
|
|
if (!new)
|
|
return -ENOMEM;
|
|
|
|
/* start filling the new info now */
|
|
|
|
/* new or old dtim period? */
|
|
if (params->dtim_period)
|
|
new->dtim_period = params->dtim_period;
|
|
else
|
|
new->dtim_period = old->dtim_period;
|
|
|
|
/*
|
|
* pointers go into the block we allocated,
|
|
* memory is | beacon_data | head | tail |
|
|
*/
|
|
new->head = ((u8 *) new) + sizeof(*new);
|
|
new->tail = new->head + new_head_len;
|
|
new->head_len = new_head_len;
|
|
new->tail_len = new_tail_len;
|
|
|
|
/* copy in head */
|
|
if (params->head)
|
|
memcpy(new->head, params->head, new_head_len);
|
|
else
|
|
memcpy(new->head, old->head, new_head_len);
|
|
|
|
/* copy in optional tail */
|
|
if (params->tail)
|
|
memcpy(new->tail, params->tail, new_tail_len);
|
|
else
|
|
if (old)
|
|
memcpy(new->tail, old->tail, new_tail_len);
|
|
|
|
sdata->vif.bss_conf.dtim_period = new->dtim_period;
|
|
|
|
rcu_assign_pointer(sdata->u.ap.beacon, new);
|
|
|
|
synchronize_rcu();
|
|
|
|
kfree(old);
|
|
|
|
ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
|
|
BSS_CHANGED_BEACON);
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_add_beacon(struct wiphy *wiphy, struct net_device *dev,
|
|
struct beacon_parameters *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct beacon_data *old;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
old = sdata->u.ap.beacon;
|
|
|
|
if (old)
|
|
return -EALREADY;
|
|
|
|
return ieee80211_config_beacon(sdata, params);
|
|
}
|
|
|
|
static int ieee80211_set_beacon(struct wiphy *wiphy, struct net_device *dev,
|
|
struct beacon_parameters *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct beacon_data *old;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
old = sdata->u.ap.beacon;
|
|
|
|
if (!old)
|
|
return -ENOENT;
|
|
|
|
return ieee80211_config_beacon(sdata, params);
|
|
}
|
|
|
|
static int ieee80211_del_beacon(struct wiphy *wiphy, struct net_device *dev)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct beacon_data *old;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
old = sdata->u.ap.beacon;
|
|
|
|
if (!old)
|
|
return -ENOENT;
|
|
|
|
rcu_assign_pointer(sdata->u.ap.beacon, NULL);
|
|
synchronize_rcu();
|
|
kfree(old);
|
|
|
|
ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
|
|
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 sta_info *sta)
|
|
{
|
|
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, sta->sta.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 = sta->sdata->dev;
|
|
skb->protocol = eth_type_trans(skb, sta->sdata->dev);
|
|
memset(skb->cb, 0, sizeof(skb->cb));
|
|
netif_rx(skb);
|
|
}
|
|
|
|
static void sta_apply_parameters(struct ieee80211_local *local,
|
|
struct sta_info *sta,
|
|
struct station_parameters *params)
|
|
{
|
|
u32 rates;
|
|
int i, j;
|
|
struct ieee80211_supported_band *sband;
|
|
struct ieee80211_sub_if_data *sdata = sta->sdata;
|
|
u32 mask, set;
|
|
|
|
sband = local->hw.wiphy->bands[local->oper_channel->band];
|
|
|
|
spin_lock_bh(&sta->lock);
|
|
mask = params->sta_flags_mask;
|
|
set = params->sta_flags_set;
|
|
|
|
if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
|
|
sta->flags &= ~WLAN_STA_AUTHORIZED;
|
|
if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
|
|
sta->flags |= WLAN_STA_AUTHORIZED;
|
|
}
|
|
|
|
if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
|
|
sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
|
|
if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
|
|
sta->flags |= WLAN_STA_SHORT_PREAMBLE;
|
|
}
|
|
|
|
if (mask & BIT(NL80211_STA_FLAG_WME)) {
|
|
sta->flags &= ~WLAN_STA_WME;
|
|
if (set & BIT(NL80211_STA_FLAG_WME))
|
|
sta->flags |= WLAN_STA_WME;
|
|
}
|
|
|
|
if (mask & BIT(NL80211_STA_FLAG_MFP)) {
|
|
sta->flags &= ~WLAN_STA_MFP;
|
|
if (set & BIT(NL80211_STA_FLAG_MFP))
|
|
sta->flags |= WLAN_STA_MFP;
|
|
}
|
|
spin_unlock_bh(&sta->lock);
|
|
|
|
/*
|
|
* cfg80211 validates this (1-2007) and allows setting the AID
|
|
* only when creating a new station entry
|
|
*/
|
|
if (params->aid)
|
|
sta->sta.aid = params->aid;
|
|
|
|
/*
|
|
* FIXME: updating the following information is racy when this
|
|
* function is called from ieee80211_change_station().
|
|
* However, all this information should be static so
|
|
* maybe we should just reject attemps to change it.
|
|
*/
|
|
|
|
if (params->listen_interval >= 0)
|
|
sta->listen_interval = params->listen_interval;
|
|
|
|
if (params->supported_rates) {
|
|
rates = 0;
|
|
|
|
for (i = 0; i < params->supported_rates_len; i++) {
|
|
int rate = (params->supported_rates[i] & 0x7f) * 5;
|
|
for (j = 0; j < sband->n_bitrates; j++) {
|
|
if (sband->bitrates[j].bitrate == rate)
|
|
rates |= BIT(j);
|
|
}
|
|
}
|
|
sta->sta.supp_rates[local->oper_channel->band] = rates;
|
|
}
|
|
|
|
if (params->ht_capa)
|
|
ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
|
|
params->ht_capa,
|
|
&sta->sta.ht_cap);
|
|
|
|
if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
|
|
switch (params->plink_action) {
|
|
case PLINK_ACTION_OPEN:
|
|
mesh_plink_open(sta);
|
|
break;
|
|
case PLINK_ACTION_BLOCK:
|
|
mesh_plink_block(sta);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *mac, struct station_parameters *params)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct sta_info *sta;
|
|
struct ieee80211_sub_if_data *sdata;
|
|
int err;
|
|
int layer2_update;
|
|
|
|
if (params->vlan) {
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
|
|
|
|
if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
|
|
sdata->vif.type != NL80211_IFTYPE_AP)
|
|
return -EINVAL;
|
|
} else
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
if (compare_ether_addr(mac, sdata->vif.addr) == 0)
|
|
return -EINVAL;
|
|
|
|
if (is_multicast_ether_addr(mac))
|
|
return -EINVAL;
|
|
|
|
sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
|
|
if (!sta)
|
|
return -ENOMEM;
|
|
|
|
sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;
|
|
|
|
sta_apply_parameters(local, sta, params);
|
|
|
|
rate_control_rate_init(sta);
|
|
|
|
layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
|
|
sdata->vif.type == NL80211_IFTYPE_AP;
|
|
|
|
err = sta_info_insert_rcu(sta);
|
|
if (err) {
|
|
rcu_read_unlock();
|
|
return err;
|
|
}
|
|
|
|
if (layer2_update)
|
|
ieee80211_send_layer2_update(sta);
|
|
|
|
rcu_read_unlock();
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *mac)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_sub_if_data *sdata;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
if (mac)
|
|
return sta_info_destroy_addr_bss(sdata, mac);
|
|
|
|
sta_info_flush(local, sdata);
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_change_station(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
u8 *mac,
|
|
struct station_parameters *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct sta_info *sta;
|
|
struct ieee80211_sub_if_data *vlansdata;
|
|
|
|
rcu_read_lock();
|
|
|
|
sta = sta_info_get_bss(sdata, mac);
|
|
if (!sta) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
|
|
if (params->vlan && params->vlan != sta->sdata->dev) {
|
|
vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
|
|
|
|
if (vlansdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
|
|
vlansdata->vif.type != NL80211_IFTYPE_AP) {
|
|
rcu_read_unlock();
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (params->vlan->ieee80211_ptr->use_4addr) {
|
|
if (vlansdata->u.vlan.sta) {
|
|
rcu_read_unlock();
|
|
return -EBUSY;
|
|
}
|
|
|
|
rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
|
|
}
|
|
|
|
sta->sdata = vlansdata;
|
|
ieee80211_send_layer2_update(sta);
|
|
}
|
|
|
|
sta_apply_parameters(local, sta, params);
|
|
|
|
rcu_read_unlock();
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *dst, u8 *next_hop)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct mesh_path *mpath;
|
|
struct sta_info *sta;
|
|
int err;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
rcu_read_lock();
|
|
sta = sta_info_get(sdata, next_hop);
|
|
if (!sta) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
|
|
err = mesh_path_add(dst, sdata);
|
|
if (err) {
|
|
rcu_read_unlock();
|
|
return err;
|
|
}
|
|
|
|
mpath = mesh_path_lookup(dst, sdata);
|
|
if (!mpath) {
|
|
rcu_read_unlock();
|
|
return -ENXIO;
|
|
}
|
|
mesh_path_fix_nexthop(mpath, sta);
|
|
|
|
rcu_read_unlock();
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *dst)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
if (dst)
|
|
return mesh_path_del(dst, sdata);
|
|
|
|
mesh_path_flush(sdata);
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_change_mpath(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
u8 *dst, u8 *next_hop)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct mesh_path *mpath;
|
|
struct sta_info *sta;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
rcu_read_lock();
|
|
|
|
sta = sta_info_get(sdata, next_hop);
|
|
if (!sta) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
|
|
mpath = mesh_path_lookup(dst, sdata);
|
|
if (!mpath) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
|
|
mesh_path_fix_nexthop(mpath, sta);
|
|
|
|
rcu_read_unlock();
|
|
return 0;
|
|
}
|
|
|
|
static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
|
|
struct mpath_info *pinfo)
|
|
{
|
|
if (mpath->next_hop)
|
|
memcpy(next_hop, mpath->next_hop->sta.addr, ETH_ALEN);
|
|
else
|
|
memset(next_hop, 0, ETH_ALEN);
|
|
|
|
pinfo->generation = mesh_paths_generation;
|
|
|
|
pinfo->filled = MPATH_INFO_FRAME_QLEN |
|
|
MPATH_INFO_SN |
|
|
MPATH_INFO_METRIC |
|
|
MPATH_INFO_EXPTIME |
|
|
MPATH_INFO_DISCOVERY_TIMEOUT |
|
|
MPATH_INFO_DISCOVERY_RETRIES |
|
|
MPATH_INFO_FLAGS;
|
|
|
|
pinfo->frame_qlen = mpath->frame_queue.qlen;
|
|
pinfo->sn = mpath->sn;
|
|
pinfo->metric = mpath->metric;
|
|
if (time_before(jiffies, mpath->exp_time))
|
|
pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
|
|
pinfo->discovery_timeout =
|
|
jiffies_to_msecs(mpath->discovery_timeout);
|
|
pinfo->discovery_retries = mpath->discovery_retries;
|
|
pinfo->flags = 0;
|
|
if (mpath->flags & MESH_PATH_ACTIVE)
|
|
pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
|
|
if (mpath->flags & MESH_PATH_RESOLVING)
|
|
pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
|
|
if (mpath->flags & MESH_PATH_SN_VALID)
|
|
pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
|
|
if (mpath->flags & MESH_PATH_FIXED)
|
|
pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
|
|
if (mpath->flags & MESH_PATH_RESOLVING)
|
|
pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
|
|
|
|
pinfo->flags = mpath->flags;
|
|
}
|
|
|
|
static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
|
|
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct mesh_path *mpath;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
rcu_read_lock();
|
|
mpath = mesh_path_lookup(dst, sdata);
|
|
if (!mpath) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
memcpy(dst, mpath->dst, ETH_ALEN);
|
|
mpath_set_pinfo(mpath, next_hop, pinfo);
|
|
rcu_read_unlock();
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
|
|
int idx, u8 *dst, u8 *next_hop,
|
|
struct mpath_info *pinfo)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct mesh_path *mpath;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
rcu_read_lock();
|
|
mpath = mesh_path_lookup_by_idx(idx, sdata);
|
|
if (!mpath) {
|
|
rcu_read_unlock();
|
|
return -ENOENT;
|
|
}
|
|
memcpy(dst, mpath->dst, ETH_ALEN);
|
|
mpath_set_pinfo(mpath, next_hop, pinfo);
|
|
rcu_read_unlock();
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_get_mesh_params(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
struct mesh_config *conf)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config));
|
|
return 0;
|
|
}
|
|
|
|
static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask)
|
|
{
|
|
return (mask >> (parm-1)) & 0x1;
|
|
}
|
|
|
|
static int ieee80211_set_mesh_params(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
const struct mesh_config *nconf, u32 mask)
|
|
{
|
|
struct mesh_config *conf;
|
|
struct ieee80211_sub_if_data *sdata;
|
|
struct ieee80211_if_mesh *ifmsh;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
ifmsh = &sdata->u.mesh;
|
|
|
|
/* Set the config options which we are interested in setting */
|
|
conf = &(sdata->u.mesh.mshcfg);
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask))
|
|
conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask))
|
|
conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask))
|
|
conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask))
|
|
conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask))
|
|
conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask))
|
|
conf->dot11MeshTTL = nconf->dot11MeshTTL;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask))
|
|
conf->auto_open_plinks = nconf->auto_open_plinks;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask))
|
|
conf->dot11MeshHWMPmaxPREQretries =
|
|
nconf->dot11MeshHWMPmaxPREQretries;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask))
|
|
conf->path_refresh_time = nconf->path_refresh_time;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask))
|
|
conf->min_discovery_timeout = nconf->min_discovery_timeout;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask))
|
|
conf->dot11MeshHWMPactivePathTimeout =
|
|
nconf->dot11MeshHWMPactivePathTimeout;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask))
|
|
conf->dot11MeshHWMPpreqMinInterval =
|
|
nconf->dot11MeshHWMPpreqMinInterval;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
|
|
mask))
|
|
conf->dot11MeshHWMPnetDiameterTraversalTime =
|
|
nconf->dot11MeshHWMPnetDiameterTraversalTime;
|
|
if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
|
|
conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
|
|
ieee80211_mesh_root_setup(ifmsh);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#endif
|
|
|
|
static int ieee80211_change_bss(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
struct bss_parameters *params)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
u32 changed = 0;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
if (params->use_cts_prot >= 0) {
|
|
sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
|
|
changed |= BSS_CHANGED_ERP_CTS_PROT;
|
|
}
|
|
if (params->use_short_preamble >= 0) {
|
|
sdata->vif.bss_conf.use_short_preamble =
|
|
params->use_short_preamble;
|
|
changed |= BSS_CHANGED_ERP_PREAMBLE;
|
|
}
|
|
|
|
if (!sdata->vif.bss_conf.use_short_slot &&
|
|
sdata->local->hw.conf.channel->band == IEEE80211_BAND_5GHZ) {
|
|
sdata->vif.bss_conf.use_short_slot = true;
|
|
changed |= BSS_CHANGED_ERP_SLOT;
|
|
}
|
|
|
|
if (params->use_short_slot_time >= 0) {
|
|
sdata->vif.bss_conf.use_short_slot =
|
|
params->use_short_slot_time;
|
|
changed |= BSS_CHANGED_ERP_SLOT;
|
|
}
|
|
|
|
if (params->basic_rates) {
|
|
int i, j;
|
|
u32 rates = 0;
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_supported_band *sband =
|
|
wiphy->bands[local->oper_channel->band];
|
|
|
|
for (i = 0; i < params->basic_rates_len; i++) {
|
|
int rate = (params->basic_rates[i] & 0x7f) * 5;
|
|
for (j = 0; j < sband->n_bitrates; j++) {
|
|
if (sband->bitrates[j].bitrate == rate)
|
|
rates |= BIT(j);
|
|
}
|
|
}
|
|
sdata->vif.bss_conf.basic_rates = rates;
|
|
changed |= BSS_CHANGED_BASIC_RATES;
|
|
}
|
|
|
|
if (params->ap_isolate >= 0) {
|
|
if (params->ap_isolate)
|
|
sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
|
|
else
|
|
sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
|
|
}
|
|
|
|
ieee80211_bss_info_change_notify(sdata, changed);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_txq_params(struct wiphy *wiphy,
|
|
struct ieee80211_txq_params *params)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_tx_queue_params p;
|
|
|
|
if (!local->ops->conf_tx)
|
|
return -EOPNOTSUPP;
|
|
|
|
memset(&p, 0, sizeof(p));
|
|
p.aifs = params->aifs;
|
|
p.cw_max = params->cwmax;
|
|
p.cw_min = params->cwmin;
|
|
p.txop = params->txop;
|
|
|
|
/*
|
|
* Setting tx queue params disables u-apsd because it's only
|
|
* called in master mode.
|
|
*/
|
|
p.uapsd = false;
|
|
|
|
if (drv_conf_tx(local, params->queue, &p)) {
|
|
printk(KERN_DEBUG "%s: failed to set TX queue "
|
|
"parameters for queue %d\n",
|
|
wiphy_name(local->hw.wiphy), params->queue);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_channel(struct wiphy *wiphy,
|
|
struct net_device *netdev,
|
|
struct ieee80211_channel *chan,
|
|
enum nl80211_channel_type channel_type)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_sub_if_data *sdata = NULL;
|
|
|
|
if (netdev)
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(netdev);
|
|
|
|
switch (ieee80211_get_channel_mode(local, NULL)) {
|
|
case CHAN_MODE_HOPPING:
|
|
return -EBUSY;
|
|
case CHAN_MODE_FIXED:
|
|
if (local->oper_channel != chan)
|
|
return -EBUSY;
|
|
if (!sdata && local->_oper_channel_type == channel_type)
|
|
return 0;
|
|
break;
|
|
case CHAN_MODE_UNDEFINED:
|
|
break;
|
|
}
|
|
|
|
local->oper_channel = chan;
|
|
|
|
if (!ieee80211_set_channel_type(local, sdata, channel_type))
|
|
return -EBUSY;
|
|
|
|
ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
|
|
if (sdata && sdata->vif.type != NL80211_IFTYPE_MONITOR)
|
|
ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_HT);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int ieee80211_suspend(struct wiphy *wiphy)
|
|
{
|
|
return __ieee80211_suspend(wiphy_priv(wiphy));
|
|
}
|
|
|
|
static int ieee80211_resume(struct wiphy *wiphy)
|
|
{
|
|
return __ieee80211_resume(wiphy_priv(wiphy));
|
|
}
|
|
#else
|
|
#define ieee80211_suspend NULL
|
|
#define ieee80211_resume NULL
|
|
#endif
|
|
|
|
static int ieee80211_scan(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
struct cfg80211_scan_request *req)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata;
|
|
|
|
sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
if (sdata->vif.type != NL80211_IFTYPE_STATION &&
|
|
sdata->vif.type != NL80211_IFTYPE_ADHOC &&
|
|
sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
|
|
(sdata->vif.type != NL80211_IFTYPE_AP || sdata->u.ap.beacon))
|
|
return -EOPNOTSUPP;
|
|
|
|
return ieee80211_request_scan(sdata, req);
|
|
}
|
|
|
|
static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
|
|
struct cfg80211_auth_request *req)
|
|
{
|
|
return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
|
|
}
|
|
|
|
static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
|
|
struct cfg80211_assoc_request *req)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
switch (ieee80211_get_channel_mode(local, sdata)) {
|
|
case CHAN_MODE_HOPPING:
|
|
return -EBUSY;
|
|
case CHAN_MODE_FIXED:
|
|
if (local->oper_channel == req->bss->channel)
|
|
break;
|
|
return -EBUSY;
|
|
case CHAN_MODE_UNDEFINED:
|
|
break;
|
|
}
|
|
|
|
return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
|
|
}
|
|
|
|
static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
|
|
struct cfg80211_deauth_request *req,
|
|
void *cookie)
|
|
{
|
|
return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev),
|
|
req, cookie);
|
|
}
|
|
|
|
static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
|
|
struct cfg80211_disassoc_request *req,
|
|
void *cookie)
|
|
{
|
|
return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev),
|
|
req, cookie);
|
|
}
|
|
|
|
static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
|
|
struct cfg80211_ibss_params *params)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
switch (ieee80211_get_channel_mode(local, sdata)) {
|
|
case CHAN_MODE_HOPPING:
|
|
return -EBUSY;
|
|
case CHAN_MODE_FIXED:
|
|
if (!params->channel_fixed)
|
|
return -EBUSY;
|
|
if (local->oper_channel == params->channel)
|
|
break;
|
|
return -EBUSY;
|
|
case CHAN_MODE_UNDEFINED:
|
|
break;
|
|
}
|
|
|
|
return ieee80211_ibss_join(sdata, params);
|
|
}
|
|
|
|
static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
return ieee80211_ibss_leave(sdata);
|
|
}
|
|
|
|
static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
int err;
|
|
|
|
if (changed & WIPHY_PARAM_COVERAGE_CLASS) {
|
|
err = drv_set_coverage_class(local, wiphy->coverage_class);
|
|
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
|
|
err = drv_set_rts_threshold(local, wiphy->rts_threshold);
|
|
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (changed & WIPHY_PARAM_RETRY_SHORT)
|
|
local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
|
|
if (changed & WIPHY_PARAM_RETRY_LONG)
|
|
local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
|
|
if (changed &
|
|
(WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
|
|
ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_tx_power(struct wiphy *wiphy,
|
|
enum nl80211_tx_power_setting type, int mbm)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
struct ieee80211_channel *chan = local->hw.conf.channel;
|
|
u32 changes = 0;
|
|
|
|
switch (type) {
|
|
case NL80211_TX_POWER_AUTOMATIC:
|
|
local->user_power_level = -1;
|
|
break;
|
|
case NL80211_TX_POWER_LIMITED:
|
|
if (mbm < 0 || (mbm % 100))
|
|
return -EOPNOTSUPP;
|
|
local->user_power_level = MBM_TO_DBM(mbm);
|
|
break;
|
|
case NL80211_TX_POWER_FIXED:
|
|
if (mbm < 0 || (mbm % 100))
|
|
return -EOPNOTSUPP;
|
|
/* TODO: move to cfg80211 when it knows the channel */
|
|
if (MBM_TO_DBM(mbm) > chan->max_power)
|
|
return -EINVAL;
|
|
local->user_power_level = MBM_TO_DBM(mbm);
|
|
break;
|
|
}
|
|
|
|
ieee80211_hw_config(local, changes);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_get_tx_power(struct wiphy *wiphy, int *dbm)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
|
|
*dbm = local->hw.conf.power_level;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
|
|
u8 *addr)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
memcpy(&sdata->u.wds.remote_addr, addr, ETH_ALEN);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ieee80211_rfkill_poll(struct wiphy *wiphy)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
|
|
drv_rfkill_poll(local);
|
|
}
|
|
|
|
#ifdef CONFIG_NL80211_TESTMODE
|
|
static int ieee80211_testmode_cmd(struct wiphy *wiphy, void *data, int len)
|
|
{
|
|
struct ieee80211_local *local = wiphy_priv(wiphy);
|
|
|
|
if (!local->ops->testmode_cmd)
|
|
return -EOPNOTSUPP;
|
|
|
|
return local->ops->testmode_cmd(&local->hw, data, len);
|
|
}
|
|
#endif
|
|
|
|
int __ieee80211_request_smps(struct ieee80211_sub_if_data *sdata,
|
|
enum ieee80211_smps_mode smps_mode)
|
|
{
|
|
const u8 *ap;
|
|
enum ieee80211_smps_mode old_req;
|
|
int err;
|
|
|
|
old_req = sdata->u.mgd.req_smps;
|
|
sdata->u.mgd.req_smps = smps_mode;
|
|
|
|
if (old_req == smps_mode &&
|
|
smps_mode != IEEE80211_SMPS_AUTOMATIC)
|
|
return 0;
|
|
|
|
/*
|
|
* If not associated, or current association is not an HT
|
|
* association, there's no need to send an action frame.
|
|
*/
|
|
if (!sdata->u.mgd.associated ||
|
|
sdata->vif.bss_conf.channel_type == NL80211_CHAN_NO_HT) {
|
|
mutex_lock(&sdata->local->iflist_mtx);
|
|
ieee80211_recalc_smps(sdata->local, sdata);
|
|
mutex_unlock(&sdata->local->iflist_mtx);
|
|
return 0;
|
|
}
|
|
|
|
ap = sdata->u.mgd.associated->bssid;
|
|
|
|
if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
|
|
if (sdata->u.mgd.powersave)
|
|
smps_mode = IEEE80211_SMPS_DYNAMIC;
|
|
else
|
|
smps_mode = IEEE80211_SMPS_OFF;
|
|
}
|
|
|
|
/* send SM PS frame to AP */
|
|
err = ieee80211_send_smps_action(sdata, smps_mode,
|
|
ap, ap);
|
|
if (err)
|
|
sdata->u.mgd.req_smps = old_req;
|
|
|
|
return err;
|
|
}
|
|
|
|
static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
|
|
bool enabled, int timeout)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
|
|
|
|
if (sdata->vif.type != NL80211_IFTYPE_STATION)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS))
|
|
return -EOPNOTSUPP;
|
|
|
|
if (enabled == sdata->u.mgd.powersave &&
|
|
timeout == local->dynamic_ps_forced_timeout)
|
|
return 0;
|
|
|
|
sdata->u.mgd.powersave = enabled;
|
|
local->dynamic_ps_forced_timeout = timeout;
|
|
|
|
/* no change, but if automatic follow powersave */
|
|
mutex_lock(&sdata->u.mgd.mtx);
|
|
__ieee80211_request_smps(sdata, sdata->u.mgd.req_smps);
|
|
mutex_unlock(&sdata->u.mgd.mtx);
|
|
|
|
if (local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)
|
|
ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
|
|
|
|
ieee80211_recalc_ps(local, -1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
s32 rssi_thold, u32 rssi_hyst)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
|
|
struct ieee80211_vif *vif = &sdata->vif;
|
|
struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
|
|
|
|
if (rssi_thold == bss_conf->cqm_rssi_thold &&
|
|
rssi_hyst == bss_conf->cqm_rssi_hyst)
|
|
return 0;
|
|
|
|
bss_conf->cqm_rssi_thold = rssi_thold;
|
|
bss_conf->cqm_rssi_hyst = rssi_hyst;
|
|
|
|
if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_CQM_RSSI)) {
|
|
if (sdata->vif.type != NL80211_IFTYPE_STATION)
|
|
return -EOPNOTSUPP;
|
|
return 0;
|
|
}
|
|
|
|
/* tell the driver upon association, unless already associated */
|
|
if (sdata->u.mgd.associated)
|
|
ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_set_bitrate_mask(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
const u8 *addr,
|
|
const struct cfg80211_bitrate_mask *mask)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
|
|
int i;
|
|
|
|
/*
|
|
* This _could_ be supported by providing a hook for
|
|
* drivers for this function, but at this point it
|
|
* doesn't seem worth bothering.
|
|
*/
|
|
if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL)
|
|
return -EOPNOTSUPP;
|
|
|
|
|
|
for (i = 0; i < IEEE80211_NUM_BANDS; i++)
|
|
sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ieee80211_remain_on_channel(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
struct ieee80211_channel *chan,
|
|
enum nl80211_channel_type channel_type,
|
|
unsigned int duration,
|
|
u64 *cookie)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
return ieee80211_wk_remain_on_channel(sdata, chan, channel_type,
|
|
duration, cookie);
|
|
}
|
|
|
|
static int ieee80211_cancel_remain_on_channel(struct wiphy *wiphy,
|
|
struct net_device *dev,
|
|
u64 cookie)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
|
|
return ieee80211_wk_cancel_remain_on_channel(sdata, cookie);
|
|
}
|
|
|
|
static int ieee80211_action(struct wiphy *wiphy, struct net_device *dev,
|
|
struct ieee80211_channel *chan,
|
|
enum nl80211_channel_type channel_type,
|
|
bool channel_type_valid,
|
|
const u8 *buf, size_t len, u64 *cookie)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = sdata->local;
|
|
struct sk_buff *skb;
|
|
struct sta_info *sta;
|
|
const struct ieee80211_mgmt *mgmt = (void *)buf;
|
|
u32 flags = IEEE80211_TX_INTFL_NL80211_FRAME_TX |
|
|
IEEE80211_TX_CTL_REQ_TX_STATUS;
|
|
|
|
/* Check that we are on the requested channel for transmission */
|
|
if (chan != local->tmp_channel &&
|
|
chan != local->oper_channel)
|
|
return -EBUSY;
|
|
if (channel_type_valid &&
|
|
(channel_type != local->tmp_channel_type &&
|
|
channel_type != local->_oper_channel_type))
|
|
return -EBUSY;
|
|
|
|
switch (sdata->vif.type) {
|
|
case NL80211_IFTYPE_ADHOC:
|
|
if (mgmt->u.action.category == WLAN_CATEGORY_PUBLIC)
|
|
break;
|
|
rcu_read_lock();
|
|
sta = sta_info_get(sdata, mgmt->da);
|
|
rcu_read_unlock();
|
|
if (!sta)
|
|
return -ENOLINK;
|
|
break;
|
|
case NL80211_IFTYPE_STATION:
|
|
if (!(sdata->u.mgd.flags & IEEE80211_STA_MFP_ENABLED))
|
|
flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
|
|
break;
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
skb = dev_alloc_skb(local->hw.extra_tx_headroom + len);
|
|
if (!skb)
|
|
return -ENOMEM;
|
|
skb_reserve(skb, local->hw.extra_tx_headroom);
|
|
|
|
memcpy(skb_put(skb, len), buf, len);
|
|
|
|
IEEE80211_SKB_CB(skb)->flags = flags;
|
|
|
|
skb->dev = sdata->dev;
|
|
ieee80211_tx_skb(sdata, skb);
|
|
|
|
*cookie = (unsigned long) skb;
|
|
return 0;
|
|
}
|
|
|
|
struct cfg80211_ops mac80211_config_ops = {
|
|
.add_virtual_intf = ieee80211_add_iface,
|
|
.del_virtual_intf = ieee80211_del_iface,
|
|
.change_virtual_intf = ieee80211_change_iface,
|
|
.add_key = ieee80211_add_key,
|
|
.del_key = ieee80211_del_key,
|
|
.get_key = ieee80211_get_key,
|
|
.set_default_key = ieee80211_config_default_key,
|
|
.set_default_mgmt_key = ieee80211_config_default_mgmt_key,
|
|
.add_beacon = ieee80211_add_beacon,
|
|
.set_beacon = ieee80211_set_beacon,
|
|
.del_beacon = ieee80211_del_beacon,
|
|
.add_station = ieee80211_add_station,
|
|
.del_station = ieee80211_del_station,
|
|
.change_station = ieee80211_change_station,
|
|
.get_station = ieee80211_get_station,
|
|
.dump_station = ieee80211_dump_station,
|
|
.dump_survey = ieee80211_dump_survey,
|
|
#ifdef CONFIG_MAC80211_MESH
|
|
.add_mpath = ieee80211_add_mpath,
|
|
.del_mpath = ieee80211_del_mpath,
|
|
.change_mpath = ieee80211_change_mpath,
|
|
.get_mpath = ieee80211_get_mpath,
|
|
.dump_mpath = ieee80211_dump_mpath,
|
|
.set_mesh_params = ieee80211_set_mesh_params,
|
|
.get_mesh_params = ieee80211_get_mesh_params,
|
|
#endif
|
|
.change_bss = ieee80211_change_bss,
|
|
.set_txq_params = ieee80211_set_txq_params,
|
|
.set_channel = ieee80211_set_channel,
|
|
.suspend = ieee80211_suspend,
|
|
.resume = ieee80211_resume,
|
|
.scan = ieee80211_scan,
|
|
.auth = ieee80211_auth,
|
|
.assoc = ieee80211_assoc,
|
|
.deauth = ieee80211_deauth,
|
|
.disassoc = ieee80211_disassoc,
|
|
.join_ibss = ieee80211_join_ibss,
|
|
.leave_ibss = ieee80211_leave_ibss,
|
|
.set_wiphy_params = ieee80211_set_wiphy_params,
|
|
.set_tx_power = ieee80211_set_tx_power,
|
|
.get_tx_power = ieee80211_get_tx_power,
|
|
.set_wds_peer = ieee80211_set_wds_peer,
|
|
.rfkill_poll = ieee80211_rfkill_poll,
|
|
CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
|
|
.set_power_mgmt = ieee80211_set_power_mgmt,
|
|
.set_bitrate_mask = ieee80211_set_bitrate_mask,
|
|
.remain_on_channel = ieee80211_remain_on_channel,
|
|
.cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
|
|
.action = ieee80211_action,
|
|
.set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
|
|
};
|