1190391Ssam/*- 2190391Ssam * Copyright (c) 2002-2009 Sam Leffler, Errno Consulting 3190391Ssam * All rights reserved. 4190391Ssam * 5190391Ssam * Redistribution and use in source and binary forms, with or without 6190391Ssam * modification, are permitted provided that the following conditions 7190391Ssam * are met: 8190391Ssam * 1. Redistributions of source code must retain the above copyright 9190391Ssam * notice, this list of conditions and the following disclaimer. 10190391Ssam * 2. Redistributions in binary form must reproduce the above copyright 11190391Ssam * notice, this list of conditions and the following disclaimer in the 12190391Ssam * documentation and/or other materials provided with the distribution. 13190391Ssam * 14190391Ssam * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15190391Ssam * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16190391Ssam * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17190391Ssam * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18190391Ssam * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 19190391Ssam * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 20190391Ssam * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 21190391Ssam * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 22190391Ssam * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 23190391Ssam * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24190391Ssam */ 25190391Ssam 26190391Ssam#include <sys/cdefs.h> 27190391Ssam__FBSDID("$FreeBSD$"); 28190391Ssam 29190391Ssam#include "opt_wlan.h" 30190391Ssam 31246226Sadrian#ifdef IEEE80211_SUPPORT_SUPERG 32246226Sadrian 33190391Ssam#include <sys/param.h> 34190391Ssam#include <sys/systm.h> 35190391Ssam#include <sys/mbuf.h> 36190391Ssam#include <sys/kernel.h> 37190391Ssam#include <sys/endian.h> 38190391Ssam 39190391Ssam#include <sys/socket.h> 40190391Ssam 41190391Ssam#include <net/if.h> 42257284Sglebius#include <net/if_var.h> 43190391Ssam#include <net/if_llc.h> 44190391Ssam#include <net/if_media.h> 45257284Sglebius#include <net/bpf.h> 46257284Sglebius#include <net/ethernet.h> 47190391Ssam 48190391Ssam#include <net80211/ieee80211_var.h> 49190391Ssam#include <net80211/ieee80211_input.h> 50190391Ssam#include <net80211/ieee80211_phy.h> 51190391Ssam#include <net80211/ieee80211_superg.h> 52190391Ssam 53190455Ssam/* 54190455Ssam * Atheros fast-frame encapsulation format. 55190455Ssam * FF max payload: 56190455Ssam * 802.2 + FFHDR + HPAD + 802.3 + 802.2 + 1500 + SPAD + 802.3 + 802.2 + 1500: 57190455Ssam * 8 + 4 + 4 + 14 + 8 + 1500 + 6 + 14 + 8 + 1500 58190455Ssam * = 3066 59190455Ssam */ 60190455Ssam/* fast frame header is 32-bits */ 61190455Ssam#define ATH_FF_PROTO 0x0000003f /* protocol */ 62190455Ssam#define ATH_FF_PROTO_S 0 63190455Ssam#define ATH_FF_FTYPE 0x000000c0 /* frame type */ 64190455Ssam#define ATH_FF_FTYPE_S 6 65190455Ssam#define ATH_FF_HLEN32 0x00000300 /* optional hdr length */ 66190455Ssam#define ATH_FF_HLEN32_S 8 67190455Ssam#define ATH_FF_SEQNUM 0x001ffc00 /* sequence number */ 68190455Ssam#define ATH_FF_SEQNUM_S 10 69190455Ssam#define ATH_FF_OFFSET 0xffe00000 /* offset to 2nd payload */ 70190455Ssam#define ATH_FF_OFFSET_S 21 71190455Ssam 72190455Ssam#define ATH_FF_MAX_HDR_PAD 4 73190455Ssam#define ATH_FF_MAX_SEP_PAD 6 74190455Ssam#define ATH_FF_MAX_HDR 30 75190455Ssam 76190455Ssam#define ATH_FF_PROTO_L2TUNNEL 0 /* L2 tunnel protocol */ 77190455Ssam#define ATH_FF_ETH_TYPE 0x88bd /* Ether type for encapsulated frames */ 78190455Ssam#define ATH_FF_SNAP_ORGCODE_0 0x00 79190455Ssam#define ATH_FF_SNAP_ORGCODE_1 0x03 80190455Ssam#define ATH_FF_SNAP_ORGCODE_2 0x7f 81190455Ssam 82190579Ssam#define ATH_FF_TXQMIN 2 /* min txq depth for staging */ 83190579Ssam#define ATH_FF_TXQMAX 50 /* maximum # of queued frames allowed */ 84190579Ssam#define ATH_FF_STAGEMAX 5 /* max waiting period for staged frame*/ 85190579Ssam 86190391Ssam#define ETHER_HEADER_COPY(dst, src) \ 87190391Ssam memcpy(dst, src, sizeof(struct ether_header)) 88190391Ssam 89193115Ssamstatic int ieee80211_ffppsmin = 2; /* pps threshold for ff aggregation */ 90273377ShselaskySYSCTL_INT(_net_wlan, OID_AUTO, ffppsmin, CTLFLAG_RW, 91193115Ssam &ieee80211_ffppsmin, 0, "min packet rate before fast-frame staging"); 92193115Ssamstatic int ieee80211_ffagemax = -1; /* max time frames held on stage q */ 93193115SsamSYSCTL_PROC(_net_wlan, OID_AUTO, ffagemax, CTLTYPE_INT | CTLFLAG_RW, 94193115Ssam &ieee80211_ffagemax, 0, ieee80211_sysctl_msecs_ticks, "I", 95193115Ssam "max hold time for fast-frame staging (ms)"); 96190579Ssam 97190391Ssamvoid 98190391Ssamieee80211_superg_attach(struct ieee80211com *ic) 99190391Ssam{ 100191753Ssam struct ieee80211_superg *sg; 101191753Ssam 102302283Savos IEEE80211_FF_LOCK_INIT(ic, ic->ic_name); 103302283Savos 104297603Sadrian sg = (struct ieee80211_superg *) IEEE80211_MALLOC( 105297603Sadrian sizeof(struct ieee80211_superg), M_80211_VAP, 106297603Sadrian IEEE80211_M_NOWAIT | IEEE80211_M_ZERO); 107297603Sadrian if (sg == NULL) { 108297603Sadrian printf("%s: cannot allocate SuperG state block\n", 109297603Sadrian __func__); 110297603Sadrian return; 111191753Ssam } 112297603Sadrian ic->ic_superg = sg; 113297603Sadrian 114297603Sadrian /* 115297603Sadrian * Default to not being so aggressive for FF/AMSDU 116297603Sadrian * aging, otherwise we may hold a frame around 117297603Sadrian * for way too long before we expire it out. 118297603Sadrian */ 119297603Sadrian ieee80211_ffagemax = msecs_to_ticks(2); 120190391Ssam} 121190391Ssam 122190391Ssamvoid 123190391Ssamieee80211_superg_detach(struct ieee80211com *ic) 124190391Ssam{ 125302283Savos IEEE80211_FF_LOCK_DESTROY(ic); 126302283Savos 127191753Ssam if (ic->ic_superg != NULL) { 128283538Sadrian IEEE80211_FREE(ic->ic_superg, M_80211_VAP); 129191753Ssam ic->ic_superg = NULL; 130191753Ssam } 131190391Ssam} 132190391Ssam 133190391Ssamvoid 134190391Ssamieee80211_superg_vattach(struct ieee80211vap *vap) 135190391Ssam{ 136191753Ssam struct ieee80211com *ic = vap->iv_ic; 137191753Ssam 138191753Ssam if (ic->ic_superg == NULL) /* NB: can't do fast-frames w/o state */ 139191753Ssam vap->iv_caps &= ~IEEE80211_C_FF; 140190391Ssam if (vap->iv_caps & IEEE80211_C_FF) 141190391Ssam vap->iv_flags |= IEEE80211_F_FF; 142190450Ssam /* NB: we only implement sta mode */ 143190450Ssam if (vap->iv_opmode == IEEE80211_M_STA && 144190450Ssam (vap->iv_caps & IEEE80211_C_TURBOP)) 145190391Ssam vap->iv_flags |= IEEE80211_F_TURBOP; 146190391Ssam} 147190391Ssam 148190391Ssamvoid 149190391Ssamieee80211_superg_vdetach(struct ieee80211vap *vap) 150190391Ssam{ 151190391Ssam} 152190391Ssam 153190391Ssam#define ATH_OUI_BYTES 0x00, 0x03, 0x7f 154190391Ssam/* 155190391Ssam * Add a WME information element to a frame. 156190391Ssam */ 157190391Ssamuint8_t * 158190451Ssamieee80211_add_ath(uint8_t *frm, uint8_t caps, ieee80211_keyix defkeyix) 159190391Ssam{ 160190391Ssam static const struct ieee80211_ath_ie info = { 161190391Ssam .ath_id = IEEE80211_ELEMID_VENDOR, 162190391Ssam .ath_len = sizeof(struct ieee80211_ath_ie) - 2, 163190391Ssam .ath_oui = { ATH_OUI_BYTES }, 164190391Ssam .ath_oui_type = ATH_OUI_TYPE, 165190391Ssam .ath_oui_subtype= ATH_OUI_SUBTYPE, 166190391Ssam .ath_version = ATH_OUI_VERSION, 167190391Ssam }; 168190391Ssam struct ieee80211_ath_ie *ath = (struct ieee80211_ath_ie *) frm; 169190391Ssam 170190391Ssam memcpy(frm, &info, sizeof(info)); 171190391Ssam ath->ath_capability = caps; 172190451Ssam if (defkeyix != IEEE80211_KEYIX_NONE) { 173190451Ssam ath->ath_defkeyix[0] = (defkeyix & 0xff); 174190451Ssam ath->ath_defkeyix[1] = ((defkeyix >> 8) & 0xff); 175190451Ssam } else { 176190451Ssam ath->ath_defkeyix[0] = 0xff; 177190451Ssam ath->ath_defkeyix[1] = 0x7f; 178190451Ssam } 179190391Ssam return frm + sizeof(info); 180190391Ssam} 181190391Ssam#undef ATH_OUI_BYTES 182190391Ssam 183190451Ssamuint8_t * 184190451Ssamieee80211_add_athcaps(uint8_t *frm, const struct ieee80211_node *bss) 185190451Ssam{ 186190451Ssam const struct ieee80211vap *vap = bss->ni_vap; 187190451Ssam 188190451Ssam return ieee80211_add_ath(frm, 189190451Ssam vap->iv_flags & IEEE80211_F_ATHEROS, 190190451Ssam ((vap->iv_flags & IEEE80211_F_WPA) == 0 && 191190451Ssam bss->ni_authmode != IEEE80211_AUTH_8021X) ? 192190451Ssam vap->iv_def_txkey : IEEE80211_KEYIX_NONE); 193190451Ssam} 194190451Ssam 195190391Ssamvoid 196190391Ssamieee80211_parse_ath(struct ieee80211_node *ni, uint8_t *ie) 197190391Ssam{ 198190391Ssam const struct ieee80211_ath_ie *ath = 199190391Ssam (const struct ieee80211_ath_ie *) ie; 200190391Ssam 201190391Ssam ni->ni_ath_flags = ath->ath_capability; 202298359Savos ni->ni_ath_defkeyix = le16dec(&ath->ath_defkeyix); 203190391Ssam} 204190391Ssam 205190391Ssamint 206190391Ssamieee80211_parse_athparams(struct ieee80211_node *ni, uint8_t *frm, 207190391Ssam const struct ieee80211_frame *wh) 208190391Ssam{ 209190391Ssam struct ieee80211vap *vap = ni->ni_vap; 210190391Ssam const struct ieee80211_ath_ie *ath; 211190391Ssam u_int len = frm[1]; 212190391Ssam int capschanged; 213190391Ssam uint16_t defkeyix; 214190391Ssam 215190391Ssam if (len < sizeof(struct ieee80211_ath_ie)-2) { 216190391Ssam IEEE80211_DISCARD_IE(vap, 217190391Ssam IEEE80211_MSG_ELEMID | IEEE80211_MSG_SUPERG, 218190391Ssam wh, "Atheros", "too short, len %u", len); 219190391Ssam return -1; 220190391Ssam } 221190391Ssam ath = (const struct ieee80211_ath_ie *)frm; 222190391Ssam capschanged = (ni->ni_ath_flags != ath->ath_capability); 223298359Savos defkeyix = le16dec(ath->ath_defkeyix); 224190391Ssam if (capschanged || defkeyix != ni->ni_ath_defkeyix) { 225190391Ssam ni->ni_ath_flags = ath->ath_capability; 226190391Ssam ni->ni_ath_defkeyix = defkeyix; 227190391Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_SUPERG, ni, 228190391Ssam "ath ie change: new caps 0x%x defkeyix 0x%x", 229190391Ssam ni->ni_ath_flags, ni->ni_ath_defkeyix); 230190391Ssam } 231190391Ssam if (IEEE80211_ATH_CAP(vap, ni, ATHEROS_CAP_TURBO_PRIME)) { 232190391Ssam uint16_t curflags, newflags; 233190391Ssam 234190391Ssam /* 235190391Ssam * Check for turbo mode switch. Calculate flags 236190391Ssam * for the new mode and effect the switch. 237190391Ssam */ 238190391Ssam newflags = curflags = vap->iv_ic->ic_bsschan->ic_flags; 239190391Ssam /* NB: BOOST is not in ic_flags, so get it from the ie */ 240190391Ssam if (ath->ath_capability & ATHEROS_CAP_BOOST) 241190391Ssam newflags |= IEEE80211_CHAN_TURBO; 242190391Ssam else 243190391Ssam newflags &= ~IEEE80211_CHAN_TURBO; 244190391Ssam if (newflags != curflags) 245190391Ssam ieee80211_dturbo_switch(vap, newflags); 246190391Ssam } 247190391Ssam return capschanged; 248190391Ssam} 249190391Ssam 250190391Ssam/* 251190391Ssam * Decap the encapsulated frame pair and dispatch the first 252190391Ssam * for delivery. The second frame is returned for delivery 253190391Ssam * via the normal path. 254190391Ssam */ 255190391Ssamstruct mbuf * 256190391Ssamieee80211_ff_decap(struct ieee80211_node *ni, struct mbuf *m) 257190391Ssam{ 258190391Ssam#define FF_LLC_SIZE (sizeof(struct ether_header) + sizeof(struct llc)) 259190391Ssam#define MS(x,f) (((x) & f) >> f##_S) 260190391Ssam struct ieee80211vap *vap = ni->ni_vap; 261190391Ssam struct llc *llc; 262190391Ssam uint32_t ath; 263190391Ssam struct mbuf *n; 264190391Ssam int framelen; 265190391Ssam 266190391Ssam /* NB: we assume caller does this check for us */ 267190391Ssam KASSERT(IEEE80211_ATH_CAP(vap, ni, IEEE80211_NODE_FF), 268190391Ssam ("ff not negotiated")); 269190391Ssam /* 270190391Ssam * Check for fast-frame tunnel encapsulation. 271190391Ssam */ 272190391Ssam if (m->m_pkthdr.len < 3*FF_LLC_SIZE) 273190391Ssam return m; 274190391Ssam if (m->m_len < FF_LLC_SIZE && 275190391Ssam (m = m_pullup(m, FF_LLC_SIZE)) == NULL) { 276190391Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 277190391Ssam ni->ni_macaddr, "fast-frame", 278190391Ssam "%s", "m_pullup(llc) failed"); 279190391Ssam vap->iv_stats.is_rx_tooshort++; 280190391Ssam return NULL; 281190391Ssam } 282190391Ssam llc = (struct llc *)(mtod(m, uint8_t *) + 283190391Ssam sizeof(struct ether_header)); 284190391Ssam if (llc->llc_snap.ether_type != htons(ATH_FF_ETH_TYPE)) 285190391Ssam return m; 286190391Ssam m_adj(m, FF_LLC_SIZE); 287190391Ssam m_copydata(m, 0, sizeof(uint32_t), (caddr_t) &ath); 288190391Ssam if (MS(ath, ATH_FF_PROTO) != ATH_FF_PROTO_L2TUNNEL) { 289190391Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 290190391Ssam ni->ni_macaddr, "fast-frame", 291190391Ssam "unsupport tunnel protocol, header 0x%x", ath); 292190391Ssam vap->iv_stats.is_ff_badhdr++; 293190391Ssam m_freem(m); 294190391Ssam return NULL; 295190391Ssam } 296190391Ssam /* NB: skip header and alignment padding */ 297190391Ssam m_adj(m, roundup(sizeof(uint32_t) - 2, 4) + 2); 298190391Ssam 299190391Ssam vap->iv_stats.is_ff_decap++; 300190391Ssam 301190391Ssam /* 302190391Ssam * Decap the first frame, bust it apart from the 303190391Ssam * second and deliver; then decap the second frame 304190391Ssam * and return it to the caller for normal delivery. 305190391Ssam */ 306190391Ssam m = ieee80211_decap1(m, &framelen); 307190391Ssam if (m == NULL) { 308190391Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 309190391Ssam ni->ni_macaddr, "fast-frame", "%s", "first decap failed"); 310190391Ssam vap->iv_stats.is_ff_tooshort++; 311190391Ssam return NULL; 312190391Ssam } 313190391Ssam n = m_split(m, framelen, M_NOWAIT); 314190391Ssam if (n == NULL) { 315190391Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 316190391Ssam ni->ni_macaddr, "fast-frame", 317190391Ssam "%s", "unable to split encapsulated frames"); 318190391Ssam vap->iv_stats.is_ff_split++; 319190391Ssam m_freem(m); /* NB: must reclaim */ 320190391Ssam return NULL; 321190391Ssam } 322190391Ssam /* XXX not right for WDS */ 323190391Ssam vap->iv_deliver_data(vap, ni, m); /* 1st of pair */ 324190391Ssam 325190391Ssam /* 326190391Ssam * Decap second frame. 327190391Ssam */ 328190391Ssam m_adj(n, roundup2(framelen, 4) - framelen); /* padding */ 329190391Ssam n = ieee80211_decap1(n, &framelen); 330190391Ssam if (n == NULL) { 331190391Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 332190391Ssam ni->ni_macaddr, "fast-frame", "%s", "second decap failed"); 333190391Ssam vap->iv_stats.is_ff_tooshort++; 334190391Ssam } 335190391Ssam /* XXX verify framelen against mbuf contents */ 336190391Ssam return n; /* 2nd delivered by caller */ 337190391Ssam#undef MS 338190391Ssam#undef FF_LLC_SIZE 339190391Ssam} 340190391Ssam 341190391Ssam/* 342190391Ssam * Fast frame encapsulation. There must be two packets 343190391Ssam * chained with m_nextpkt. We do header adjustment for 344190391Ssam * each, add the tunnel encapsulation, and then concatenate 345190391Ssam * the mbuf chains to form a single frame for transmission. 346190391Ssam */ 347190391Ssamstruct mbuf * 348190391Ssamieee80211_ff_encap(struct ieee80211vap *vap, struct mbuf *m1, int hdrspace, 349190391Ssam struct ieee80211_key *key) 350190391Ssam{ 351190391Ssam struct mbuf *m2; 352190391Ssam struct ether_header eh1, eh2; 353190391Ssam struct llc *llc; 354190391Ssam struct mbuf *m; 355190391Ssam int pad; 356190391Ssam 357190391Ssam m2 = m1->m_nextpkt; 358190391Ssam if (m2 == NULL) { 359190391Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 360190391Ssam "%s: only one frame\n", __func__); 361190391Ssam goto bad; 362190391Ssam } 363190391Ssam m1->m_nextpkt = NULL; 364297603Sadrian 365190391Ssam /* 366297603Sadrian * Adjust to include 802.11 header requirement. 367190391Ssam */ 368190579Ssam KASSERT(m1->m_len >= sizeof(eh1), ("no ethernet header!")); 369190579Ssam ETHER_HEADER_COPY(&eh1, mtod(m1, caddr_t)); 370297603Sadrian m1 = ieee80211_mbuf_adjust(vap, hdrspace, key, m1); 371190391Ssam if (m1 == NULL) { 372297603Sadrian printf("%s: failed initial mbuf_adjust\n", __func__); 373190391Ssam /* NB: ieee80211_mbuf_adjust handles msgs+statistics */ 374190391Ssam m_freem(m2); 375190391Ssam goto bad; 376190391Ssam } 377190391Ssam 378190391Ssam /* 379190391Ssam * Copy second frame's Ethernet header out of line 380297603Sadrian * and adjust for possible padding in case there isn't room 381190391Ssam * at the end of first frame. 382190391Ssam */ 383190391Ssam KASSERT(m2->m_len >= sizeof(eh2), ("no ethernet header!")); 384190391Ssam ETHER_HEADER_COPY(&eh2, mtod(m2, caddr_t)); 385297603Sadrian m2 = ieee80211_mbuf_adjust(vap, 4, NULL, m2); 386190391Ssam if (m2 == NULL) { 387190391Ssam /* NB: ieee80211_mbuf_adjust handles msgs+statistics */ 388297603Sadrian printf("%s: failed second \n", __func__); 389190391Ssam goto bad; 390190391Ssam } 391190391Ssam 392190391Ssam /* 393190391Ssam * Now do tunnel encapsulation. First, each 394190391Ssam * frame gets a standard encapsulation. 395190391Ssam */ 396254900Sadrian m1 = ieee80211_ff_encap1(vap, m1, &eh1); 397190391Ssam if (m1 == NULL) 398190391Ssam goto bad; 399254900Sadrian m2 = ieee80211_ff_encap1(vap, m2, &eh2); 400190391Ssam if (m2 == NULL) 401190391Ssam goto bad; 402190391Ssam 403190391Ssam /* 404190391Ssam * Pad leading frame to a 4-byte boundary. If there 405190391Ssam * is space at the end of the first frame, put it 406190391Ssam * there; otherwise prepend to the front of the second 407190391Ssam * frame. We know doing the second will always work 408190391Ssam * because we reserve space above. We prefer appending 409190391Ssam * as this typically has better DMA alignment properties. 410190391Ssam */ 411190391Ssam for (m = m1; m->m_next != NULL; m = m->m_next) 412190391Ssam ; 413190391Ssam pad = roundup2(m1->m_pkthdr.len, 4) - m1->m_pkthdr.len; 414190391Ssam if (pad) { 415190391Ssam if (M_TRAILINGSPACE(m) < pad) { /* prepend to second */ 416190391Ssam m2->m_data -= pad; 417190391Ssam m2->m_len += pad; 418190391Ssam m2->m_pkthdr.len += pad; 419190391Ssam } else { /* append to first */ 420190391Ssam m->m_len += pad; 421190391Ssam m1->m_pkthdr.len += pad; 422190391Ssam } 423190391Ssam } 424190391Ssam 425190391Ssam /* 426297603Sadrian * A-MSDU's are just appended; the "I'm A-MSDU!" bit is in the 427297603Sadrian * QoS header. 428190391Ssam * 429190391Ssam * XXX optimize by prepending together 430190391Ssam */ 431190391Ssam m->m_next = m2; /* NB: last mbuf from above */ 432190391Ssam m1->m_pkthdr.len += m2->m_pkthdr.len; 433243882Sglebius M_PREPEND(m1, sizeof(uint32_t)+2, M_NOWAIT); 434190391Ssam if (m1 == NULL) { /* XXX cannot happen */ 435190391Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 436190391Ssam "%s: no space for tunnel header\n", __func__); 437190391Ssam vap->iv_stats.is_tx_nobuf++; 438190391Ssam return NULL; 439190391Ssam } 440190391Ssam memset(mtod(m1, void *), 0, sizeof(uint32_t)+2); 441190391Ssam 442243882Sglebius M_PREPEND(m1, sizeof(struct llc), M_NOWAIT); 443190391Ssam if (m1 == NULL) { /* XXX cannot happen */ 444190391Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 445190391Ssam "%s: no space for llc header\n", __func__); 446190391Ssam vap->iv_stats.is_tx_nobuf++; 447190391Ssam return NULL; 448190391Ssam } 449190391Ssam llc = mtod(m1, struct llc *); 450190391Ssam llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP; 451190391Ssam llc->llc_control = LLC_UI; 452190391Ssam llc->llc_snap.org_code[0] = ATH_FF_SNAP_ORGCODE_0; 453190391Ssam llc->llc_snap.org_code[1] = ATH_FF_SNAP_ORGCODE_1; 454190391Ssam llc->llc_snap.org_code[2] = ATH_FF_SNAP_ORGCODE_2; 455190391Ssam llc->llc_snap.ether_type = htons(ATH_FF_ETH_TYPE); 456190391Ssam 457190391Ssam vap->iv_stats.is_ff_encap++; 458190391Ssam 459190391Ssam return m1; 460190391Ssambad: 461297603Sadrian vap->iv_stats.is_ff_encapfail++; 462190391Ssam if (m1 != NULL) 463190391Ssam m_freem(m1); 464190391Ssam if (m2 != NULL) 465190391Ssam m_freem(m2); 466190391Ssam return NULL; 467190391Ssam} 468190391Ssam 469297603Sadrian/* 470297603Sadrian * A-MSDU encapsulation. 471297603Sadrian * 472297603Sadrian * This assumes just two frames for now, since we're borrowing the 473297603Sadrian * same queuing code and infrastructure as fast-frames. 474297603Sadrian * 475297603Sadrian * There must be two packets chained with m_nextpkt. 476297603Sadrian * We do header adjustment for each, and then concatenate the mbuf chains 477297603Sadrian * to form a single frame for transmission. 478297603Sadrian */ 479297603Sadrianstruct mbuf * 480297603Sadrianieee80211_amsdu_encap(struct ieee80211vap *vap, struct mbuf *m1, int hdrspace, 481297603Sadrian struct ieee80211_key *key) 482297603Sadrian{ 483297603Sadrian struct mbuf *m2; 484297603Sadrian struct ether_header eh1, eh2; 485297603Sadrian struct mbuf *m; 486297603Sadrian int pad; 487297603Sadrian 488297603Sadrian m2 = m1->m_nextpkt; 489297603Sadrian if (m2 == NULL) { 490297603Sadrian IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 491297603Sadrian "%s: only one frame\n", __func__); 492297603Sadrian goto bad; 493297603Sadrian } 494297603Sadrian m1->m_nextpkt = NULL; 495297603Sadrian 496297603Sadrian /* 497297603Sadrian * Include A-MSDU header in adjusting header layout. 498297603Sadrian */ 499297603Sadrian KASSERT(m1->m_len >= sizeof(eh1), ("no ethernet header!")); 500297603Sadrian ETHER_HEADER_COPY(&eh1, mtod(m1, caddr_t)); 501297603Sadrian m1 = ieee80211_mbuf_adjust(vap, 502297603Sadrian hdrspace + sizeof(struct llc) + sizeof(uint32_t) + 503297603Sadrian sizeof(struct ether_header), 504297603Sadrian key, m1); 505297603Sadrian if (m1 == NULL) { 506297603Sadrian /* NB: ieee80211_mbuf_adjust handles msgs+statistics */ 507297603Sadrian m_freem(m2); 508297603Sadrian goto bad; 509297603Sadrian } 510297603Sadrian 511297603Sadrian /* 512297603Sadrian * Copy second frame's Ethernet header out of line 513297603Sadrian * and adjust for encapsulation headers. Note that 514297603Sadrian * we make room for padding in case there isn't room 515297603Sadrian * at the end of first frame. 516297603Sadrian */ 517297603Sadrian KASSERT(m2->m_len >= sizeof(eh2), ("no ethernet header!")); 518297603Sadrian ETHER_HEADER_COPY(&eh2, mtod(m2, caddr_t)); 519297603Sadrian m2 = ieee80211_mbuf_adjust(vap, 4, NULL, m2); 520297603Sadrian if (m2 == NULL) { 521297603Sadrian /* NB: ieee80211_mbuf_adjust handles msgs+statistics */ 522297603Sadrian goto bad; 523297603Sadrian } 524297603Sadrian 525297603Sadrian /* 526297603Sadrian * Now do tunnel encapsulation. First, each 527297603Sadrian * frame gets a standard encapsulation. 528297603Sadrian */ 529297603Sadrian m1 = ieee80211_ff_encap1(vap, m1, &eh1); 530297603Sadrian if (m1 == NULL) 531297603Sadrian goto bad; 532297603Sadrian m2 = ieee80211_ff_encap1(vap, m2, &eh2); 533297603Sadrian if (m2 == NULL) 534297603Sadrian goto bad; 535297603Sadrian 536297603Sadrian /* 537297603Sadrian * Pad leading frame to a 4-byte boundary. If there 538297603Sadrian * is space at the end of the first frame, put it 539297603Sadrian * there; otherwise prepend to the front of the second 540297603Sadrian * frame. We know doing the second will always work 541297603Sadrian * because we reserve space above. We prefer appending 542297603Sadrian * as this typically has better DMA alignment properties. 543297603Sadrian */ 544297603Sadrian for (m = m1; m->m_next != NULL; m = m->m_next) 545297603Sadrian ; 546297603Sadrian pad = roundup2(m1->m_pkthdr.len, 4) - m1->m_pkthdr.len; 547297603Sadrian if (pad) { 548297603Sadrian if (M_TRAILINGSPACE(m) < pad) { /* prepend to second */ 549297603Sadrian m2->m_data -= pad; 550297603Sadrian m2->m_len += pad; 551297603Sadrian m2->m_pkthdr.len += pad; 552297603Sadrian } else { /* append to first */ 553297603Sadrian m->m_len += pad; 554297603Sadrian m1->m_pkthdr.len += pad; 555297603Sadrian } 556297603Sadrian } 557297603Sadrian 558297603Sadrian /* 559297603Sadrian * Now, stick 'em together. 560297603Sadrian */ 561297603Sadrian m->m_next = m2; /* NB: last mbuf from above */ 562297603Sadrian m1->m_pkthdr.len += m2->m_pkthdr.len; 563297603Sadrian 564297603Sadrian vap->iv_stats.is_amsdu_encap++; 565297603Sadrian 566297603Sadrian return m1; 567297603Sadrianbad: 568297603Sadrian vap->iv_stats.is_amsdu_encapfail++; 569297603Sadrian if (m1 != NULL) 570297603Sadrian m_freem(m1); 571297603Sadrian if (m2 != NULL) 572297603Sadrian m_freem(m2); 573297603Sadrian return NULL; 574297603Sadrian} 575297603Sadrian 576297603Sadrian 577190579Ssamstatic void 578190579Ssamff_transmit(struct ieee80211_node *ni, struct mbuf *m) 579190579Ssam{ 580190579Ssam struct ieee80211vap *vap = ni->ni_vap; 581248069Sadrian struct ieee80211com *ic = ni->ni_ic; 582190579Ssam 583302283Savos IEEE80211_TX_LOCK_ASSERT(ic); 584248069Sadrian 585190579Ssam /* encap and xmit */ 586190579Ssam m = ieee80211_encap(vap, ni, m); 587302283Savos if (m != NULL) 588302283Savos (void) ieee80211_parent_xmitpkt(ic, m); 589302283Savos else 590190579Ssam ieee80211_free_node(ni); 591190579Ssam} 592190579Ssam 593190391Ssam/* 594190579Ssam * Flush frames to device; note we re-use the linked list 595190579Ssam * the frames were stored on and use the sentinel (unchanged) 596190579Ssam * which may be non-NULL. 597190579Ssam */ 598190579Ssamstatic void 599190579Ssamff_flush(struct mbuf *head, struct mbuf *last) 600190579Ssam{ 601190579Ssam struct mbuf *m, *next; 602190579Ssam struct ieee80211_node *ni; 603190579Ssam struct ieee80211vap *vap; 604190579Ssam 605190579Ssam for (m = head; m != last; m = next) { 606190579Ssam next = m->m_nextpkt; 607190579Ssam m->m_nextpkt = NULL; 608190579Ssam 609190579Ssam ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 610190579Ssam vap = ni->ni_vap; 611190579Ssam 612190579Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_SUPERG, ni, 613190579Ssam "%s: flush frame, age %u", __func__, M_AGE_GET(m)); 614190579Ssam vap->iv_stats.is_ff_flush++; 615190579Ssam 616190579Ssam ff_transmit(ni, m); 617190579Ssam } 618190579Ssam} 619190579Ssam 620190579Ssam/* 621190579Ssam * Age frames on the staging queue. 622190579Ssam */ 623190579Ssamvoid 624191753Ssamieee80211_ff_age(struct ieee80211com *ic, struct ieee80211_stageq *sq, 625191753Ssam int quanta) 626190579Ssam{ 627190579Ssam struct mbuf *m, *head; 628190579Ssam struct ieee80211_node *ni; 629190579Ssam 630302283Savos IEEE80211_FF_LOCK(ic); 631302283Savos if (sq->depth == 0) { 632302283Savos IEEE80211_FF_UNLOCK(ic); 633302283Savos return; /* nothing to do */ 634302283Savos } 635302283Savos 636190579Ssam KASSERT(sq->head != NULL, ("stageq empty")); 637190579Ssam 638190579Ssam head = sq->head; 639190579Ssam while ((m = sq->head) != NULL && M_AGE_GET(m) < quanta) { 640234324Sadrian int tid = WME_AC_TO_TID(M_WME_GETAC(m)); 641234324Sadrian 642288318Sadrian /* clear staging ref to frame */ 643190579Ssam ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 644288318Sadrian KASSERT(ni->ni_tx_superg[tid] == m, ("staging queue empty")); 645288318Sadrian ni->ni_tx_superg[tid] = NULL; 646190579Ssam 647190579Ssam sq->head = m->m_nextpkt; 648190579Ssam sq->depth--; 649190579Ssam } 650190579Ssam if (m == NULL) 651190579Ssam sq->tail = NULL; 652190579Ssam else 653190579Ssam M_AGE_SUB(m, quanta); 654302283Savos IEEE80211_FF_UNLOCK(ic); 655190579Ssam 656248069Sadrian IEEE80211_TX_LOCK(ic); 657190579Ssam ff_flush(head, m); 658248069Sadrian IEEE80211_TX_UNLOCK(ic); 659190579Ssam} 660190579Ssam 661190579Ssamstatic void 662244051Sadrianstageq_add(struct ieee80211com *ic, struct ieee80211_stageq *sq, struct mbuf *m) 663190579Ssam{ 664190579Ssam int age = ieee80211_ffagemax; 665244051Sadrian 666302283Savos IEEE80211_FF_LOCK_ASSERT(ic); 667244051Sadrian 668190579Ssam if (sq->tail != NULL) { 669190579Ssam sq->tail->m_nextpkt = m; 670190579Ssam age -= M_AGE_GET(sq->head); 671190579Ssam } else 672190579Ssam sq->head = m; 673190579Ssam KASSERT(age >= 0, ("age %d", age)); 674190579Ssam M_AGE_SET(m, age); 675190579Ssam m->m_nextpkt = NULL; 676190579Ssam sq->tail = m; 677190579Ssam sq->depth++; 678190579Ssam} 679190579Ssam 680190579Ssamstatic void 681244051Sadrianstageq_remove(struct ieee80211com *ic, struct ieee80211_stageq *sq, struct mbuf *mstaged) 682190579Ssam{ 683190579Ssam struct mbuf *m, *mprev; 684190579Ssam 685302283Savos IEEE80211_FF_LOCK_ASSERT(ic); 686244051Sadrian 687190579Ssam mprev = NULL; 688190579Ssam for (m = sq->head; m != NULL; m = m->m_nextpkt) { 689190579Ssam if (m == mstaged) { 690190579Ssam if (mprev == NULL) 691190579Ssam sq->head = m->m_nextpkt; 692190579Ssam else 693190579Ssam mprev->m_nextpkt = m->m_nextpkt; 694190579Ssam if (sq->tail == m) 695190579Ssam sq->tail = mprev; 696190579Ssam sq->depth--; 697190579Ssam return; 698190579Ssam } 699190579Ssam mprev = m; 700190579Ssam } 701190579Ssam printf("%s: packet not found\n", __func__); 702190579Ssam} 703190579Ssam 704190579Ssamstatic uint32_t 705190579Ssamff_approx_txtime(struct ieee80211_node *ni, 706190579Ssam const struct mbuf *m1, const struct mbuf *m2) 707190579Ssam{ 708190579Ssam struct ieee80211com *ic = ni->ni_ic; 709190579Ssam struct ieee80211vap *vap = ni->ni_vap; 710190579Ssam uint32_t framelen; 711297603Sadrian uint32_t frame_time; 712190579Ssam 713190579Ssam /* 714190579Ssam * Approximate the frame length to be transmitted. A swag to add 715190579Ssam * the following maximal values to the skb payload: 716190579Ssam * - 32: 802.11 encap + CRC 717190579Ssam * - 24: encryption overhead (if wep bit) 718190579Ssam * - 4 + 6: fast-frame header and padding 719190579Ssam * - 16: 2 LLC FF tunnel headers 720190579Ssam * - 14: 1 802.3 FF tunnel header (mbuf already accounts for 2nd) 721190579Ssam */ 722190579Ssam framelen = m1->m_pkthdr.len + 32 + 723190579Ssam ATH_FF_MAX_HDR_PAD + ATH_FF_MAX_SEP_PAD + ATH_FF_MAX_HDR; 724190579Ssam if (vap->iv_flags & IEEE80211_F_PRIVACY) 725190579Ssam framelen += 24; 726190579Ssam if (m2 != NULL) 727190579Ssam framelen += m2->m_pkthdr.len; 728297603Sadrian 729297603Sadrian /* 730297603Sadrian * For now, we assume non-shortgi, 20MHz, just because I want to 731297603Sadrian * at least test 802.11n. 732297603Sadrian */ 733297603Sadrian if (ni->ni_txrate & IEEE80211_RATE_MCS) 734297603Sadrian frame_time = ieee80211_compute_duration_ht(framelen, 735297603Sadrian ni->ni_txrate, 736297603Sadrian IEEE80211_HT_RC_2_STREAMS(ni->ni_txrate), 737297603Sadrian 0, /* isht40 */ 738297603Sadrian 0); /* isshortgi */ 739297603Sadrian else 740297603Sadrian frame_time = ieee80211_compute_duration(ic->ic_rt, framelen, 741297603Sadrian ni->ni_txrate, 0); 742297603Sadrian return (frame_time); 743190579Ssam} 744190579Ssam 745190579Ssam/* 746190579Ssam * Check if the supplied frame can be partnered with an existing 747190579Ssam * or pending frame. Return a reference to any frame that should be 748190579Ssam * sent on return; otherwise return NULL. 749190579Ssam */ 750190579Ssamstruct mbuf * 751190579Ssamieee80211_ff_check(struct ieee80211_node *ni, struct mbuf *m) 752190579Ssam{ 753190579Ssam struct ieee80211vap *vap = ni->ni_vap; 754190579Ssam struct ieee80211com *ic = ni->ni_ic; 755191753Ssam struct ieee80211_superg *sg = ic->ic_superg; 756190579Ssam const int pri = M_WME_GETAC(m); 757190579Ssam struct ieee80211_stageq *sq; 758190579Ssam struct ieee80211_tx_ampdu *tap; 759190579Ssam struct mbuf *mstaged; 760190579Ssam uint32_t txtime, limit; 761190579Ssam 762248069Sadrian IEEE80211_TX_UNLOCK_ASSERT(ic); 763248069Sadrian 764302283Savos IEEE80211_LOCK(ic); 765302283Savos limit = IEEE80211_TXOP_TO_US( 766302283Savos ic->ic_wme.wme_chanParams.cap_wmeParams[pri].wmep_txopLimit); 767302283Savos IEEE80211_UNLOCK(ic); 768302283Savos 769190579Ssam /* 770190579Ssam * Check if the supplied frame can be aggregated. 771190579Ssam * 772190579Ssam * NB: we allow EAPOL frames to be aggregated with other ucast traffic. 773190579Ssam * Do 802.1x EAPOL frames proceed in the clear? Then they couldn't 774190579Ssam * be aggregated with other types of frames when encryption is on? 775190579Ssam */ 776302283Savos IEEE80211_FF_LOCK(ic); 777234324Sadrian tap = &ni->ni_tx_ampdu[WME_AC_TO_TID(pri)]; 778288318Sadrian mstaged = ni->ni_tx_superg[WME_AC_TO_TID(pri)]; 779288318Sadrian /* XXX NOTE: reusing packet counter state from A-MPDU */ 780288318Sadrian /* 781288318Sadrian * XXX NOTE: this means we're double-counting; it should just 782288318Sadrian * be done in ieee80211_output.c once for both superg and A-MPDU. 783288318Sadrian */ 784190579Ssam ieee80211_txampdu_count_packet(tap); 785190579Ssam 786190579Ssam /* 787190579Ssam * When not in station mode never aggregate a multicast 788190579Ssam * frame; this insures, for example, that a combined frame 789190579Ssam * does not require multiple encryption keys. 790190579Ssam */ 791190579Ssam if (vap->iv_opmode != IEEE80211_M_STA && 792190579Ssam ETHER_IS_MULTICAST(mtod(m, struct ether_header *)->ether_dhost)) { 793190579Ssam /* XXX flush staged frame? */ 794302283Savos IEEE80211_FF_UNLOCK(ic); 795190579Ssam return m; 796190579Ssam } 797190579Ssam /* 798190579Ssam * If there is no frame to combine with and the pps is 799190579Ssam * too low; then do not attempt to aggregate this frame. 800190579Ssam */ 801190579Ssam if (mstaged == NULL && 802190579Ssam ieee80211_txampdu_getpps(tap) < ieee80211_ffppsmin) { 803302283Savos IEEE80211_FF_UNLOCK(ic); 804190579Ssam return m; 805190579Ssam } 806191753Ssam sq = &sg->ff_stageq[pri]; 807190579Ssam /* 808190579Ssam * Check the txop limit to insure the aggregate fits. 809190579Ssam */ 810190579Ssam if (limit != 0 && 811190579Ssam (txtime = ff_approx_txtime(ni, m, mstaged)) > limit) { 812190579Ssam /* 813190579Ssam * Aggregate too long, return to the caller for direct 814190579Ssam * transmission. In addition, flush any pending frame 815190579Ssam * before sending this one. 816190579Ssam */ 817190579Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 818190579Ssam "%s: txtime %u exceeds txop limit %u\n", 819190579Ssam __func__, txtime, limit); 820190579Ssam 821288318Sadrian ni->ni_tx_superg[WME_AC_TO_TID(pri)] = NULL; 822190579Ssam if (mstaged != NULL) 823244051Sadrian stageq_remove(ic, sq, mstaged); 824302283Savos IEEE80211_FF_UNLOCK(ic); 825190579Ssam 826190579Ssam if (mstaged != NULL) { 827248069Sadrian IEEE80211_TX_LOCK(ic); 828190579Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_SUPERG, ni, 829190579Ssam "%s: flush staged frame", __func__); 830190579Ssam /* encap and xmit */ 831190579Ssam ff_transmit(ni, mstaged); 832248069Sadrian IEEE80211_TX_UNLOCK(ic); 833190579Ssam } 834190579Ssam return m; /* NB: original frame */ 835190579Ssam } 836190579Ssam /* 837190579Ssam * An aggregation candidate. If there's a frame to partner 838190579Ssam * with then combine and return for processing. Otherwise 839190579Ssam * save this frame and wait for a partner to show up (or 840190579Ssam * the frame to be flushed). Note that staged frames also 841190579Ssam * hold their node reference. 842190579Ssam */ 843190579Ssam if (mstaged != NULL) { 844288318Sadrian ni->ni_tx_superg[WME_AC_TO_TID(pri)] = NULL; 845244051Sadrian stageq_remove(ic, sq, mstaged); 846302283Savos IEEE80211_FF_UNLOCK(ic); 847190579Ssam 848190579Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_SUPERG, ni, 849190579Ssam "%s: aggregate fast-frame", __func__); 850190579Ssam /* 851190579Ssam * Release the node reference; we only need 852190579Ssam * the one already in mstaged. 853190579Ssam */ 854190579Ssam KASSERT(mstaged->m_pkthdr.rcvif == (void *)ni, 855190579Ssam ("rcvif %p ni %p", mstaged->m_pkthdr.rcvif, ni)); 856190579Ssam ieee80211_free_node(ni); 857190579Ssam 858190579Ssam m->m_nextpkt = NULL; 859190579Ssam mstaged->m_nextpkt = m; 860190579Ssam mstaged->m_flags |= M_FF; /* NB: mark for encap work */ 861190579Ssam } else { 862302283Savos KASSERT(ni->ni_tx_superg[WME_AC_TO_TID(pri)] == NULL, 863288318Sadrian ("ni_tx_superg[]: %p", 864288318Sadrian ni->ni_tx_superg[WME_AC_TO_TID(pri)])); 865288318Sadrian ni->ni_tx_superg[WME_AC_TO_TID(pri)] = m; 866190579Ssam 867244051Sadrian stageq_add(ic, sq, m); 868302283Savos IEEE80211_FF_UNLOCK(ic); 869190579Ssam 870190579Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_SUPERG, ni, 871190579Ssam "%s: stage frame, %u queued", __func__, sq->depth); 872190579Ssam /* NB: mstaged is NULL */ 873190579Ssam } 874190579Ssam return mstaged; 875190579Ssam} 876190579Ssam 877297603Sadrianstruct mbuf * 878297603Sadrianieee80211_amsdu_check(struct ieee80211_node *ni, struct mbuf *m) 879297603Sadrian{ 880297603Sadrian /* 881297603Sadrian * XXX TODO: actually enforce the node support 882297603Sadrian * and HTCAP requirements for the maximum A-MSDU 883297603Sadrian * size. 884297603Sadrian */ 885297603Sadrian 886297603Sadrian /* First: software A-MSDU transmit? */ 887297603Sadrian if (! ieee80211_amsdu_tx_ok(ni)) 888297603Sadrian return (m); 889297603Sadrian 890297603Sadrian /* Next - EAPOL? Nope, don't aggregate; we don't QoS encap them */ 891297603Sadrian if (m->m_flags & (M_EAPOL | M_MCAST | M_BCAST)) 892297603Sadrian return (m); 893297603Sadrian 894297603Sadrian /* Next - needs to be a data frame, non-broadcast, etc */ 895297603Sadrian if (ETHER_IS_MULTICAST(mtod(m, struct ether_header *)->ether_dhost)) 896297603Sadrian return (m); 897297603Sadrian 898297603Sadrian return (ieee80211_ff_check(ni, m)); 899297603Sadrian} 900297603Sadrian 901190579Ssamvoid 902190579Ssamieee80211_ff_node_init(struct ieee80211_node *ni) 903190579Ssam{ 904190579Ssam /* 905190579Ssam * Clean FF state on re-associate. This handles the case 906190579Ssam * where a station leaves w/o notifying us and then returns 907190579Ssam * before node is reaped for inactivity. 908190579Ssam */ 909190579Ssam ieee80211_ff_node_cleanup(ni); 910190579Ssam} 911190579Ssam 912302018Sadrian/* 913302018Sadrian * Note: this comlock acquisition LORs with the node lock: 914302018Sadrian * 915302018Sadrian * 1: sta_join1 -> NODE_LOCK -> node_free -> node_cleanup -> ff_node_cleanup -> COM_LOCK 916302018Sadrian * 2: TBD 917302018Sadrian */ 918190579Ssamvoid 919190579Ssamieee80211_ff_node_cleanup(struct ieee80211_node *ni) 920190579Ssam{ 921190579Ssam struct ieee80211com *ic = ni->ni_ic; 922191753Ssam struct ieee80211_superg *sg = ic->ic_superg; 923244025Sadrian struct mbuf *m, *next_m, *head; 924234324Sadrian int tid; 925190579Ssam 926302283Savos IEEE80211_FF_LOCK(ic); 927190579Ssam head = NULL; 928234324Sadrian for (tid = 0; tid < WME_NUM_TID; tid++) { 929234324Sadrian int ac = TID_TO_WME_AC(tid); 930288318Sadrian /* 931288318Sadrian * XXX Initialise the packet counter. 932288318Sadrian * 933288318Sadrian * This may be double-work for 11n stations; 934288318Sadrian * but without it we never setup things. 935288318Sadrian */ 936288318Sadrian ieee80211_txampdu_init_pps(&ni->ni_tx_ampdu[tid]); 937288318Sadrian m = ni->ni_tx_superg[tid]; 938190579Ssam if (m != NULL) { 939288318Sadrian ni->ni_tx_superg[tid] = NULL; 940244051Sadrian stageq_remove(ic, &sg->ff_stageq[ac], m); 941190579Ssam m->m_nextpkt = head; 942190579Ssam head = m; 943190579Ssam } 944190579Ssam } 945302283Savos IEEE80211_FF_UNLOCK(ic); 946190579Ssam 947244025Sadrian /* 948244025Sadrian * Free mbufs, taking care to not dereference the mbuf after 949244025Sadrian * we free it (hence grabbing m_nextpkt before we free it.) 950244025Sadrian */ 951244025Sadrian m = head; 952244025Sadrian while (m != NULL) { 953244025Sadrian next_m = m->m_nextpkt; 954190579Ssam m_freem(m); 955190579Ssam ieee80211_free_node(ni); 956244025Sadrian m = next_m; 957190579Ssam } 958190579Ssam} 959190579Ssam 960190579Ssam/* 961190391Ssam * Switch between turbo and non-turbo operating modes. 962190391Ssam * Use the specified channel flags to locate the new 963190391Ssam * channel, update 802.11 state, and then call back into 964190391Ssam * the driver to effect the change. 965190391Ssam */ 966190391Ssamvoid 967190391Ssamieee80211_dturbo_switch(struct ieee80211vap *vap, int newflags) 968190391Ssam{ 969190391Ssam struct ieee80211com *ic = vap->iv_ic; 970190391Ssam struct ieee80211_channel *chan; 971190391Ssam 972190391Ssam chan = ieee80211_find_channel(ic, ic->ic_bsschan->ic_freq, newflags); 973190391Ssam if (chan == NULL) { /* XXX should not happen */ 974190391Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 975190391Ssam "%s: no channel with freq %u flags 0x%x\n", 976190391Ssam __func__, ic->ic_bsschan->ic_freq, newflags); 977190391Ssam return; 978190391Ssam } 979190391Ssam 980190391Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_SUPERG, 981190391Ssam "%s: %s -> %s (freq %u flags 0x%x)\n", __func__, 982190391Ssam ieee80211_phymode_name[ieee80211_chan2mode(ic->ic_bsschan)], 983190391Ssam ieee80211_phymode_name[ieee80211_chan2mode(chan)], 984190391Ssam chan->ic_freq, chan->ic_flags); 985190391Ssam 986190391Ssam ic->ic_bsschan = chan; 987190391Ssam ic->ic_prevchan = ic->ic_curchan; 988190391Ssam ic->ic_curchan = chan; 989190532Ssam ic->ic_rt = ieee80211_get_ratetable(chan); 990190391Ssam ic->ic_set_channel(ic); 991192468Ssam ieee80211_radiotap_chan_change(ic); 992190391Ssam /* NB: do not need to reset ERP state 'cuz we're in sta mode */ 993190391Ssam} 994190391Ssam 995190391Ssam/* 996190391Ssam * Return the current ``state'' of an Atheros capbility. 997190391Ssam * If associated in station mode report the negotiated 998190391Ssam * setting. Otherwise report the current setting. 999190391Ssam */ 1000190391Ssamstatic int 1001190391Ssamgetathcap(struct ieee80211vap *vap, int cap) 1002190391Ssam{ 1003190391Ssam if (vap->iv_opmode == IEEE80211_M_STA && 1004190391Ssam vap->iv_state == IEEE80211_S_RUN) 1005190391Ssam return IEEE80211_ATH_CAP(vap, vap->iv_bss, cap) != 0; 1006190391Ssam else 1007190391Ssam return (vap->iv_flags & cap) != 0; 1008190391Ssam} 1009190391Ssam 1010190391Ssamstatic int 1011190391Ssamsuperg_ioctl_get80211(struct ieee80211vap *vap, struct ieee80211req *ireq) 1012190391Ssam{ 1013190391Ssam switch (ireq->i_type) { 1014190391Ssam case IEEE80211_IOC_FF: 1015190391Ssam ireq->i_val = getathcap(vap, IEEE80211_F_FF); 1016190391Ssam break; 1017190391Ssam case IEEE80211_IOC_TURBOP: 1018190391Ssam ireq->i_val = getathcap(vap, IEEE80211_F_TURBOP); 1019190391Ssam break; 1020190391Ssam default: 1021190391Ssam return ENOSYS; 1022190391Ssam } 1023190391Ssam return 0; 1024190391Ssam} 1025190391SsamIEEE80211_IOCTL_GET(superg, superg_ioctl_get80211); 1026190391Ssam 1027190391Ssamstatic int 1028190391Ssamsuperg_ioctl_set80211(struct ieee80211vap *vap, struct ieee80211req *ireq) 1029190391Ssam{ 1030190391Ssam switch (ireq->i_type) { 1031190391Ssam case IEEE80211_IOC_FF: 1032190391Ssam if (ireq->i_val) { 1033190391Ssam if ((vap->iv_caps & IEEE80211_C_FF) == 0) 1034190391Ssam return EOPNOTSUPP; 1035190391Ssam vap->iv_flags |= IEEE80211_F_FF; 1036190391Ssam } else 1037190391Ssam vap->iv_flags &= ~IEEE80211_F_FF; 1038190530Ssam return ENETRESET; 1039190391Ssam case IEEE80211_IOC_TURBOP: 1040190391Ssam if (ireq->i_val) { 1041190391Ssam if ((vap->iv_caps & IEEE80211_C_TURBOP) == 0) 1042190391Ssam return EOPNOTSUPP; 1043190391Ssam vap->iv_flags |= IEEE80211_F_TURBOP; 1044190391Ssam } else 1045190391Ssam vap->iv_flags &= ~IEEE80211_F_TURBOP; 1046190391Ssam return ENETRESET; 1047190391Ssam default: 1048190391Ssam return ENOSYS; 1049190391Ssam } 1050190391Ssam} 1051190391SsamIEEE80211_IOCTL_SET(superg, superg_ioctl_set80211); 1052246226Sadrian 1053246226Sadrian#endif /* IEEE80211_SUPPORT_SUPERG */ 1054