48a77bb98b
SVN-Revision: 28711
797 lines
25 KiB
Diff
797 lines
25 KiB
Diff
--- a/drivers/net/wireless/ath/ath9k/ar9003_calib.c
|
|
+++ b/drivers/net/wireless/ath/ath9k/ar9003_calib.c
|
|
@@ -908,12 +908,15 @@ static bool ar9003_hw_rtt_restore(struct
|
|
int i;
|
|
bool restore;
|
|
|
|
- if (!(ah->caps.hw_caps & ATH9K_HW_CAP_RTT) || !ah->caldata)
|
|
+ if (!ah->caldata)
|
|
return false;
|
|
|
|
hist = &ah->caldata->rtt_hist;
|
|
+ if (!hist->num_readings)
|
|
+ return false;
|
|
+
|
|
ar9003_hw_rtt_enable(ah);
|
|
- ar9003_hw_rtt_set_mask(ah, 0x10);
|
|
+ ar9003_hw_rtt_set_mask(ah, 0x00);
|
|
for (i = 0; i < AR9300_MAX_CHAINS; i++) {
|
|
if (!(ah->rxchainmask & (1 << i)))
|
|
continue;
|
|
@@ -1070,6 +1073,7 @@ skip_tx_iqcal:
|
|
if (is_reusable && (hist->num_readings < RTT_HIST_MAX)) {
|
|
u32 *table;
|
|
|
|
+ hist->num_readings++;
|
|
for (i = 0; i < AR9300_MAX_CHAINS; i++) {
|
|
if (!(ah->rxchainmask & (1 << i)))
|
|
continue;
|
|
--- a/drivers/net/wireless/ath/ath9k/ar9003_phy.h
|
|
+++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.h
|
|
@@ -572,14 +572,14 @@
|
|
|
|
#define AR_PHY_TXGAIN_TABLE (AR_SM_BASE + 0x300)
|
|
|
|
-#define AR_PHY_TX_IQCAL_CONTROL_0 (AR_SM_BASE + AR_SREV_9485(ah) ? \
|
|
- 0x3c4 : 0x444)
|
|
-#define AR_PHY_TX_IQCAL_CONTROL_1 (AR_SM_BASE + AR_SREV_9485(ah) ? \
|
|
- 0x3c8 : 0x448)
|
|
-#define AR_PHY_TX_IQCAL_START (AR_SM_BASE + AR_SREV_9485(ah) ? \
|
|
- 0x3c4 : 0x440)
|
|
-#define AR_PHY_TX_IQCAL_STATUS_B0 (AR_SM_BASE + AR_SREV_9485(ah) ? \
|
|
- 0x3f0 : 0x48c)
|
|
+#define AR_PHY_TX_IQCAL_CONTROL_0 (AR_SM_BASE + (AR_SREV_9485(ah) ? \
|
|
+ 0x3c4 : 0x444))
|
|
+#define AR_PHY_TX_IQCAL_CONTROL_1 (AR_SM_BASE + (AR_SREV_9485(ah) ? \
|
|
+ 0x3c8 : 0x448))
|
|
+#define AR_PHY_TX_IQCAL_START (AR_SM_BASE + (AR_SREV_9485(ah) ? \
|
|
+ 0x3c4 : 0x440))
|
|
+#define AR_PHY_TX_IQCAL_STATUS_B0 (AR_SM_BASE + (AR_SREV_9485(ah) ? \
|
|
+ 0x3f0 : 0x48c))
|
|
#define AR_PHY_TX_IQCAL_CORR_COEFF_B0(_i) (AR_SM_BASE + \
|
|
(AR_SREV_9485(ah) ? \
|
|
0x3d0 : 0x450) + ((_i) << 2))
|
|
@@ -931,10 +931,10 @@
|
|
#define AR_PHY_AIC_SRAM_ADDR_B1 (AR_SM1_BASE + 0x5f0)
|
|
#define AR_PHY_AIC_SRAM_DATA_B1 (AR_SM1_BASE + 0x5f4)
|
|
|
|
-#define AR_PHY_RTT_TABLE_SW_INTF_B(i) (0x384 + (i) ? \
|
|
- AR_SM1_BASE : AR_SM_BASE)
|
|
-#define AR_PHY_RTT_TABLE_SW_INTF_1_B(i) (0x388 + (i) ? \
|
|
- AR_SM1_BASE : AR_SM_BASE)
|
|
+#define AR_PHY_RTT_TABLE_SW_INTF_B(i) (0x384 + ((i) ? \
|
|
+ AR_SM1_BASE : AR_SM_BASE))
|
|
+#define AR_PHY_RTT_TABLE_SW_INTF_1_B(i) (0x388 + ((i) ? \
|
|
+ AR_SM1_BASE : AR_SM_BASE))
|
|
/*
|
|
* Channel 2 Register Map
|
|
*/
|
|
--- a/include/net/cfg80211.h
|
|
+++ b/include/net/cfg80211.h
|
|
@@ -1122,6 +1122,7 @@ struct cfg80211_ibss_params {
|
|
u8 *ssid;
|
|
u8 *bssid;
|
|
struct ieee80211_channel *channel;
|
|
+ enum nl80211_channel_type channel_type;
|
|
u8 *ie;
|
|
u8 ssid_len, ie_len;
|
|
u16 beacon_interval;
|
|
@@ -3188,6 +3189,16 @@ void cfg80211_gtk_rekey_notify(struct ne
|
|
void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
|
|
const u8 *bssid, bool preauth, gfp_t gfp);
|
|
|
|
+/**
|
|
+ * cfg80211_can_use_ext_chan - test if ht40 on extension channel can be used
|
|
+ * @wiphy: the wiphy
|
|
+ * @chan: main channel
|
|
+ * @channel_type: HT mode
|
|
+ */
|
|
+bool cfg80211_can_beacon_sec_chan(struct wiphy *wiphy,
|
|
+ struct ieee80211_channel *chan,
|
|
+ enum nl80211_channel_type channel_type);
|
|
+
|
|
/* Logging, debugging and troubleshooting/diagnostic helpers. */
|
|
|
|
/* wiphy_printk helpers, similar to dev_printk */
|
|
--- a/net/mac80211/agg-rx.c
|
|
+++ b/net/mac80211/agg-rx.c
|
|
@@ -180,6 +180,10 @@ static void ieee80211_send_addba_resp(st
|
|
memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
|
|
else if (sdata->vif.type == NL80211_IFTYPE_STATION)
|
|
memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
|
|
+ else if (sdata->vif.type == NL80211_IFTYPE_WDS)
|
|
+ memcpy(mgmt->bssid, da, ETH_ALEN);
|
|
+ else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
|
|
+ memcpy(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN);
|
|
|
|
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
|
IEEE80211_STYPE_ACTION);
|
|
--- a/net/mac80211/agg-tx.c
|
|
+++ b/net/mac80211/agg-tx.c
|
|
@@ -77,10 +77,13 @@ static void ieee80211_send_addba_request
|
|
memcpy(mgmt->da, da, ETH_ALEN);
|
|
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
|
|
if (sdata->vif.type == NL80211_IFTYPE_AP ||
|
|
- sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
|
|
+ sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
|
|
+ sdata->vif.type == NL80211_IFTYPE_WDS)
|
|
memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
|
|
else if (sdata->vif.type == NL80211_IFTYPE_STATION)
|
|
memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
|
|
+ else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
|
|
+ memcpy(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN);
|
|
|
|
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
|
IEEE80211_STYPE_ACTION);
|
|
@@ -397,7 +400,9 @@ int ieee80211_start_tx_ba_session(struct
|
|
*/
|
|
if (sdata->vif.type != NL80211_IFTYPE_STATION &&
|
|
sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
|
|
- sdata->vif.type != NL80211_IFTYPE_AP)
|
|
+ sdata->vif.type != NL80211_IFTYPE_AP &&
|
|
+ sdata->vif.type != NL80211_IFTYPE_ADHOC &&
|
|
+ sdata->vif.type != NL80211_IFTYPE_WDS)
|
|
return -EINVAL;
|
|
|
|
if (test_sta_flag(sta, WLAN_STA_BLOCK_BA)) {
|
|
--- a/net/mac80211/debugfs_sta.c
|
|
+++ b/net/mac80211/debugfs_sta.c
|
|
@@ -63,11 +63,11 @@ static ssize_t sta_flags_read(struct fil
|
|
test_sta_flag(sta, WLAN_STA_##flg) ? #flg "\n" : ""
|
|
|
|
int res = scnprintf(buf, sizeof(buf),
|
|
- "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
|
|
+ "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
|
|
TEST(AUTH), TEST(ASSOC), TEST(PS_STA),
|
|
TEST(PS_DRIVER), TEST(AUTHORIZED),
|
|
TEST(SHORT_PREAMBLE), TEST(ASSOC_AP),
|
|
- TEST(WME), TEST(WDS), TEST(CLEAR_PS_FILT),
|
|
+ TEST(WME), TEST(CLEAR_PS_FILT),
|
|
TEST(MFP), TEST(BLOCK_BA), TEST(PSPOLL),
|
|
TEST(UAPSD), TEST(SP), TEST(TDLS_PEER),
|
|
TEST(TDLS_PEER_AUTH));
|
|
--- a/net/mac80211/ht.c
|
|
+++ b/net/mac80211/ht.c
|
|
@@ -199,6 +199,8 @@ void ieee80211_send_delba(struct ieee802
|
|
memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
|
|
else if (sdata->vif.type == NL80211_IFTYPE_STATION)
|
|
memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
|
|
+ else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
|
|
+ memcpy(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN);
|
|
|
|
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
|
IEEE80211_STYPE_ACTION);
|
|
--- a/net/mac80211/ibss.c
|
|
+++ b/net/mac80211/ibss.c
|
|
@@ -77,6 +77,7 @@ static void __ieee80211_sta_join_ibss(st
|
|
struct cfg80211_bss *bss;
|
|
u32 bss_change;
|
|
u8 supp_rates[IEEE80211_MAX_SUPP_RATES];
|
|
+ enum nl80211_channel_type channel_type;
|
|
|
|
lockdep_assert_held(&ifibss->mtx);
|
|
|
|
@@ -104,8 +105,16 @@ static void __ieee80211_sta_join_ibss(st
|
|
|
|
sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0;
|
|
|
|
- local->oper_channel = chan;
|
|
- WARN_ON(!ieee80211_set_channel_type(local, sdata, NL80211_CHAN_NO_HT));
|
|
+ channel_type = ifibss->channel_type;
|
|
+ if (channel_type > NL80211_CHAN_HT20 &&
|
|
+ !cfg80211_can_beacon_sec_chan(local->hw.wiphy, chan, channel_type))
|
|
+ channel_type = NL80211_CHAN_HT20;
|
|
+ if (!ieee80211_set_channel_type(local, sdata, channel_type)) {
|
|
+ /* can only fail due to HT40+/- mismatch */
|
|
+ channel_type = NL80211_CHAN_HT20;
|
|
+ WARN_ON(!ieee80211_set_channel_type(local, sdata,
|
|
+ NL80211_CHAN_HT20));
|
|
+ }
|
|
ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
|
|
|
|
sband = local->hw.wiphy->bands[chan->band];
|
|
@@ -171,6 +180,18 @@ static void __ieee80211_sta_join_ibss(st
|
|
memcpy(skb_put(skb, ifibss->ie_len),
|
|
ifibss->ie, ifibss->ie_len);
|
|
|
|
+ /* add HT capability and information IEs */
|
|
+ if (channel_type && sband->ht_cap.ht_supported) {
|
|
+ pos = skb_put(skb, 4 +
|
|
+ sizeof(struct ieee80211_ht_cap) +
|
|
+ sizeof(struct ieee80211_ht_info));
|
|
+ pos = ieee80211_ie_build_ht_cap(pos, sband, sband->ht_cap.cap);
|
|
+ pos = ieee80211_ie_build_ht_info(pos,
|
|
+ &sband->ht_cap,
|
|
+ chan,
|
|
+ channel_type);
|
|
+ }
|
|
+
|
|
if (local->hw.queues >= 4) {
|
|
pos = skb_put(skb, 9);
|
|
*pos++ = WLAN_EID_VENDOR_SPECIFIC;
|
|
@@ -194,6 +215,7 @@ static void __ieee80211_sta_join_ibss(st
|
|
bss_change |= BSS_CHANGED_BEACON;
|
|
bss_change |= BSS_CHANGED_BEACON_ENABLED;
|
|
bss_change |= BSS_CHANGED_BASIC_RATES;
|
|
+ bss_change |= BSS_CHANGED_HT;
|
|
bss_change |= BSS_CHANGED_IBSS;
|
|
sdata->vif.bss_conf.ibss_joined = true;
|
|
ieee80211_bss_info_change_notify(sdata, bss_change);
|
|
@@ -266,6 +288,7 @@ static void ieee80211_rx_bss_info(struct
|
|
u64 beacon_timestamp, rx_timestamp;
|
|
u32 supp_rates = 0;
|
|
enum ieee80211_band band = rx_status->band;
|
|
+ struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
|
|
|
|
if (elems->ds_params && elems->ds_params_len == 1)
|
|
freq = ieee80211_channel_to_frequency(elems->ds_params[0],
|
|
@@ -275,7 +298,10 @@ static void ieee80211_rx_bss_info(struct
|
|
|
|
channel = ieee80211_get_channel(local->hw.wiphy, freq);
|
|
|
|
- if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
|
|
+ if (!channel ||
|
|
+ channel->flags & (IEEE80211_CHAN_DISABLED ||
|
|
+ IEEE80211_CHAN_NO_IBSS ||
|
|
+ IEEE80211_CHAN_RADAR))
|
|
return;
|
|
|
|
if (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
|
|
@@ -313,8 +339,41 @@ static void ieee80211_rx_bss_info(struct
|
|
GFP_ATOMIC);
|
|
}
|
|
|
|
- if (sta && elems->wmm_info)
|
|
- set_sta_flag(sta, WLAN_STA_WME);
|
|
+ if (sta) {
|
|
+ if (elems->wmm_info)
|
|
+ set_sta_flag(sta, WLAN_STA_WME);
|
|
+
|
|
+ /* we both use HT */
|
|
+ if (elems->ht_info_elem && elems->ht_cap_elem &&
|
|
+ sdata->u.ibss.channel_type) {
|
|
+ enum nl80211_channel_type channel_type =
|
|
+ ieee80211_ht_info_to_channel_type(
|
|
+ elems->ht_info_elem);
|
|
+ struct ieee80211_sta_ht_cap sta_ht_cap_new;
|
|
+
|
|
+ /*
|
|
+ * fall back to HT20 if we don't use or use
|
|
+ * the other extension channel
|
|
+ */
|
|
+ if (channel_type > NL80211_CHAN_HT20 &&
|
|
+ channel_type != sdata->u.ibss.channel_type)
|
|
+ channel_type = NL80211_CHAN_HT20;
|
|
+
|
|
+ ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
|
|
+ elems->ht_cap_elem,
|
|
+ &sta_ht_cap_new);
|
|
+ if (memcmp(&sta->sta.ht_cap, &sta_ht_cap_new,
|
|
+ sizeof(sta_ht_cap_new))) {
|
|
+ memcpy(&sta->sta.ht_cap,
|
|
+ &sta_ht_cap_new,
|
|
+ sizeof(sta_ht_cap_new));
|
|
+ rate_control_rate_update(local, sband,
|
|
+ sta,
|
|
+ IEEE80211_RC_HT_CHANGED,
|
|
+ channel_type);
|
|
+ }
|
|
+ }
|
|
+ }
|
|
|
|
rcu_read_unlock();
|
|
}
|
|
@@ -896,10 +955,15 @@ int ieee80211_ibss_join(struct ieee80211
|
|
struct sk_buff *skb;
|
|
|
|
skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom +
|
|
- 36 /* bitrates */ +
|
|
- 34 /* SSID */ +
|
|
- 3 /* DS params */ +
|
|
- 4 /* IBSS params */ +
|
|
+ sizeof(struct ieee80211_hdr_3addr) +
|
|
+ 12 /* struct ieee80211_mgmt.u.beacon */ +
|
|
+ 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ +
|
|
+ 2 + 8 /* max Supported Rates */ +
|
|
+ 3 /* max DS params */ +
|
|
+ 4 /* IBSS params */ +
|
|
+ 2 + (IEEE80211_MAX_SUPP_RATES - 8) +
|
|
+ 2 + sizeof(struct ieee80211_ht_cap) +
|
|
+ 2 + sizeof(struct ieee80211_ht_info) +
|
|
params->ie_len);
|
|
if (!skb)
|
|
return -ENOMEM;
|
|
@@ -920,13 +984,15 @@ int ieee80211_ibss_join(struct ieee80211
|
|
sdata->vif.bss_conf.beacon_int = params->beacon_interval;
|
|
|
|
sdata->u.ibss.channel = params->channel;
|
|
+ sdata->u.ibss.channel_type = params->channel_type;
|
|
sdata->u.ibss.fixed_channel = params->channel_fixed;
|
|
|
|
/* fix ourselves to that channel now already */
|
|
if (params->channel_fixed) {
|
|
sdata->local->oper_channel = params->channel;
|
|
- WARN_ON(!ieee80211_set_channel_type(sdata->local, sdata,
|
|
- NL80211_CHAN_NO_HT));
|
|
+ if (!ieee80211_set_channel_type(sdata->local, sdata,
|
|
+ params->channel_type))
|
|
+ return -EINVAL;
|
|
}
|
|
|
|
if (params->ie) {
|
|
--- a/net/mac80211/ieee80211_i.h
|
|
+++ b/net/mac80211/ieee80211_i.h
|
|
@@ -464,6 +464,7 @@ struct ieee80211_if_ibss {
|
|
u8 ssid_len, ie_len;
|
|
u8 *ie;
|
|
struct ieee80211_channel *channel;
|
|
+ enum nl80211_channel_type channel_type;
|
|
|
|
unsigned long ibss_join_req;
|
|
/* probe response/beacon for IBSS */
|
|
@@ -1338,6 +1339,12 @@ void ieee80211_recalc_smps(struct ieee80
|
|
size_t ieee80211_ie_split(const u8 *ies, size_t ielen,
|
|
const u8 *ids, int n_ids, size_t offset);
|
|
size_t ieee80211_ie_split_vendor(const u8 *ies, size_t ielen, size_t offset);
|
|
+u8 *ieee80211_ie_build_ht_cap(u8 *pos, struct ieee80211_supported_band *sband,
|
|
+ u16 cap);
|
|
+u8 *ieee80211_ie_build_ht_info(u8 *pos,
|
|
+ struct ieee80211_sta_ht_cap *ht_cap,
|
|
+ struct ieee80211_channel *channel,
|
|
+ enum nl80211_channel_type channel_type);
|
|
|
|
/* internal work items */
|
|
void ieee80211_work_init(struct ieee80211_local *local);
|
|
@@ -1366,6 +1373,8 @@ ieee80211_get_channel_mode(struct ieee80
|
|
bool ieee80211_set_channel_type(struct ieee80211_local *local,
|
|
struct ieee80211_sub_if_data *sdata,
|
|
enum nl80211_channel_type chantype);
|
|
+enum nl80211_channel_type
|
|
+ieee80211_ht_info_to_channel_type(struct ieee80211_ht_info *ht_info);
|
|
|
|
#ifdef CONFIG_MAC80211_NOINLINE
|
|
#define debug_noinline noinline
|
|
--- a/net/mac80211/iface.c
|
|
+++ b/net/mac80211/iface.c
|
|
@@ -178,7 +178,6 @@ static int ieee80211_do_open(struct net_
|
|
{
|
|
struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
|
|
struct ieee80211_local *local = sdata->local;
|
|
- struct sta_info *sta;
|
|
u32 changed = 0;
|
|
int res;
|
|
u32 hw_reconf_flags = 0;
|
|
@@ -290,27 +289,6 @@ static int ieee80211_do_open(struct net_
|
|
|
|
set_bit(SDATA_STATE_RUNNING, &sdata->state);
|
|
|
|
- if (sdata->vif.type == NL80211_IFTYPE_WDS) {
|
|
- /* Create STA entry for the WDS peer */
|
|
- sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
|
|
- GFP_KERNEL);
|
|
- if (!sta) {
|
|
- res = -ENOMEM;
|
|
- goto err_del_interface;
|
|
- }
|
|
-
|
|
- /* no atomic bitop required since STA is not live yet */
|
|
- set_sta_flag(sta, WLAN_STA_AUTHORIZED);
|
|
-
|
|
- res = sta_info_insert(sta);
|
|
- if (res) {
|
|
- /* STA has been freed */
|
|
- goto err_del_interface;
|
|
- }
|
|
-
|
|
- rate_control_rate_init(sta);
|
|
- }
|
|
-
|
|
/*
|
|
* set_multicast_list will be invoked by the networking core
|
|
* which will check whether any increments here were done in
|
|
@@ -344,8 +322,7 @@ static int ieee80211_do_open(struct net_
|
|
netif_tx_start_all_queues(dev);
|
|
|
|
return 0;
|
|
- err_del_interface:
|
|
- drv_remove_interface(local, &sdata->vif);
|
|
+
|
|
err_stop:
|
|
if (!local->open_count)
|
|
drv_stop(local);
|
|
@@ -716,6 +693,70 @@ static void ieee80211_if_setup(struct ne
|
|
dev->destructor = free_netdev;
|
|
}
|
|
|
|
+static void ieee80211_wds_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
|
|
+ struct sk_buff *skb)
|
|
+{
|
|
+ struct ieee80211_local *local = sdata->local;
|
|
+ struct ieee80211_rx_status *rx_status;
|
|
+ struct ieee802_11_elems elems;
|
|
+ struct ieee80211_mgmt *mgmt;
|
|
+ struct sta_info *sta;
|
|
+ size_t baselen;
|
|
+ u32 rates = 0;
|
|
+ u16 stype;
|
|
+ bool new = false;
|
|
+ enum ieee80211_band band = local->hw.conf.channel->band;
|
|
+ struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
|
|
+
|
|
+ rx_status = IEEE80211_SKB_RXCB(skb);
|
|
+ mgmt = (struct ieee80211_mgmt *) skb->data;
|
|
+ stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE;
|
|
+
|
|
+ if (stype != IEEE80211_STYPE_BEACON)
|
|
+ return;
|
|
+
|
|
+ baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
|
|
+ if (baselen > skb->len)
|
|
+ return;
|
|
+
|
|
+ ieee802_11_parse_elems(mgmt->u.probe_resp.variable,
|
|
+ skb->len - baselen, &elems);
|
|
+
|
|
+ rates = ieee80211_sta_get_rates(local, &elems, band);
|
|
+
|
|
+ rcu_read_lock();
|
|
+
|
|
+ sta = sta_info_get(sdata, sdata->u.wds.remote_addr);
|
|
+
|
|
+ if (!sta) {
|
|
+ rcu_read_unlock();
|
|
+ sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
|
|
+ GFP_KERNEL);
|
|
+ if (!sta)
|
|
+ return;
|
|
+
|
|
+ new = true;
|
|
+ }
|
|
+
|
|
+ sta->last_rx = jiffies;
|
|
+ sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
|
|
+
|
|
+ if (elems.ht_cap_elem)
|
|
+ ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
|
|
+ elems.ht_cap_elem, &sta->sta.ht_cap);
|
|
+
|
|
+ if (elems.wmm_param)
|
|
+ set_sta_flag(sta, WLAN_STA_WME);
|
|
+
|
|
+ if (new) {
|
|
+ set_sta_flag(sta, WLAN_STA_AUTHORIZED);
|
|
+ rate_control_rate_init(sta);
|
|
+ sta_info_insert_rcu(sta);
|
|
+ }
|
|
+
|
|
+ rcu_read_unlock();
|
|
+}
|
|
+
|
|
static void ieee80211_iface_work(struct work_struct *work)
|
|
{
|
|
struct ieee80211_sub_if_data *sdata =
|
|
@@ -820,6 +861,9 @@ static void ieee80211_iface_work(struct
|
|
break;
|
|
ieee80211_mesh_rx_queued_mgmt(sdata, skb);
|
|
break;
|
|
+ case NL80211_IFTYPE_WDS:
|
|
+ ieee80211_wds_rx_queued_mgmt(sdata, skb);
|
|
+ break;
|
|
default:
|
|
WARN(1, "frame for unexpected interface type");
|
|
break;
|
|
--- a/net/mac80211/rx.c
|
|
+++ b/net/mac80211/rx.c
|
|
@@ -2211,7 +2211,9 @@ ieee80211_rx_h_action(struct ieee80211_r
|
|
*/
|
|
if (sdata->vif.type != NL80211_IFTYPE_STATION &&
|
|
sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
|
|
- sdata->vif.type != NL80211_IFTYPE_AP)
|
|
+ sdata->vif.type != NL80211_IFTYPE_AP &&
|
|
+ sdata->vif.type != NL80211_IFTYPE_ADHOC &&
|
|
+ sdata->vif.type != NL80211_IFTYPE_WDS)
|
|
break;
|
|
|
|
/* verify action_code is present */
|
|
@@ -2426,13 +2428,14 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_
|
|
|
|
if (!ieee80211_vif_is_mesh(&sdata->vif) &&
|
|
sdata->vif.type != NL80211_IFTYPE_ADHOC &&
|
|
- sdata->vif.type != NL80211_IFTYPE_STATION)
|
|
+ sdata->vif.type != NL80211_IFTYPE_STATION &&
|
|
+ sdata->vif.type != NL80211_IFTYPE_WDS)
|
|
return RX_DROP_MONITOR;
|
|
|
|
switch (stype) {
|
|
case cpu_to_le16(IEEE80211_STYPE_BEACON):
|
|
case cpu_to_le16(IEEE80211_STYPE_PROBE_RESP):
|
|
- /* process for all: mesh, mlme, ibss */
|
|
+ /* process for all: mesh, mlme, ibss, wds */
|
|
break;
|
|
case cpu_to_le16(IEEE80211_STYPE_DEAUTH):
|
|
case cpu_to_le16(IEEE80211_STYPE_DISASSOC):
|
|
@@ -2775,10 +2778,16 @@ static int prepare_for_handlers(struct i
|
|
}
|
|
break;
|
|
case NL80211_IFTYPE_WDS:
|
|
- if (bssid || !ieee80211_is_data(hdr->frame_control))
|
|
- return 0;
|
|
if (compare_ether_addr(sdata->u.wds.remote_addr, hdr->addr2))
|
|
return 0;
|
|
+
|
|
+ if (ieee80211_is_data(hdr->frame_control) ||
|
|
+ ieee80211_is_action(hdr->frame_control)) {
|
|
+ if (compare_ether_addr(sdata->vif.addr, hdr->addr1))
|
|
+ return 0;
|
|
+ } else if (!ieee80211_is_beacon(hdr->frame_control))
|
|
+ return 0;
|
|
+
|
|
break;
|
|
default:
|
|
/* should never get here */
|
|
--- a/net/mac80211/sta_info.h
|
|
+++ b/net/mac80211/sta_info.h
|
|
@@ -32,7 +32,6 @@
|
|
* frames.
|
|
* @WLAN_STA_ASSOC_AP: We're associated to that station, it is an AP.
|
|
* @WLAN_STA_WME: Station is a QoS-STA.
|
|
- * @WLAN_STA_WDS: Station is one of our WDS peers.
|
|
* @WLAN_STA_CLEAR_PS_FILT: Clear PS filter in hardware (using the
|
|
* IEEE80211_TX_CTL_CLEAR_PS_FILT control flag) when the next
|
|
* frame to this station is transmitted.
|
|
@@ -61,7 +60,6 @@ enum ieee80211_sta_info_flags {
|
|
WLAN_STA_SHORT_PREAMBLE,
|
|
WLAN_STA_ASSOC_AP,
|
|
WLAN_STA_WME,
|
|
- WLAN_STA_WDS,
|
|
WLAN_STA_CLEAR_PS_FILT,
|
|
WLAN_STA_MFP,
|
|
WLAN_STA_BLOCK_BA,
|
|
--- a/net/mac80211/util.c
|
|
+++ b/net/mac80211/util.c
|
|
@@ -836,23 +836,8 @@ int ieee80211_build_preq_ies(struct ieee
|
|
offset = noffset;
|
|
}
|
|
|
|
- if (sband->ht_cap.ht_supported) {
|
|
- u16 cap = sband->ht_cap.cap;
|
|
- __le16 tmp;
|
|
-
|
|
- *pos++ = WLAN_EID_HT_CAPABILITY;
|
|
- *pos++ = sizeof(struct ieee80211_ht_cap);
|
|
- memset(pos, 0, sizeof(struct ieee80211_ht_cap));
|
|
- tmp = cpu_to_le16(cap);
|
|
- memcpy(pos, &tmp, sizeof(u16));
|
|
- pos += sizeof(u16);
|
|
- *pos++ = sband->ht_cap.ampdu_factor |
|
|
- (sband->ht_cap.ampdu_density <<
|
|
- IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT);
|
|
- memcpy(pos, &sband->ht_cap.mcs, sizeof(sband->ht_cap.mcs));
|
|
- pos += sizeof(sband->ht_cap.mcs);
|
|
- pos += 2 + 4 + 1; /* ext info, BF cap, antsel */
|
|
- }
|
|
+ if (sband->ht_cap.ht_supported)
|
|
+ pos = ieee80211_ie_build_ht_cap(pos, sband, sband->ht_cap.cap);
|
|
|
|
/*
|
|
* If adding more here, adjust code in main.c
|
|
@@ -1443,3 +1428,100 @@ int ieee80211_add_ext_srates_ie(struct i
|
|
}
|
|
return 0;
|
|
}
|
|
+
|
|
+u8 *ieee80211_ie_build_ht_cap(u8 *pos, struct ieee80211_supported_band *sband,
|
|
+ u16 cap)
|
|
+{
|
|
+ __le16 tmp;
|
|
+
|
|
+ *pos++ = WLAN_EID_HT_CAPABILITY;
|
|
+ *pos++ = sizeof(struct ieee80211_ht_cap);
|
|
+ memset(pos, 0, sizeof(struct ieee80211_ht_cap));
|
|
+
|
|
+ /* capability flags */
|
|
+ tmp = cpu_to_le16(cap);
|
|
+ memcpy(pos, &tmp, sizeof(u16));
|
|
+ pos += sizeof(u16);
|
|
+
|
|
+ /* AMPDU parameters */
|
|
+ *pos++ = sband->ht_cap.ampdu_factor |
|
|
+ (sband->ht_cap.ampdu_density <<
|
|
+ IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT);
|
|
+
|
|
+ /* MCS set */
|
|
+ memcpy(pos, &sband->ht_cap.mcs, sizeof(sband->ht_cap.mcs));
|
|
+ pos += sizeof(sband->ht_cap.mcs);
|
|
+
|
|
+ /* extended capabilities */
|
|
+ pos += sizeof(__le16);
|
|
+
|
|
+ /* BF capabilities */
|
|
+ pos += sizeof(__le32);
|
|
+
|
|
+ /* antenna selection */
|
|
+ pos += sizeof(u8);
|
|
+
|
|
+ return pos;
|
|
+}
|
|
+
|
|
+u8 *ieee80211_ie_build_ht_info(u8 *pos,
|
|
+ struct ieee80211_sta_ht_cap *ht_cap,
|
|
+ struct ieee80211_channel *channel,
|
|
+ enum nl80211_channel_type channel_type)
|
|
+{
|
|
+ struct ieee80211_ht_info *ht_info;
|
|
+ /* Build HT Information */
|
|
+ *pos++ = WLAN_EID_HT_INFORMATION;
|
|
+ *pos++ = sizeof(struct ieee80211_ht_info);
|
|
+ ht_info = (struct ieee80211_ht_info *)pos;
|
|
+ ht_info->control_chan =
|
|
+ ieee80211_frequency_to_channel(channel->center_freq);
|
|
+ switch (channel_type) {
|
|
+ case NL80211_CHAN_HT40MINUS:
|
|
+ ht_info->ht_param = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
|
|
+ break;
|
|
+ case NL80211_CHAN_HT40PLUS:
|
|
+ ht_info->ht_param = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
|
|
+ break;
|
|
+ case NL80211_CHAN_HT20:
|
|
+ default:
|
|
+ ht_info->ht_param = IEEE80211_HT_PARAM_CHA_SEC_NONE;
|
|
+ break;
|
|
+ }
|
|
+ if (ht_cap->cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40)
|
|
+ ht_info->ht_param |= IEEE80211_HT_PARAM_CHAN_WIDTH_ANY;
|
|
+ ht_info->operation_mode = 0x0000;
|
|
+ ht_info->stbc_param = 0x0000;
|
|
+
|
|
+ /* It seems that Basic MCS set and Supported MCS set
|
|
+ are identical for the first 10 bytes */
|
|
+ memset(&ht_info->basic_set, 0, 16);
|
|
+ memcpy(&ht_info->basic_set, &ht_cap->mcs, 10);
|
|
+
|
|
+ return pos + sizeof(struct ieee80211_ht_info);
|
|
+}
|
|
+
|
|
+enum nl80211_channel_type
|
|
+ieee80211_ht_info_to_channel_type(struct ieee80211_ht_info *ht_info)
|
|
+{
|
|
+ enum nl80211_channel_type channel_type;
|
|
+
|
|
+ if (!ht_info)
|
|
+ return NL80211_CHAN_NO_HT;
|
|
+
|
|
+ switch (ht_info->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
|
|
+ case IEEE80211_HT_PARAM_CHA_SEC_NONE:
|
|
+ channel_type = NL80211_CHAN_HT20;
|
|
+ break;
|
|
+ case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
|
|
+ channel_type = NL80211_CHAN_HT40PLUS;
|
|
+ break;
|
|
+ case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
|
|
+ channel_type = NL80211_CHAN_HT40MINUS;
|
|
+ break;
|
|
+ default:
|
|
+ channel_type = NL80211_CHAN_NO_HT;
|
|
+ }
|
|
+
|
|
+ return channel_type;
|
|
+}
|
|
--- a/net/mac80211/work.c
|
|
+++ b/net/mac80211/work.c
|
|
@@ -118,7 +118,6 @@ static void ieee80211_add_ht_ie(struct s
|
|
u8 *pos;
|
|
u32 flags = channel->flags;
|
|
u16 cap = sband->ht_cap.cap;
|
|
- __le16 tmp;
|
|
|
|
if (!sband->ht_cap.ht_supported)
|
|
return;
|
|
@@ -169,34 +168,8 @@ static void ieee80211_add_ht_ie(struct s
|
|
}
|
|
|
|
/* reserve and fill IE */
|
|
-
|
|
pos = skb_put(skb, sizeof(struct ieee80211_ht_cap) + 2);
|
|
- *pos++ = WLAN_EID_HT_CAPABILITY;
|
|
- *pos++ = sizeof(struct ieee80211_ht_cap);
|
|
- memset(pos, 0, sizeof(struct ieee80211_ht_cap));
|
|
-
|
|
- /* capability flags */
|
|
- tmp = cpu_to_le16(cap);
|
|
- memcpy(pos, &tmp, sizeof(u16));
|
|
- pos += sizeof(u16);
|
|
-
|
|
- /* AMPDU parameters */
|
|
- *pos++ = sband->ht_cap.ampdu_factor |
|
|
- (sband->ht_cap.ampdu_density <<
|
|
- IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT);
|
|
-
|
|
- /* MCS set */
|
|
- memcpy(pos, &sband->ht_cap.mcs, sizeof(sband->ht_cap.mcs));
|
|
- pos += sizeof(sband->ht_cap.mcs);
|
|
-
|
|
- /* extended capabilities */
|
|
- pos += sizeof(__le16);
|
|
-
|
|
- /* BF capabilities */
|
|
- pos += sizeof(__le32);
|
|
-
|
|
- /* antenna selection */
|
|
- pos += sizeof(u8);
|
|
+ ieee80211_ie_build_ht_cap(pos, sband, cap);
|
|
}
|
|
|
|
static void ieee80211_send_assoc(struct ieee80211_sub_if_data *sdata,
|
|
--- a/net/wireless/chan.c
|
|
+++ b/net/wireless/chan.c
|
|
@@ -44,9 +44,9 @@ rdev_freq_to_chan(struct cfg80211_regist
|
|
return chan;
|
|
}
|
|
|
|
-static bool can_beacon_sec_chan(struct wiphy *wiphy,
|
|
- struct ieee80211_channel *chan,
|
|
- enum nl80211_channel_type channel_type)
|
|
+bool cfg80211_can_beacon_sec_chan(struct wiphy *wiphy,
|
|
+ struct ieee80211_channel *chan,
|
|
+ enum nl80211_channel_type channel_type)
|
|
{
|
|
struct ieee80211_channel *sec_chan;
|
|
int diff;
|
|
@@ -75,6 +75,7 @@ static bool can_beacon_sec_chan(struct w
|
|
|
|
return true;
|
|
}
|
|
+EXPORT_SYMBOL(cfg80211_can_beacon_sec_chan);
|
|
|
|
int cfg80211_set_freq(struct cfg80211_registered_device *rdev,
|
|
struct wireless_dev *wdev, int freq,
|
|
@@ -109,8 +110,8 @@ int cfg80211_set_freq(struct cfg80211_re
|
|
switch (channel_type) {
|
|
case NL80211_CHAN_HT40PLUS:
|
|
case NL80211_CHAN_HT40MINUS:
|
|
- if (!can_beacon_sec_chan(&rdev->wiphy, chan,
|
|
- channel_type)) {
|
|
+ if (!cfg80211_can_beacon_sec_chan(&rdev->wiphy, chan,
|
|
+ channel_type)) {
|
|
printk(KERN_DEBUG
|
|
"cfg80211: Secondary channel not "
|
|
"allowed to initiate communication\n");
|
|
--- a/net/wireless/nl80211.c
|
|
+++ b/net/wireless/nl80211.c
|
|
@@ -4574,13 +4574,34 @@ static int nl80211_join_ibss(struct sk_b
|
|
ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
|
|
}
|
|
|
|
- ibss.channel = ieee80211_get_channel(wiphy,
|
|
- nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
|
|
+ if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
|
|
+ enum nl80211_channel_type channel_type;
|
|
+
|
|
+ channel_type = nla_get_u32(
|
|
+ info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
|
|
+ if (channel_type > NL80211_CHAN_HT40PLUS)
|
|
+ return -EINVAL;
|
|
+ ibss.channel_type = channel_type;
|
|
+ } else {
|
|
+ ibss.channel_type = NL80211_CHAN_NO_HT;
|
|
+ }
|
|
+
|
|
+ ibss.channel = rdev_freq_to_chan(rdev,
|
|
+ nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]),
|
|
+ ibss.channel_type);
|
|
if (!ibss.channel ||
|
|
+ ibss.channel->flags & IEEE80211_CHAN_RADAR ||
|
|
ibss.channel->flags & IEEE80211_CHAN_NO_IBSS ||
|
|
ibss.channel->flags & IEEE80211_CHAN_DISABLED)
|
|
return -EINVAL;
|
|
|
|
+ /* Both channels should be able to initiate communication */
|
|
+ if ((ibss.channel_type == NL80211_CHAN_HT40PLUS ||
|
|
+ ibss.channel_type == NL80211_CHAN_HT40MINUS) &&
|
|
+ !cfg80211_can_beacon_sec_chan(&rdev->wiphy, ibss.channel,
|
|
+ ibss.channel_type))
|
|
+ return -EINVAL;
|
|
+
|
|
ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
|
|
ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
|
|
|