mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-28 02:32:09 -04:00
Merge branch 'for-john' of git://git.kernel.org/pub/scm/linux/kernel/git/jberg/mac80211-next
This commit is contained in:
commit
d074666366
28 changed files with 707 additions and 372 deletions
|
|
@ -2302,14 +2302,25 @@ static void ieee80211_rfkill_poll(struct wiphy *wiphy)
|
|||
}
|
||||
|
||||
#ifdef CONFIG_NL80211_TESTMODE
|
||||
static int ieee80211_testmode_cmd(struct wiphy *wiphy, void *data, int len)
|
||||
static int ieee80211_testmode_cmd(struct wiphy *wiphy,
|
||||
struct wireless_dev *wdev,
|
||||
void *data, int len)
|
||||
{
|
||||
struct ieee80211_local *local = wiphy_priv(wiphy);
|
||||
struct ieee80211_vif *vif = NULL;
|
||||
|
||||
if (!local->ops->testmode_cmd)
|
||||
return -EOPNOTSUPP;
|
||||
|
||||
return local->ops->testmode_cmd(&local->hw, data, len);
|
||||
if (wdev) {
|
||||
struct ieee80211_sub_if_data *sdata;
|
||||
|
||||
sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
|
||||
if (sdata->flags & IEEE80211_SDATA_IN_DRIVER)
|
||||
vif = &sdata->vif;
|
||||
}
|
||||
|
||||
return local->ops->testmode_cmd(&local->hw, vif, data, len);
|
||||
}
|
||||
|
||||
static int ieee80211_testmode_dump(struct wiphy *wiphy,
|
||||
|
|
|
|||
|
|
@ -34,6 +34,170 @@
|
|||
|
||||
#define IEEE80211_IBSS_MAX_STA_ENTRIES 128
|
||||
|
||||
static struct beacon_data *
|
||||
ieee80211_ibss_build_presp(struct ieee80211_sub_if_data *sdata,
|
||||
const int beacon_int, const u32 basic_rates,
|
||||
const u16 capability, u64 tsf,
|
||||
struct cfg80211_chan_def *chandef,
|
||||
bool *have_higher_than_11mbit)
|
||||
{
|
||||
struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
|
||||
struct ieee80211_local *local = sdata->local;
|
||||
int rates_n = 0, i, ri;
|
||||
struct ieee80211_mgmt *mgmt;
|
||||
u8 *pos;
|
||||
struct ieee80211_supported_band *sband;
|
||||
u32 rate_flags, rates = 0, rates_added = 0;
|
||||
struct beacon_data *presp;
|
||||
int frame_len;
|
||||
int shift;
|
||||
|
||||
/* Build IBSS probe response */
|
||||
frame_len = 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_operation) +
|
||||
ifibss->ie_len;
|
||||
presp = kzalloc(sizeof(*presp) + frame_len, GFP_KERNEL);
|
||||
if (!presp)
|
||||
return NULL;
|
||||
|
||||
presp->head = (void *)(presp + 1);
|
||||
|
||||
mgmt = (void *) presp->head;
|
||||
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
||||
IEEE80211_STYPE_PROBE_RESP);
|
||||
eth_broadcast_addr(mgmt->da);
|
||||
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
|
||||
memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN);
|
||||
mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int);
|
||||
mgmt->u.beacon.timestamp = cpu_to_le64(tsf);
|
||||
mgmt->u.beacon.capab_info = cpu_to_le16(capability);
|
||||
|
||||
pos = (u8 *)mgmt + offsetof(struct ieee80211_mgmt, u.beacon.variable);
|
||||
|
||||
*pos++ = WLAN_EID_SSID;
|
||||
*pos++ = ifibss->ssid_len;
|
||||
memcpy(pos, ifibss->ssid, ifibss->ssid_len);
|
||||
pos += ifibss->ssid_len;
|
||||
|
||||
sband = local->hw.wiphy->bands[chandef->chan->band];
|
||||
rate_flags = ieee80211_chandef_rate_flags(chandef);
|
||||
shift = ieee80211_chandef_get_shift(chandef);
|
||||
rates_n = 0;
|
||||
if (have_higher_than_11mbit)
|
||||
*have_higher_than_11mbit = false;
|
||||
|
||||
for (i = 0; i < sband->n_bitrates; i++) {
|
||||
if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
|
||||
continue;
|
||||
if (sband->bitrates[i].bitrate > 110 &&
|
||||
have_higher_than_11mbit)
|
||||
*have_higher_than_11mbit = true;
|
||||
|
||||
rates |= BIT(i);
|
||||
rates_n++;
|
||||
}
|
||||
|
||||
*pos++ = WLAN_EID_SUPP_RATES;
|
||||
*pos++ = min_t(int, 8, rates_n);
|
||||
for (ri = 0; ri < sband->n_bitrates; ri++) {
|
||||
int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
|
||||
5 * (1 << shift));
|
||||
u8 basic = 0;
|
||||
if (!(rates & BIT(ri)))
|
||||
continue;
|
||||
|
||||
if (basic_rates & BIT(ri))
|
||||
basic = 0x80;
|
||||
*pos++ = basic | (u8) rate;
|
||||
if (++rates_added == 8) {
|
||||
ri++; /* continue at next rate for EXT_SUPP_RATES */
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (sband->band == IEEE80211_BAND_2GHZ) {
|
||||
*pos++ = WLAN_EID_DS_PARAMS;
|
||||
*pos++ = 1;
|
||||
*pos++ = ieee80211_frequency_to_channel(
|
||||
chandef->chan->center_freq);
|
||||
}
|
||||
|
||||
*pos++ = WLAN_EID_IBSS_PARAMS;
|
||||
*pos++ = 2;
|
||||
/* FIX: set ATIM window based on scan results */
|
||||
*pos++ = 0;
|
||||
*pos++ = 0;
|
||||
|
||||
/* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */
|
||||
if (rates_n > 8) {
|
||||
*pos++ = WLAN_EID_EXT_SUPP_RATES;
|
||||
*pos++ = rates_n - 8;
|
||||
for (; ri < sband->n_bitrates; ri++) {
|
||||
int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
|
||||
5 * (1 << shift));
|
||||
u8 basic = 0;
|
||||
if (!(rates & BIT(ri)))
|
||||
continue;
|
||||
|
||||
if (basic_rates & BIT(ri))
|
||||
basic = 0x80;
|
||||
*pos++ = basic | (u8) rate;
|
||||
}
|
||||
}
|
||||
|
||||
if (ifibss->ie_len) {
|
||||
memcpy(pos, ifibss->ie, ifibss->ie_len);
|
||||
pos += ifibss->ie_len;
|
||||
}
|
||||
|
||||
/* add HT capability and information IEs */
|
||||
if (chandef->width != NL80211_CHAN_WIDTH_20_NOHT &&
|
||||
chandef->width != NL80211_CHAN_WIDTH_5 &&
|
||||
chandef->width != NL80211_CHAN_WIDTH_10 &&
|
||||
sband->ht_cap.ht_supported) {
|
||||
struct ieee80211_sta_ht_cap ht_cap;
|
||||
|
||||
memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap));
|
||||
ieee80211_apply_htcap_overrides(sdata, &ht_cap);
|
||||
|
||||
pos = ieee80211_ie_build_ht_cap(pos, &ht_cap, ht_cap.cap);
|
||||
/*
|
||||
* Note: According to 802.11n-2009 9.13.3.1, HT Protection
|
||||
* field and RIFS Mode are reserved in IBSS mode, therefore
|
||||
* keep them at 0
|
||||
*/
|
||||
pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap,
|
||||
chandef, 0);
|
||||
}
|
||||
|
||||
if (local->hw.queues >= IEEE80211_NUM_ACS) {
|
||||
*pos++ = WLAN_EID_VENDOR_SPECIFIC;
|
||||
*pos++ = 7; /* len */
|
||||
*pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
|
||||
*pos++ = 0x50;
|
||||
*pos++ = 0xf2;
|
||||
*pos++ = 2; /* WME */
|
||||
*pos++ = 0; /* WME info */
|
||||
*pos++ = 1; /* WME ver */
|
||||
*pos++ = 0; /* U-APSD no in use */
|
||||
}
|
||||
|
||||
presp->head_len = pos - presp->head;
|
||||
if (WARN_ON(presp->head_len > frame_len))
|
||||
goto error;
|
||||
|
||||
return presp;
|
||||
error:
|
||||
kfree(presp);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
|
||||
const u8 *bssid, const int beacon_int,
|
||||
|
|
@ -44,18 +208,14 @@ static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
|
|||
{
|
||||
struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
|
||||
struct ieee80211_local *local = sdata->local;
|
||||
int rates_n = 0, i, ri;
|
||||
struct ieee80211_mgmt *mgmt;
|
||||
u8 *pos;
|
||||
struct ieee80211_supported_band *sband;
|
||||
struct ieee80211_mgmt *mgmt;
|
||||
struct cfg80211_bss *bss;
|
||||
u32 bss_change, rate_flags, rates = 0, rates_added = 0;
|
||||
u32 bss_change;
|
||||
struct cfg80211_chan_def chandef;
|
||||
enum nl80211_bss_scan_width scan_width;
|
||||
bool have_higher_than_11mbit = false;
|
||||
struct beacon_data *presp;
|
||||
int frame_len;
|
||||
int shift;
|
||||
enum nl80211_bss_scan_width scan_width;
|
||||
bool have_higher_than_11mbit;
|
||||
|
||||
sdata_assert_lock(sdata);
|
||||
|
||||
|
|
@ -110,142 +270,15 @@ static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata,
|
|||
memcpy(ifibss->bssid, bssid, ETH_ALEN);
|
||||
|
||||
sband = local->hw.wiphy->bands[chan->band];
|
||||
shift = ieee80211_vif_get_shift(&sdata->vif);
|
||||
|
||||
/* Build IBSS probe response */
|
||||
frame_len = 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_operation) +
|
||||
ifibss->ie_len;
|
||||
presp = kzalloc(sizeof(*presp) + frame_len, GFP_KERNEL);
|
||||
presp = ieee80211_ibss_build_presp(sdata, beacon_int, basic_rates,
|
||||
capability, tsf, &chandef,
|
||||
&have_higher_than_11mbit);
|
||||
if (!presp)
|
||||
return;
|
||||
|
||||
presp->head = (void *)(presp + 1);
|
||||
|
||||
mgmt = (void *) presp->head;
|
||||
mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
|
||||
IEEE80211_STYPE_PROBE_RESP);
|
||||
eth_broadcast_addr(mgmt->da);
|
||||
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
|
||||
memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN);
|
||||
mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int);
|
||||
mgmt->u.beacon.timestamp = cpu_to_le64(tsf);
|
||||
mgmt->u.beacon.capab_info = cpu_to_le16(capability);
|
||||
|
||||
pos = (u8 *)mgmt + offsetof(struct ieee80211_mgmt, u.beacon.variable);
|
||||
|
||||
*pos++ = WLAN_EID_SSID;
|
||||
*pos++ = ifibss->ssid_len;
|
||||
memcpy(pos, ifibss->ssid, ifibss->ssid_len);
|
||||
pos += ifibss->ssid_len;
|
||||
|
||||
rate_flags = ieee80211_chandef_rate_flags(&chandef);
|
||||
for (i = 0; i < sband->n_bitrates; i++) {
|
||||
if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
|
||||
continue;
|
||||
if (sband->bitrates[i].bitrate > 110)
|
||||
have_higher_than_11mbit = true;
|
||||
|
||||
rates |= BIT(i);
|
||||
rates_n++;
|
||||
}
|
||||
|
||||
*pos++ = WLAN_EID_SUPP_RATES;
|
||||
*pos++ = min_t(int, 8, rates_n);
|
||||
for (ri = 0; ri < sband->n_bitrates; ri++) {
|
||||
int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
|
||||
5 * (1 << shift));
|
||||
u8 basic = 0;
|
||||
if (!(rates & BIT(ri)))
|
||||
continue;
|
||||
|
||||
if (basic_rates & BIT(ri))
|
||||
basic = 0x80;
|
||||
*pos++ = basic | (u8) rate;
|
||||
if (++rates_added == 8) {
|
||||
ri++; /* continue at next rate for EXT_SUPP_RATES */
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (sband->band == IEEE80211_BAND_2GHZ) {
|
||||
*pos++ = WLAN_EID_DS_PARAMS;
|
||||
*pos++ = 1;
|
||||
*pos++ = ieee80211_frequency_to_channel(chan->center_freq);
|
||||
}
|
||||
|
||||
*pos++ = WLAN_EID_IBSS_PARAMS;
|
||||
*pos++ = 2;
|
||||
/* FIX: set ATIM window based on scan results */
|
||||
*pos++ = 0;
|
||||
*pos++ = 0;
|
||||
|
||||
/* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */
|
||||
if (rates_n > 8) {
|
||||
*pos++ = WLAN_EID_EXT_SUPP_RATES;
|
||||
*pos++ = rates_n - 8;
|
||||
for (; ri < sband->n_bitrates; ri++) {
|
||||
int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate,
|
||||
5 * (1 << shift));
|
||||
u8 basic = 0;
|
||||
if (!(rates & BIT(ri)))
|
||||
continue;
|
||||
|
||||
if (basic_rates & BIT(ri))
|
||||
basic = 0x80;
|
||||
*pos++ = basic | (u8) rate;
|
||||
}
|
||||
}
|
||||
|
||||
if (ifibss->ie_len) {
|
||||
memcpy(pos, ifibss->ie, ifibss->ie_len);
|
||||
pos += ifibss->ie_len;
|
||||
}
|
||||
|
||||
/* add HT capability and information IEs */
|
||||
if (chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
|
||||
chandef.width != NL80211_CHAN_WIDTH_5 &&
|
||||
chandef.width != NL80211_CHAN_WIDTH_10 &&
|
||||
sband->ht_cap.ht_supported) {
|
||||
struct ieee80211_sta_ht_cap ht_cap;
|
||||
|
||||
memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap));
|
||||
ieee80211_apply_htcap_overrides(sdata, &ht_cap);
|
||||
|
||||
pos = ieee80211_ie_build_ht_cap(pos, &ht_cap, ht_cap.cap);
|
||||
/*
|
||||
* Note: According to 802.11n-2009 9.13.3.1, HT Protection
|
||||
* field and RIFS Mode are reserved in IBSS mode, therefore
|
||||
* keep them at 0
|
||||
*/
|
||||
pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap,
|
||||
&chandef, 0);
|
||||
}
|
||||
|
||||
if (local->hw.queues >= IEEE80211_NUM_ACS) {
|
||||
*pos++ = WLAN_EID_VENDOR_SPECIFIC;
|
||||
*pos++ = 7; /* len */
|
||||
*pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
|
||||
*pos++ = 0x50;
|
||||
*pos++ = 0xf2;
|
||||
*pos++ = 2; /* WME */
|
||||
*pos++ = 0; /* WME info */
|
||||
*pos++ = 1; /* WME ver */
|
||||
*pos++ = 0; /* U-APSD no in use */
|
||||
}
|
||||
|
||||
presp->head_len = pos - presp->head;
|
||||
if (WARN_ON(presp->head_len > frame_len))
|
||||
return;
|
||||
|
||||
rcu_assign_pointer(ifibss->presp, presp);
|
||||
mgmt = (void *)presp->head;
|
||||
|
||||
sdata->vif.bss_conf.enable_beacon = true;
|
||||
sdata->vif.bss_conf.beacon_int = beacon_int;
|
||||
|
|
@ -891,6 +924,17 @@ static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata)
|
|||
return;
|
||||
}
|
||||
|
||||
/* if a fixed bssid and a fixed freq have been provided create the IBSS
|
||||
* directly and do not waste time scanning
|
||||
*/
|
||||
if (ifibss->fixed_bssid && ifibss->fixed_channel) {
|
||||
sdata_info(sdata, "Created IBSS using preconfigured BSSID %pM\n",
|
||||
bssid);
|
||||
ieee80211_sta_create_ibss(sdata);
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n");
|
||||
|
||||
/* Selected IBSS not found in current scan results - try to scan */
|
||||
|
|
|
|||
|
|
@ -53,9 +53,6 @@ struct ieee80211_local;
|
|||
* increased memory use (about 2 kB of RAM per entry). */
|
||||
#define IEEE80211_FRAGMENT_MAX 4
|
||||
|
||||
#define TU_TO_JIFFIES(x) (usecs_to_jiffies((x) * 1024))
|
||||
#define TU_TO_EXP_TIME(x) (jiffies + TU_TO_JIFFIES(x))
|
||||
|
||||
/* power level hasn't been configured (or set to automatic) */
|
||||
#define IEEE80211_UNSET_POWER_LEVEL INT_MIN
|
||||
|
||||
|
|
|
|||
|
|
@ -93,6 +93,9 @@ static int ieee80211_key_enable_hw_accel(struct ieee80211_key *key)
|
|||
|
||||
might_sleep();
|
||||
|
||||
if (key->flags & KEY_FLAG_TAINTED)
|
||||
return -EINVAL;
|
||||
|
||||
if (!key->local->ops->set_key)
|
||||
goto out_unsupported;
|
||||
|
||||
|
|
@ -455,6 +458,7 @@ int ieee80211_key_link(struct ieee80211_key *key,
|
|||
struct ieee80211_sub_if_data *sdata,
|
||||
struct sta_info *sta)
|
||||
{
|
||||
struct ieee80211_local *local = sdata->local;
|
||||
struct ieee80211_key *old_key;
|
||||
int idx, ret;
|
||||
bool pairwise;
|
||||
|
|
@ -484,10 +488,13 @@ int ieee80211_key_link(struct ieee80211_key *key,
|
|||
|
||||
ieee80211_debugfs_key_add(key);
|
||||
|
||||
ret = ieee80211_key_enable_hw_accel(key);
|
||||
|
||||
if (ret)
|
||||
ieee80211_key_free(key, true);
|
||||
if (!local->wowlan) {
|
||||
ret = ieee80211_key_enable_hw_accel(key);
|
||||
if (ret)
|
||||
ieee80211_key_free(key, true);
|
||||
} else {
|
||||
ret = 0;
|
||||
}
|
||||
|
||||
mutex_unlock(&sdata->local->key_mtx);
|
||||
|
||||
|
|
@ -540,7 +547,7 @@ void ieee80211_iter_keys(struct ieee80211_hw *hw,
|
|||
void *iter_data)
|
||||
{
|
||||
struct ieee80211_local *local = hw_to_local(hw);
|
||||
struct ieee80211_key *key;
|
||||
struct ieee80211_key *key, *tmp;
|
||||
struct ieee80211_sub_if_data *sdata;
|
||||
|
||||
ASSERT_RTNL();
|
||||
|
|
@ -548,13 +555,14 @@ void ieee80211_iter_keys(struct ieee80211_hw *hw,
|
|||
mutex_lock(&local->key_mtx);
|
||||
if (vif) {
|
||||
sdata = vif_to_sdata(vif);
|
||||
list_for_each_entry(key, &sdata->key_list, list)
|
||||
list_for_each_entry_safe(key, tmp, &sdata->key_list, list)
|
||||
iter(hw, &sdata->vif,
|
||||
key->sta ? &key->sta->sta : NULL,
|
||||
&key->conf, iter_data);
|
||||
} else {
|
||||
list_for_each_entry(sdata, &local->interfaces, list)
|
||||
list_for_each_entry(key, &sdata->key_list, list)
|
||||
list_for_each_entry_safe(key, tmp,
|
||||
&sdata->key_list, list)
|
||||
iter(hw, &sdata->vif,
|
||||
key->sta ? &key->sta->sta : NULL,
|
||||
&key->conf, iter_data);
|
||||
|
|
@ -751,3 +759,135 @@ void ieee80211_get_key_rx_seq(struct ieee80211_key_conf *keyconf,
|
|||
}
|
||||
}
|
||||
EXPORT_SYMBOL(ieee80211_get_key_rx_seq);
|
||||
|
||||
void ieee80211_set_key_tx_seq(struct ieee80211_key_conf *keyconf,
|
||||
struct ieee80211_key_seq *seq)
|
||||
{
|
||||
struct ieee80211_key *key;
|
||||
u64 pn64;
|
||||
|
||||
key = container_of(keyconf, struct ieee80211_key, conf);
|
||||
|
||||
switch (key->conf.cipher) {
|
||||
case WLAN_CIPHER_SUITE_TKIP:
|
||||
key->u.tkip.tx.iv32 = seq->tkip.iv32;
|
||||
key->u.tkip.tx.iv16 = seq->tkip.iv16;
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_CCMP:
|
||||
pn64 = (u64)seq->ccmp.pn[5] |
|
||||
((u64)seq->ccmp.pn[4] << 8) |
|
||||
((u64)seq->ccmp.pn[3] << 16) |
|
||||
((u64)seq->ccmp.pn[2] << 24) |
|
||||
((u64)seq->ccmp.pn[1] << 32) |
|
||||
((u64)seq->ccmp.pn[0] << 40);
|
||||
atomic64_set(&key->u.ccmp.tx_pn, pn64);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_AES_CMAC:
|
||||
pn64 = (u64)seq->aes_cmac.pn[5] |
|
||||
((u64)seq->aes_cmac.pn[4] << 8) |
|
||||
((u64)seq->aes_cmac.pn[3] << 16) |
|
||||
((u64)seq->aes_cmac.pn[2] << 24) |
|
||||
((u64)seq->aes_cmac.pn[1] << 32) |
|
||||
((u64)seq->aes_cmac.pn[0] << 40);
|
||||
atomic64_set(&key->u.aes_cmac.tx_pn, pn64);
|
||||
break;
|
||||
default:
|
||||
WARN_ON(1);
|
||||
break;
|
||||
}
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(ieee80211_set_key_tx_seq);
|
||||
|
||||
void ieee80211_set_key_rx_seq(struct ieee80211_key_conf *keyconf,
|
||||
int tid, struct ieee80211_key_seq *seq)
|
||||
{
|
||||
struct ieee80211_key *key;
|
||||
u8 *pn;
|
||||
|
||||
key = container_of(keyconf, struct ieee80211_key, conf);
|
||||
|
||||
switch (key->conf.cipher) {
|
||||
case WLAN_CIPHER_SUITE_TKIP:
|
||||
if (WARN_ON(tid < 0 || tid >= IEEE80211_NUM_TIDS))
|
||||
return;
|
||||
key->u.tkip.rx[tid].iv32 = seq->tkip.iv32;
|
||||
key->u.tkip.rx[tid].iv16 = seq->tkip.iv16;
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_CCMP:
|
||||
if (WARN_ON(tid < -1 || tid >= IEEE80211_NUM_TIDS))
|
||||
return;
|
||||
if (tid < 0)
|
||||
pn = key->u.ccmp.rx_pn[IEEE80211_NUM_TIDS];
|
||||
else
|
||||
pn = key->u.ccmp.rx_pn[tid];
|
||||
memcpy(pn, seq->ccmp.pn, IEEE80211_CCMP_PN_LEN);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_AES_CMAC:
|
||||
if (WARN_ON(tid != 0))
|
||||
return;
|
||||
pn = key->u.aes_cmac.rx_pn;
|
||||
memcpy(pn, seq->aes_cmac.pn, IEEE80211_CMAC_PN_LEN);
|
||||
break;
|
||||
default:
|
||||
WARN_ON(1);
|
||||
break;
|
||||
}
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(ieee80211_set_key_rx_seq);
|
||||
|
||||
void ieee80211_remove_key(struct ieee80211_key_conf *keyconf)
|
||||
{
|
||||
struct ieee80211_key *key;
|
||||
|
||||
key = container_of(keyconf, struct ieee80211_key, conf);
|
||||
|
||||
assert_key_lock(key->local);
|
||||
|
||||
/*
|
||||
* if key was uploaded, we assume the driver will/has remove(d)
|
||||
* it, so adjust bookkeeping accordingly
|
||||
*/
|
||||
if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE) {
|
||||
key->flags &= ~KEY_FLAG_UPLOADED_TO_HARDWARE;
|
||||
|
||||
if (!((key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_MMIC) ||
|
||||
(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV) ||
|
||||
(key->conf.flags & IEEE80211_KEY_FLAG_PUT_IV_SPACE)))
|
||||
increment_tailroom_need_count(key->sdata);
|
||||
}
|
||||
|
||||
ieee80211_key_free(key, false);
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(ieee80211_remove_key);
|
||||
|
||||
struct ieee80211_key_conf *
|
||||
ieee80211_gtk_rekey_add(struct ieee80211_vif *vif,
|
||||
struct ieee80211_key_conf *keyconf)
|
||||
{
|
||||
struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
|
||||
struct ieee80211_local *local = sdata->local;
|
||||
struct ieee80211_key *key;
|
||||
int err;
|
||||
|
||||
if (WARN_ON(!local->wowlan))
|
||||
return ERR_PTR(-EINVAL);
|
||||
|
||||
if (WARN_ON(vif->type != NL80211_IFTYPE_STATION))
|
||||
return ERR_PTR(-EINVAL);
|
||||
|
||||
key = ieee80211_key_alloc(keyconf->cipher, keyconf->keyidx,
|
||||
keyconf->keylen, keyconf->key,
|
||||
0, NULL);
|
||||
if (IS_ERR(key))
|
||||
return ERR_PTR(PTR_ERR(key));
|
||||
|
||||
if (sdata->u.mgd.mfp != IEEE80211_MFP_DISABLED)
|
||||
key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
|
||||
|
||||
err = ieee80211_key_link(key, sdata, NULL);
|
||||
if (err)
|
||||
return ERR_PTR(err);
|
||||
|
||||
return &key->conf;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(ieee80211_gtk_rekey_add);
|
||||
|
|
|
|||
|
|
@ -1113,6 +1113,15 @@ ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata,
|
|||
case -1:
|
||||
cfg80211_chandef_create(&new_chandef, new_chan,
|
||||
NL80211_CHAN_NO_HT);
|
||||
/* keep width for 5/10 MHz channels */
|
||||
switch (sdata->vif.bss_conf.chandef.width) {
|
||||
case NL80211_CHAN_WIDTH_5:
|
||||
case NL80211_CHAN_WIDTH_10:
|
||||
new_chandef.width = sdata->vif.bss_conf.chandef.width;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
|
|
|
|||
|
|
@ -210,7 +210,7 @@ static bool rc_no_data_or_no_ack_use_min(struct ieee80211_tx_rate_control *txrc)
|
|||
!ieee80211_is_data(fc);
|
||||
}
|
||||
|
||||
static void rc_send_low_broadcast(s8 *idx, u32 basic_rates,
|
||||
static void rc_send_low_basicrate(s8 *idx, u32 basic_rates,
|
||||
struct ieee80211_supported_band *sband)
|
||||
{
|
||||
u8 i;
|
||||
|
|
@ -263,28 +263,37 @@ static void __rate_control_send_low(struct ieee80211_hw *hw,
|
|||
}
|
||||
|
||||
|
||||
bool rate_control_send_low(struct ieee80211_sta *sta,
|
||||
bool rate_control_send_low(struct ieee80211_sta *pubsta,
|
||||
void *priv_sta,
|
||||
struct ieee80211_tx_rate_control *txrc)
|
||||
{
|
||||
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(txrc->skb);
|
||||
struct ieee80211_supported_band *sband = txrc->sband;
|
||||
struct sta_info *sta;
|
||||
int mcast_rate;
|
||||
bool use_basicrate = false;
|
||||
|
||||
if (!sta || !priv_sta || rc_no_data_or_no_ack_use_min(txrc)) {
|
||||
__rate_control_send_low(txrc->hw, sband, sta, info);
|
||||
if (!pubsta || !priv_sta || rc_no_data_or_no_ack_use_min(txrc)) {
|
||||
__rate_control_send_low(txrc->hw, sband, pubsta, info);
|
||||
|
||||
if (!sta && txrc->bss) {
|
||||
if (!pubsta && txrc->bss) {
|
||||
mcast_rate = txrc->bss_conf->mcast_rate[sband->band];
|
||||
if (mcast_rate > 0) {
|
||||
info->control.rates[0].idx = mcast_rate - 1;
|
||||
return true;
|
||||
}
|
||||
use_basicrate = true;
|
||||
} else if (pubsta) {
|
||||
sta = container_of(pubsta, struct sta_info, sta);
|
||||
if (ieee80211_vif_is_mesh(&sta->sdata->vif))
|
||||
use_basicrate = true;
|
||||
}
|
||||
|
||||
rc_send_low_broadcast(&info->control.rates[0].idx,
|
||||
if (use_basicrate)
|
||||
rc_send_low_basicrate(&info->control.rates[0].idx,
|
||||
txrc->bss_conf->basic_rates,
|
||||
sband);
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
|
|
|
|||
|
|
@ -439,12 +439,13 @@ minstrel_aggr_check(struct ieee80211_sta *pubsta, struct sk_buff *skb)
|
|||
{
|
||||
struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
|
||||
struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
|
||||
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
|
||||
u16 tid;
|
||||
|
||||
if (unlikely(!ieee80211_is_data_qos(hdr->frame_control)))
|
||||
return;
|
||||
|
||||
if (unlikely(skb->protocol == cpu_to_be16(ETH_P_PAE)))
|
||||
if (unlikely(info->control.flags & IEEE80211_TX_CTRL_PORT_CTRL_PROTO))
|
||||
return;
|
||||
|
||||
tid = *ieee80211_get_qos_ctl(hdr) & IEEE80211_QOS_CTL_TID_MASK;
|
||||
|
|
@ -776,7 +777,7 @@ minstrel_ht_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
|
|||
|
||||
/* Don't use EAPOL frames for sampling on non-mrr hw */
|
||||
if (mp->hw->max_rates == 1 &&
|
||||
txrc->skb->protocol == cpu_to_be16(ETH_P_PAE))
|
||||
(info->control.flags & IEEE80211_TX_CTRL_PORT_CTRL_PROTO))
|
||||
sample_idx = -1;
|
||||
else
|
||||
sample_idx = minstrel_get_sample_rate(mp, mi);
|
||||
|
|
|
|||
|
|
@ -1054,207 +1054,6 @@ ieee80211_rx_h_check(struct ieee80211_rx_data *rx)
|
|||
}
|
||||
|
||||
|
||||
static ieee80211_rx_result debug_noinline
|
||||
ieee80211_rx_h_decrypt(struct ieee80211_rx_data *rx)
|
||||
{
|
||||
struct sk_buff *skb = rx->skb;
|
||||
struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
|
||||
struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
|
||||
int keyidx;
|
||||
int hdrlen;
|
||||
ieee80211_rx_result result = RX_DROP_UNUSABLE;
|
||||
struct ieee80211_key *sta_ptk = NULL;
|
||||
int mmie_keyidx = -1;
|
||||
__le16 fc;
|
||||
|
||||
/*
|
||||
* Key selection 101
|
||||
*
|
||||
* There are four types of keys:
|
||||
* - GTK (group keys)
|
||||
* - IGTK (group keys for management frames)
|
||||
* - PTK (pairwise keys)
|
||||
* - STK (station-to-station pairwise keys)
|
||||
*
|
||||
* When selecting a key, we have to distinguish between multicast
|
||||
* (including broadcast) and unicast frames, the latter can only
|
||||
* use PTKs and STKs while the former always use GTKs and IGTKs.
|
||||
* Unless, of course, actual WEP keys ("pre-RSNA") are used, then
|
||||
* unicast frames can also use key indices like GTKs. Hence, if we
|
||||
* don't have a PTK/STK we check the key index for a WEP key.
|
||||
*
|
||||
* Note that in a regular BSS, multicast frames are sent by the
|
||||
* AP only, associated stations unicast the frame to the AP first
|
||||
* which then multicasts it on their behalf.
|
||||
*
|
||||
* There is also a slight problem in IBSS mode: GTKs are negotiated
|
||||
* with each station, that is something we don't currently handle.
|
||||
* The spec seems to expect that one negotiates the same key with
|
||||
* every station but there's no such requirement; VLANs could be
|
||||
* possible.
|
||||
*/
|
||||
|
||||
/*
|
||||
* No point in finding a key and decrypting if the frame is neither
|
||||
* addressed to us nor a multicast frame.
|
||||
*/
|
||||
if (!(status->rx_flags & IEEE80211_RX_RA_MATCH))
|
||||
return RX_CONTINUE;
|
||||
|
||||
/* start without a key */
|
||||
rx->key = NULL;
|
||||
|
||||
if (rx->sta)
|
||||
sta_ptk = rcu_dereference(rx->sta->ptk);
|
||||
|
||||
fc = hdr->frame_control;
|
||||
|
||||
if (!ieee80211_has_protected(fc))
|
||||
mmie_keyidx = ieee80211_get_mmie_keyidx(rx->skb);
|
||||
|
||||
if (!is_multicast_ether_addr(hdr->addr1) && sta_ptk) {
|
||||
rx->key = sta_ptk;
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
/* Skip decryption if the frame is not protected. */
|
||||
if (!ieee80211_has_protected(fc))
|
||||
return RX_CONTINUE;
|
||||
} else if (mmie_keyidx >= 0) {
|
||||
/* Broadcast/multicast robust management frame / BIP */
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
|
||||
if (mmie_keyidx < NUM_DEFAULT_KEYS ||
|
||||
mmie_keyidx >= NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
|
||||
return RX_DROP_MONITOR; /* unexpected BIP keyidx */
|
||||
if (rx->sta)
|
||||
rx->key = rcu_dereference(rx->sta->gtk[mmie_keyidx]);
|
||||
if (!rx->key)
|
||||
rx->key = rcu_dereference(rx->sdata->keys[mmie_keyidx]);
|
||||
} else if (!ieee80211_has_protected(fc)) {
|
||||
/*
|
||||
* The frame was not protected, so skip decryption. However, we
|
||||
* need to set rx->key if there is a key that could have been
|
||||
* used so that the frame may be dropped if encryption would
|
||||
* have been expected.
|
||||
*/
|
||||
struct ieee80211_key *key = NULL;
|
||||
struct ieee80211_sub_if_data *sdata = rx->sdata;
|
||||
int i;
|
||||
|
||||
if (ieee80211_is_mgmt(fc) &&
|
||||
is_multicast_ether_addr(hdr->addr1) &&
|
||||
(key = rcu_dereference(rx->sdata->default_mgmt_key)))
|
||||
rx->key = key;
|
||||
else {
|
||||
if (rx->sta) {
|
||||
for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
|
||||
key = rcu_dereference(rx->sta->gtk[i]);
|
||||
if (key)
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (!key) {
|
||||
for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
|
||||
key = rcu_dereference(sdata->keys[i]);
|
||||
if (key)
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (key)
|
||||
rx->key = key;
|
||||
}
|
||||
return RX_CONTINUE;
|
||||
} else {
|
||||
u8 keyid;
|
||||
/*
|
||||
* The device doesn't give us the IV so we won't be
|
||||
* able to look up the key. That's ok though, we
|
||||
* don't need to decrypt the frame, we just won't
|
||||
* be able to keep statistics accurate.
|
||||
* Except for key threshold notifications, should
|
||||
* we somehow allow the driver to tell us which key
|
||||
* the hardware used if this flag is set?
|
||||
*/
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
|
||||
hdrlen = ieee80211_hdrlen(fc);
|
||||
|
||||
if (rx->skb->len < 8 + hdrlen)
|
||||
return RX_DROP_UNUSABLE; /* TODO: count this? */
|
||||
|
||||
/*
|
||||
* no need to call ieee80211_wep_get_keyidx,
|
||||
* it verifies a bunch of things we've done already
|
||||
*/
|
||||
skb_copy_bits(rx->skb, hdrlen + 3, &keyid, 1);
|
||||
keyidx = keyid >> 6;
|
||||
|
||||
/* check per-station GTK first, if multicast packet */
|
||||
if (is_multicast_ether_addr(hdr->addr1) && rx->sta)
|
||||
rx->key = rcu_dereference(rx->sta->gtk[keyidx]);
|
||||
|
||||
/* if not found, try default key */
|
||||
if (!rx->key) {
|
||||
rx->key = rcu_dereference(rx->sdata->keys[keyidx]);
|
||||
|
||||
/*
|
||||
* RSNA-protected unicast frames should always be
|
||||
* sent with pairwise or station-to-station keys,
|
||||
* but for WEP we allow using a key index as well.
|
||||
*/
|
||||
if (rx->key &&
|
||||
rx->key->conf.cipher != WLAN_CIPHER_SUITE_WEP40 &&
|
||||
rx->key->conf.cipher != WLAN_CIPHER_SUITE_WEP104 &&
|
||||
!is_multicast_ether_addr(hdr->addr1))
|
||||
rx->key = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
if (rx->key) {
|
||||
if (unlikely(rx->key->flags & KEY_FLAG_TAINTED))
|
||||
return RX_DROP_MONITOR;
|
||||
|
||||
rx->key->tx_rx_count++;
|
||||
/* TODO: add threshold stuff again */
|
||||
} else {
|
||||
return RX_DROP_MONITOR;
|
||||
}
|
||||
|
||||
switch (rx->key->conf.cipher) {
|
||||
case WLAN_CIPHER_SUITE_WEP40:
|
||||
case WLAN_CIPHER_SUITE_WEP104:
|
||||
result = ieee80211_crypto_wep_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_TKIP:
|
||||
result = ieee80211_crypto_tkip_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_CCMP:
|
||||
result = ieee80211_crypto_ccmp_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_AES_CMAC:
|
||||
result = ieee80211_crypto_aes_cmac_decrypt(rx);
|
||||
break;
|
||||
default:
|
||||
/*
|
||||
* We can reach here only with HW-only algorithms
|
||||
* but why didn't it decrypt the frame?!
|
||||
*/
|
||||
return RX_DROP_UNUSABLE;
|
||||
}
|
||||
|
||||
/* the hdr variable is invalid after the decrypt handlers */
|
||||
|
||||
/* either the frame has been decrypted or will be dropped */
|
||||
status->flag |= RX_FLAG_DECRYPTED;
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static ieee80211_rx_result debug_noinline
|
||||
ieee80211_rx_h_check_more_data(struct ieee80211_rx_data *rx)
|
||||
{
|
||||
|
|
@ -1556,6 +1355,207 @@ ieee80211_rx_h_sta_process(struct ieee80211_rx_data *rx)
|
|||
return RX_CONTINUE;
|
||||
} /* ieee80211_rx_h_sta_process */
|
||||
|
||||
static ieee80211_rx_result debug_noinline
|
||||
ieee80211_rx_h_decrypt(struct ieee80211_rx_data *rx)
|
||||
{
|
||||
struct sk_buff *skb = rx->skb;
|
||||
struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
|
||||
struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
|
||||
int keyidx;
|
||||
int hdrlen;
|
||||
ieee80211_rx_result result = RX_DROP_UNUSABLE;
|
||||
struct ieee80211_key *sta_ptk = NULL;
|
||||
int mmie_keyidx = -1;
|
||||
__le16 fc;
|
||||
|
||||
/*
|
||||
* Key selection 101
|
||||
*
|
||||
* There are four types of keys:
|
||||
* - GTK (group keys)
|
||||
* - IGTK (group keys for management frames)
|
||||
* - PTK (pairwise keys)
|
||||
* - STK (station-to-station pairwise keys)
|
||||
*
|
||||
* When selecting a key, we have to distinguish between multicast
|
||||
* (including broadcast) and unicast frames, the latter can only
|
||||
* use PTKs and STKs while the former always use GTKs and IGTKs.
|
||||
* Unless, of course, actual WEP keys ("pre-RSNA") are used, then
|
||||
* unicast frames can also use key indices like GTKs. Hence, if we
|
||||
* don't have a PTK/STK we check the key index for a WEP key.
|
||||
*
|
||||
* Note that in a regular BSS, multicast frames are sent by the
|
||||
* AP only, associated stations unicast the frame to the AP first
|
||||
* which then multicasts it on their behalf.
|
||||
*
|
||||
* There is also a slight problem in IBSS mode: GTKs are negotiated
|
||||
* with each station, that is something we don't currently handle.
|
||||
* The spec seems to expect that one negotiates the same key with
|
||||
* every station but there's no such requirement; VLANs could be
|
||||
* possible.
|
||||
*/
|
||||
|
||||
/*
|
||||
* No point in finding a key and decrypting if the frame is neither
|
||||
* addressed to us nor a multicast frame.
|
||||
*/
|
||||
if (!(status->rx_flags & IEEE80211_RX_RA_MATCH))
|
||||
return RX_CONTINUE;
|
||||
|
||||
/* start without a key */
|
||||
rx->key = NULL;
|
||||
|
||||
if (rx->sta)
|
||||
sta_ptk = rcu_dereference(rx->sta->ptk);
|
||||
|
||||
fc = hdr->frame_control;
|
||||
|
||||
if (!ieee80211_has_protected(fc))
|
||||
mmie_keyidx = ieee80211_get_mmie_keyidx(rx->skb);
|
||||
|
||||
if (!is_multicast_ether_addr(hdr->addr1) && sta_ptk) {
|
||||
rx->key = sta_ptk;
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
/* Skip decryption if the frame is not protected. */
|
||||
if (!ieee80211_has_protected(fc))
|
||||
return RX_CONTINUE;
|
||||
} else if (mmie_keyidx >= 0) {
|
||||
/* Broadcast/multicast robust management frame / BIP */
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
|
||||
if (mmie_keyidx < NUM_DEFAULT_KEYS ||
|
||||
mmie_keyidx >= NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
|
||||
return RX_DROP_MONITOR; /* unexpected BIP keyidx */
|
||||
if (rx->sta)
|
||||
rx->key = rcu_dereference(rx->sta->gtk[mmie_keyidx]);
|
||||
if (!rx->key)
|
||||
rx->key = rcu_dereference(rx->sdata->keys[mmie_keyidx]);
|
||||
} else if (!ieee80211_has_protected(fc)) {
|
||||
/*
|
||||
* The frame was not protected, so skip decryption. However, we
|
||||
* need to set rx->key if there is a key that could have been
|
||||
* used so that the frame may be dropped if encryption would
|
||||
* have been expected.
|
||||
*/
|
||||
struct ieee80211_key *key = NULL;
|
||||
struct ieee80211_sub_if_data *sdata = rx->sdata;
|
||||
int i;
|
||||
|
||||
if (ieee80211_is_mgmt(fc) &&
|
||||
is_multicast_ether_addr(hdr->addr1) &&
|
||||
(key = rcu_dereference(rx->sdata->default_mgmt_key)))
|
||||
rx->key = key;
|
||||
else {
|
||||
if (rx->sta) {
|
||||
for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
|
||||
key = rcu_dereference(rx->sta->gtk[i]);
|
||||
if (key)
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (!key) {
|
||||
for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
|
||||
key = rcu_dereference(sdata->keys[i]);
|
||||
if (key)
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (key)
|
||||
rx->key = key;
|
||||
}
|
||||
return RX_CONTINUE;
|
||||
} else {
|
||||
u8 keyid;
|
||||
/*
|
||||
* The device doesn't give us the IV so we won't be
|
||||
* able to look up the key. That's ok though, we
|
||||
* don't need to decrypt the frame, we just won't
|
||||
* be able to keep statistics accurate.
|
||||
* Except for key threshold notifications, should
|
||||
* we somehow allow the driver to tell us which key
|
||||
* the hardware used if this flag is set?
|
||||
*/
|
||||
if ((status->flag & RX_FLAG_DECRYPTED) &&
|
||||
(status->flag & RX_FLAG_IV_STRIPPED))
|
||||
return RX_CONTINUE;
|
||||
|
||||
hdrlen = ieee80211_hdrlen(fc);
|
||||
|
||||
if (rx->skb->len < 8 + hdrlen)
|
||||
return RX_DROP_UNUSABLE; /* TODO: count this? */
|
||||
|
||||
/*
|
||||
* no need to call ieee80211_wep_get_keyidx,
|
||||
* it verifies a bunch of things we've done already
|
||||
*/
|
||||
skb_copy_bits(rx->skb, hdrlen + 3, &keyid, 1);
|
||||
keyidx = keyid >> 6;
|
||||
|
||||
/* check per-station GTK first, if multicast packet */
|
||||
if (is_multicast_ether_addr(hdr->addr1) && rx->sta)
|
||||
rx->key = rcu_dereference(rx->sta->gtk[keyidx]);
|
||||
|
||||
/* if not found, try default key */
|
||||
if (!rx->key) {
|
||||
rx->key = rcu_dereference(rx->sdata->keys[keyidx]);
|
||||
|
||||
/*
|
||||
* RSNA-protected unicast frames should always be
|
||||
* sent with pairwise or station-to-station keys,
|
||||
* but for WEP we allow using a key index as well.
|
||||
*/
|
||||
if (rx->key &&
|
||||
rx->key->conf.cipher != WLAN_CIPHER_SUITE_WEP40 &&
|
||||
rx->key->conf.cipher != WLAN_CIPHER_SUITE_WEP104 &&
|
||||
!is_multicast_ether_addr(hdr->addr1))
|
||||
rx->key = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
if (rx->key) {
|
||||
if (unlikely(rx->key->flags & KEY_FLAG_TAINTED))
|
||||
return RX_DROP_MONITOR;
|
||||
|
||||
rx->key->tx_rx_count++;
|
||||
/* TODO: add threshold stuff again */
|
||||
} else {
|
||||
return RX_DROP_MONITOR;
|
||||
}
|
||||
|
||||
switch (rx->key->conf.cipher) {
|
||||
case WLAN_CIPHER_SUITE_WEP40:
|
||||
case WLAN_CIPHER_SUITE_WEP104:
|
||||
result = ieee80211_crypto_wep_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_TKIP:
|
||||
result = ieee80211_crypto_tkip_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_CCMP:
|
||||
result = ieee80211_crypto_ccmp_decrypt(rx);
|
||||
break;
|
||||
case WLAN_CIPHER_SUITE_AES_CMAC:
|
||||
result = ieee80211_crypto_aes_cmac_decrypt(rx);
|
||||
break;
|
||||
default:
|
||||
/*
|
||||
* We can reach here only with HW-only algorithms
|
||||
* but why didn't it decrypt the frame?!
|
||||
*/
|
||||
return RX_DROP_UNUSABLE;
|
||||
}
|
||||
|
||||
/* the hdr variable is invalid after the decrypt handlers */
|
||||
|
||||
/* either the frame has been decrypted or will be dropped */
|
||||
status->flag |= RX_FLAG_DECRYPTED;
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static inline struct ieee80211_fragment_entry *
|
||||
ieee80211_reassemble_add(struct ieee80211_sub_if_data *sdata,
|
||||
unsigned int frag, unsigned int seq, int rx_queue,
|
||||
|
|
@ -2939,10 +2939,10 @@ static void ieee80211_rx_handlers(struct ieee80211_rx_data *rx,
|
|||
*/
|
||||
rx->skb = skb;
|
||||
|
||||
CALL_RXH(ieee80211_rx_h_decrypt)
|
||||
CALL_RXH(ieee80211_rx_h_check_more_data)
|
||||
CALL_RXH(ieee80211_rx_h_uapsd_and_pspoll)
|
||||
CALL_RXH(ieee80211_rx_h_sta_process)
|
||||
CALL_RXH(ieee80211_rx_h_decrypt)
|
||||
CALL_RXH(ieee80211_rx_h_defragment)
|
||||
CALL_RXH(ieee80211_rx_h_michael_mic_verify)
|
||||
/* must be after MMIC verify so header is counted in MPDU mic */
|
||||
|
|
|
|||
|
|
@ -539,9 +539,11 @@ ieee80211_tx_h_check_control_port_protocol(struct ieee80211_tx_data *tx)
|
|||
{
|
||||
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx->skb);
|
||||
|
||||
if (unlikely(tx->sdata->control_port_protocol == tx->skb->protocol &&
|
||||
tx->sdata->control_port_no_encrypt))
|
||||
info->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
|
||||
if (unlikely(tx->sdata->control_port_protocol == tx->skb->protocol)) {
|
||||
if (tx->sdata->control_port_no_encrypt)
|
||||
info->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
|
||||
info->control.flags |= IEEE80211_TX_CTRL_PORT_CTRL_PROTO;
|
||||
}
|
||||
|
||||
return TX_CONTINUE;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -1453,8 +1453,8 @@ int ieee80211_reconfig(struct ieee80211_local *local)
|
|||
local->resuming = true;
|
||||
|
||||
if (local->wowlan) {
|
||||
local->wowlan = false;
|
||||
res = drv_resume(local);
|
||||
local->wowlan = false;
|
||||
if (res < 0) {
|
||||
local->resuming = false;
|
||||
return res;
|
||||
|
|
|
|||
Loading…
Reference in a new issue