Commit 387910cc authored by Andrei Otcheretianski's avatar Andrei Otcheretianski Committed by Johannes Berg

mac80211: Update CSA counters in mgmt frames

Track current csa counter value and use it
to update mgmt frames at the provided offsets.
Signed-off-by: default avatarAndrei Otcheretianski <andrei.otcheretianski@intel.com>
Signed-off-by: default avatarLuciano Coelho <luciano.coelho@intel.com>
Signed-off-by: default avatarJohannes Berg <johannes.berg@intel.com>
parent 34d22ce2
...@@ -3338,6 +3338,7 @@ __ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev, ...@@ -3338,6 +3338,7 @@ __ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
sdata->csa_radar_required = params->radar_required; sdata->csa_radar_required = params->radar_required;
sdata->csa_chandef = params->chandef; sdata->csa_chandef = params->chandef;
sdata->csa_block_tx = params->block_tx; sdata->csa_block_tx = params->block_tx;
sdata->csa_current_counter = params->count;
sdata->vif.csa_active = true; sdata->vif.csa_active = true;
if (sdata->csa_block_tx) if (sdata->csa_block_tx)
...@@ -3382,6 +3383,7 @@ static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, ...@@ -3382,6 +3383,7 @@ static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
bool need_offchan = false; bool need_offchan = false;
u32 flags; u32 flags;
int ret; int ret;
u8 *data;
if (params->dont_wait_for_ack) if (params->dont_wait_for_ack)
flags = IEEE80211_TX_CTL_NO_ACK; flags = IEEE80211_TX_CTL_NO_ACK;
...@@ -3475,7 +3477,20 @@ static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, ...@@ -3475,7 +3477,20 @@ static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
} }
skb_reserve(skb, local->hw.extra_tx_headroom); skb_reserve(skb, local->hw.extra_tx_headroom);
memcpy(skb_put(skb, params->len), params->buf, params->len); data = skb_put(skb, params->len);
memcpy(data, params->buf, params->len);
/* Update CSA counters */
if (sdata->vif.csa_active &&
(sdata->vif.type == NL80211_IFTYPE_AP ||
sdata->vif.type == NL80211_IFTYPE_ADHOC) &&
params->n_csa_offsets) {
int i;
for (i = 0; i < params->n_csa_offsets; i++)
data[params->csa_offsets[i]] =
sdata->csa_current_counter;
}
IEEE80211_SKB_CB(skb)->flags = flags; IEEE80211_SKB_CB(skb)->flags = flags;
......
...@@ -766,6 +766,7 @@ struct ieee80211_sub_if_data { ...@@ -766,6 +766,7 @@ struct ieee80211_sub_if_data {
struct ieee80211_chanctx *reserved_chanctx; struct ieee80211_chanctx *reserved_chanctx;
struct cfg80211_chan_def reserved_chandef; struct cfg80211_chan_def reserved_chandef;
bool reserved_radar_required; bool reserved_radar_required;
u8 csa_current_counter;
/* used to reconfigure hardware SM PS */ /* used to reconfigure hardware SM PS */
struct work_struct recalc_smps; struct work_struct recalc_smps;
......
...@@ -2449,7 +2449,8 @@ static void ieee80211_update_csa(struct ieee80211_sub_if_data *sdata, ...@@ -2449,7 +2449,8 @@ static void ieee80211_update_csa(struct ieee80211_sub_if_data *sdata,
if (WARN_ON(beacon_data[counter_offset_beacon] == 1)) if (WARN_ON(beacon_data[counter_offset_beacon] == 1))
return; return;
beacon_data[counter_offset_beacon]--; sdata->csa_current_counter--;
beacon_data[counter_offset_beacon] = sdata->csa_current_counter;
if (sdata->vif.type == NL80211_IFTYPE_AP && counter_offset_presp) { if (sdata->vif.type == NL80211_IFTYPE_AP && counter_offset_presp) {
rcu_read_lock(); rcu_read_lock();
...@@ -2460,7 +2461,7 @@ static void ieee80211_update_csa(struct ieee80211_sub_if_data *sdata, ...@@ -2460,7 +2461,7 @@ static void ieee80211_update_csa(struct ieee80211_sub_if_data *sdata,
rcu_read_unlock(); rcu_read_unlock();
return; return;
} }
resp->data[counter_offset_presp]--; resp->data[counter_offset_presp] = sdata->csa_current_counter;
rcu_read_unlock(); rcu_read_unlock();
} }
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment