mirror of
https://github.com/proski/madwifi
synced 2024-11-26 08:21:26 +03:00
ebe8ee9736
* Counters for total outstanding instances for each resource type (skb, ath_node and ath_buf) * One pair of acquisition/release functions per resource type in unlocked and one in locked * Adds some more _debug versions of functions in the call chain that acquire/release resources so that the original func/line in the driver as well as the func/line that affected the resource use can be shown in the trace. Intermediate stack frames aren't necessary to trace the leaks. * Changes naming convention for "lock-required" functions to suffix _locked for the versions that expect locking, to be consistent with some other places in the code. * Consolidate debug messages to the helper functions that actually affect the reference count or acquire/release a resource * Additional sanity checks and leak detection (esp for detecting node ref leaks through skb) * skb references are nulled out by the new sbk unref/free function. I've tested these changes extensively and found lots of cases where we didn't get enough node references when cloning skbuff, and where the kernel drops packets due to performance issues and leaks our node references. With these changes and the tracing enabled I have verified that: * TX BUF: tx buffers always go down to zero when the tx queue is done, and you can watch tx queue usage ratio go up and down again as the driver is working. There are no leaks here at the moment, although there *are* some in the madwifi-dfs branch during CAC at the moment. * skbuff leaks in all the common flows are fixed. We were leaking node references in a lot of places where kernel was dropping skb's due to congestion and we were failing to increment node references when cloning skbuffs. These are now detected, as are skbuffs that are reaped by the kernel while still holding a node reference. * the ath_node count works correctly and on an idle system we get about 5 references per station table node, with 2 node instances per VAP. One for the bss and one for the node in the station table, I believe. The ath_node count goes up and down but always lands back at the stable number based on the vaps you have configured and the number of actual stations in the station table. The point here is that it's pretty constant what you will see over time, despite excessive node creation/release in our code during input (esp input_all). Thank god for the slab allocator. git-svn-id: http://madwifi-project.org/svn/madwifi/trunk@2902 0192ed92-7a03-0410-a25b-9323aeb14dbd
563 lines
17 KiB
C
563 lines
17 KiB
C
/*-
|
|
* Copyright (c) 2001 Atsushi Onoe
|
|
* Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* Alternatively, this software may be distributed under the terms of the
|
|
* GNU General Public License ("GPL") version 2 as published by the Free
|
|
* Software Foundation.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* $Id$
|
|
*/
|
|
#ifndef EXPORT_SYMTAB
|
|
#define EXPORT_SYMTAB
|
|
#endif
|
|
|
|
/*
|
|
* IEEE 802.11 beacon handling routines
|
|
*/
|
|
#ifndef AUTOCONF_INCLUDED
|
|
#include <linux/config.h>
|
|
#endif
|
|
#include <linux/version.h>
|
|
#include <linux/module.h>
|
|
#include <linux/skbuff.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/if_vlan.h>
|
|
|
|
#include "if_media.h"
|
|
#include <net80211/ieee80211_var.h>
|
|
|
|
|
|
static u_int8_t *
|
|
ieee80211_beacon_init(struct ieee80211_node *ni, struct ieee80211_beacon_offsets *bo,
|
|
u_int8_t *frm)
|
|
{
|
|
struct ieee80211vap *vap = ni->ni_vap;
|
|
struct ieee80211com *ic = ni->ni_ic;
|
|
u_int16_t capinfo;
|
|
struct ieee80211_rateset *rs = &ni->ni_rates;
|
|
|
|
KASSERT(ic->ic_bsschan != IEEE80211_CHAN_ANYC, ("no bss chan"));
|
|
|
|
/* XXX timestamp is set by hardware/driver */
|
|
memset(frm, 0, 8);
|
|
frm += 8;
|
|
|
|
/* beacon interval */
|
|
*(__le16 *)frm = htole16(ni->ni_intval);
|
|
frm += 2;
|
|
|
|
/* capability information */
|
|
if (vap->iv_opmode == IEEE80211_M_IBSS)
|
|
capinfo = IEEE80211_CAPINFO_IBSS;
|
|
else
|
|
capinfo = IEEE80211_CAPINFO_ESS;
|
|
if (vap->iv_flags & IEEE80211_F_PRIVACY)
|
|
capinfo |= IEEE80211_CAPINFO_PRIVACY;
|
|
if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
|
|
IEEE80211_IS_CHAN_2GHZ(ic->ic_bsschan))
|
|
capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
|
|
if (ic->ic_flags & IEEE80211_F_SHSLOT)
|
|
capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME;
|
|
if (ic->ic_flags & IEEE80211_F_DOTH)
|
|
capinfo |= IEEE80211_CAPINFO_SPECTRUM_MGMT;
|
|
bo->bo_caps = (__le16 *)frm;
|
|
*(__le16 *)frm = htole16(capinfo);
|
|
frm += 2;
|
|
|
|
/* ssid */
|
|
*frm++ = IEEE80211_ELEMID_SSID;
|
|
if ((vap->iv_flags & IEEE80211_F_HIDESSID) == 0) {
|
|
*frm++ = ni->ni_esslen;
|
|
memcpy(frm, ni->ni_essid, ni->ni_esslen);
|
|
frm += ni->ni_esslen;
|
|
} else
|
|
*frm++ = 0;
|
|
|
|
/* supported rates */
|
|
frm = ieee80211_add_rates(frm, rs);
|
|
|
|
|
|
/* XXX: better way to check this? */
|
|
/* XXX: how about DS ? */
|
|
if (!IEEE80211_IS_CHAN_FHSS(ic->ic_bsschan)) {
|
|
*frm++ = IEEE80211_ELEMID_DSPARMS;
|
|
*frm++ = 1;
|
|
*frm++ = ieee80211_chan2ieee(ic, ic->ic_bsschan);
|
|
}
|
|
bo->bo_tim = frm;
|
|
|
|
/* IBSS/TIM */
|
|
if (vap->iv_opmode == IEEE80211_M_IBSS) {
|
|
*frm++ = IEEE80211_ELEMID_IBSSPARMS;
|
|
*frm++ = 2;
|
|
*frm++ = 0; *frm++ = 0; /* TODO: ATIM window */
|
|
bo->bo_tim_len = 0;
|
|
} else {
|
|
struct ieee80211_tim_ie *tie = (struct ieee80211_tim_ie *) frm;
|
|
|
|
tie->tim_ie = IEEE80211_ELEMID_TIM;
|
|
tie->tim_len = 4; /* length */
|
|
tie->tim_count = 0; /* DTIM count */
|
|
tie->tim_period = vap->iv_dtim_period; /* DTIM period */
|
|
tie->tim_bitctl = 0; /* bitmap control */
|
|
tie->tim_bitmap[0] = 0; /* Partial Virtual Bitmap */
|
|
frm += sizeof(struct ieee80211_tim_ie);
|
|
bo->bo_tim_len = 1;
|
|
}
|
|
bo->bo_tim_trailer = frm;
|
|
|
|
/* country */
|
|
if ((ic->ic_flags & IEEE80211_F_DOTH) ||
|
|
(ic->ic_flags_ext & IEEE80211_FEXT_COUNTRYIE)) {
|
|
frm = ieee80211_add_country(frm, ic);
|
|
}
|
|
|
|
/* power constraint */
|
|
if (ic->ic_flags & IEEE80211_F_DOTH) {
|
|
*frm++ = IEEE80211_ELEMID_PWRCNSTR;
|
|
*frm++ = 1;
|
|
*frm++ = IEEE80211_PWRCONSTRAINT_VAL(ic);
|
|
}
|
|
|
|
/* XXX: channel switch announcement ? */
|
|
bo->bo_chanswitch = frm;
|
|
|
|
/* ERP */
|
|
if (IEEE80211_IS_CHAN_ANYG(ic->ic_bsschan)) {
|
|
bo->bo_erp = frm;
|
|
frm = ieee80211_add_erp(frm, ic);
|
|
}
|
|
|
|
/* Ext. Supp. Rates */
|
|
frm = ieee80211_add_xrates(frm, rs);
|
|
|
|
/* WME */
|
|
if (vap->iv_flags & IEEE80211_F_WME) {
|
|
bo->bo_wme = frm;
|
|
frm = ieee80211_add_wme_param(frm, &ic->ic_wme, IEEE80211_VAP_UAPSD_ENABLED(vap));
|
|
vap->iv_flags &= ~IEEE80211_F_WMEUPDATE;
|
|
}
|
|
|
|
/* WPA 1+2 */
|
|
if (vap->iv_flags & IEEE80211_F_WPA)
|
|
frm = ieee80211_add_wpa(frm, vap);
|
|
|
|
/* athAdvCaps */
|
|
bo->bo_ath_caps = frm;
|
|
if (vap->iv_bss && vap->iv_bss->ni_ath_flags)
|
|
frm = ieee80211_add_athAdvCap(frm, vap->iv_bss->ni_ath_flags,
|
|
vap->iv_bss->ni_ath_defkeyindex);
|
|
|
|
/* XR */
|
|
bo->bo_xr = frm;
|
|
#ifdef ATH_SUPERG_XR
|
|
if (vap->iv_xrvap && vap->iv_ath_cap & IEEE80211_ATHC_XR) /* XR */
|
|
frm = ieee80211_add_xr_param(frm, vap);
|
|
#endif
|
|
bo->bo_appie_buf = frm;
|
|
bo->bo_appie_buf_len = 0;
|
|
|
|
bo->bo_tim_trailerlen = frm - bo->bo_tim_trailer;
|
|
bo->bo_chanswitch_trailerlen = frm - bo->bo_chanswitch;
|
|
|
|
return frm;
|
|
}
|
|
|
|
|
|
/*
|
|
* Allocate a beacon frame and fillin the appropriate bits.
|
|
*/
|
|
struct sk_buff *
|
|
ieee80211_beacon_alloc(struct ieee80211_node *ni,
|
|
struct ieee80211_beacon_offsets *bo)
|
|
{
|
|
struct ieee80211vap *vap = ni->ni_vap;
|
|
struct ieee80211com *ic = ni->ni_ic;
|
|
struct ieee80211_frame *wh;
|
|
struct sk_buff *skb;
|
|
int pktlen;
|
|
u_int8_t *frm;
|
|
struct ieee80211_rateset *rs;
|
|
|
|
/*
|
|
* beacon frame format
|
|
* [8] time stamp
|
|
* [2] beacon interval
|
|
* [2] capability information
|
|
* [tlv] ssid
|
|
* [tlv] supported rates
|
|
* [7] FH/DS parameter set
|
|
* [tlv] IBSS/TIM parameter set
|
|
* [tlv] country code
|
|
* [3] power constraint
|
|
* [5] channel switch announcement
|
|
* [3] extended rate phy (ERP)
|
|
* [tlv] extended supported rates
|
|
* [tlv] WME parameters
|
|
* [tlv] WPA/RSN parameters
|
|
* [tlv] Atheros Advanced Capabilities
|
|
* [tlv] AtherosXR parameters
|
|
* XXX Vendor-specific OIDs (e.g. Atheros)
|
|
* NB: we allocate the max space required for the TIM bitmap.
|
|
*/
|
|
rs = &ni->ni_rates;
|
|
pktlen = 8 /* time stamp */
|
|
+ sizeof(u_int16_t) /* beacon interval */
|
|
+ sizeof(u_int16_t) /* capability information */
|
|
+ 2 + ni->ni_esslen /* ssid */
|
|
+ 2 + IEEE80211_RATE_SIZE /* supported rates */
|
|
+ 7 /* FH/DS parameters max(7,3) */
|
|
+ 2 + 4 + vap->iv_tim_len /* IBSS/TIM parameter set*/
|
|
+ ic->ic_country_ie.country_len + 2 /* country code */
|
|
+ 3 /* power constraint */
|
|
+ 5 /* channel switch announcement */
|
|
+ 3 /* ERP */
|
|
+ 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE) /* Ext. Supp. Rates */
|
|
+ (vap->iv_caps & IEEE80211_C_WME ? /* WME */
|
|
sizeof(struct ieee80211_wme_param) : 0)
|
|
+ (vap->iv_caps & IEEE80211_C_WPA ? /* WPA 1+2 */
|
|
2 * sizeof(struct ieee80211_ie_wpa) : 0)
|
|
+ sizeof(struct ieee80211_ie_athAdvCap)
|
|
#ifdef ATH_SUPERG_XR
|
|
+ (ic->ic_ath_cap & IEEE80211_ATHC_XR ? /* XR */
|
|
sizeof(struct ieee80211_xr_param) : 0)
|
|
#endif
|
|
;
|
|
skb = ieee80211_getmgtframe(&frm, pktlen);
|
|
if (skb == NULL) {
|
|
IEEE80211_NOTE(vap, IEEE80211_MSG_ANY, ni,
|
|
"%s: cannot get buf; size %u", __func__, pktlen);
|
|
vap->iv_stats.is_tx_nobuf++;
|
|
return NULL;
|
|
}
|
|
|
|
SKB_CB(skb)->ni = ieee80211_ref_node(ni);
|
|
|
|
frm = ieee80211_beacon_init(ni, bo, frm);
|
|
|
|
skb_trim(skb, frm - skb->data);
|
|
|
|
wh = (struct ieee80211_frame *)
|
|
skb_push(skb, sizeof(struct ieee80211_frame));
|
|
wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT |
|
|
IEEE80211_FC0_SUBTYPE_BEACON;
|
|
wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
|
|
wh->i_dur = 0;
|
|
IEEE80211_ADDR_COPY(wh->i_addr1, ic->ic_dev->broadcast);
|
|
IEEE80211_ADDR_COPY(wh->i_addr2, vap->iv_myaddr);
|
|
IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid);
|
|
*(u_int16_t *)wh->i_seq = 0;
|
|
|
|
return skb;
|
|
}
|
|
EXPORT_SYMBOL(ieee80211_beacon_alloc);
|
|
|
|
/*
|
|
* Update the dynamic parts of a beacon frame based on the current state.
|
|
*/
|
|
int
|
|
ieee80211_beacon_update(struct ieee80211_node *ni,
|
|
struct ieee80211_beacon_offsets *bo, struct sk_buff *skb, int mcast)
|
|
{
|
|
struct ieee80211vap *vap = ni->ni_vap;
|
|
struct ieee80211com *ic = ni->ni_ic;
|
|
int len_changed = 0;
|
|
u_int16_t capinfo;
|
|
|
|
IEEE80211_LOCK_IRQ(ic);
|
|
|
|
/* Check if we need to change channel right now */
|
|
|
|
if ((ic->ic_flags & IEEE80211_F_DOTH) &&
|
|
(vap->iv_flags & IEEE80211_F_CHANSWITCH)) {
|
|
struct ieee80211_channel *c =
|
|
ieee80211_doth_findchan(vap, ic->ic_chanchange_chan);
|
|
|
|
if (!vap->iv_chanchange_count && !c) {
|
|
vap->iv_flags &= ~IEEE80211_F_CHANSWITCH;
|
|
ic->ic_flags &= ~IEEE80211_F_CHANSWITCH;
|
|
} else if (vap->iv_chanchange_count == ic->ic_chanchange_tbtt) {
|
|
u_int8_t *frm;
|
|
|
|
IEEE80211_DPRINTF(vap, IEEE80211_MSG_DOTH,
|
|
"%s: reinit beacon\n", __func__);
|
|
|
|
/* NB: ic_bsschan is in the DSPARMS beacon IE, so must
|
|
* set this prior to the beacon re-init, below. */
|
|
if (c == NULL) {
|
|
/* Requested channel invalid; drop the channel
|
|
* switch announcement and do nothing. */
|
|
IEEE80211_DPRINTF(vap, IEEE80211_MSG_DOTH,
|
|
"%s: find channel failure\n", __func__);
|
|
} else
|
|
ic->ic_bsschan = c;
|
|
|
|
skb_pull(skb, sizeof(struct ieee80211_frame));
|
|
skb_trim(skb, 0);
|
|
frm = skb->data;
|
|
skb_put(skb, ieee80211_beacon_init(ni, bo, frm) - frm);
|
|
skb_push(skb, sizeof(struct ieee80211_frame));
|
|
|
|
vap->iv_chanchange_count = 0;
|
|
vap->iv_flags &= ~IEEE80211_F_CHANSWITCH;
|
|
ic->ic_flags &= ~IEEE80211_F_CHANSWITCH;
|
|
|
|
/* NB: Only for the first VAP to get here, and when we
|
|
* have a valid channel to which to change. */
|
|
if (c && (ic->ic_curchan != c)) {
|
|
ic->ic_curchan = c;
|
|
ic->ic_set_channel(ic);
|
|
}
|
|
|
|
len_changed = 1;
|
|
}
|
|
}
|
|
|
|
/* XXX faster to recalculate entirely or just changes? */
|
|
if (vap->iv_opmode == IEEE80211_M_IBSS)
|
|
capinfo = IEEE80211_CAPINFO_IBSS;
|
|
else
|
|
capinfo = IEEE80211_CAPINFO_ESS;
|
|
|
|
if (vap->iv_flags & IEEE80211_F_PRIVACY)
|
|
capinfo |= IEEE80211_CAPINFO_PRIVACY;
|
|
if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
|
|
IEEE80211_IS_CHAN_2GHZ(ic->ic_bsschan))
|
|
capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
|
|
if (ic->ic_flags & IEEE80211_F_SHSLOT)
|
|
capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME;
|
|
if (ic->ic_flags & IEEE80211_F_DOTH)
|
|
capinfo |= IEEE80211_CAPINFO_SPECTRUM_MGMT;
|
|
|
|
*bo->bo_caps = htole16(capinfo);
|
|
|
|
if (vap->iv_flags & IEEE80211_F_WME) {
|
|
struct ieee80211_wme_state *wme = &ic->ic_wme;
|
|
|
|
/*
|
|
* Check for aggressive mode change. When there is
|
|
* significant high priority traffic in the BSS
|
|
* throttle back BE traffic by using conservative
|
|
* parameters. Otherwise BE uses aggressive params
|
|
* to optimize performance of legacy/non-QoS traffic.
|
|
*/
|
|
if (wme->wme_flags & WME_F_AGGRMODE) {
|
|
if (wme->wme_hipri_traffic >
|
|
wme->wme_hipri_switch_thresh) {
|
|
IEEE80211_NOTE(vap, IEEE80211_MSG_WME, ni,
|
|
"%s: traffic %u, disable aggressive mode",
|
|
__func__, wme->wme_hipri_traffic);
|
|
wme->wme_flags &= ~WME_F_AGGRMODE;
|
|
ieee80211_wme_updateparams_locked(vap);
|
|
wme->wme_hipri_traffic =
|
|
wme->wme_hipri_switch_hysteresis;
|
|
} else
|
|
wme->wme_hipri_traffic = 0;
|
|
} else {
|
|
if (wme->wme_hipri_traffic <=
|
|
wme->wme_hipri_switch_thresh) {
|
|
IEEE80211_NOTE(vap, IEEE80211_MSG_WME, ni,
|
|
"%s: traffic %u, enable aggressive mode",
|
|
__func__, wme->wme_hipri_traffic);
|
|
wme->wme_flags |= WME_F_AGGRMODE;
|
|
ieee80211_wme_updateparams_locked(vap);
|
|
wme->wme_hipri_traffic = 0;
|
|
} else
|
|
wme->wme_hipri_traffic =
|
|
wme->wme_hipri_switch_hysteresis;
|
|
}
|
|
/* XXX multi-bss */
|
|
if (vap->iv_flags & IEEE80211_F_WMEUPDATE) {
|
|
(void) ieee80211_add_wme_param(bo->bo_wme, wme, IEEE80211_VAP_UAPSD_ENABLED(vap));
|
|
vap->iv_flags &= ~IEEE80211_F_WMEUPDATE;
|
|
}
|
|
}
|
|
|
|
if (vap->iv_opmode == IEEE80211_M_HOSTAP) { /* NB: no IBSS support*/
|
|
struct ieee80211_tim_ie *tie =
|
|
(struct ieee80211_tim_ie *) bo->bo_tim;
|
|
if (vap->iv_flags & IEEE80211_F_TIMUPDATE) {
|
|
u_int timlen, timoff, i;
|
|
/*
|
|
* ATIM/DTIM needs updating. If it fits in the
|
|
* current space allocated then just copy in the
|
|
* new bits. Otherwise we need to move any trailing
|
|
* data to make room. Note that we know there is
|
|
* contiguous space because ieee80211_beacon_allocate
|
|
* ensures there is space in the mbuf to write a
|
|
* maximal-size virtual bitmap (based on ic_max_aid).
|
|
*/
|
|
/*
|
|
* Calculate the bitmap size and offset, copy any
|
|
* trailer out of the way, and then copy in the
|
|
* new bitmap and update the information element.
|
|
* Note that the tim bitmap must contain at least
|
|
* one byte and any offset must be even.
|
|
*/
|
|
if (vap->iv_ps_pending != 0) {
|
|
timoff = 128; /* impossibly large */
|
|
for (i = 0; i < vap->iv_tim_len; i++)
|
|
if (vap->iv_tim_bitmap[i]) {
|
|
timoff = i &~ 1;
|
|
break;
|
|
}
|
|
KASSERT(timoff != 128, ("tim bitmap empty!"));
|
|
for (i = vap->iv_tim_len-1; i >= timoff; i--)
|
|
if (vap->iv_tim_bitmap[i])
|
|
break;
|
|
timlen = 1 + (i - timoff);
|
|
} else {
|
|
timoff = 0;
|
|
timlen = 1;
|
|
}
|
|
if (timlen != bo->bo_tim_len) {
|
|
/* copy up/down trailer */
|
|
int trailer_adjust =
|
|
(tie->tim_bitmap+timlen) - (bo->bo_tim_trailer);
|
|
memmove(tie->tim_bitmap+timlen, bo->bo_tim_trailer,
|
|
bo->bo_tim_trailerlen);
|
|
bo->bo_tim_trailer = tie->tim_bitmap+timlen;
|
|
bo->bo_chanswitch += trailer_adjust;
|
|
bo->bo_wme += trailer_adjust;
|
|
bo->bo_erp += trailer_adjust;
|
|
bo->bo_ath_caps += trailer_adjust;
|
|
bo->bo_xr += trailer_adjust;
|
|
if (timlen > bo->bo_tim_len)
|
|
skb_put(skb, timlen - bo->bo_tim_len);
|
|
else
|
|
skb_trim(skb, skb->len - (bo->bo_tim_len - timlen));
|
|
bo->bo_tim_len = timlen;
|
|
|
|
/* update information element */
|
|
tie->tim_len = 3 + timlen;
|
|
tie->tim_bitctl = timoff;
|
|
len_changed = 1;
|
|
}
|
|
memcpy(tie->tim_bitmap, vap->iv_tim_bitmap + timoff,
|
|
bo->bo_tim_len);
|
|
|
|
vap->iv_flags &= ~IEEE80211_F_TIMUPDATE;
|
|
|
|
IEEE80211_NOTE(vap, IEEE80211_MSG_POWER, ni,
|
|
"%s: TIM updated, pending %u, off %u, len %u",
|
|
__func__, vap->iv_ps_pending, timoff, timlen);
|
|
}
|
|
/* count down DTIM period */
|
|
if (tie->tim_count == 0)
|
|
tie->tim_count = tie->tim_period - 1;
|
|
else
|
|
tie->tim_count--;
|
|
/* update state for buffered multicast frames on DTIM */
|
|
if (mcast && (tie->tim_count == 0))
|
|
tie->tim_bitctl |= 1;
|
|
else
|
|
tie->tim_bitctl &= ~1;
|
|
|
|
if ((ic->ic_flags & IEEE80211_F_DOTH) &&
|
|
(ic->ic_flags & IEEE80211_F_CHANSWITCH)) {
|
|
|
|
if (!vap->iv_chanchange_count) {
|
|
vap->iv_flags |= IEEE80211_F_CHANSWITCH;
|
|
|
|
/* copy out trailer to open up a slot */
|
|
memmove(bo->bo_chanswitch + IEEE80211_CHANSWITCHANN_BYTES,
|
|
bo->bo_chanswitch, bo->bo_chanswitch_trailerlen);
|
|
|
|
/* add ie in opened slot */
|
|
bo->bo_chanswitch[0] = IEEE80211_ELEMID_CHANSWITCHANN;
|
|
bo->bo_chanswitch[1] = 3; /* fixed length */
|
|
bo->bo_chanswitch[2] = 1; /* stas get off for now */
|
|
bo->bo_chanswitch[3] = ic->ic_chanchange_chan;
|
|
bo->bo_chanswitch[4] = ic->ic_chanchange_tbtt;
|
|
|
|
/* update the trailer lens */
|
|
bo->bo_chanswitch_trailerlen += IEEE80211_CHANSWITCHANN_BYTES;
|
|
bo->bo_tim_trailerlen += IEEE80211_CHANSWITCHANN_BYTES;
|
|
bo->bo_wme += IEEE80211_CHANSWITCHANN_BYTES;
|
|
bo->bo_erp += IEEE80211_CHANSWITCHANN_BYTES;
|
|
bo->bo_ath_caps += IEEE80211_CHANSWITCHANN_BYTES;
|
|
bo->bo_xr += IEEE80211_CHANSWITCHANN_BYTES;
|
|
|
|
/* indicate new beacon length so other layers may manage memory */
|
|
skb_put(skb, IEEE80211_CHANSWITCHANN_BYTES);
|
|
len_changed = 1;
|
|
} else
|
|
bo->bo_chanswitch[4]--;
|
|
|
|
vap->iv_chanchange_count++;
|
|
IEEE80211_DPRINTF(vap, IEEE80211_MSG_DOTH,
|
|
"%s: CHANSWITCH IE, change in %d\n",
|
|
__func__, bo->bo_chanswitch[4]);
|
|
}
|
|
#ifdef ATH_SUPERG_XR
|
|
if (vap->iv_flags & IEEE80211_F_XRUPDATE) {
|
|
if (vap->iv_xrvap)
|
|
(void) ieee80211_add_xr_param(bo->bo_xr, vap);
|
|
vap->iv_flags &= ~IEEE80211_F_XRUPDATE;
|
|
}
|
|
#endif
|
|
if ((ic->ic_flags_ext & IEEE80211_FEXT_ERPUPDATE) && (bo->bo_erp != NULL)) {
|
|
(void) ieee80211_add_erp(bo->bo_erp, ic);
|
|
ic->ic_flags_ext &= ~IEEE80211_FEXT_ERPUPDATE;
|
|
}
|
|
}
|
|
/* if it is a mode change beacon for dynamic turbo case */
|
|
if (((ic->ic_ath_cap & IEEE80211_ATHC_BOOST) != 0) ^
|
|
IEEE80211_IS_CHAN_TURBO(ic->ic_curchan))
|
|
ieee80211_add_athAdvCap(bo->bo_ath_caps, vap->iv_bss->ni_ath_flags,
|
|
vap->iv_bss->ni_ath_defkeyindex);
|
|
/* add APP_IE buffer if app updated it */
|
|
if (vap->iv_flags_ext & IEEE80211_FEXT_APPIE_UPDATE) {
|
|
/* adjust the buffer size if the size is changed */
|
|
if (vap->app_ie[IEEE80211_APPIE_FRAME_BEACON].length != bo->bo_appie_buf_len) {
|
|
int diff_len;
|
|
diff_len = vap->app_ie[IEEE80211_APPIE_FRAME_BEACON].length - bo->bo_appie_buf_len;
|
|
|
|
if (diff_len > 0)
|
|
skb_put(skb, diff_len);
|
|
else
|
|
skb_trim(skb, skb->len + diff_len);
|
|
|
|
bo->bo_appie_buf_len = vap->app_ie[IEEE80211_APPIE_FRAME_BEACON].length;
|
|
/* update the trailer lens */
|
|
bo->bo_chanswitch_trailerlen += diff_len;
|
|
bo->bo_tim_trailerlen += diff_len;
|
|
|
|
len_changed = 1;
|
|
}
|
|
memcpy(bo->bo_appie_buf, vap->app_ie[IEEE80211_APPIE_FRAME_BEACON].ie,
|
|
vap->app_ie[IEEE80211_APPIE_FRAME_BEACON].length);
|
|
|
|
vap->iv_flags_ext &= ~IEEE80211_FEXT_APPIE_UPDATE;
|
|
}
|
|
|
|
IEEE80211_UNLOCK_IRQ(ic);
|
|
|
|
return len_changed;
|
|
}
|
|
EXPORT_SYMBOL(ieee80211_beacon_update);
|