16b4cac81SBjoern A. Zeeb /*- 28ac540d3SBjoern A. Zeeb * Copyright (c) 2020-2023 The FreeBSD Foundation 3086be6a8SBjoern A. Zeeb * Copyright (c) 2020-2022 Bjoern A. Zeeb 46b4cac81SBjoern A. Zeeb * 56b4cac81SBjoern A. Zeeb * This software was developed by Björn Zeeb under sponsorship from 66b4cac81SBjoern A. Zeeb * the FreeBSD Foundation. 76b4cac81SBjoern A. Zeeb * 86b4cac81SBjoern A. Zeeb * Redistribution and use in source and binary forms, with or without 96b4cac81SBjoern A. Zeeb * modification, are permitted provided that the following conditions 106b4cac81SBjoern A. Zeeb * are met: 116b4cac81SBjoern A. Zeeb * 1. Redistributions of source code must retain the above copyright 126b4cac81SBjoern A. Zeeb * notice, this list of conditions and the following disclaimer. 136b4cac81SBjoern A. Zeeb * 2. Redistributions in binary form must reproduce the above copyright 146b4cac81SBjoern A. Zeeb * notice, this list of conditions and the following disclaimer in the 156b4cac81SBjoern A. Zeeb * documentation and/or other materials provided with the distribution. 166b4cac81SBjoern A. Zeeb * 176b4cac81SBjoern A. Zeeb * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 186b4cac81SBjoern A. Zeeb * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 196b4cac81SBjoern A. Zeeb * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 206b4cac81SBjoern A. Zeeb * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 216b4cac81SBjoern A. Zeeb * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 226b4cac81SBjoern A. Zeeb * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 236b4cac81SBjoern A. Zeeb * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 246b4cac81SBjoern A. Zeeb * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 256b4cac81SBjoern A. Zeeb * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 266b4cac81SBjoern A. Zeeb * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 276b4cac81SBjoern A. Zeeb * SUCH DAMAGE. 286b4cac81SBjoern A. Zeeb */ 296b4cac81SBjoern A. Zeeb 306b4cac81SBjoern A. Zeeb /* 316b4cac81SBjoern A. Zeeb * Public functions are called linuxkpi_*(). 326b4cac81SBjoern A. Zeeb * Internal (static) functions are called lkpi_*(). 336b4cac81SBjoern A. Zeeb * 346b4cac81SBjoern A. Zeeb * The internal structures holding metadata over public structures are also 356b4cac81SBjoern A. Zeeb * called lkpi_xxx (usually with a member at the end called xxx). 366b4cac81SBjoern A. Zeeb * Note: we do not replicate the structure names but the general variable names 376b4cac81SBjoern A. Zeeb * for these (e.g., struct hw -> struct lkpi_hw, struct sta -> struct lkpi_sta). 386b4cac81SBjoern A. Zeeb * There are macros to access one from the other. 396b4cac81SBjoern A. Zeeb * We call the internal versions lxxx (e.g., hw -> lhw, sta -> lsta). 406b4cac81SBjoern A. Zeeb */ 416b4cac81SBjoern A. Zeeb 426b4cac81SBjoern A. Zeeb #include <sys/cdefs.h> 436b4cac81SBjoern A. Zeeb #include <sys/param.h> 446b4cac81SBjoern A. Zeeb #include <sys/types.h> 456b4cac81SBjoern A. Zeeb #include <sys/kernel.h> 466b4cac81SBjoern A. Zeeb #include <sys/errno.h> 476b4cac81SBjoern A. Zeeb #include <sys/malloc.h> 486b4cac81SBjoern A. Zeeb #include <sys/module.h> 496b4cac81SBjoern A. Zeeb #include <sys/mutex.h> 506b4cac81SBjoern A. Zeeb #include <sys/socket.h> 516b4cac81SBjoern A. Zeeb #include <sys/sysctl.h> 526b4cac81SBjoern A. Zeeb #include <sys/queue.h> 536b4cac81SBjoern A. Zeeb #include <sys/taskqueue.h> 54527687a9SBjoern A. Zeeb #include <sys/libkern.h> 556b4cac81SBjoern A. Zeeb 566b4cac81SBjoern A. Zeeb #include <net/if.h> 576b4cac81SBjoern A. Zeeb #include <net/if_var.h> 586b4cac81SBjoern A. Zeeb #include <net/if_media.h> 596b4cac81SBjoern A. Zeeb #include <net/ethernet.h> 606b4cac81SBjoern A. Zeeb 616b4cac81SBjoern A. Zeeb #include <net80211/ieee80211_var.h> 626b4cac81SBjoern A. Zeeb #include <net80211/ieee80211_proto.h> 636b4cac81SBjoern A. Zeeb #include <net80211/ieee80211_ratectl.h> 646b4cac81SBjoern A. Zeeb #include <net80211/ieee80211_radiotap.h> 656b4cac81SBjoern A. Zeeb 666b4cac81SBjoern A. Zeeb #define LINUXKPI_NET80211 676b4cac81SBjoern A. Zeeb #include <net/mac80211.h> 686b4cac81SBjoern A. Zeeb 696b4cac81SBjoern A. Zeeb #include <linux/workqueue.h> 706b4cac81SBjoern A. Zeeb #include "linux_80211.h" 716b4cac81SBjoern A. Zeeb 724a67f1dfSBjoern A. Zeeb #define LKPI_80211_WME 73b35f6cd0SBjoern A. Zeeb /* #define LKPI_80211_HW_CRYPTO */ 74b35f6cd0SBjoern A. Zeeb 756b4cac81SBjoern A. Zeeb static MALLOC_DEFINE(M_LKPI80211, "lkpi80211", "LinuxKPI 80211 compat"); 766b4cac81SBjoern A. Zeeb 775a9a0d78SBjoern A. Zeeb /* XXX-BZ really want this and others in queue.h */ 785a9a0d78SBjoern A. Zeeb #define TAILQ_ELEM_INIT(elm, field) do { \ 795a9a0d78SBjoern A. Zeeb (elm)->field.tqe_next = NULL; \ 805a9a0d78SBjoern A. Zeeb (elm)->field.tqe_prev = NULL; \ 815a9a0d78SBjoern A. Zeeb } while (0) 825a9a0d78SBjoern A. Zeeb 836b4cac81SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 846b4cac81SBjoern A. Zeeb 859d9ba2b7SBjoern A. Zeeb /* Keep public for as long as header files are using it too. */ 869d9ba2b7SBjoern A. Zeeb int linuxkpi_debug_80211; 876b4cac81SBjoern A. Zeeb 886b4cac81SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 899d9ba2b7SBjoern A. Zeeb SYSCTL_DECL(_compat_linuxkpi); 909d9ba2b7SBjoern A. Zeeb SYSCTL_NODE(_compat_linuxkpi, OID_AUTO, 80211, CTLFLAG_RW | CTLFLAG_MPSAFE, 0, 919d9ba2b7SBjoern A. Zeeb "LinuxKPI 802.11 compatibility layer"); 929d9ba2b7SBjoern A. Zeeb 939d9ba2b7SBjoern A. Zeeb SYSCTL_INT(_compat_linuxkpi_80211, OID_AUTO, debug, CTLFLAG_RWTUN, 949d9ba2b7SBjoern A. Zeeb &linuxkpi_debug_80211, 0, "LinuxKPI 802.11 debug level"); 959d9ba2b7SBjoern A. Zeeb 969d9ba2b7SBjoern A. Zeeb #define UNIMPLEMENTED if (linuxkpi_debug_80211 & D80211_TODO) \ 976b4cac81SBjoern A. Zeeb printf("XXX-TODO %s:%d: UNIMPLEMENTED\n", __func__, __LINE__) 989d9ba2b7SBjoern A. Zeeb #define TRACEOK() if (linuxkpi_debug_80211 & D80211_TRACEOK) \ 996b4cac81SBjoern A. Zeeb printf("XXX-TODO %s:%d: TRACEPOINT\n", __func__, __LINE__) 1006b4cac81SBjoern A. Zeeb #else 1016b4cac81SBjoern A. Zeeb #define UNIMPLEMENTED do { } while (0) 1026b4cac81SBjoern A. Zeeb #define TRACEOK() do { } while (0) 1036b4cac81SBjoern A. Zeeb #endif 1046b4cac81SBjoern A. Zeeb 1056b4cac81SBjoern A. Zeeb /* #define PREP_TX_INFO_DURATION (IEEE80211_TRANS_WAIT * 1000) */ 1066b4cac81SBjoern A. Zeeb #ifndef PREP_TX_INFO_DURATION 1076b4cac81SBjoern A. Zeeb #define PREP_TX_INFO_DURATION 0 /* Let the driver do its thing. */ 1086b4cac81SBjoern A. Zeeb #endif 1096b4cac81SBjoern A. Zeeb 1106b4cac81SBjoern A. Zeeb /* This is DSAP | SSAP | CTRL | ProtoID/OrgCode{3}. */ 1116b4cac81SBjoern A. Zeeb const uint8_t rfc1042_header[6] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; 1126b4cac81SBjoern A. Zeeb 113b0f73768SBjoern A. Zeeb /* IEEE 802.11-05/0257r1 */ 114b0f73768SBjoern A. Zeeb const uint8_t bridge_tunnel_header[6] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; 115b0f73768SBjoern A. Zeeb 116fb3c249eSBjoern A. Zeeb /* IEEE 802.11e Table 20i-UP-to-AC mappings. */ 117fb3c249eSBjoern A. Zeeb static const uint8_t ieee80211e_up_to_ac[] = { 1184f61ef8bSBjoern A. Zeeb IEEE80211_AC_BE, 1194f61ef8bSBjoern A. Zeeb IEEE80211_AC_BK, 1204f61ef8bSBjoern A. Zeeb IEEE80211_AC_BK, 1214f61ef8bSBjoern A. Zeeb IEEE80211_AC_BE, 1224f61ef8bSBjoern A. Zeeb IEEE80211_AC_VI, 1234f61ef8bSBjoern A. Zeeb IEEE80211_AC_VI, 1244f61ef8bSBjoern A. Zeeb IEEE80211_AC_VO, 1254f61ef8bSBjoern A. Zeeb IEEE80211_AC_VO, 1264f61ef8bSBjoern A. Zeeb #if 0 1274f61ef8bSBjoern A. Zeeb IEEE80211_AC_VO, /* We treat MGMT as TID 8, which is set as AC_VO */ 1284f61ef8bSBjoern A. Zeeb #endif 1294f61ef8bSBjoern A. Zeeb }; 1304f61ef8bSBjoern A. Zeeb 1316b4cac81SBjoern A. Zeeb const struct cfg80211_ops linuxkpi_mac80211cfgops = { 1326b4cac81SBjoern A. Zeeb /* 1336b4cac81SBjoern A. Zeeb * XXX TODO need a "glue layer" to link cfg80211 ops to 1346b4cac81SBjoern A. Zeeb * mac80211 and to the driver or net80211. 1356b4cac81SBjoern A. Zeeb * Can we pass some on 1:1? Need to compare the (*f)(). 1366b4cac81SBjoern A. Zeeb */ 1376b4cac81SBjoern A. Zeeb }; 1386b4cac81SBjoern A. Zeeb 1396b4cac81SBjoern A. Zeeb static struct lkpi_sta *lkpi_find_lsta_by_ni(struct lkpi_vif *, 1406b4cac81SBjoern A. Zeeb struct ieee80211_node *); 1416b4cac81SBjoern A. Zeeb static void lkpi_80211_txq_task(void *, int); 1426b4cac81SBjoern A. Zeeb static void lkpi_ieee80211_free_skb_mbuf(void *); 1434a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 1444a67f1dfSBjoern A. Zeeb static int lkpi_wme_update(struct lkpi_hw *, struct ieee80211vap *, bool); 1454a67f1dfSBjoern A. Zeeb #endif 1466b4cac81SBjoern A. Zeeb 147d9f59799SBjoern A. Zeeb static void 14867674c1cSBjoern A. Zeeb lkpi_lsta_dump(struct lkpi_sta *lsta, struct ieee80211_node *ni, 14967674c1cSBjoern A. Zeeb const char *_f, int _l) 150d9f59799SBjoern A. Zeeb { 151d9f59799SBjoern A. Zeeb 1529d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 1539d9ba2b7SBjoern A. Zeeb if ((linuxkpi_debug_80211 & D80211_TRACE_STA) == 0) 154d9f59799SBjoern A. Zeeb return; 155d9f59799SBjoern A. Zeeb if (lsta == NULL) 156d9f59799SBjoern A. Zeeb return; 157d9f59799SBjoern A. Zeeb 158d9f59799SBjoern A. Zeeb printf("%s:%d lsta %p ni %p sta %p\n", 15967674c1cSBjoern A. Zeeb _f, _l, lsta, ni, &lsta->sta); 16067674c1cSBjoern A. Zeeb if (ni != NULL) 16167674c1cSBjoern A. Zeeb ieee80211_dump_node(NULL, ni); 162d9f59799SBjoern A. Zeeb printf("\ttxq_task txq len %d mtx\n", mbufq_len(&lsta->txq)); 163d9f59799SBjoern A. Zeeb printf("\tkc %p state %d added_to_drv %d in_mgd %d\n", 164d9f59799SBjoern A. Zeeb lsta->kc, lsta->state, lsta->added_to_drv, lsta->in_mgd); 1659d9ba2b7SBjoern A. Zeeb #endif 166d9f59799SBjoern A. Zeeb } 167d9f59799SBjoern A. Zeeb 168d9f59799SBjoern A. Zeeb static void 169d9f59799SBjoern A. Zeeb lkpi_lsta_remove(struct lkpi_sta *lsta, struct lkpi_vif *lvif) 170d9f59799SBjoern A. Zeeb { 171d9f59799SBjoern A. Zeeb struct ieee80211_node *ni; 172d9f59799SBjoern A. Zeeb 1733689f8aeSColin Percival IMPROVE("XXX-BZ remove tqe_prev check once ni-sta-state-sync is fixed"); 1743689f8aeSColin Percival 175d9f59799SBjoern A. Zeeb ni = lsta->ni; 176d9f59799SBjoern A. Zeeb 177d9f59799SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 1783689f8aeSColin Percival if (lsta->lsta_entry.tqe_prev != NULL) 179d9f59799SBjoern A. Zeeb TAILQ_REMOVE(&lvif->lsta_head, lsta, lsta_entry); 180d9f59799SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 181d9f59799SBjoern A. Zeeb 182d9f59799SBjoern A. Zeeb lsta->ni = NULL; 183d9f59799SBjoern A. Zeeb ni->ni_drv_data = NULL; 184e24e8103SBjoern A. Zeeb if (ni != NULL) 185d9f59799SBjoern A. Zeeb ieee80211_free_node(ni); 186d9f59799SBjoern A. Zeeb 187e24e8103SBjoern A. Zeeb IMPROVE("more from lkpi_ic_node_free() should happen here."); 188e24e8103SBjoern A. Zeeb 189e24e8103SBjoern A. Zeeb free(lsta, M_LKPI80211); 190d9f59799SBjoern A. Zeeb } 191d9f59799SBjoern A. Zeeb 1924f61ef8bSBjoern A. Zeeb static struct lkpi_sta * 1934f61ef8bSBjoern A. Zeeb lkpi_lsta_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN], 1944f61ef8bSBjoern A. Zeeb struct ieee80211_hw *hw, struct ieee80211_node *ni) 1954f61ef8bSBjoern A. Zeeb { 1964f61ef8bSBjoern A. Zeeb struct lkpi_sta *lsta; 1974f61ef8bSBjoern A. Zeeb struct lkpi_vif *lvif; 1984f61ef8bSBjoern A. Zeeb struct ieee80211_vif *vif; 1994f61ef8bSBjoern A. Zeeb struct ieee80211_sta *sta; 200b6b352e4SBjoern A. Zeeb int band, i, tid; 2014f61ef8bSBjoern A. Zeeb 2024f61ef8bSBjoern A. Zeeb lsta = malloc(sizeof(*lsta) + hw->sta_data_size, M_LKPI80211, 2034f61ef8bSBjoern A. Zeeb M_NOWAIT | M_ZERO); 2044f61ef8bSBjoern A. Zeeb if (lsta == NULL) 2054f61ef8bSBjoern A. Zeeb return (NULL); 2064f61ef8bSBjoern A. Zeeb 2074f61ef8bSBjoern A. Zeeb lsta->added_to_drv = false; 2084f61ef8bSBjoern A. Zeeb lsta->state = IEEE80211_STA_NOTEXIST; 2094f61ef8bSBjoern A. Zeeb #if 0 2104f61ef8bSBjoern A. Zeeb /* 2114f61ef8bSBjoern A. Zeeb * This needs to be done in node_init() as ieee80211_alloc_node() 2124f61ef8bSBjoern A. Zeeb * will initialise the refcount after us. 2134f61ef8bSBjoern A. Zeeb */ 2144f61ef8bSBjoern A. Zeeb lsta->ni = ieee80211_ref_node(ni); 2154f61ef8bSBjoern A. Zeeb #endif 2164f61ef8bSBjoern A. Zeeb /* The back-pointer "drv_data" to net80211_node let's us get lsta. */ 2174f61ef8bSBjoern A. Zeeb ni->ni_drv_data = lsta; 2184f61ef8bSBjoern A. Zeeb 2194f61ef8bSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 2204f61ef8bSBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 2214f61ef8bSBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 2224f61ef8bSBjoern A. Zeeb 2234f61ef8bSBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->addr, mac); 224b6b352e4SBjoern A. Zeeb 225b6b352e4SBjoern A. Zeeb /* TXQ */ 2264f61ef8bSBjoern A. Zeeb for (tid = 0; tid < nitems(sta->txq); tid++) { 2274f61ef8bSBjoern A. Zeeb struct lkpi_txq *ltxq; 2284f61ef8bSBjoern A. Zeeb 229d0d29110SBjoern A. Zeeb /* We are not limiting ourselves to hw.queues here. */ 2304f61ef8bSBjoern A. Zeeb ltxq = malloc(sizeof(*ltxq) + hw->txq_data_size, 2314f61ef8bSBjoern A. Zeeb M_LKPI80211, M_NOWAIT | M_ZERO); 2324f61ef8bSBjoern A. Zeeb if (ltxq == NULL) 2334f61ef8bSBjoern A. Zeeb goto cleanup; 2344f61ef8bSBjoern A. Zeeb /* iwlwifi//mvm/sta.c::tid_to_mac80211_ac[] */ 2354f61ef8bSBjoern A. Zeeb if (tid == IEEE80211_NUM_TIDS) { 236d0d29110SBjoern A. Zeeb if (!ieee80211_hw_check(hw, STA_MMPDU_TXQ)) { 237d0d29110SBjoern A. Zeeb free(ltxq, M_LKPI80211); 238d0d29110SBjoern A. Zeeb continue; 239d0d29110SBjoern A. Zeeb } 240d0d29110SBjoern A. Zeeb IMPROVE("AP/if we support non-STA here too"); 2414f61ef8bSBjoern A. Zeeb ltxq->txq.ac = IEEE80211_AC_VO; 2424f61ef8bSBjoern A. Zeeb } else { 243fb3c249eSBjoern A. Zeeb ltxq->txq.ac = ieee80211e_up_to_ac[tid & 7]; 2444f61ef8bSBjoern A. Zeeb } 245d0d29110SBjoern A. Zeeb ltxq->seen_dequeue = false; 2460cbcfa19SBjoern A. Zeeb ltxq->stopped = false; 247d0d29110SBjoern A. Zeeb ltxq->txq.vif = vif; 2484f61ef8bSBjoern A. Zeeb ltxq->txq.tid = tid; 2494f61ef8bSBjoern A. Zeeb ltxq->txq.sta = sta; 2500cbcfa19SBjoern A. Zeeb TAILQ_ELEM_INIT(ltxq, txq_entry); 251d0d29110SBjoern A. Zeeb skb_queue_head_init(<xq->skbq); 2524f61ef8bSBjoern A. Zeeb sta->txq[tid] = <xq->txq; 2534f61ef8bSBjoern A. Zeeb } 2544f61ef8bSBjoern A. Zeeb 255b6b352e4SBjoern A. Zeeb /* Deflink information. */ 256b6b352e4SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 257b6b352e4SBjoern A. Zeeb struct ieee80211_supported_band *supband; 258b6b352e4SBjoern A. Zeeb 259b6b352e4SBjoern A. Zeeb supband = hw->wiphy->bands[band]; 260b6b352e4SBjoern A. Zeeb if (supband == NULL) 261b6b352e4SBjoern A. Zeeb continue; 262b6b352e4SBjoern A. Zeeb 263b6b352e4SBjoern A. Zeeb for (i = 0; i < supband->n_bitrates; i++) { 264b6b352e4SBjoern A. Zeeb 265b6b352e4SBjoern A. Zeeb IMPROVE("Further supband->bitrates[i]* checks?"); 266b6b352e4SBjoern A. Zeeb /* or should we get them from the ni? */ 267b6b352e4SBjoern A. Zeeb sta->deflink.supp_rates[band] |= BIT(i); 268b6b352e4SBjoern A. Zeeb } 269b6b352e4SBjoern A. Zeeb } 2706ffb7bd4SBjoern A. Zeeb sta->deflink.smps_mode = IEEE80211_SMPS_OFF; 271b6b352e4SBjoern A. Zeeb IMPROVE("ht, vht, he, ... bandwidth, smps_mode, .."); 272b6b352e4SBjoern A. Zeeb /* bandwidth = IEEE80211_STA_RX_... */ 273b6b352e4SBjoern A. Zeeb 2746ffb7bd4SBjoern A. Zeeb /* Link configuration. */ 2756ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->deflink.addr, sta->addr); 2766ffb7bd4SBjoern A. Zeeb sta->link[0] = &sta->deflink; 2776ffb7bd4SBjoern A. Zeeb for (i = 1; i < nitems(sta->link); i++) { 2786ffb7bd4SBjoern A. Zeeb IMPROVE("more links; only link[0] = deflink currently."); 2796ffb7bd4SBjoern A. Zeeb } 2806ffb7bd4SBjoern A. Zeeb 2814f61ef8bSBjoern A. Zeeb /* Deferred TX path. */ 2824f61ef8bSBjoern A. Zeeb mtx_init(&lsta->txq_mtx, "lsta_txq", NULL, MTX_DEF); 2834f61ef8bSBjoern A. Zeeb TASK_INIT(&lsta->txq_task, 0, lkpi_80211_txq_task, lsta); 2844f61ef8bSBjoern A. Zeeb mbufq_init(&lsta->txq, IFQ_MAXLEN); 2854f61ef8bSBjoern A. Zeeb 2864f61ef8bSBjoern A. Zeeb return (lsta); 2874f61ef8bSBjoern A. Zeeb 2884f61ef8bSBjoern A. Zeeb cleanup: 2894f61ef8bSBjoern A. Zeeb for (; tid >= 0; tid--) 2904f61ef8bSBjoern A. Zeeb free(sta->txq[tid], M_LKPI80211); 2914f61ef8bSBjoern A. Zeeb free(lsta, M_LKPI80211); 2924f61ef8bSBjoern A. Zeeb return (NULL); 2934f61ef8bSBjoern A. Zeeb } 2944f61ef8bSBjoern A. Zeeb 2956b4cac81SBjoern A. Zeeb static enum nl80211_band 2966b4cac81SBjoern A. Zeeb lkpi_net80211_chan_to_nl80211_band(struct ieee80211_channel *c) 2976b4cac81SBjoern A. Zeeb { 2986b4cac81SBjoern A. Zeeb 2996b4cac81SBjoern A. Zeeb if (IEEE80211_IS_CHAN_2GHZ(c)) 3006b4cac81SBjoern A. Zeeb return (NL80211_BAND_2GHZ); 3016b4cac81SBjoern A. Zeeb else if (IEEE80211_IS_CHAN_5GHZ(c)) 3026b4cac81SBjoern A. Zeeb return (NL80211_BAND_5GHZ); 3036b4cac81SBjoern A. Zeeb #ifdef __notyet__ 3046b4cac81SBjoern A. Zeeb else if () 3056b4cac81SBjoern A. Zeeb return (NL80211_BAND_6GHZ); 3066b4cac81SBjoern A. Zeeb else if () 3076b4cac81SBjoern A. Zeeb return (NL80211_BAND_60GHZ); 3086b4cac81SBjoern A. Zeeb else if (IEEE80211_IS_CHAN_GSM(c)) 3096b4cac81SBjoern A. Zeeb return (NL80211_BAND_XXX); 3106b4cac81SBjoern A. Zeeb #endif 3116b4cac81SBjoern A. Zeeb else 3126b4cac81SBjoern A. Zeeb panic("%s: unsupported band. c %p flags %#x\n", 3136b4cac81SBjoern A. Zeeb __func__, c, c->ic_flags); 3146b4cac81SBjoern A. Zeeb } 3156b4cac81SBjoern A. Zeeb 3166b4cac81SBjoern A. Zeeb static uint32_t 3176b4cac81SBjoern A. Zeeb lkpi_nl80211_band_to_net80211_band(enum nl80211_band band) 3186b4cac81SBjoern A. Zeeb { 3196b4cac81SBjoern A. Zeeb 3206b4cac81SBjoern A. Zeeb /* XXX-BZ this is just silly; net80211 is too convoluted. */ 3216b4cac81SBjoern A. Zeeb /* IEEE80211_CHAN_A / _G / .. doesn't really work either. */ 3226b4cac81SBjoern A. Zeeb switch (band) { 3236b4cac81SBjoern A. Zeeb case NL80211_BAND_2GHZ: 3246b4cac81SBjoern A. Zeeb return (IEEE80211_CHAN_2GHZ); 3256b4cac81SBjoern A. Zeeb break; 3266b4cac81SBjoern A. Zeeb case NL80211_BAND_5GHZ: 3276b4cac81SBjoern A. Zeeb return (IEEE80211_CHAN_5GHZ); 3286b4cac81SBjoern A. Zeeb break; 3296b4cac81SBjoern A. Zeeb case NL80211_BAND_60GHZ: 3306b4cac81SBjoern A. Zeeb break; 3316b4cac81SBjoern A. Zeeb case NL80211_BAND_6GHZ: 3326b4cac81SBjoern A. Zeeb break; 3336b4cac81SBjoern A. Zeeb default: 3346b4cac81SBjoern A. Zeeb panic("%s: unsupported band %u\n", __func__, band); 3356b4cac81SBjoern A. Zeeb break; 3366b4cac81SBjoern A. Zeeb } 3376b4cac81SBjoern A. Zeeb 3386b4cac81SBjoern A. Zeeb IMPROVE(); 3396b4cac81SBjoern A. Zeeb return (0x00); 3406b4cac81SBjoern A. Zeeb } 3416b4cac81SBjoern A. Zeeb 342e3a0b120SBjoern A. Zeeb #if 0 3436b4cac81SBjoern A. Zeeb static enum ieee80211_ac_numbers 3446b4cac81SBjoern A. Zeeb lkpi_ac_net_to_l80211(int ac) 3456b4cac81SBjoern A. Zeeb { 3466b4cac81SBjoern A. Zeeb 3476b4cac81SBjoern A. Zeeb switch (ac) { 3486b4cac81SBjoern A. Zeeb case WME_AC_VO: 3496b4cac81SBjoern A. Zeeb return (IEEE80211_AC_VO); 3506b4cac81SBjoern A. Zeeb case WME_AC_VI: 3516b4cac81SBjoern A. Zeeb return (IEEE80211_AC_VI); 3526b4cac81SBjoern A. Zeeb case WME_AC_BE: 3536b4cac81SBjoern A. Zeeb return (IEEE80211_AC_BE); 3546b4cac81SBjoern A. Zeeb case WME_AC_BK: 3556b4cac81SBjoern A. Zeeb return (IEEE80211_AC_BK); 3566b4cac81SBjoern A. Zeeb default: 3576b4cac81SBjoern A. Zeeb printf("%s: invalid WME_AC_* input: ac = %d\n", __func__, ac); 3586b4cac81SBjoern A. Zeeb return (IEEE80211_AC_BE); 3596b4cac81SBjoern A. Zeeb } 3606b4cac81SBjoern A. Zeeb } 361e3a0b120SBjoern A. Zeeb #endif 3626b4cac81SBjoern A. Zeeb 3636b4cac81SBjoern A. Zeeb static enum nl80211_iftype 3646b4cac81SBjoern A. Zeeb lkpi_opmode_to_vif_type(enum ieee80211_opmode opmode) 3656b4cac81SBjoern A. Zeeb { 3666b4cac81SBjoern A. Zeeb 3676b4cac81SBjoern A. Zeeb switch (opmode) { 3686b4cac81SBjoern A. Zeeb case IEEE80211_M_IBSS: 3696b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_ADHOC); 3706b4cac81SBjoern A. Zeeb break; 3716b4cac81SBjoern A. Zeeb case IEEE80211_M_STA: 3726b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_STATION); 3736b4cac81SBjoern A. Zeeb break; 3746b4cac81SBjoern A. Zeeb case IEEE80211_M_WDS: 3756b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_WDS); 3766b4cac81SBjoern A. Zeeb break; 3776b4cac81SBjoern A. Zeeb case IEEE80211_M_HOSTAP: 3786b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_AP); 3796b4cac81SBjoern A. Zeeb break; 3806b4cac81SBjoern A. Zeeb case IEEE80211_M_MONITOR: 3816b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_MONITOR); 3826b4cac81SBjoern A. Zeeb break; 3836b4cac81SBjoern A. Zeeb case IEEE80211_M_MBSS: 3846b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_MESH_POINT); 3856b4cac81SBjoern A. Zeeb break; 3866b4cac81SBjoern A. Zeeb case IEEE80211_M_AHDEMO: 3876b4cac81SBjoern A. Zeeb /* FALLTHROUGH */ 3886b4cac81SBjoern A. Zeeb default: 3896b4cac81SBjoern A. Zeeb printf("ERROR: %s: unsupported opmode %d\n", __func__, opmode); 3906b4cac81SBjoern A. Zeeb /* FALLTHROUGH */ 3916b4cac81SBjoern A. Zeeb } 3926b4cac81SBjoern A. Zeeb return (NL80211_IFTYPE_UNSPECIFIED); 3936b4cac81SBjoern A. Zeeb } 3946b4cac81SBjoern A. Zeeb 395b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 3966b4cac81SBjoern A. Zeeb static uint32_t 3976b4cac81SBjoern A. Zeeb lkpi_l80211_to_net80211_cyphers(uint32_t wlan_cipher_suite) 3986b4cac81SBjoern A. Zeeb { 3996b4cac81SBjoern A. Zeeb 4006b4cac81SBjoern A. Zeeb switch (wlan_cipher_suite) { 4016b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_WEP40: 4026b4cac81SBjoern A. Zeeb return (IEEE80211_CRYPTO_WEP); 4036b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_TKIP: 4046b4cac81SBjoern A. Zeeb return (IEEE80211_CRYPTO_TKIP); 4056b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_CCMP: 4066b4cac81SBjoern A. Zeeb return (IEEE80211_CIPHER_AES_CCM); 4076b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_WEP104: 4086b4cac81SBjoern A. Zeeb return (IEEE80211_CRYPTO_WEP); 4096b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_AES_CMAC: 4106b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_GCMP: 4116b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_GCMP_256: 4126b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_CCMP_256: 4136b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_BIP_GMAC_128: 4146b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_BIP_GMAC_256: 4156b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_BIP_CMAC_256: 4166b4cac81SBjoern A. Zeeb printf("%s: unsupported WLAN Cipher Suite %#08x | %u\n", __func__, 4176b4cac81SBjoern A. Zeeb wlan_cipher_suite >> 8, wlan_cipher_suite & 0xff); 4186b4cac81SBjoern A. Zeeb break; 4196b4cac81SBjoern A. Zeeb default: 4206b4cac81SBjoern A. Zeeb printf("%s: unknown WLAN Cipher Suite %#08x | %u\n", __func__, 4216b4cac81SBjoern A. Zeeb wlan_cipher_suite >> 8, wlan_cipher_suite & 0xff); 4226b4cac81SBjoern A. Zeeb } 4236b4cac81SBjoern A. Zeeb 4246b4cac81SBjoern A. Zeeb return (0); 4256b4cac81SBjoern A. Zeeb } 4266b4cac81SBjoern A. Zeeb 4276b4cac81SBjoern A. Zeeb static uint32_t 4286b4cac81SBjoern A. Zeeb lkpi_net80211_to_l80211_cipher_suite(uint32_t cipher, uint8_t keylen) 4296b4cac81SBjoern A. Zeeb { 4306b4cac81SBjoern A. Zeeb 4316b4cac81SBjoern A. Zeeb switch (cipher) { 4326b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_TKIP: 4336b4cac81SBjoern A. Zeeb return (WLAN_CIPHER_SUITE_TKIP); 4346b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_AES_CCM: 4356b4cac81SBjoern A. Zeeb return (WLAN_CIPHER_SUITE_CCMP); 4366b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_WEP: 4376b4cac81SBjoern A. Zeeb if (keylen < 8) 4386b4cac81SBjoern A. Zeeb return (WLAN_CIPHER_SUITE_WEP40); 4396b4cac81SBjoern A. Zeeb else 4406b4cac81SBjoern A. Zeeb return (WLAN_CIPHER_SUITE_WEP104); 4416b4cac81SBjoern A. Zeeb break; 4426b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_AES_OCB: 4436b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_TKIPMIC: 4446b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_CKIP: 4456b4cac81SBjoern A. Zeeb case IEEE80211_CIPHER_NONE: 4466b4cac81SBjoern A. Zeeb printf("%s: unsupported cipher %#010x\n", __func__, cipher); 4476b4cac81SBjoern A. Zeeb break; 4486b4cac81SBjoern A. Zeeb default: 4496b4cac81SBjoern A. Zeeb printf("%s: unknown cipher %#010x\n", __func__, cipher); 4506b4cac81SBjoern A. Zeeb }; 4516b4cac81SBjoern A. Zeeb return (0); 4526b4cac81SBjoern A. Zeeb } 4536b4cac81SBjoern A. Zeeb #endif 4546b4cac81SBjoern A. Zeeb 4556b4cac81SBjoern A. Zeeb #ifdef __notyet__ 4566b4cac81SBjoern A. Zeeb static enum ieee80211_sta_state 4576b4cac81SBjoern A. Zeeb lkpi_net80211_state_to_sta_state(enum ieee80211_state state) 4586b4cac81SBjoern A. Zeeb { 4596b4cac81SBjoern A. Zeeb 4606b4cac81SBjoern A. Zeeb /* 4616b4cac81SBjoern A. Zeeb * XXX-BZ The net80211 states are "try to ..", the lkpi8011 states are 4626b4cac81SBjoern A. Zeeb * "done". Also ASSOC/AUTHORIZED are both "RUN" then? 4636b4cac81SBjoern A. Zeeb */ 4646b4cac81SBjoern A. Zeeb switch (state) { 4656b4cac81SBjoern A. Zeeb case IEEE80211_S_INIT: 4666b4cac81SBjoern A. Zeeb return (IEEE80211_STA_NOTEXIST); 4676b4cac81SBjoern A. Zeeb case IEEE80211_S_SCAN: 4686b4cac81SBjoern A. Zeeb return (IEEE80211_STA_NONE); 4696b4cac81SBjoern A. Zeeb case IEEE80211_S_AUTH: 4706b4cac81SBjoern A. Zeeb return (IEEE80211_STA_AUTH); 4716b4cac81SBjoern A. Zeeb case IEEE80211_S_ASSOC: 4726b4cac81SBjoern A. Zeeb return (IEEE80211_STA_ASSOC); 4736b4cac81SBjoern A. Zeeb case IEEE80211_S_RUN: 4746b4cac81SBjoern A. Zeeb return (IEEE80211_STA_AUTHORIZED); 4756b4cac81SBjoern A. Zeeb case IEEE80211_S_CAC: 4766b4cac81SBjoern A. Zeeb case IEEE80211_S_CSA: 4776b4cac81SBjoern A. Zeeb case IEEE80211_S_SLEEP: 4786b4cac81SBjoern A. Zeeb default: 4796b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 4806b4cac81SBjoern A. Zeeb }; 4816b4cac81SBjoern A. Zeeb 4826b4cac81SBjoern A. Zeeb return (IEEE80211_STA_NOTEXIST); 4836b4cac81SBjoern A. Zeeb } 4846b4cac81SBjoern A. Zeeb #endif 4856b4cac81SBjoern A. Zeeb 4866b4cac81SBjoern A. Zeeb static struct linuxkpi_ieee80211_channel * 4876b4cac81SBjoern A. Zeeb lkpi_find_lkpi80211_chan(struct lkpi_hw *lhw, 4886b4cac81SBjoern A. Zeeb struct ieee80211_channel *c) 4896b4cac81SBjoern A. Zeeb { 4906b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 4916b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 4926b4cac81SBjoern A. Zeeb enum nl80211_band band; 4936b4cac81SBjoern A. Zeeb int i, nchans; 4946b4cac81SBjoern A. Zeeb 4956b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 4966b4cac81SBjoern A. Zeeb band = lkpi_net80211_chan_to_nl80211_band(c); 4976b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[band] == NULL) 4986b4cac81SBjoern A. Zeeb return (NULL); 4996b4cac81SBjoern A. Zeeb 5006b4cac81SBjoern A. Zeeb nchans = hw->wiphy->bands[band]->n_channels; 5016b4cac81SBjoern A. Zeeb if (nchans <= 0) 5026b4cac81SBjoern A. Zeeb return (NULL); 5036b4cac81SBjoern A. Zeeb 5046b4cac81SBjoern A. Zeeb channels = hw->wiphy->bands[band]->channels; 5056b4cac81SBjoern A. Zeeb for (i = 0; i < nchans; i++) { 5066b4cac81SBjoern A. Zeeb if (channels[i].hw_value == c->ic_ieee) 5076b4cac81SBjoern A. Zeeb return (&channels[i]); 5086b4cac81SBjoern A. Zeeb } 5096b4cac81SBjoern A. Zeeb 5106b4cac81SBjoern A. Zeeb return (NULL); 5116b4cac81SBjoern A. Zeeb } 5126b4cac81SBjoern A. Zeeb 5136b4cac81SBjoern A. Zeeb static struct linuxkpi_ieee80211_channel * 5146b4cac81SBjoern A. Zeeb lkpi_get_lkpi80211_chan(struct ieee80211com *ic, struct ieee80211_node *ni) 5156b4cac81SBjoern A. Zeeb { 5166b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 5176b4cac81SBjoern A. Zeeb struct ieee80211_channel *c; 5186b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 5196b4cac81SBjoern A. Zeeb 5206b4cac81SBjoern A. Zeeb chan = NULL; 5216b4cac81SBjoern A. Zeeb if (ni != NULL && ni->ni_chan != IEEE80211_CHAN_ANYC) 5226b4cac81SBjoern A. Zeeb c = ni->ni_chan; 5236b4cac81SBjoern A. Zeeb else if (ic->ic_bsschan != IEEE80211_CHAN_ANYC) 5246b4cac81SBjoern A. Zeeb c = ic->ic_bsschan; 5256b4cac81SBjoern A. Zeeb else if (ic->ic_curchan != IEEE80211_CHAN_ANYC) 5266b4cac81SBjoern A. Zeeb c = ic->ic_curchan; 5276b4cac81SBjoern A. Zeeb else 5286b4cac81SBjoern A. Zeeb c = NULL; 5296b4cac81SBjoern A. Zeeb 5306b4cac81SBjoern A. Zeeb if (c != NULL && c != IEEE80211_CHAN_ANYC) { 5316b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 5326b4cac81SBjoern A. Zeeb chan = lkpi_find_lkpi80211_chan(lhw, c); 5336b4cac81SBjoern A. Zeeb } 5346b4cac81SBjoern A. Zeeb 5356b4cac81SBjoern A. Zeeb return (chan); 5366b4cac81SBjoern A. Zeeb } 5376b4cac81SBjoern A. Zeeb 5382e183d99SBjoern A. Zeeb struct linuxkpi_ieee80211_channel * 5392e183d99SBjoern A. Zeeb linuxkpi_ieee80211_get_channel(struct wiphy *wiphy, uint32_t freq) 5402e183d99SBjoern A. Zeeb { 5412e183d99SBjoern A. Zeeb enum nl80211_band band; 5422e183d99SBjoern A. Zeeb 5432e183d99SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 5442e183d99SBjoern A. Zeeb struct ieee80211_supported_band *supband; 5452e183d99SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 5462e183d99SBjoern A. Zeeb int i; 5472e183d99SBjoern A. Zeeb 5482e183d99SBjoern A. Zeeb supband = wiphy->bands[band]; 5492e183d99SBjoern A. Zeeb if (supband == NULL || supband->n_channels == 0) 5502e183d99SBjoern A. Zeeb continue; 5512e183d99SBjoern A. Zeeb 5522e183d99SBjoern A. Zeeb channels = supband->channels; 5532e183d99SBjoern A. Zeeb for (i = 0; i < supband->n_channels; i++) { 5542e183d99SBjoern A. Zeeb if (channels[i].center_freq == freq) 5552e183d99SBjoern A. Zeeb return (&channels[i]); 5562e183d99SBjoern A. Zeeb } 5572e183d99SBjoern A. Zeeb } 5582e183d99SBjoern A. Zeeb 5592e183d99SBjoern A. Zeeb return (NULL); 5602e183d99SBjoern A. Zeeb } 5612e183d99SBjoern A. Zeeb 562b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 5636b4cac81SBjoern A. Zeeb static int 5646b4cac81SBjoern A. Zeeb _lkpi_iv_key_set_delete(struct ieee80211vap *vap, const struct ieee80211_key *k, 5656b4cac81SBjoern A. Zeeb enum set_key_cmd cmd) 5666b4cac81SBjoern A. Zeeb { 5676b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 5686b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 5696b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 5706b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 5716b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 5726b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 5736b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 5746b4cac81SBjoern A. Zeeb struct ieee80211_key_conf *kc; 5756b4cac81SBjoern A. Zeeb int error; 5766b4cac81SBjoern A. Zeeb 5776b4cac81SBjoern A. Zeeb /* XXX TODO Check (k->wk_flags & IEEE80211_KEY_SWENCRYPT) and don't upload to driver/hw? */ 5786b4cac81SBjoern A. Zeeb 5796b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 5806b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 5816b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 5826b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 5836b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 5846b4cac81SBjoern A. Zeeb 5856b4cac81SBjoern A. Zeeb memset(&kc, 0, sizeof(kc)); 5866b4cac81SBjoern A. Zeeb kc = malloc(sizeof(*kc) + k->wk_keylen, M_LKPI80211, M_WAITOK | M_ZERO); 5876b4cac81SBjoern A. Zeeb kc->cipher = lkpi_net80211_to_l80211_cipher_suite( 5886b4cac81SBjoern A. Zeeb k->wk_cipher->ic_cipher, k->wk_keylen); 5896b4cac81SBjoern A. Zeeb kc->keyidx = k->wk_keyix; 5906b4cac81SBjoern A. Zeeb #if 0 5916b4cac81SBjoern A. Zeeb kc->hw_key_idx = /* set by hw and needs to be passed for TX */; 5926b4cac81SBjoern A. Zeeb #endif 5936b4cac81SBjoern A. Zeeb atomic64_set(&kc->tx_pn, k->wk_keytsc); 5946b4cac81SBjoern A. Zeeb kc->keylen = k->wk_keylen; 5956b4cac81SBjoern A. Zeeb memcpy(kc->key, k->wk_key, k->wk_keylen); 5966b4cac81SBjoern A. Zeeb 5976b4cac81SBjoern A. Zeeb switch (kc->cipher) { 5986b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_CCMP: 5996b4cac81SBjoern A. Zeeb kc->iv_len = k->wk_cipher->ic_header; 6006b4cac81SBjoern A. Zeeb kc->icv_len = k->wk_cipher->ic_trailer; 6016b4cac81SBjoern A. Zeeb break; 6026b4cac81SBjoern A. Zeeb case WLAN_CIPHER_SUITE_TKIP: 6036b4cac81SBjoern A. Zeeb default: 6046b4cac81SBjoern A. Zeeb IMPROVE(); 6056b4cac81SBjoern A. Zeeb return (0); 6066b4cac81SBjoern A. Zeeb }; 6076b4cac81SBjoern A. Zeeb 6086b4cac81SBjoern A. Zeeb ni = vap->iv_bss; 6096b4cac81SBjoern A. Zeeb sta = ieee80211_find_sta(vif, ni->ni_bssid); 6106b4cac81SBjoern A. Zeeb if (sta != NULL) { 6116b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 6126b4cac81SBjoern A. Zeeb 6136b4cac81SBjoern A. Zeeb lsta = STA_TO_LSTA(sta); 6146b4cac81SBjoern A. Zeeb lsta->kc = kc; 6156b4cac81SBjoern A. Zeeb } 6166b4cac81SBjoern A. Zeeb 6176b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_set_key(hw, cmd, vif, sta, kc); 6186b4cac81SBjoern A. Zeeb if (error != 0) { 6196b4cac81SBjoern A. Zeeb /* XXX-BZ leaking kc currently */ 6206b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: set_key failed: %d\n", __func__, error); 6216b4cac81SBjoern A. Zeeb return (0); 6226b4cac81SBjoern A. Zeeb } else { 6236b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: set_key succeeded: keyidx %u hw_key_idx %u " 6246b4cac81SBjoern A. Zeeb "flags %#10x\n", __func__, 6256b4cac81SBjoern A. Zeeb kc->keyidx, kc->hw_key_idx, kc->flags); 6266b4cac81SBjoern A. Zeeb return (1); 6276b4cac81SBjoern A. Zeeb } 6286b4cac81SBjoern A. Zeeb } 6296b4cac81SBjoern A. Zeeb 6306b4cac81SBjoern A. Zeeb static int 6316b4cac81SBjoern A. Zeeb lkpi_iv_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k) 6326b4cac81SBjoern A. Zeeb { 6336b4cac81SBjoern A. Zeeb 6346b4cac81SBjoern A. Zeeb /* XXX-BZ one day we should replace this iterating over VIFs, or node list? */ 6356b4cac81SBjoern A. Zeeb return (_lkpi_iv_key_set_delete(vap, k, DISABLE_KEY)); 6366b4cac81SBjoern A. Zeeb } 6376b4cac81SBjoern A. Zeeb static int 6386b4cac81SBjoern A. Zeeb lkpi_iv_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k) 6396b4cac81SBjoern A. Zeeb { 6406b4cac81SBjoern A. Zeeb 6416b4cac81SBjoern A. Zeeb return (_lkpi_iv_key_set_delete(vap, k, SET_KEY)); 6426b4cac81SBjoern A. Zeeb } 6436b4cac81SBjoern A. Zeeb #endif 6446b4cac81SBjoern A. Zeeb 6456b4cac81SBjoern A. Zeeb static u_int 6466b4cac81SBjoern A. Zeeb lkpi_ic_update_mcast_copy(void *arg, struct sockaddr_dl *sdl, u_int cnt) 6476b4cac81SBjoern A. Zeeb { 6486b4cac81SBjoern A. Zeeb struct netdev_hw_addr_list *mc_list; 6496b4cac81SBjoern A. Zeeb struct netdev_hw_addr *addr; 6506b4cac81SBjoern A. Zeeb 6516b4cac81SBjoern A. Zeeb KASSERT(arg != NULL && sdl != NULL, ("%s: arg %p sdl %p cnt %u\n", 6526b4cac81SBjoern A. Zeeb __func__, arg, sdl, cnt)); 6536b4cac81SBjoern A. Zeeb 6546b4cac81SBjoern A. Zeeb mc_list = arg; 6556b4cac81SBjoern A. Zeeb /* If it is on the list already skip it. */ 6566b4cac81SBjoern A. Zeeb netdev_hw_addr_list_for_each(addr, mc_list) { 6576b4cac81SBjoern A. Zeeb if (!memcmp(addr->addr, LLADDR(sdl), sdl->sdl_alen)) 6586b4cac81SBjoern A. Zeeb return (0); 6596b4cac81SBjoern A. Zeeb } 6606b4cac81SBjoern A. Zeeb 6616b4cac81SBjoern A. Zeeb addr = malloc(sizeof(*addr), M_LKPI80211, M_NOWAIT | M_ZERO); 6626b4cac81SBjoern A. Zeeb if (addr == NULL) 6636b4cac81SBjoern A. Zeeb return (0); 6646b4cac81SBjoern A. Zeeb 6656b4cac81SBjoern A. Zeeb INIT_LIST_HEAD(&addr->addr_list); 6666b4cac81SBjoern A. Zeeb memcpy(addr->addr, LLADDR(sdl), sdl->sdl_alen); 6676b4cac81SBjoern A. Zeeb /* XXX this should be a netdev function? */ 6686b4cac81SBjoern A. Zeeb list_add(&addr->addr_list, &mc_list->addr_list); 6696b4cac81SBjoern A. Zeeb mc_list->count++; 6706b4cac81SBjoern A. Zeeb 6719d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 6729d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 6736b4cac81SBjoern A. Zeeb printf("%s:%d: mc_list count %d: added %6D\n", 6746b4cac81SBjoern A. Zeeb __func__, __LINE__, mc_list->count, addr->addr, ":"); 6759d9ba2b7SBjoern A. Zeeb #endif 6766b4cac81SBjoern A. Zeeb 6776b4cac81SBjoern A. Zeeb return (1); 6786b4cac81SBjoern A. Zeeb } 6796b4cac81SBjoern A. Zeeb 6806b4cac81SBjoern A. Zeeb static void 6816b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(struct ieee80211com *ic, bool force) 6826b4cac81SBjoern A. Zeeb { 6836b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 6846b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 6856b4cac81SBjoern A. Zeeb struct netdev_hw_addr_list mc_list; 6866b4cac81SBjoern A. Zeeb struct list_head *le, *next; 6876b4cac81SBjoern A. Zeeb struct netdev_hw_addr *addr; 6886b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 6896b4cac81SBjoern A. Zeeb u64 mc; 6906b4cac81SBjoern A. Zeeb unsigned int changed_flags, total_flags; 6916b4cac81SBjoern A. Zeeb 6926b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 6936b4cac81SBjoern A. Zeeb 6946b4cac81SBjoern A. Zeeb if (lhw->ops->prepare_multicast == NULL || 6956b4cac81SBjoern A. Zeeb lhw->ops->configure_filter == NULL) 6966b4cac81SBjoern A. Zeeb return; 6976b4cac81SBjoern A. Zeeb 6986b4cac81SBjoern A. Zeeb if (!lhw->update_mc && !force) 6996b4cac81SBjoern A. Zeeb return; 7006b4cac81SBjoern A. Zeeb 7016b4cac81SBjoern A. Zeeb changed_flags = total_flags = 0; 7026b4cac81SBjoern A. Zeeb mc_list.count = 0; 7036b4cac81SBjoern A. Zeeb INIT_LIST_HEAD(&mc_list.addr_list); 7046b4cac81SBjoern A. Zeeb if (ic->ic_allmulti == 0) { 7056b4cac81SBjoern A. Zeeb TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) 7066b4cac81SBjoern A. Zeeb if_foreach_llmaddr(vap->iv_ifp, 7076b4cac81SBjoern A. Zeeb lkpi_ic_update_mcast_copy, &mc_list); 7086b4cac81SBjoern A. Zeeb } else { 7096b4cac81SBjoern A. Zeeb changed_flags |= FIF_ALLMULTI; 7106b4cac81SBjoern A. Zeeb } 7116b4cac81SBjoern A. Zeeb 7126b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 7136b4cac81SBjoern A. Zeeb mc = lkpi_80211_mo_prepare_multicast(hw, &mc_list); 7146b4cac81SBjoern A. Zeeb /* 7156b4cac81SBjoern A. Zeeb * XXX-BZ make sure to get this sorted what is a change, 7166b4cac81SBjoern A. Zeeb * what gets all set; what was already set? 7176b4cac81SBjoern A. Zeeb */ 7186b4cac81SBjoern A. Zeeb total_flags = changed_flags; 7196b4cac81SBjoern A. Zeeb lkpi_80211_mo_configure_filter(hw, changed_flags, &total_flags, mc); 7206b4cac81SBjoern A. Zeeb 7219d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 7229d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 7236b4cac81SBjoern A. Zeeb printf("%s: changed_flags %#06x count %d total_flags %#010x\n", 7246b4cac81SBjoern A. Zeeb __func__, changed_flags, mc_list.count, total_flags); 7259d9ba2b7SBjoern A. Zeeb #endif 7266b4cac81SBjoern A. Zeeb 7276b4cac81SBjoern A. Zeeb if (mc_list.count != 0) { 7286b4cac81SBjoern A. Zeeb list_for_each_safe(le, next, &mc_list.addr_list) { 7296b4cac81SBjoern A. Zeeb addr = list_entry(le, struct netdev_hw_addr, addr_list); 7306b4cac81SBjoern A. Zeeb free(addr, M_LKPI80211); 7316b4cac81SBjoern A. Zeeb mc_list.count--; 7326b4cac81SBjoern A. Zeeb } 7336b4cac81SBjoern A. Zeeb } 7346b4cac81SBjoern A. Zeeb KASSERT(mc_list.count == 0, ("%s: mc_list %p count %d != 0\n", 7356b4cac81SBjoern A. Zeeb __func__, &mc_list, mc_list.count)); 7366b4cac81SBjoern A. Zeeb } 7376b4cac81SBjoern A. Zeeb 738fa8f007dSBjoern A. Zeeb static enum ieee80211_bss_changed 739fa8f007dSBjoern A. Zeeb lkpi_update_dtim_tsf(struct ieee80211_vif *vif, struct ieee80211_node *ni, 740fa8f007dSBjoern A. Zeeb struct ieee80211vap *vap, const char *_f, int _l) 741fa8f007dSBjoern A. Zeeb { 742fa8f007dSBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 743fa8f007dSBjoern A. Zeeb 744fa8f007dSBjoern A. Zeeb bss_changed = 0; 745fa8f007dSBjoern A. Zeeb 7469d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 7479d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 748fa8f007dSBjoern A. Zeeb printf("%s:%d [%s:%d] assoc %d aid %d beacon_int %u " 749fa8f007dSBjoern A. Zeeb "dtim_period %u sync_dtim_count %u sync_tsf %ju " 750fa8f007dSBjoern A. Zeeb "sync_device_ts %u bss_changed %#08x\n", 751fa8f007dSBjoern A. Zeeb __func__, __LINE__, _f, _l, 752616e1330SBjoern A. Zeeb vif->cfg.assoc, vif->cfg.aid, 753fa8f007dSBjoern A. Zeeb vif->bss_conf.beacon_int, vif->bss_conf.dtim_period, 754fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_dtim_count, 755fa8f007dSBjoern A. Zeeb (uintmax_t)vif->bss_conf.sync_tsf, 756fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_device_ts, 757fa8f007dSBjoern A. Zeeb bss_changed); 7589d9ba2b7SBjoern A. Zeeb #endif 759fa8f007dSBjoern A. Zeeb 760fa8f007dSBjoern A. Zeeb if (vif->bss_conf.beacon_int != ni->ni_intval) { 761fa8f007dSBjoern A. Zeeb vif->bss_conf.beacon_int = ni->ni_intval; 762fa8f007dSBjoern A. Zeeb /* iwlwifi FW bug workaround; iwl_mvm_mac_sta_state. */ 763fa8f007dSBjoern A. Zeeb if (vif->bss_conf.beacon_int < 16) 764fa8f007dSBjoern A. Zeeb vif->bss_conf.beacon_int = 16; 765fa8f007dSBjoern A. Zeeb bss_changed |= BSS_CHANGED_BEACON_INT; 766fa8f007dSBjoern A. Zeeb } 767fa8f007dSBjoern A. Zeeb if (vif->bss_conf.dtim_period != vap->iv_dtim_period && 768fa8f007dSBjoern A. Zeeb vap->iv_dtim_period > 0) { 769fa8f007dSBjoern A. Zeeb vif->bss_conf.dtim_period = vap->iv_dtim_period; 770fa8f007dSBjoern A. Zeeb bss_changed |= BSS_CHANGED_BEACON_INFO; 771fa8f007dSBjoern A. Zeeb } 772fa8f007dSBjoern A. Zeeb 773fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_dtim_count = vap->iv_dtim_count; 774fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_tsf = le64toh(ni->ni_tstamp.tsf); 775fa8f007dSBjoern A. Zeeb /* vif->bss_conf.sync_device_ts = set in linuxkpi_ieee80211_rx. */ 776fa8f007dSBjoern A. Zeeb 7779d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 7789d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 779fa8f007dSBjoern A. Zeeb printf("%s:%d [%s:%d] assoc %d aid %d beacon_int %u " 780fa8f007dSBjoern A. Zeeb "dtim_period %u sync_dtim_count %u sync_tsf %ju " 781fa8f007dSBjoern A. Zeeb "sync_device_ts %u bss_changed %#08x\n", 782fa8f007dSBjoern A. Zeeb __func__, __LINE__, _f, _l, 783616e1330SBjoern A. Zeeb vif->cfg.assoc, vif->cfg.aid, 784fa8f007dSBjoern A. Zeeb vif->bss_conf.beacon_int, vif->bss_conf.dtim_period, 785fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_dtim_count, 786fa8f007dSBjoern A. Zeeb (uintmax_t)vif->bss_conf.sync_tsf, 787fa8f007dSBjoern A. Zeeb vif->bss_conf.sync_device_ts, 788fa8f007dSBjoern A. Zeeb bss_changed); 7899d9ba2b7SBjoern A. Zeeb #endif 790fa8f007dSBjoern A. Zeeb 791fa8f007dSBjoern A. Zeeb return (bss_changed); 792fa8f007dSBjoern A. Zeeb } 793fa8f007dSBjoern A. Zeeb 7946b4cac81SBjoern A. Zeeb static void 7956b4cac81SBjoern A. Zeeb lkpi_stop_hw_scan(struct lkpi_hw *lhw, struct ieee80211_vif *vif) 7966b4cac81SBjoern A. Zeeb { 7976b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 7986b4cac81SBjoern A. Zeeb int error; 7998ac540d3SBjoern A. Zeeb bool cancel; 8006b4cac81SBjoern A. Zeeb 8018ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 8028ac540d3SBjoern A. Zeeb cancel = (lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0; 8038ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 8048ac540d3SBjoern A. Zeeb if (!cancel) 8056b4cac81SBjoern A. Zeeb return; 8066b4cac81SBjoern A. Zeeb 8076b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 8086b4cac81SBjoern A. Zeeb 809bec76628SBjoern A. Zeeb IEEE80211_UNLOCK(lhw->ic); 810bec76628SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 8116b4cac81SBjoern A. Zeeb /* Need to cancel the scan. */ 8126b4cac81SBjoern A. Zeeb lkpi_80211_mo_cancel_hw_scan(hw, vif); 8138ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 8146b4cac81SBjoern A. Zeeb 8156b4cac81SBjoern A. Zeeb /* Need to make sure we see ieee80211_scan_completed. */ 8168ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 8178ac540d3SBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0) 8188ac540d3SBjoern A. Zeeb error = msleep(lhw, &lhw->scan_mtx, 0, "lhwscanstop", hz/2); 8198ac540d3SBjoern A. Zeeb cancel = (lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0; 8208ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 8218ac540d3SBjoern A. Zeeb 822bec76628SBjoern A. Zeeb IEEE80211_LOCK(lhw->ic); 8236b4cac81SBjoern A. Zeeb 8248ac540d3SBjoern A. Zeeb if (cancel) 8256b4cac81SBjoern A. Zeeb ic_printf(lhw->ic, "%s: failed to cancel scan: %d (%p, %p)\n", 8266b4cac81SBjoern A. Zeeb __func__, error, lhw, vif); 8276b4cac81SBjoern A. Zeeb } 8286b4cac81SBjoern A. Zeeb 8296b4cac81SBjoern A. Zeeb static void 830086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(struct ieee80211_hw *hw, bool new) 831086be6a8SBjoern A. Zeeb { 832086be6a8SBjoern A. Zeeb struct lkpi_hw *lhw; 833086be6a8SBjoern A. Zeeb int error; 834086be6a8SBjoern A. Zeeb bool old; 835086be6a8SBjoern A. Zeeb 836086be6a8SBjoern A. Zeeb old = hw->conf.flags & IEEE80211_CONF_IDLE; 837086be6a8SBjoern A. Zeeb if (old == new) 838086be6a8SBjoern A. Zeeb return; 839086be6a8SBjoern A. Zeeb 840086be6a8SBjoern A. Zeeb hw->conf.flags ^= IEEE80211_CONF_IDLE; 841086be6a8SBjoern A. Zeeb error = lkpi_80211_mo_config(hw, IEEE80211_CONF_CHANGE_IDLE); 842086be6a8SBjoern A. Zeeb if (error != 0 && error != EOPNOTSUPP) { 843086be6a8SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 844086be6a8SBjoern A. Zeeb ic_printf(lhw->ic, "ERROR: %s: config %#0x returned %d\n", 845086be6a8SBjoern A. Zeeb __func__, IEEE80211_CONF_CHANGE_IDLE, error); 846086be6a8SBjoern A. Zeeb } 847086be6a8SBjoern A. Zeeb } 848086be6a8SBjoern A. Zeeb 849086be6a8SBjoern A. Zeeb static void 8506b4cac81SBjoern A. Zeeb lkpi_disassoc(struct ieee80211_sta *sta, struct ieee80211_vif *vif, 8516b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw) 8526b4cac81SBjoern A. Zeeb { 8536b4cac81SBjoern A. Zeeb sta->aid = 0; 854616e1330SBjoern A. Zeeb if (vif->cfg.assoc) { 8556b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 8566b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed changed; 8576b4cac81SBjoern A. Zeeb 8586b4cac81SBjoern A. Zeeb lhw->update_mc = true; 8596b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(lhw->ic, true); 8606b4cac81SBjoern A. Zeeb 8616b4cac81SBjoern A. Zeeb changed = 0; 862616e1330SBjoern A. Zeeb vif->cfg.assoc = false; 863616e1330SBjoern A. Zeeb vif->cfg.aid = 0; 8646b4cac81SBjoern A. Zeeb changed |= BSS_CHANGED_ASSOC; 865d9f59799SBjoern A. Zeeb /* 866d9f59799SBjoern A. Zeeb * This will remove the sta from firmware for iwlwifi. 867d9f59799SBjoern A. Zeeb * So confusing that they use state and flags and ... ^%$%#%$^. 868d9f59799SBjoern A. Zeeb */ 8696b4cac81SBjoern A. Zeeb IMPROVE(); 8706b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 8716b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, 8726b4cac81SBjoern A. Zeeb changed); 873086be6a8SBjoern A. Zeeb 874086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, true); 8756b4cac81SBjoern A. Zeeb } 8766b4cac81SBjoern A. Zeeb } 8776b4cac81SBjoern A. Zeeb 8786b4cac81SBjoern A. Zeeb static void 8796b4cac81SBjoern A. Zeeb lkpi_wake_tx_queues(struct ieee80211_hw *hw, struct ieee80211_sta *sta, 8806b4cac81SBjoern A. Zeeb bool dequeue_seen, bool no_emptyq) 8816b4cac81SBjoern A. Zeeb { 8826b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 8836b4cac81SBjoern A. Zeeb int tid; 8846b4cac81SBjoern A. Zeeb 8856b4cac81SBjoern A. Zeeb /* Wake up all queues to know they are allocated in the driver. */ 8866b4cac81SBjoern A. Zeeb for (tid = 0; tid < nitems(sta->txq); tid++) { 8876b4cac81SBjoern A. Zeeb 8886b4cac81SBjoern A. Zeeb if (tid == IEEE80211_NUM_TIDS) { 8896b4cac81SBjoern A. Zeeb IMPROVE("station specific?"); 8906b4cac81SBjoern A. Zeeb if (!ieee80211_hw_check(hw, STA_MMPDU_TXQ)) 8916b4cac81SBjoern A. Zeeb continue; 8926b4cac81SBjoern A. Zeeb } else if (tid >= hw->queues) 8936b4cac81SBjoern A. Zeeb continue; 8946b4cac81SBjoern A. Zeeb 8956b4cac81SBjoern A. Zeeb if (sta->txq[tid] == NULL) 8966b4cac81SBjoern A. Zeeb continue; 8976b4cac81SBjoern A. Zeeb 8986b4cac81SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[tid]); 8996b4cac81SBjoern A. Zeeb if (dequeue_seen && !ltxq->seen_dequeue) 9006b4cac81SBjoern A. Zeeb continue; 9016b4cac81SBjoern A. Zeeb 9026b4cac81SBjoern A. Zeeb if (no_emptyq && skb_queue_empty(<xq->skbq)) 9036b4cac81SBjoern A. Zeeb continue; 9046b4cac81SBjoern A. Zeeb 9056b4cac81SBjoern A. Zeeb lkpi_80211_mo_wake_tx_queue(hw, sta->txq[tid]); 9066b4cac81SBjoern A. Zeeb } 9076b4cac81SBjoern A. Zeeb } 9086b4cac81SBjoern A. Zeeb 9096b4cac81SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 9106b4cac81SBjoern A. Zeeb 9116b4cac81SBjoern A. Zeeb static int 9126b4cac81SBjoern A. Zeeb lkpi_sta_state_do_nada(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 9136b4cac81SBjoern A. Zeeb { 9146b4cac81SBjoern A. Zeeb 9156b4cac81SBjoern A. Zeeb return (0); 9166b4cac81SBjoern A. Zeeb } 9176b4cac81SBjoern A. Zeeb 9186b4cac81SBjoern A. Zeeb /* lkpi_iv_newstate() handles the stop scan case generally. */ 9196b4cac81SBjoern A. Zeeb #define lkpi_sta_scan_to_init(_v, _n, _a) lkpi_sta_state_do_nada(_v, _n, _a) 9206b4cac81SBjoern A. Zeeb 9216b4cac81SBjoern A. Zeeb static int 9226b4cac81SBjoern A. Zeeb lkpi_sta_scan_to_auth(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 9236b4cac81SBjoern A. Zeeb { 9246b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 925c5e25798SBjoern A. Zeeb struct lkpi_chanctx *lchanctx; 9266b4cac81SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 9276b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 9286b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 9296b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 9306b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 9316b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 9326b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 9336b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 9346b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 9356b4cac81SBjoern A. Zeeb uint32_t changed; 9366b4cac81SBjoern A. Zeeb int error; 9376b4cac81SBjoern A. Zeeb 9386b4cac81SBjoern A. Zeeb chan = lkpi_get_lkpi80211_chan(vap->iv_ic, vap->iv_bss); 9396b4cac81SBjoern A. Zeeb if (chan == NULL) { 9406b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: failed to get channel\n", __func__); 9416b4cac81SBjoern A. Zeeb return (ESRCH); 9426b4cac81SBjoern A. Zeeb } 9436b4cac81SBjoern A. Zeeb 9446b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 9456b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 9466b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 9476b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 9486b4cac81SBjoern A. Zeeb 949d9f59799SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 950d9f59799SBjoern A. Zeeb 9516b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 9528ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 9536b4cac81SBjoern A. Zeeb 9546b4cac81SBjoern A. Zeeb /* Add chanctx (or if exists, change it). */ 9556b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 9566b4cac81SBjoern A. Zeeb conf = vif->chanctx_conf; 957c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(conf); 9586b4cac81SBjoern A. Zeeb IMPROVE("diff changes for changed, working on live copy, rcu"); 9596b4cac81SBjoern A. Zeeb } else { 9606b4cac81SBjoern A. Zeeb /* Keep separate alloc as in Linux this is rcu managed? */ 961c5e25798SBjoern A. Zeeb lchanctx = malloc(sizeof(*lchanctx) + hw->chanctx_data_size, 9626b4cac81SBjoern A. Zeeb M_LKPI80211, M_WAITOK | M_ZERO); 963c5e25798SBjoern A. Zeeb conf = &lchanctx->conf; 9646b4cac81SBjoern A. Zeeb } 9656b4cac81SBjoern A. Zeeb 9666b4cac81SBjoern A. Zeeb conf->rx_chains_dynamic = 1; 9676b4cac81SBjoern A. Zeeb conf->rx_chains_static = 1; 9686b4cac81SBjoern A. Zeeb conf->radar_enabled = 9696b4cac81SBjoern A. Zeeb (chan->flags & IEEE80211_CHAN_RADAR) ? true : false; 9706b4cac81SBjoern A. Zeeb conf->def.chan = chan; 9716b4cac81SBjoern A. Zeeb conf->def.width = NL80211_CHAN_WIDTH_20_NOHT; 9726b4cac81SBjoern A. Zeeb conf->def.center_freq1 = chan->center_freq; 9736b4cac81SBjoern A. Zeeb conf->def.center_freq2 = 0; 9746b4cac81SBjoern A. Zeeb /* Responder ... */ 9756b4cac81SBjoern A. Zeeb conf->min_def.chan = chan; 9766b4cac81SBjoern A. Zeeb conf->min_def.width = NL80211_CHAN_WIDTH_20_NOHT; 9776b4cac81SBjoern A. Zeeb conf->min_def.center_freq1 = chan->center_freq; 9786b4cac81SBjoern A. Zeeb conf->min_def.center_freq2 = 0; 9796b4cac81SBjoern A. Zeeb IMPROVE("currently 20_NOHT only"); 9806b4cac81SBjoern A. Zeeb 9816ffb7bd4SBjoern A. Zeeb /* Set bss info (bss_info_changed). */ 9826ffb7bd4SBjoern A. Zeeb bss_changed = 0; 9836ffb7bd4SBjoern A. Zeeb vif->bss_conf.bssid = ni->ni_bssid; 9846ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 9856ffb7bd4SBjoern A. Zeeb vif->bss_conf.txpower = ni->ni_txpower; 9866ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_TXPOWER; 9876ffb7bd4SBjoern A. Zeeb vif->cfg.idle = false; 9886ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_IDLE; 9896ffb7bd4SBjoern A. Zeeb 9906ffb7bd4SBjoern A. Zeeb /* vif->bss_conf.basic_rates ? Where exactly? */ 9916ffb7bd4SBjoern A. Zeeb 9926ffb7bd4SBjoern A. Zeeb /* Should almost assert it is this. */ 9936ffb7bd4SBjoern A. Zeeb vif->cfg.assoc = false; 9946ffb7bd4SBjoern A. Zeeb vif->cfg.aid = 0; 9956ffb7bd4SBjoern A. Zeeb 9966ffb7bd4SBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 9976ffb7bd4SBjoern A. Zeeb 9986b4cac81SBjoern A. Zeeb error = 0; 9996b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 10006b4cac81SBjoern A. Zeeb changed = IEEE80211_CHANCTX_CHANGE_MIN_WIDTH; 10016b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_RADAR; 10026b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_RX_CHAINS; 10036b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_WIDTH; 10046b4cac81SBjoern A. Zeeb lkpi_80211_mo_change_chanctx(hw, conf, changed); 10056b4cac81SBjoern A. Zeeb } else { 10066b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_add_chanctx(hw, conf); 10076b4cac81SBjoern A. Zeeb if (error == 0 || error == EOPNOTSUPP) { 10086b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.chan = conf->def.chan; 10096b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.width = conf->def.width; 10106b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.center_freq1 = 10116b4cac81SBjoern A. Zeeb conf->def.center_freq1; 10126b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.center_freq2 = 10136b4cac81SBjoern A. Zeeb conf->def.center_freq2; 10146b4cac81SBjoern A. Zeeb } else { 10156b4cac81SBjoern A. Zeeb goto out; 10166b4cac81SBjoern A. Zeeb } 10176ffb7bd4SBjoern A. Zeeb 10186ffb7bd4SBjoern A. Zeeb vif->bss_conf.chanctx_conf = conf; 10196ffb7bd4SBjoern A. Zeeb 10206b4cac81SBjoern A. Zeeb /* Assign vif chanctx. */ 10216b4cac81SBjoern A. Zeeb if (error == 0) 102268541546SBjoern A. Zeeb error = lkpi_80211_mo_assign_vif_chanctx(hw, vif, 102368541546SBjoern A. Zeeb &vif->bss_conf, conf); 10246b4cac81SBjoern A. Zeeb if (error == EOPNOTSUPP) 10256b4cac81SBjoern A. Zeeb error = 0; 10266b4cac81SBjoern A. Zeeb if (error != 0) { 10276b4cac81SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1028c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(conf); 1029c5e25798SBjoern A. Zeeb free(lchanctx, M_LKPI80211); 10306b4cac81SBjoern A. Zeeb goto out; 10316b4cac81SBjoern A. Zeeb } 10326b4cac81SBjoern A. Zeeb } 10336b4cac81SBjoern A. Zeeb IMPROVE("update radiotap chan fields too"); 10346b4cac81SBjoern A. Zeeb 10356b4cac81SBjoern A. Zeeb /* RATES */ 10366b4cac81SBjoern A. Zeeb IMPROVE("bss info: not all needs to come now and rates are missing"); 10376b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 10386b4cac81SBjoern A. Zeeb 1039d9f59799SBjoern A. Zeeb /* 1040d9f59799SBjoern A. Zeeb * This is a bandaid for now. If we went through (*iv_update_bss)() 1041d9f59799SBjoern A. Zeeb * and then removed the lsta we end up here without a lsta and have 1042d9f59799SBjoern A. Zeeb * to manually allocate and link it in as lkpi_ic_node_alloc()/init() 1043d9f59799SBjoern A. Zeeb * would normally do. 1044d9f59799SBjoern A. Zeeb * XXX-BZ I do not like this but currently we have no good way of 1045d9f59799SBjoern A. Zeeb * intercepting the bss swap and state changes and packets going out 1046d9f59799SBjoern A. Zeeb * workflow so live with this. It is a compat layer after all. 1047d9f59799SBjoern A. Zeeb */ 1048d9f59799SBjoern A. Zeeb if (ni->ni_drv_data == NULL) { 1049d9f59799SBjoern A. Zeeb lsta = lkpi_lsta_alloc(vap, ni->ni_macaddr, hw, ni); 1050d9f59799SBjoern A. Zeeb if (lsta == NULL) { 1051d9f59799SBjoern A. Zeeb error = ENOMEM; 1052d9f59799SBjoern A. Zeeb goto out; 1053d9f59799SBjoern A. Zeeb } 1054d9f59799SBjoern A. Zeeb lsta->ni = ieee80211_ref_node(ni); 1055d9f59799SBjoern A. Zeeb } else { 10566b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 1057d9f59799SBjoern A. Zeeb } 1058e24e8103SBjoern A. Zeeb 1059e24e8103SBjoern A. Zeeb /* Insert the [l]sta into the list of known stations. */ 1060e24e8103SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 1061e24e8103SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lvif->lsta_head, lsta, lsta_entry); 1062e24e8103SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 1063e24e8103SBjoern A. Zeeb 1064d9f59799SBjoern A. Zeeb /* Add (or adjust) sta and change state (from NOTEXIST) to NONE. */ 10656b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 10666b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NOTEXIST, ("%s: lsta %p state not " 10676b4cac81SBjoern A. Zeeb "NOTEXIST: %#x\n", __func__, lsta, lsta->state)); 1068e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 10696b4cac81SBjoern A. Zeeb if (error != 0) { 10706b4cac81SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 10716b4cac81SBjoern A. Zeeb goto out; 10726b4cac81SBjoern A. Zeeb } 10736b4cac81SBjoern A. Zeeb #if 0 10746b4cac81SBjoern A. Zeeb lsta->added_to_drv = true; /* mo manages. */ 10756b4cac81SBjoern A. Zeeb #endif 10766b4cac81SBjoern A. Zeeb 10779d9ba2b7SBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 10789d9ba2b7SBjoern A. Zeeb 10796b4cac81SBjoern A. Zeeb /* 10806b4cac81SBjoern A. Zeeb * Wakeup all queues now that sta is there so we have as much time to 10816b4cac81SBjoern A. Zeeb * possibly prepare the queue in the driver to be ready for the 1st 10826b4cac81SBjoern A. Zeeb * packet; lkpi_80211_txq_tx_one() still has a workaround as there 10836b4cac81SBjoern A. Zeeb * is no guarantee or way to check. 1084d9f59799SBjoern A. Zeeb * XXX-BZ and by now we know that this does not work on all drivers 1085d9f59799SBjoern A. Zeeb * for all queues. 10866b4cac81SBjoern A. Zeeb */ 1087e7fe0373SBjoern A. Zeeb lkpi_wake_tx_queues(hw, LSTA_TO_STA(lsta), false, false); 10886b4cac81SBjoern A. Zeeb 10896b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 10906b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 10916b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 10926b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 10936b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 10946b4cac81SBjoern A. Zeeb 10956b4cac81SBjoern A. Zeeb /* 10966b4cac81SBjoern A. Zeeb * What is going to happen next: 10976b4cac81SBjoern A. Zeeb * - <twiddle> .. we should end up in "auth_to_assoc" 10986b4cac81SBjoern A. Zeeb * - event_callback 10996b4cac81SBjoern A. Zeeb * - update sta_state (NONE to AUTH) 11006b4cac81SBjoern A. Zeeb * - mgd_complete_tx 11016b4cac81SBjoern A. Zeeb * (ideally we'd do that on a callback for something else ...) 11026b4cac81SBjoern A. Zeeb */ 11036b4cac81SBjoern A. Zeeb 11046b4cac81SBjoern A. Zeeb out: 11058ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 11066b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 11076b4cac81SBjoern A. Zeeb if (ni != NULL) 11086b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 11096b4cac81SBjoern A. Zeeb return (error); 11106b4cac81SBjoern A. Zeeb } 11116b4cac81SBjoern A. Zeeb 11126b4cac81SBjoern A. Zeeb static int 11136b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 11146b4cac81SBjoern A. Zeeb { 11156b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 11166b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 11176b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 11186b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 11196b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 11206b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 11216b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 11226b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 11236b4cac81SBjoern A. Zeeb int error; 11246b4cac81SBjoern A. Zeeb 11256b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 11266b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 11276b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 11286b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 11296b4cac81SBjoern A. Zeeb 11306b4cac81SBjoern A. Zeeb /* Keep ni around. */ 11316b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 11326b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 11336b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 11346b4cac81SBjoern A. Zeeb 113567674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 11366b4cac81SBjoern A. Zeeb 11376b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 11388ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 11396b4cac81SBjoern A. Zeeb 1140d9f59799SBjoern A. Zeeb /* flush, drop. */ 1141d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1142d9f59799SBjoern A. Zeeb 11436b4cac81SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 11446b4cac81SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 11456b4cac81SBjoern A. Zeeb 11466b4cac81SBjoern A. Zeeb /* flush, no drop */ 11476b4cac81SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 11486b4cac81SBjoern A. Zeeb 11496b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 11506b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 11516b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 11526b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 11536b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 11546b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 11556b4cac81SBjoern A. Zeeb } 11566b4cac81SBjoern A. Zeeb 11576b4cac81SBjoern A. Zeeb /* sync_rx_queues */ 11586b4cac81SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 11596b4cac81SBjoern A. Zeeb 11606b4cac81SBjoern A. Zeeb /* sta_pre_rcu_remove */ 11616b4cac81SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1162d9f59799SBjoern A. Zeeb 1163d9f59799SBjoern A. Zeeb /* Take the station down. */ 11646b4cac81SBjoern A. Zeeb 11656b4cac81SBjoern A. Zeeb /* Adjust sta and change state (from NONE) to NOTEXIST. */ 11666b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 11676b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1168d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1169e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 11706b4cac81SBjoern A. Zeeb if (error != 0) { 11716b4cac81SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 11726b4cac81SBjoern A. Zeeb goto out; 11736b4cac81SBjoern A. Zeeb } 11746b4cac81SBjoern A. Zeeb #if 0 11756b4cac81SBjoern A. Zeeb lsta->added_to_drv = false; /* mo manages. */ 11766b4cac81SBjoern A. Zeeb #endif 11776b4cac81SBjoern A. Zeeb 117867674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 11796b4cac81SBjoern A. Zeeb 1180d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1181d9f59799SBjoern A. Zeeb 1182d9f59799SBjoern A. Zeeb /* conf_tx */ 1183d9f59799SBjoern A. Zeeb 1184d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 11856b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 1186c5e25798SBjoern A. Zeeb struct lkpi_chanctx *lchanctx; 11876b4cac81SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 11886b4cac81SBjoern A. Zeeb 11896b4cac81SBjoern A. Zeeb conf = vif->chanctx_conf; 11906b4cac81SBjoern A. Zeeb /* Remove vif context. */ 119168541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 11926b4cac81SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 11936b4cac81SBjoern A. Zeeb 11946b4cac81SBjoern A. Zeeb /* Remove chan ctx. */ 11956b4cac81SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1196c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(conf); 1197c5e25798SBjoern A. Zeeb free(lchanctx, M_LKPI80211); 11986b4cac81SBjoern A. Zeeb } 11996b4cac81SBjoern A. Zeeb 12006b4cac81SBjoern A. Zeeb out: 12018ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 12026b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 12036b4cac81SBjoern A. Zeeb if (ni != NULL) 12046b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 12056b4cac81SBjoern A. Zeeb return (error); 12066b4cac81SBjoern A. Zeeb } 12076b4cac81SBjoern A. Zeeb 12086b4cac81SBjoern A. Zeeb static int 12096b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12106b4cac81SBjoern A. Zeeb { 12116b4cac81SBjoern A. Zeeb int error; 12126b4cac81SBjoern A. Zeeb 12136b4cac81SBjoern A. Zeeb error = lkpi_sta_auth_to_scan(vap, nstate, arg); 12146b4cac81SBjoern A. Zeeb if (error == 0) 12156b4cac81SBjoern A. Zeeb error = lkpi_sta_scan_to_init(vap, nstate, arg); 12166b4cac81SBjoern A. Zeeb return (error); 12176b4cac81SBjoern A. Zeeb } 12186b4cac81SBjoern A. Zeeb 12196b4cac81SBjoern A. Zeeb static int 12206b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_assoc(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12216b4cac81SBjoern A. Zeeb { 12226b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 12236b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 12246b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 12256b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 12266b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 12276b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 12286b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 12296b4cac81SBjoern A. Zeeb int error; 12306b4cac81SBjoern A. Zeeb 12316b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 12326b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 12336b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 12346b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 12356b4cac81SBjoern A. Zeeb 12366b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 12378ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 12386b4cac81SBjoern A. Zeeb ni = NULL; 12396b4cac81SBjoern A. Zeeb 12406b4cac81SBjoern A. Zeeb /* Finish auth. */ 12416b4cac81SBjoern A. Zeeb IMPROVE("event callback"); 12426b4cac81SBjoern A. Zeeb 12436b4cac81SBjoern A. Zeeb /* Update sta_state (NONE to AUTH). */ 12446b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 12456b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 12466b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 12476b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 12486b4cac81SBjoern A. Zeeb "NONE: %#x\n", __func__, lsta, lsta->state)); 1249e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 12506b4cac81SBjoern A. Zeeb if (error != 0) 12516b4cac81SBjoern A. Zeeb goto out; 12526b4cac81SBjoern A. Zeeb 12536b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 12546b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 12556b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 12566b4cac81SBjoern A. Zeeb prep_tx_info.success = true; 12576b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 12586b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 12596b4cac81SBjoern A. Zeeb } 12606b4cac81SBjoern A. Zeeb 12616b4cac81SBjoern A. Zeeb /* Now start assoc. */ 12626b4cac81SBjoern A. Zeeb 12636b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 12646b4cac81SBjoern A. Zeeb if (!lsta->in_mgd) { 12656b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 12666b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 12676b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 12686b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 12696b4cac81SBjoern A. Zeeb } 12706b4cac81SBjoern A. Zeeb 12716b4cac81SBjoern A. Zeeb /* Wake tx queue to get packet out. */ 1272e7fe0373SBjoern A. Zeeb lkpi_wake_tx_queues(hw, LSTA_TO_STA(lsta), true, true); 12736b4cac81SBjoern A. Zeeb 12746b4cac81SBjoern A. Zeeb /* 12756b4cac81SBjoern A. Zeeb * <twiddle> .. we end up in "assoc_to_run" 12766b4cac81SBjoern A. Zeeb * - update sta_state (AUTH to ASSOC) 12776b4cac81SBjoern A. Zeeb * - conf_tx [all] 12786b4cac81SBjoern A. Zeeb * - bss_info_changed (assoc, aid, ssid, ..) 12796b4cac81SBjoern A. Zeeb * - change_chanctx (if needed) 12806b4cac81SBjoern A. Zeeb * - event_callback 12816b4cac81SBjoern A. Zeeb * - mgd_complete_tx 12826b4cac81SBjoern A. Zeeb */ 12836b4cac81SBjoern A. Zeeb 12846b4cac81SBjoern A. Zeeb out: 12858ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 12866b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 12876b4cac81SBjoern A. Zeeb if (ni != NULL) 12886b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 12896b4cac81SBjoern A. Zeeb return (error); 12906b4cac81SBjoern A. Zeeb } 12916b4cac81SBjoern A. Zeeb 12926b4cac81SBjoern A. Zeeb /* auth_to_auth, assoc_to_assoc. */ 12936b4cac81SBjoern A. Zeeb static int 12946b4cac81SBjoern A. Zeeb lkpi_sta_a_to_a(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12956b4cac81SBjoern A. Zeeb { 12966b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 12976b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 12986b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 12996b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 13006b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 13016b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 13026b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 13036b4cac81SBjoern A. Zeeb 13046b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 13056b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 13066b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 13076b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 13086b4cac81SBjoern A. Zeeb 13096b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 13106b4cac81SBjoern A. Zeeb 13116b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13128ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 13136b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 13146b4cac81SBjoern A. Zeeb 13156b4cac81SBjoern A. Zeeb IMPROVE("event callback?"); 13166b4cac81SBjoern A. Zeeb 13176b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 13186b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 13196b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 13206b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 13216b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 13226b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 13236b4cac81SBjoern A. Zeeb } 13246b4cac81SBjoern A. Zeeb 13256b4cac81SBjoern A. Zeeb /* Now start assoc. */ 13266b4cac81SBjoern A. Zeeb 13276b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 13286b4cac81SBjoern A. Zeeb if (!lsta->in_mgd) { 13296b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 13306b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 13316b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 13326b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 13336b4cac81SBjoern A. Zeeb } 13346b4cac81SBjoern A. Zeeb 13358ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 13366b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 13376b4cac81SBjoern A. Zeeb if (ni != NULL) 13386b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 13396b4cac81SBjoern A. Zeeb 13406b4cac81SBjoern A. Zeeb return (0); 13416b4cac81SBjoern A. Zeeb } 13426b4cac81SBjoern A. Zeeb 13436b4cac81SBjoern A. Zeeb static int 1344d9f59799SBjoern A. Zeeb _lkpi_sta_assoc_to_down(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 13456b4cac81SBjoern A. Zeeb { 13466b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 13476b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 13486b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 13496b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 13506b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 13516b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 13526b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 13536b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1354d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 13556b4cac81SBjoern A. Zeeb int error; 13566b4cac81SBjoern A. Zeeb 13576b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 13586b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 13596b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 13606b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 13616b4cac81SBjoern A. Zeeb 13626b4cac81SBjoern A. Zeeb /* Keep ni around. */ 13636b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 13646b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 13656b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 13666b4cac81SBjoern A. Zeeb 136767674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1368d9f59799SBjoern A. Zeeb 1369d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13708ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1371d9f59799SBjoern A. Zeeb 1372d9f59799SBjoern A. Zeeb /* flush, drop. */ 1373d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1374d9f59799SBjoern A. Zeeb 1375d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1376d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1377d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1378d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1379d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1380d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1381d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1382d9f59799SBjoern A. Zeeb } 1383d9f59799SBjoern A. Zeeb 13848ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1385d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1386d9f59799SBjoern A. Zeeb 1387d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1388d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1389d9f59799SBjoern A. Zeeb if (error != 0) 1390d9f59799SBjoern A. Zeeb goto outni; 1391d9f59799SBjoern A. Zeeb 1392d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13938ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1394d9f59799SBjoern A. Zeeb 139567674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1396d9f59799SBjoern A. Zeeb 1397d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1398d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1399d9f59799SBjoern A. Zeeb 1400d9f59799SBjoern A. Zeeb /* flush, no drop */ 1401d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1402d9f59799SBjoern A. Zeeb 14036b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 14046b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 14056b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 14066b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 14076b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 14086b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 14096b4cac81SBjoern A. Zeeb } 14106b4cac81SBjoern A. Zeeb 1411d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1412d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1413d9f59799SBjoern A. Zeeb 1414d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1415d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1416d9f59799SBjoern A. Zeeb 1417d9f59799SBjoern A. Zeeb /* Take the station down. */ 1418d9f59799SBjoern A. Zeeb 14196b4cac81SBjoern A. Zeeb /* Update sta and change state (from AUTH) to NONE. */ 14206b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 14216b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 14226b4cac81SBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 1423e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 14246b4cac81SBjoern A. Zeeb if (error != 0) 14256b4cac81SBjoern A. Zeeb goto out; 14266b4cac81SBjoern A. Zeeb 142767674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 14286b4cac81SBjoern A. Zeeb 142916e688b2SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 143016e688b2SBjoern A. Zeeb /* 143116e688b2SBjoern A. Zeeb * We need to do this now, before sta changes to IEEE80211_STA_NOTEXIST 143216e688b2SBjoern A. Zeeb * as otherwise drivers (iwlwifi at least) will silently not remove 143316e688b2SBjoern A. Zeeb * the sta from the firmware and when we will add a new one trigger 143416e688b2SBjoern A. Zeeb * a fw assert. 143516e688b2SBjoern A. Zeeb */ 143616e688b2SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 143716e688b2SBjoern A. Zeeb 1438d9f59799SBjoern A. Zeeb /* Adjust sta and change state (from NONE) to NOTEXIST. */ 1439d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1440d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1441d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1442e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 1443d9f59799SBjoern A. Zeeb if (error != 0) { 1444d9f59799SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 1445d9f59799SBjoern A. Zeeb goto out; 1446d9f59799SBjoern A. Zeeb } 1447d9f59799SBjoern A. Zeeb 144816e688b2SBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); /* sta no longer save to use. */ 1449d9f59799SBjoern A. Zeeb 1450d9f59799SBjoern A. Zeeb IMPROVE("Any bss_info changes to announce?"); 1451d9f59799SBjoern A. Zeeb bss_changed = 0; 1452d9f59799SBjoern A. Zeeb vif->bss_conf.qos = 0; 1453d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 1454616e1330SBjoern A. Zeeb vif->cfg.ssid_len = 0; 1455616e1330SBjoern A. Zeeb memset(vif->cfg.ssid, '\0', sizeof(vif->cfg.ssid)); 1456d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 1457d9f59799SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1458d9f59799SBjoern A. Zeeb 1459d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1460d9f59799SBjoern A. Zeeb 1461d9f59799SBjoern A. Zeeb /* conf_tx */ 1462d9f59799SBjoern A. Zeeb 1463d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 1464d9f59799SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 1465c5e25798SBjoern A. Zeeb struct lkpi_chanctx *lchanctx; 1466d9f59799SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 1467d9f59799SBjoern A. Zeeb 1468d9f59799SBjoern A. Zeeb conf = vif->chanctx_conf; 1469d9f59799SBjoern A. Zeeb /* Remove vif context. */ 147068541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 1471d9f59799SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 1472d9f59799SBjoern A. Zeeb 1473d9f59799SBjoern A. Zeeb /* Remove chan ctx. */ 1474d9f59799SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1475c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(conf); 1476c5e25798SBjoern A. Zeeb free(lchanctx, M_LKPI80211); 1477d9f59799SBjoern A. Zeeb } 1478d9f59799SBjoern A. Zeeb 1479d9f59799SBjoern A. Zeeb error = EALREADY; 14806b4cac81SBjoern A. Zeeb out: 14818ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 14826b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1483d9f59799SBjoern A. Zeeb outni: 14846b4cac81SBjoern A. Zeeb if (ni != NULL) 14856b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 14866b4cac81SBjoern A. Zeeb return (error); 14876b4cac81SBjoern A. Zeeb } 14886b4cac81SBjoern A. Zeeb 14896b4cac81SBjoern A. Zeeb static int 1490d9f59799SBjoern A. Zeeb lkpi_sta_assoc_to_auth(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1491d9f59799SBjoern A. Zeeb { 1492d9f59799SBjoern A. Zeeb int error; 1493d9f59799SBjoern A. Zeeb 1494d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 1495d9f59799SBjoern A. Zeeb if (error != 0 && error != EALREADY) 1496d9f59799SBjoern A. Zeeb return (error); 1497d9f59799SBjoern A. Zeeb 1498d9f59799SBjoern A. Zeeb /* At this point iv_bss is long a new node! */ 1499d9f59799SBjoern A. Zeeb 1500d9f59799SBjoern A. Zeeb error |= lkpi_sta_scan_to_auth(vap, nstate, 0); 1501d9f59799SBjoern A. Zeeb return (error); 1502d9f59799SBjoern A. Zeeb } 1503d9f59799SBjoern A. Zeeb 1504d9f59799SBjoern A. Zeeb static int 15056b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 15066b4cac81SBjoern A. Zeeb { 15076b4cac81SBjoern A. Zeeb int error; 15086b4cac81SBjoern A. Zeeb 1509d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 15106b4cac81SBjoern A. Zeeb return (error); 15116b4cac81SBjoern A. Zeeb } 15126b4cac81SBjoern A. Zeeb 15136b4cac81SBjoern A. Zeeb static int 15146b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 15156b4cac81SBjoern A. Zeeb { 15166b4cac81SBjoern A. Zeeb int error; 15176b4cac81SBjoern A. Zeeb 1518d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 15196b4cac81SBjoern A. Zeeb return (error); 15206b4cac81SBjoern A. Zeeb } 15216b4cac81SBjoern A. Zeeb 15226b4cac81SBjoern A. Zeeb static int 15236b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_run(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 15246b4cac81SBjoern A. Zeeb { 15256b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 15266b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 15276b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 15286b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 15296b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 15306b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 15316b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 15326b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 15336b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 15346b4cac81SBjoern A. Zeeb int error; 15356b4cac81SBjoern A. Zeeb 15366b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 15376b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 15386b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 15396b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 15406b4cac81SBjoern A. Zeeb 15416b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 15428ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 15439597f7cbSBjoern A. Zeeb ni = NULL; 15446b4cac81SBjoern A. Zeeb 15456b4cac81SBjoern A. Zeeb IMPROVE("ponder some of this moved to ic_newassoc, scan_assoc_success, " 15466b4cac81SBjoern A. Zeeb "and to lesser extend ieee80211_notify_node_join"); 15476b4cac81SBjoern A. Zeeb 15489597f7cbSBjoern A. Zeeb /* Finish assoc. */ 15499597f7cbSBjoern A. Zeeb /* Update sta_state (AUTH to ASSOC) and set aid. */ 15506b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 15516b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 15526b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 15539597f7cbSBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 15549597f7cbSBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 15556b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 15569597f7cbSBjoern A. Zeeb sta->aid = IEEE80211_NODE_AID(ni); 15574a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 15584a67f1dfSBjoern A. Zeeb if (vap->iv_flags & IEEE80211_F_WME) 15594a67f1dfSBjoern A. Zeeb sta->wme = true; 15604a67f1dfSBjoern A. Zeeb #endif 1561e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 15629597f7cbSBjoern A. Zeeb if (error != 0) 15639597f7cbSBjoern A. Zeeb goto out; 15646b4cac81SBjoern A. Zeeb 15656b4cac81SBjoern A. Zeeb IMPROVE("wme / conf_tx [all]"); 15666b4cac81SBjoern A. Zeeb 15676b4cac81SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 15686b4cac81SBjoern A. Zeeb bss_changed = 0; 15694a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 15704a67f1dfSBjoern A. Zeeb bss_changed |= lkpi_wme_update(lhw, vap, true); 15714a67f1dfSBjoern A. Zeeb #endif 1572616e1330SBjoern A. Zeeb if (!vif->cfg.assoc || vif->cfg.aid != IEEE80211_NODE_AID(ni)) { 1573616e1330SBjoern A. Zeeb vif->cfg.assoc = true; 1574616e1330SBjoern A. Zeeb vif->cfg.aid = IEEE80211_NODE_AID(ni); 15756b4cac81SBjoern A. Zeeb bss_changed |= BSS_CHANGED_ASSOC; 15766b4cac81SBjoern A. Zeeb } 15776b4cac81SBjoern A. Zeeb /* We set SSID but this is not BSSID! */ 1578616e1330SBjoern A. Zeeb vif->cfg.ssid_len = ni->ni_esslen; 1579616e1330SBjoern A. Zeeb memcpy(vif->cfg.ssid, ni->ni_essid, ni->ni_esslen); 15806b4cac81SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_SHPREAMBLE) != 15816b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble) { 15826b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble ^= 1; 15836b4cac81SBjoern A. Zeeb /* bss_changed |= BSS_CHANGED_??? */ 15846b4cac81SBjoern A. Zeeb } 15856b4cac81SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_SHSLOT) != 15866b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot) { 15876b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot ^= 1; 15886b4cac81SBjoern A. Zeeb /* bss_changed |= BSS_CHANGED_??? */ 15896b4cac81SBjoern A. Zeeb } 15906b4cac81SBjoern A. Zeeb if ((ni->ni_flags & IEEE80211_NODE_QOS) != 15916b4cac81SBjoern A. Zeeb vif->bss_conf.qos) { 15926b4cac81SBjoern A. Zeeb vif->bss_conf.qos ^= 1; 15936b4cac81SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 15946b4cac81SBjoern A. Zeeb } 1595fa8f007dSBjoern A. Zeeb 1596fa8f007dSBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 1597fa8f007dSBjoern A. Zeeb 15986b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 15996b4cac81SBjoern A. Zeeb 16006b4cac81SBjoern A. Zeeb /* - change_chanctx (if needed) 16016b4cac81SBjoern A. Zeeb * - event_callback 16026b4cac81SBjoern A. Zeeb */ 16036b4cac81SBjoern A. Zeeb 16046b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 16056b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 16066b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 16076b4cac81SBjoern A. Zeeb prep_tx_info.success = true; 16086b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 16096b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 16106b4cac81SBjoern A. Zeeb } 16116b4cac81SBjoern A. Zeeb 1612086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, false); 1613086be6a8SBjoern A. Zeeb 16146b4cac81SBjoern A. Zeeb /* 16156b4cac81SBjoern A. Zeeb * And then: 16166b4cac81SBjoern A. Zeeb * - (more packets)? 16176b4cac81SBjoern A. Zeeb * - set_key 16186b4cac81SBjoern A. Zeeb * - set_default_unicast_key 16196b4cac81SBjoern A. Zeeb * - set_key (?) 16206b4cac81SBjoern A. Zeeb * - ipv6_addr_change (?) 16216b4cac81SBjoern A. Zeeb */ 16226b4cac81SBjoern A. Zeeb /* Prepare_multicast && configure_filter. */ 16236b4cac81SBjoern A. Zeeb lhw->update_mc = true; 16246b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(vap->iv_ic, true); 16256b4cac81SBjoern A. Zeeb 16266b4cac81SBjoern A. Zeeb if (!ieee80211_node_is_authorized(ni)) { 16276b4cac81SBjoern A. Zeeb IMPROVE("net80211 does not consider node authorized"); 16286b4cac81SBjoern A. Zeeb } 16296b4cac81SBjoern A. Zeeb 16306b4cac81SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTHORIZED). */ 16316b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 16326b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 16336b4cac81SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1634e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTHORIZED); 16356b4cac81SBjoern A. Zeeb if (error != 0) { 16366b4cac81SBjoern A. Zeeb IMPROVE("undo some changes?"); 16376b4cac81SBjoern A. Zeeb goto out; 16386b4cac81SBjoern A. Zeeb } 16396b4cac81SBjoern A. Zeeb 16406b4cac81SBjoern A. Zeeb /* - drv_config (?) 16416b4cac81SBjoern A. Zeeb * - bss_info_changed 16426b4cac81SBjoern A. Zeeb * - set_rekey_data (?) 16436b4cac81SBjoern A. Zeeb * 16446b4cac81SBjoern A. Zeeb * And now we should be passing packets. 16456b4cac81SBjoern A. Zeeb */ 16466b4cac81SBjoern A. Zeeb IMPROVE("Need that bssid setting, and the keys"); 16476b4cac81SBjoern A. Zeeb 1648fa8f007dSBjoern A. Zeeb bss_changed = 0; 1649fa8f007dSBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 1650fa8f007dSBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1651fa8f007dSBjoern A. Zeeb 16526b4cac81SBjoern A. Zeeb out: 16538ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 16546b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 16556b4cac81SBjoern A. Zeeb if (ni != NULL) 16566b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 16576b4cac81SBjoern A. Zeeb return (error); 16586b4cac81SBjoern A. Zeeb } 16596b4cac81SBjoern A. Zeeb 16606b4cac81SBjoern A. Zeeb static int 16616b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_run(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 16626b4cac81SBjoern A. Zeeb { 16636b4cac81SBjoern A. Zeeb int error; 16646b4cac81SBjoern A. Zeeb 16656b4cac81SBjoern A. Zeeb error = lkpi_sta_auth_to_assoc(vap, nstate, arg); 16666b4cac81SBjoern A. Zeeb if (error == 0) 16676b4cac81SBjoern A. Zeeb error = lkpi_sta_assoc_to_run(vap, nstate, arg); 16686b4cac81SBjoern A. Zeeb return (error); 16696b4cac81SBjoern A. Zeeb } 16706b4cac81SBjoern A. Zeeb 16716b4cac81SBjoern A. Zeeb static int 16726b4cac81SBjoern A. Zeeb lkpi_sta_run_to_assoc(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 16736b4cac81SBjoern A. Zeeb { 16746b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 16756b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 16766b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 16776b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 16786b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 16796b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 16806b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 1681d9f59799SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1682d9f59799SBjoern A. Zeeb #if 0 1683d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 1684d9f59799SBjoern A. Zeeb #endif 16856b4cac81SBjoern A. Zeeb int error; 16866b4cac81SBjoern A. Zeeb 16876b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 16886b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 16896b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 16906b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 16916b4cac81SBjoern A. Zeeb 16926b4cac81SBjoern A. Zeeb /* Keep ni around. */ 16936b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 16946b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 16956b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 16966b4cac81SBjoern A. Zeeb 169767674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1698d9f59799SBjoern A. Zeeb 1699d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 17008ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1701d9f59799SBjoern A. Zeeb 1702d9f59799SBjoern A. Zeeb /* flush, drop. */ 1703d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1704d9f59799SBjoern A. Zeeb 1705d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1706d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1707d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1708d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1709d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1710d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1711d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1712d9f59799SBjoern A. Zeeb } 1713d9f59799SBjoern A. Zeeb 17148ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1715d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1716d9f59799SBjoern A. Zeeb 1717d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1718d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1719d9f59799SBjoern A. Zeeb if (error != 0) 1720d9f59799SBjoern A. Zeeb goto outni; 1721d9f59799SBjoern A. Zeeb 1722d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 17238ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1724d9f59799SBjoern A. Zeeb 172567674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1726d9f59799SBjoern A. Zeeb 1727d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1728d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1729d9f59799SBjoern A. Zeeb 1730d9f59799SBjoern A. Zeeb /* flush, no drop */ 1731d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1732d9f59799SBjoern A. Zeeb 1733d9f59799SBjoern A. Zeeb /* End mgd_complete_tx. */ 1734d9f59799SBjoern A. Zeeb if (lsta->in_mgd) { 1735d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1736d9f59799SBjoern A. Zeeb prep_tx_info.success = false; 1737d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 1738d9f59799SBjoern A. Zeeb lsta->in_mgd = false; 1739d9f59799SBjoern A. Zeeb } 1740d9f59799SBjoern A. Zeeb 1741d9f59799SBjoern A. Zeeb #if 0 1742d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1743d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1744d9f59799SBjoern A. Zeeb 1745d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1746d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1747d9f59799SBjoern A. Zeeb #endif 1748d9f59799SBjoern A. Zeeb 1749d9f59799SBjoern A. Zeeb /* Take the station down. */ 1750d9f59799SBjoern A. Zeeb 17516b4cac81SBjoern A. Zeeb /* Adjust sta and change state (from AUTHORIZED) to ASSOC. */ 17526b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 17536b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTHORIZED, ("%s: lsta %p state not " 17546b4cac81SBjoern A. Zeeb "AUTHORIZED: %#x\n", __func__, lsta, lsta->state)); 1755e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 17566b4cac81SBjoern A. Zeeb if (error != 0) 17576b4cac81SBjoern A. Zeeb goto out; 17586b4cac81SBjoern A. Zeeb 175967674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 17606b4cac81SBjoern A. Zeeb 17616b4cac81SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTH). */ 17626b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 17636b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 17646b4cac81SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1765e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 17666b4cac81SBjoern A. Zeeb if (error != 0) 17676b4cac81SBjoern A. Zeeb goto out; 17686b4cac81SBjoern A. Zeeb 176967674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 17706b4cac81SBjoern A. Zeeb 1771d9f59799SBjoern A. Zeeb #if 0 1772d9f59799SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 1773d9f59799SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 1774d9f59799SBjoern A. Zeeb #endif 1775d9f59799SBjoern A. Zeeb 1776d9f59799SBjoern A. Zeeb error = EALREADY; 17776b4cac81SBjoern A. Zeeb out: 17788ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 17796b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1780d9f59799SBjoern A. Zeeb outni: 17816b4cac81SBjoern A. Zeeb if (ni != NULL) 17826b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 17836b4cac81SBjoern A. Zeeb return (error); 17846b4cac81SBjoern A. Zeeb } 17856b4cac81SBjoern A. Zeeb 17866b4cac81SBjoern A. Zeeb static int 1787d9f59799SBjoern A. Zeeb lkpi_sta_run_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1788d9f59799SBjoern A. Zeeb { 1789d9f59799SBjoern A. Zeeb struct lkpi_hw *lhw; 1790d9f59799SBjoern A. Zeeb struct ieee80211_hw *hw; 1791d9f59799SBjoern A. Zeeb struct lkpi_vif *lvif; 1792d9f59799SBjoern A. Zeeb struct ieee80211_vif *vif; 1793d9f59799SBjoern A. Zeeb struct ieee80211_node *ni; 1794d9f59799SBjoern A. Zeeb struct lkpi_sta *lsta; 1795d9f59799SBjoern A. Zeeb struct ieee80211_sta *sta; 1796d9f59799SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1797d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 1798d9f59799SBjoern A. Zeeb int error; 1799d9f59799SBjoern A. Zeeb 1800d9f59799SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 1801d9f59799SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 1802d9f59799SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 1803d9f59799SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 1804d9f59799SBjoern A. Zeeb 1805d9f59799SBjoern A. Zeeb /* Keep ni around. */ 1806d9f59799SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 1807d9f59799SBjoern A. Zeeb lsta = ni->ni_drv_data; 1808d9f59799SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 1809d9f59799SBjoern A. Zeeb 181067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1811d9f59799SBjoern A. Zeeb 1812d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 18138ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1814d9f59799SBjoern A. Zeeb 1815d9f59799SBjoern A. Zeeb /* flush, drop. */ 1816d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1817d9f59799SBjoern A. Zeeb 1818d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1819d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1820d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1821d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1822d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1823d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1824d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1825d9f59799SBjoern A. Zeeb } 1826d9f59799SBjoern A. Zeeb 18278ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1828d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1829d9f59799SBjoern A. Zeeb 1830d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1831d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1832d9f59799SBjoern A. Zeeb if (error != 0) 1833d9f59799SBjoern A. Zeeb goto outni; 1834d9f59799SBjoern A. Zeeb 1835d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 18368ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1837d9f59799SBjoern A. Zeeb 183867674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1839d9f59799SBjoern A. Zeeb 1840d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1841d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1842d9f59799SBjoern A. Zeeb 1843d9f59799SBjoern A. Zeeb /* flush, no drop */ 1844d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1845d9f59799SBjoern A. Zeeb 1846d9f59799SBjoern A. Zeeb /* End mgd_complete_tx. */ 1847d9f59799SBjoern A. Zeeb if (lsta->in_mgd) { 1848d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1849d9f59799SBjoern A. Zeeb prep_tx_info.success = false; 1850d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 1851d9f59799SBjoern A. Zeeb lsta->in_mgd = false; 1852d9f59799SBjoern A. Zeeb } 1853d9f59799SBjoern A. Zeeb 1854d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1855d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1856d9f59799SBjoern A. Zeeb 1857d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1858d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1859d9f59799SBjoern A. Zeeb 1860d9f59799SBjoern A. Zeeb /* Take the station down. */ 1861d9f59799SBjoern A. Zeeb 1862d9f59799SBjoern A. Zeeb /* Adjust sta and change state (from AUTHORIZED) to ASSOC. */ 1863d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1864d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTHORIZED, ("%s: lsta %p state not " 1865d9f59799SBjoern A. Zeeb "AUTHORIZED: %#x\n", __func__, lsta, lsta->state)); 1866e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 1867d9f59799SBjoern A. Zeeb if (error != 0) 1868d9f59799SBjoern A. Zeeb goto out; 1869d9f59799SBjoern A. Zeeb 187067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1871d9f59799SBjoern A. Zeeb 1872d9f59799SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTH). */ 1873d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1874d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 1875d9f59799SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1876e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 1877d9f59799SBjoern A. Zeeb if (error != 0) 1878d9f59799SBjoern A. Zeeb goto out; 1879d9f59799SBjoern A. Zeeb 188067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1881d9f59799SBjoern A. Zeeb 1882d9f59799SBjoern A. Zeeb /* Update sta and change state (from AUTH) to NONE. */ 1883d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1884d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 1885d9f59799SBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 1886e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 1887d9f59799SBjoern A. Zeeb if (error != 0) 1888d9f59799SBjoern A. Zeeb goto out; 1889d9f59799SBjoern A. Zeeb 189067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1891d9f59799SBjoern A. Zeeb 189216e688b2SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 189316e688b2SBjoern A. Zeeb /* 189416e688b2SBjoern A. Zeeb * One would expect this to happen when going off AUTHORIZED. 189516e688b2SBjoern A. Zeeb * See comment there; removes the sta from fw. 189616e688b2SBjoern A. Zeeb */ 189716e688b2SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 189816e688b2SBjoern A. Zeeb 1899d9f59799SBjoern A. Zeeb /* Adjust sta and change state (from NONE) to NOTEXIST. */ 1900d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1901d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1902d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1903e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 1904d9f59799SBjoern A. Zeeb if (error != 0) { 1905d9f59799SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 1906d9f59799SBjoern A. Zeeb goto out; 1907d9f59799SBjoern A. Zeeb } 1908d9f59799SBjoern A. Zeeb 190916e688b2SBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); /* sta no longer save to use. */ 1910d9f59799SBjoern A. Zeeb 1911d9f59799SBjoern A. Zeeb IMPROVE("Any bss_info changes to announce?"); 1912d9f59799SBjoern A. Zeeb bss_changed = 0; 1913d9f59799SBjoern A. Zeeb vif->bss_conf.qos = 0; 1914d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 1915616e1330SBjoern A. Zeeb vif->cfg.ssid_len = 0; 1916616e1330SBjoern A. Zeeb memset(vif->cfg.ssid, '\0', sizeof(vif->cfg.ssid)); 1917d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 1918d9f59799SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1919d9f59799SBjoern A. Zeeb 1920d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1921d9f59799SBjoern A. Zeeb 1922d9f59799SBjoern A. Zeeb /* conf_tx */ 1923d9f59799SBjoern A. Zeeb 1924d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 1925d9f59799SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 1926c5e25798SBjoern A. Zeeb struct lkpi_chanctx *lchanctx; 1927d9f59799SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 1928d9f59799SBjoern A. Zeeb 1929d9f59799SBjoern A. Zeeb conf = vif->chanctx_conf; 1930d9f59799SBjoern A. Zeeb /* Remove vif context. */ 193168541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 1932d9f59799SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 1933d9f59799SBjoern A. Zeeb 1934d9f59799SBjoern A. Zeeb /* Remove chan ctx. */ 1935d9f59799SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1936c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(conf); 1937c5e25798SBjoern A. Zeeb free(lchanctx, M_LKPI80211); 1938d9f59799SBjoern A. Zeeb } 1939d9f59799SBjoern A. Zeeb 1940d9f59799SBjoern A. Zeeb error = EALREADY; 1941d9f59799SBjoern A. Zeeb out: 19428ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1943d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1944d9f59799SBjoern A. Zeeb outni: 1945d9f59799SBjoern A. Zeeb if (ni != NULL) 1946d9f59799SBjoern A. Zeeb ieee80211_free_node(ni); 1947d9f59799SBjoern A. Zeeb return (error); 1948d9f59799SBjoern A. Zeeb } 1949d9f59799SBjoern A. Zeeb 1950d9f59799SBjoern A. Zeeb static int 1951d9f59799SBjoern A. Zeeb lkpi_sta_run_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1952d9f59799SBjoern A. Zeeb { 1953d9f59799SBjoern A. Zeeb 1954d9f59799SBjoern A. Zeeb return (lkpi_sta_run_to_init(vap, nstate, arg)); 1955d9f59799SBjoern A. Zeeb } 1956d9f59799SBjoern A. Zeeb 1957d9f59799SBjoern A. Zeeb static int 19586b4cac81SBjoern A. Zeeb lkpi_sta_run_to_auth(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 19596b4cac81SBjoern A. Zeeb { 19606b4cac81SBjoern A. Zeeb int error; 19616b4cac81SBjoern A. Zeeb 1962d9f59799SBjoern A. Zeeb error = lkpi_sta_run_to_init(vap, nstate, arg); 1963d9f59799SBjoern A. Zeeb if (error != 0 && error != EALREADY) 1964d9f59799SBjoern A. Zeeb return (error); 1965d9f59799SBjoern A. Zeeb 1966d9f59799SBjoern A. Zeeb /* At this point iv_bss is long a new node! */ 1967d9f59799SBjoern A. Zeeb 1968d9f59799SBjoern A. Zeeb error |= lkpi_sta_scan_to_auth(vap, nstate, 0); 19696b4cac81SBjoern A. Zeeb return (error); 19706b4cac81SBjoern A. Zeeb } 19716b4cac81SBjoern A. Zeeb 1972d9f59799SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 19736b4cac81SBjoern A. Zeeb 19746b4cac81SBjoern A. Zeeb /* 19756b4cac81SBjoern A. Zeeb * The matches the documented state changes in net80211::sta_newstate(). 19766b4cac81SBjoern A. Zeeb * XXX (1) without CSA and SLEEP yet, * XXX (2) not all unhandled cases 19776b4cac81SBjoern A. Zeeb * there are "invalid" (so there is a room for failure here). 19786b4cac81SBjoern A. Zeeb */ 19796b4cac81SBjoern A. Zeeb struct fsm_state { 19806b4cac81SBjoern A. Zeeb /* INIT, SCAN, AUTH, ASSOC, CAC, RUN, CSA, SLEEP */ 19816b4cac81SBjoern A. Zeeb enum ieee80211_state ostate; 19826b4cac81SBjoern A. Zeeb enum ieee80211_state nstate; 19836b4cac81SBjoern A. Zeeb int (*handler)(struct ieee80211vap *, enum ieee80211_state, int); 19846b4cac81SBjoern A. Zeeb } sta_state_fsm[] = { 19856b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_INIT, lkpi_sta_state_do_nada }, 19866b4cac81SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_INIT, lkpi_sta_state_do_nada }, /* scan_to_init */ 19876b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_INIT, lkpi_sta_auth_to_init }, /* not explicitly in sta_newstate() */ 1988d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_INIT, lkpi_sta_assoc_to_init }, /* Send DEAUTH. */ 1989d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_INIT, lkpi_sta_run_to_init }, /* Send DISASSOC. */ 19906b4cac81SBjoern A. Zeeb 19916b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_SCAN, lkpi_sta_state_do_nada }, 19926b4cac81SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_SCAN, lkpi_sta_state_do_nada }, 19936b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_SCAN, lkpi_sta_auth_to_scan }, 19946b4cac81SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_SCAN, lkpi_sta_assoc_to_scan }, 1995d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_SCAN, lkpi_sta_run_to_scan }, /* Beacon miss. */ 19966b4cac81SBjoern A. Zeeb 1997d9f59799SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_AUTH, lkpi_sta_scan_to_auth }, /* Send AUTH. */ 1998d9f59799SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_AUTH, lkpi_sta_scan_to_auth }, /* Send AUTH. */ 1999d9f59799SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_AUTH, lkpi_sta_a_to_a }, /* Send ?AUTH. */ 2000d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_AUTH, lkpi_sta_assoc_to_auth }, /* Send ?AUTH. */ 2001d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_AUTH, lkpi_sta_run_to_auth }, /* Send ?AUTH. */ 20026b4cac81SBjoern A. Zeeb 2003d9f59799SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_ASSOC, lkpi_sta_auth_to_assoc }, /* Send ASSOCREQ. */ 2004d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_ASSOC, lkpi_sta_a_to_a }, /* Send ASSOCREQ. */ 2005d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_ASSOC, lkpi_sta_run_to_assoc }, /* Send ASSOCREQ/REASSOCREQ. */ 20066b4cac81SBjoern A. Zeeb 20076b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_RUN, lkpi_sta_auth_to_run }, 20086b4cac81SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_RUN, lkpi_sta_assoc_to_run }, 20096b4cac81SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_RUN, lkpi_sta_state_do_nada }, 20106b4cac81SBjoern A. Zeeb 20116b4cac81SBjoern A. Zeeb /* Dummy at the end without handler. */ 20126b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_INIT, NULL }, 20136b4cac81SBjoern A. Zeeb }; 20146b4cac81SBjoern A. Zeeb 20156b4cac81SBjoern A. Zeeb static int 20166b4cac81SBjoern A. Zeeb lkpi_iv_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 20176b4cac81SBjoern A. Zeeb { 20186b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 20196b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 20206b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 20216b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 20226b4cac81SBjoern A. Zeeb struct fsm_state *s; 20236b4cac81SBjoern A. Zeeb enum ieee80211_state ostate; 20246b4cac81SBjoern A. Zeeb int error; 20256b4cac81SBjoern A. Zeeb 20266b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 20276b4cac81SBjoern A. Zeeb IEEE80211_LOCK_ASSERT(ic); 20286b4cac81SBjoern A. Zeeb ostate = vap->iv_state; 20296b4cac81SBjoern A. Zeeb 20309d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20319d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 20326b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s:%d: vap %p nstate %#x arg %#x\n", 20336b4cac81SBjoern A. Zeeb __func__, __LINE__, vap, nstate, arg); 20349d9ba2b7SBjoern A. Zeeb #endif 20356b4cac81SBjoern A. Zeeb 20366b4cac81SBjoern A. Zeeb if (vap->iv_opmode == IEEE80211_M_STA) { 20376b4cac81SBjoern A. Zeeb 20386b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 20396b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 20406b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 20416b4cac81SBjoern A. Zeeb 20426b4cac81SBjoern A. Zeeb /* No need to replicate this in most state handlers. */ 20436b4cac81SBjoern A. Zeeb if (ostate == IEEE80211_S_SCAN && nstate != IEEE80211_S_SCAN) 20446b4cac81SBjoern A. Zeeb lkpi_stop_hw_scan(lhw, vif); 20456b4cac81SBjoern A. Zeeb 20466b4cac81SBjoern A. Zeeb s = sta_state_fsm; 20476b4cac81SBjoern A. Zeeb 20486b4cac81SBjoern A. Zeeb } else { 20496b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: only station mode currently supported: " 20506b4cac81SBjoern A. Zeeb "cap %p iv_opmode %d\n", __func__, vap, vap->iv_opmode); 20516b4cac81SBjoern A. Zeeb return (ENOSYS); 20526b4cac81SBjoern A. Zeeb } 20536b4cac81SBjoern A. Zeeb 20546b4cac81SBjoern A. Zeeb error = 0; 20556b4cac81SBjoern A. Zeeb for (; s->handler != NULL; s++) { 20566b4cac81SBjoern A. Zeeb if (ostate == s->ostate && nstate == s->nstate) { 20579d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20589d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2059d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: new state %d (%s) ->" 2060d9f59799SBjoern A. Zeeb " %d (%s): arg %d.\n", __func__, 2061d9f59799SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 2062d9f59799SBjoern A. Zeeb nstate, ieee80211_state_name[nstate], arg); 20639d9ba2b7SBjoern A. Zeeb #endif 20646b4cac81SBjoern A. Zeeb error = s->handler(vap, nstate, arg); 20656b4cac81SBjoern A. Zeeb break; 20666b4cac81SBjoern A. Zeeb } 20676b4cac81SBjoern A. Zeeb } 20686b4cac81SBjoern A. Zeeb IEEE80211_LOCK_ASSERT(vap->iv_ic); 20696b4cac81SBjoern A. Zeeb 20706b4cac81SBjoern A. Zeeb if (s->handler == NULL) { 2071d9f59799SBjoern A. Zeeb IMPROVE("turn this into a KASSERT\n"); 20726b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: unsupported state transition " 20736b4cac81SBjoern A. Zeeb "%d (%s) -> %d (%s)\n", __func__, 20746b4cac81SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 20756b4cac81SBjoern A. Zeeb nstate, ieee80211_state_name[nstate]); 20766b4cac81SBjoern A. Zeeb return (ENOSYS); 20776b4cac81SBjoern A. Zeeb } 20786b4cac81SBjoern A. Zeeb 20796b4cac81SBjoern A. Zeeb if (error == EALREADY) { 20809d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20819d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2082d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: state transition %d (%s) -> " 2083d9f59799SBjoern A. Zeeb "%d (%s): iv_newstate already handled: %d.\n", 2084d9f59799SBjoern A. Zeeb __func__, ostate, ieee80211_state_name[ostate], 2085d9f59799SBjoern A. Zeeb nstate, ieee80211_state_name[nstate], error); 20869d9ba2b7SBjoern A. Zeeb #endif 20876b4cac81SBjoern A. Zeeb return (0); 20886b4cac81SBjoern A. Zeeb } 20896b4cac81SBjoern A. Zeeb 20906b4cac81SBjoern A. Zeeb if (error != 0) { 20916b4cac81SBjoern A. Zeeb /* XXX-BZ currently expected so ignore. */ 20926b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: error %d during state transition " 20936b4cac81SBjoern A. Zeeb "%d (%s) -> %d (%s)\n", __func__, error, 20946b4cac81SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 20956b4cac81SBjoern A. Zeeb nstate, ieee80211_state_name[nstate]); 20966b4cac81SBjoern A. Zeeb /* return (error); */ 20976b4cac81SBjoern A. Zeeb } 20986b4cac81SBjoern A. Zeeb 20999d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 21009d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2101d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s:%d: vap %p nstate %#x arg %#x " 2102d9f59799SBjoern A. Zeeb "calling net80211 parent\n", 21036b4cac81SBjoern A. Zeeb __func__, __LINE__, vap, nstate, arg); 21049d9ba2b7SBjoern A. Zeeb #endif 21056b4cac81SBjoern A. Zeeb 21066b4cac81SBjoern A. Zeeb return (lvif->iv_newstate(vap, nstate, arg)); 21076b4cac81SBjoern A. Zeeb } 21086b4cac81SBjoern A. Zeeb 21096b4cac81SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 21106b4cac81SBjoern A. Zeeb 2111d9f59799SBjoern A. Zeeb /* 2112d9f59799SBjoern A. Zeeb * We overload (*iv_update_bss) as otherwise we have cases in, e.g., 2113d9f59799SBjoern A. Zeeb * net80211::ieee80211_sta_join1() where vap->iv_bss gets replaced by a 2114d9f59799SBjoern A. Zeeb * new node without us knowing and thus our ni/lsta are out of sync. 2115d9f59799SBjoern A. Zeeb */ 2116d9f59799SBjoern A. Zeeb static struct ieee80211_node * 2117d9f59799SBjoern A. Zeeb lkpi_iv_update_bss(struct ieee80211vap *vap, struct ieee80211_node *ni) 2118d9f59799SBjoern A. Zeeb { 2119d9f59799SBjoern A. Zeeb struct lkpi_vif *lvif; 2120d9f59799SBjoern A. Zeeb struct ieee80211_node *obss; 2121d9f59799SBjoern A. Zeeb struct lkpi_sta *lsta; 2122ed3ef56bSBjoern A. Zeeb struct ieee80211_sta *sta; 2123d9f59799SBjoern A. Zeeb 2124d9f59799SBjoern A. Zeeb obss = vap->iv_bss; 2125d9f59799SBjoern A. Zeeb 21269d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 21279d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 21289d9ba2b7SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: obss %p ni_drv_data %p " 21299d9ba2b7SBjoern A. Zeeb "ni %p ni_drv_data %p\n", __func__, 21309d9ba2b7SBjoern A. Zeeb obss, (obss != NULL) ? obss->ni_drv_data : NULL, 21319d9ba2b7SBjoern A. Zeeb ni, (ni != NULL) ? ni->ni_drv_data : NULL); 21329d9ba2b7SBjoern A. Zeeb #endif 21339d9ba2b7SBjoern A. Zeeb 2134d9f59799SBjoern A. Zeeb /* Nothing to copy from. Just return. */ 2135d9f59799SBjoern A. Zeeb if (obss == NULL || obss->ni_drv_data == NULL) 2136d9f59799SBjoern A. Zeeb goto out; 2137d9f59799SBjoern A. Zeeb 2138d9f59799SBjoern A. Zeeb /* Nothing to copy to. Just return. */ 2139d9f59799SBjoern A. Zeeb IMPROVE("clearing the obss might still be needed?"); 2140d9f59799SBjoern A. Zeeb if (ni == NULL) 2141d9f59799SBjoern A. Zeeb goto out; 2142d9f59799SBjoern A. Zeeb 2143d9f59799SBjoern A. Zeeb /* Nothing changed? panic? */ 2144d9f59799SBjoern A. Zeeb if (obss == ni) 2145d9f59799SBjoern A. Zeeb goto out; 2146d9f59799SBjoern A. Zeeb 2147d9f59799SBjoern A. Zeeb lsta = obss->ni_drv_data; 2148d9f59799SBjoern A. Zeeb obss->ni_drv_data = ni->ni_drv_data; 2149d9f59799SBjoern A. Zeeb ni->ni_drv_data = lsta; 2150ed3ef56bSBjoern A. Zeeb if (lsta != NULL) { 2151d9f59799SBjoern A. Zeeb lsta->ni = ni; 2152ed3ef56bSBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 2153ed3ef56bSBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->addr, lsta->ni->ni_macaddr); 21546ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->deflink.addr, sta->addr); 2155ed3ef56bSBjoern A. Zeeb } 2156d9f59799SBjoern A. Zeeb lsta = obss->ni_drv_data; 2157ed3ef56bSBjoern A. Zeeb if (lsta != NULL) { 2158d9f59799SBjoern A. Zeeb lsta->ni = obss; 2159ed3ef56bSBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 2160ed3ef56bSBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->addr, lsta->ni->ni_macaddr); 21616ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->deflink.addr, sta->addr); 2162ed3ef56bSBjoern A. Zeeb } 2163d9f59799SBjoern A. Zeeb 2164d9f59799SBjoern A. Zeeb out: 2165ed3ef56bSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 2166d9f59799SBjoern A. Zeeb return (lvif->iv_update_bss(vap, ni)); 2167d9f59799SBjoern A. Zeeb } 2168d9f59799SBjoern A. Zeeb 21694a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 21706b4cac81SBjoern A. Zeeb static int 21714a67f1dfSBjoern A. Zeeb lkpi_wme_update(struct lkpi_hw *lhw, struct ieee80211vap *vap, bool planned) 21726b4cac81SBjoern A. Zeeb { 21734a67f1dfSBjoern A. Zeeb struct ieee80211com *ic; 21746b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 21756b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 21766b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 21776b4cac81SBjoern A. Zeeb struct chanAccParams chp; 21786b4cac81SBjoern A. Zeeb struct wmeParams wmeparr[WME_NUM_AC]; 21796b4cac81SBjoern A. Zeeb struct ieee80211_tx_queue_params txqp; 21806b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed changed; 21816b4cac81SBjoern A. Zeeb int error; 21826b4cac81SBjoern A. Zeeb uint16_t ac; 21836b4cac81SBjoern A. Zeeb 21846b4cac81SBjoern A. Zeeb IMPROVE(); 21856b4cac81SBjoern A. Zeeb KASSERT(WME_NUM_AC == IEEE80211_NUM_ACS, ("%s: WME_NUM_AC %d != " 21866b4cac81SBjoern A. Zeeb "IEEE80211_NUM_ACS %d\n", __func__, WME_NUM_AC, IEEE80211_NUM_ACS)); 21876b4cac81SBjoern A. Zeeb 21886b4cac81SBjoern A. Zeeb if (vap == NULL) 21896b4cac81SBjoern A. Zeeb return (0); 21906b4cac81SBjoern A. Zeeb 21914a67f1dfSBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WME) == 0) 21924a67f1dfSBjoern A. Zeeb return (0); 21934a67f1dfSBjoern A. Zeeb 21946b4cac81SBjoern A. Zeeb if (lhw->ops->conf_tx == NULL) 21956b4cac81SBjoern A. Zeeb return (0); 21966b4cac81SBjoern A. Zeeb 21974a67f1dfSBjoern A. Zeeb if (!planned && (vap->iv_state != IEEE80211_S_RUN)) { 21984a67f1dfSBjoern A. Zeeb lhw->update_wme = true; 21994a67f1dfSBjoern A. Zeeb return (0); 22004a67f1dfSBjoern A. Zeeb } 22014a67f1dfSBjoern A. Zeeb lhw->update_wme = false; 22026b4cac81SBjoern A. Zeeb 22034a67f1dfSBjoern A. Zeeb ic = lhw->ic; 22046b4cac81SBjoern A. Zeeb ieee80211_wme_ic_getparams(ic, &chp); 22056b4cac81SBjoern A. Zeeb IEEE80211_LOCK(ic); 22066b4cac81SBjoern A. Zeeb for (ac = 0; ac < WME_NUM_AC; ac++) 22076b4cac81SBjoern A. Zeeb wmeparr[ac] = chp.cap_wmeParams[ac]; 22086b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(ic); 22096b4cac81SBjoern A. Zeeb 22104a67f1dfSBjoern A. Zeeb hw = LHW_TO_HW(lhw); 22114a67f1dfSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 22124a67f1dfSBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 22134a67f1dfSBjoern A. Zeeb 22146b4cac81SBjoern A. Zeeb /* Configure tx queues (conf_tx) & send BSS_CHANGED_QOS. */ 22156b4cac81SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 22166b4cac81SBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 22176b4cac81SBjoern A. Zeeb struct wmeParams *wmep; 22186b4cac81SBjoern A. Zeeb 22196b4cac81SBjoern A. Zeeb wmep = &wmeparr[ac]; 22206b4cac81SBjoern A. Zeeb bzero(&txqp, sizeof(txqp)); 22216b4cac81SBjoern A. Zeeb txqp.cw_min = wmep->wmep_logcwmin; 22226b4cac81SBjoern A. Zeeb txqp.cw_max = wmep->wmep_logcwmax; 22236b4cac81SBjoern A. Zeeb txqp.txop = wmep->wmep_txopLimit; 22246b4cac81SBjoern A. Zeeb txqp.aifs = wmep->wmep_aifsn; 222568541546SBjoern A. Zeeb error = lkpi_80211_mo_conf_tx(hw, vif, /* link_id */0, ac, &txqp); 22266b4cac81SBjoern A. Zeeb if (error != 0) 22273f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: conf_tx ac %u failed %d\n", 22286b4cac81SBjoern A. Zeeb __func__, ac, error); 22296b4cac81SBjoern A. Zeeb } 22306b4cac81SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 22316b4cac81SBjoern A. Zeeb changed = BSS_CHANGED_QOS; 22324a67f1dfSBjoern A. Zeeb if (!planned) 22336b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 22344a67f1dfSBjoern A. Zeeb 22354a67f1dfSBjoern A. Zeeb return (changed); 22364a67f1dfSBjoern A. Zeeb } 22376b4cac81SBjoern A. Zeeb #endif 22386b4cac81SBjoern A. Zeeb 22394a67f1dfSBjoern A. Zeeb static int 22404a67f1dfSBjoern A. Zeeb lkpi_ic_wme_update(struct ieee80211com *ic) 22414a67f1dfSBjoern A. Zeeb { 22424a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 22434a67f1dfSBjoern A. Zeeb struct ieee80211vap *vap; 22444a67f1dfSBjoern A. Zeeb struct lkpi_hw *lhw; 22454a67f1dfSBjoern A. Zeeb 22464a67f1dfSBjoern A. Zeeb IMPROVE("Use the per-VAP callback in net80211."); 22474a67f1dfSBjoern A. Zeeb vap = TAILQ_FIRST(&ic->ic_vaps); 22484a67f1dfSBjoern A. Zeeb if (vap == NULL) 22496b4cac81SBjoern A. Zeeb return (0); 22504a67f1dfSBjoern A. Zeeb 22514a67f1dfSBjoern A. Zeeb lhw = ic->ic_softc; 22524a67f1dfSBjoern A. Zeeb 22534a67f1dfSBjoern A. Zeeb lkpi_wme_update(lhw, vap, false); 22544a67f1dfSBjoern A. Zeeb #endif 22554a67f1dfSBjoern A. Zeeb return (0); /* unused */ 22566b4cac81SBjoern A. Zeeb } 22576b4cac81SBjoern A. Zeeb 22586b4cac81SBjoern A. Zeeb static struct ieee80211vap * 22596b4cac81SBjoern A. Zeeb lkpi_ic_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], 22606b4cac81SBjoern A. Zeeb int unit, enum ieee80211_opmode opmode, int flags, 22616b4cac81SBjoern A. Zeeb const uint8_t bssid[IEEE80211_ADDR_LEN], 22626b4cac81SBjoern A. Zeeb const uint8_t mac[IEEE80211_ADDR_LEN]) 22636b4cac81SBjoern A. Zeeb { 22646b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 22656b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 22666b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 22676b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 22686b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 2269a6042e17SBjoern A. Zeeb struct ieee80211_tx_queue_params txqp; 22706b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed changed; 22716b4cac81SBjoern A. Zeeb size_t len; 2272e3a0b120SBjoern A. Zeeb int error, i; 2273a6042e17SBjoern A. Zeeb uint16_t ac; 22746b4cac81SBjoern A. Zeeb 22756b4cac81SBjoern A. Zeeb if (!TAILQ_EMPTY(&ic->ic_vaps)) /* 1 so far. Add <n> once this works. */ 22766b4cac81SBjoern A. Zeeb return (NULL); 22776b4cac81SBjoern A. Zeeb 22786b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 22796b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 22806b4cac81SBjoern A. Zeeb 22816b4cac81SBjoern A. Zeeb len = sizeof(*lvif); 22826b4cac81SBjoern A. Zeeb len += hw->vif_data_size; /* vif->drv_priv */ 22836b4cac81SBjoern A. Zeeb 22846b4cac81SBjoern A. Zeeb lvif = malloc(len, M_80211_VAP, M_WAITOK | M_ZERO); 22856b4cac81SBjoern A. Zeeb mtx_init(&lvif->mtx, "lvif", NULL, MTX_DEF); 22866b4cac81SBjoern A. Zeeb TAILQ_INIT(&lvif->lsta_head); 22876b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 22886b4cac81SBjoern A. Zeeb 22896b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 22906b4cac81SBjoern A. Zeeb memcpy(vif->addr, mac, IEEE80211_ADDR_LEN); 22916b4cac81SBjoern A. Zeeb vif->p2p = false; 22926b4cac81SBjoern A. Zeeb vif->probe_req_reg = false; 22936b4cac81SBjoern A. Zeeb vif->type = lkpi_opmode_to_vif_type(opmode); 22946b4cac81SBjoern A. Zeeb lvif->wdev.iftype = vif->type; 22956b4cac81SBjoern A. Zeeb /* Need to fill in other fields as well. */ 22966b4cac81SBjoern A. Zeeb IMPROVE(); 22976b4cac81SBjoern A. Zeeb 22986b4cac81SBjoern A. Zeeb /* XXX-BZ hardcoded for now! */ 22996b4cac81SBjoern A. Zeeb #if 1 23006b4cac81SBjoern A. Zeeb vif->chanctx_conf = NULL; 2301adff403fSBjoern A. Zeeb vif->bss_conf.vif = vif; 23026ffb7bd4SBjoern A. Zeeb /* vap->iv_myaddr is not set until net80211::vap_setup or vap_attach. */ 23036ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(vif->bss_conf.addr, mac); 23046ffb7bd4SBjoern A. Zeeb vif->bss_conf.link_id = 0; /* Non-MLO operation. */ 23056b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.width = NL80211_CHAN_WIDTH_20_NOHT; 23066b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble = false; /* vap->iv_flags IEEE80211_F_SHPREAMBLE */ 23076b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot = false; /* vap->iv_flags IEEE80211_F_SHSLOT */ 23086b4cac81SBjoern A. Zeeb vif->bss_conf.qos = false; 23096b4cac81SBjoern A. Zeeb vif->bss_conf.use_cts_prot = false; /* vap->iv_protmode */ 23106b4cac81SBjoern A. Zeeb vif->bss_conf.ht_operation_mode = IEEE80211_HT_OP_MODE_PROTECTION_NONE; 2311616e1330SBjoern A. Zeeb vif->cfg.aid = 0; 2312616e1330SBjoern A. Zeeb vif->cfg.assoc = false; 2313616e1330SBjoern A. Zeeb vif->cfg.idle = true; 2314616e1330SBjoern A. Zeeb vif->cfg.ps = false; 23156ffb7bd4SBjoern A. Zeeb IMPROVE("Check other fields and then figure out whats is left elsewhere of them"); 2316caaa79c3SBjoern A. Zeeb /* 2317caaa79c3SBjoern A. Zeeb * We need to initialize it to something as the bss_info_changed call 2318caaa79c3SBjoern A. Zeeb * will try to copy from it in iwlwifi and NULL is a panic. 2319caaa79c3SBjoern A. Zeeb * We will set the proper one in scan_to_auth() before being assoc. 2320caaa79c3SBjoern A. Zeeb */ 23216ffb7bd4SBjoern A. Zeeb vif->bss_conf.bssid = ieee80211broadcastaddr; 23226b4cac81SBjoern A. Zeeb #endif 23236b4cac81SBjoern A. Zeeb #if 0 23246b4cac81SBjoern A. Zeeb vif->bss_conf.dtim_period = 0; /* IEEE80211_DTIM_DEFAULT ; must stay 0. */ 23256b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(vif->bss_conf.bssid, bssid); 23266b4cac81SBjoern A. Zeeb vif->bss_conf.beacon_int = ic->ic_bintval; 23276b4cac81SBjoern A. Zeeb /* iwlwifi bug. */ 23286b4cac81SBjoern A. Zeeb if (vif->bss_conf.beacon_int < 16) 23296b4cac81SBjoern A. Zeeb vif->bss_conf.beacon_int = 16; 23306b4cac81SBjoern A. Zeeb #endif 2331e3a0b120SBjoern A. Zeeb 23326ffb7bd4SBjoern A. Zeeb /* Link Config */ 23336ffb7bd4SBjoern A. Zeeb vif->link_conf[0] = &vif->bss_conf; 23346ffb7bd4SBjoern A. Zeeb for (i = 0; i < nitems(vif->link_conf); i++) { 23356ffb7bd4SBjoern A. Zeeb IMPROVE("more than 1 link one day"); 23366ffb7bd4SBjoern A. Zeeb } 23376ffb7bd4SBjoern A. Zeeb 2338e3a0b120SBjoern A. Zeeb /* Setup queue defaults; driver may override in (*add_interface). */ 2339e3a0b120SBjoern A. Zeeb for (i = 0; i < IEEE80211_NUM_ACS; i++) { 2340e3a0b120SBjoern A. Zeeb if (ieee80211_hw_check(hw, QUEUE_CONTROL)) 2341e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = IEEE80211_INVAL_HW_QUEUE; 2342e3a0b120SBjoern A. Zeeb else if (hw->queues >= IEEE80211_NUM_ACS) 2343e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = i; 2344e3a0b120SBjoern A. Zeeb else 2345e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = 0; 23460cbcfa19SBjoern A. Zeeb 23470cbcfa19SBjoern A. Zeeb /* Initialize the queue to running. Stopped? */ 23480cbcfa19SBjoern A. Zeeb lvif->hw_queue_stopped[i] = false; 2349e3a0b120SBjoern A. Zeeb } 2350e3a0b120SBjoern A. Zeeb vif->cab_queue = IEEE80211_INVAL_HW_QUEUE; 2351e3a0b120SBjoern A. Zeeb 23526b4cac81SBjoern A. Zeeb IMPROVE(); 23536b4cac81SBjoern A. Zeeb 23546b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_start(hw); 23556b4cac81SBjoern A. Zeeb if (error != 0) { 23563f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: failed to start hw: %d\n", __func__, error); 23576b4cac81SBjoern A. Zeeb mtx_destroy(&lvif->mtx); 23586b4cac81SBjoern A. Zeeb free(lvif, M_80211_VAP); 23596b4cac81SBjoern A. Zeeb return (NULL); 23606b4cac81SBjoern A. Zeeb } 23616b4cac81SBjoern A. Zeeb 23626b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_add_interface(hw, vif); 23636b4cac81SBjoern A. Zeeb if (error != 0) { 23646b4cac81SBjoern A. Zeeb IMPROVE(); /* XXX-BZ mo_stop()? */ 23653f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: failed to add interface: %d\n", __func__, error); 23666b4cac81SBjoern A. Zeeb mtx_destroy(&lvif->mtx); 23676b4cac81SBjoern A. Zeeb free(lvif, M_80211_VAP); 23686b4cac81SBjoern A. Zeeb return (NULL); 23696b4cac81SBjoern A. Zeeb } 23706b4cac81SBjoern A. Zeeb 23718891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 23726b4cac81SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lhw->lvif_head, lvif, lvif_entry); 23738891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 23746b4cac81SBjoern A. Zeeb 23756b4cac81SBjoern A. Zeeb /* Set bss_info. */ 23766b4cac81SBjoern A. Zeeb changed = 0; 23776b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 23786b4cac81SBjoern A. Zeeb 2379a6042e17SBjoern A. Zeeb /* Configure tx queues (conf_tx), default WME & send BSS_CHANGED_QOS. */ 2380a6042e17SBjoern A. Zeeb IMPROVE("Hardcoded values; to fix see 802.11-2016, 9.4.2.29 EDCA Parameter Set element"); 2381a6042e17SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 2382a6042e17SBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 2383a6042e17SBjoern A. Zeeb 2384a6042e17SBjoern A. Zeeb bzero(&txqp, sizeof(txqp)); 2385a6042e17SBjoern A. Zeeb txqp.cw_min = 15; 2386a6042e17SBjoern A. Zeeb txqp.cw_max = 1023; 2387a6042e17SBjoern A. Zeeb txqp.txop = 0; 2388a6042e17SBjoern A. Zeeb txqp.aifs = 2; 2389a6042e17SBjoern A. Zeeb error = lkpi_80211_mo_conf_tx(hw, vif, /* link_id */0, ac, &txqp); 2390a6042e17SBjoern A. Zeeb if (error != 0) 2391a6042e17SBjoern A. Zeeb ic_printf(ic, "%s: conf_tx ac %u failed %d\n", 2392a6042e17SBjoern A. Zeeb __func__, ac, error); 2393a6042e17SBjoern A. Zeeb } 2394a6042e17SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 2395a6042e17SBjoern A. Zeeb changed = BSS_CHANGED_QOS; 2396a6042e17SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 23976b4cac81SBjoern A. Zeeb 23986b4cac81SBjoern A. Zeeb /* Force MC init. */ 23996b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(ic, true); 24006b4cac81SBjoern A. Zeeb 24016b4cac81SBjoern A. Zeeb IMPROVE(); 24026b4cac81SBjoern A. Zeeb 24036b4cac81SBjoern A. Zeeb ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid); 24046b4cac81SBjoern A. Zeeb 24056b4cac81SBjoern A. Zeeb /* Override with LinuxKPI method so we can drive mac80211/cfg80211. */ 24066b4cac81SBjoern A. Zeeb lvif->iv_newstate = vap->iv_newstate; 24076b4cac81SBjoern A. Zeeb vap->iv_newstate = lkpi_iv_newstate; 2408d9f59799SBjoern A. Zeeb lvif->iv_update_bss = vap->iv_update_bss; 2409d9f59799SBjoern A. Zeeb vap->iv_update_bss = lkpi_iv_update_bss; 24106b4cac81SBjoern A. Zeeb 24116b4cac81SBjoern A. Zeeb /* Key management. */ 24126b4cac81SBjoern A. Zeeb if (lhw->ops->set_key != NULL) { 2413b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 24146b4cac81SBjoern A. Zeeb vap->iv_key_set = lkpi_iv_key_set; 24156b4cac81SBjoern A. Zeeb vap->iv_key_delete = lkpi_iv_key_delete; 24166b4cac81SBjoern A. Zeeb #endif 24176b4cac81SBjoern A. Zeeb } 24186b4cac81SBjoern A. Zeeb 24196b4cac81SBjoern A. Zeeb ieee80211_ratectl_init(vap); 24206b4cac81SBjoern A. Zeeb 24216b4cac81SBjoern A. Zeeb /* Complete setup. */ 24226b4cac81SBjoern A. Zeeb ieee80211_vap_attach(vap, ieee80211_media_change, 24236b4cac81SBjoern A. Zeeb ieee80211_media_status, mac); 24246b4cac81SBjoern A. Zeeb 24256b4cac81SBjoern A. Zeeb if (hw->max_listen_interval == 0) 24266b4cac81SBjoern A. Zeeb hw->max_listen_interval = 7 * (ic->ic_lintval / ic->ic_bintval); 24276b4cac81SBjoern A. Zeeb hw->conf.listen_interval = hw->max_listen_interval; 24286b4cac81SBjoern A. Zeeb ic->ic_set_channel(ic); 24296b4cac81SBjoern A. Zeeb 24306b4cac81SBjoern A. Zeeb /* XXX-BZ do we need to be able to update these? */ 24316b4cac81SBjoern A. Zeeb hw->wiphy->frag_threshold = vap->iv_fragthreshold; 24326b4cac81SBjoern A. Zeeb lkpi_80211_mo_set_frag_threshold(hw, vap->iv_fragthreshold); 24336b4cac81SBjoern A. Zeeb hw->wiphy->rts_threshold = vap->iv_rtsthreshold; 24346b4cac81SBjoern A. Zeeb lkpi_80211_mo_set_rts_threshold(hw, vap->iv_rtsthreshold); 24356b4cac81SBjoern A. Zeeb /* any others? */ 24366b4cac81SBjoern A. Zeeb IMPROVE(); 24376b4cac81SBjoern A. Zeeb 24386b4cac81SBjoern A. Zeeb return (vap); 24396b4cac81SBjoern A. Zeeb } 24406b4cac81SBjoern A. Zeeb 24414b0af114SBjoern A. Zeeb void 24424b0af114SBjoern A. Zeeb linuxkpi_ieee80211_unregister_hw(struct ieee80211_hw *hw) 24434b0af114SBjoern A. Zeeb { 24444b0af114SBjoern A. Zeeb 24454b0af114SBjoern A. Zeeb wiphy_unregister(hw->wiphy); 24464b0af114SBjoern A. Zeeb linuxkpi_ieee80211_ifdetach(hw); 24474b0af114SBjoern A. Zeeb 24484b0af114SBjoern A. Zeeb IMPROVE(); 24494b0af114SBjoern A. Zeeb } 24504b0af114SBjoern A. Zeeb 24514b0af114SBjoern A. Zeeb void 24524b0af114SBjoern A. Zeeb linuxkpi_ieee80211_restart_hw(struct ieee80211_hw *hw) 24534b0af114SBjoern A. Zeeb { 24544b0af114SBjoern A. Zeeb 24554b0af114SBjoern A. Zeeb TODO(); 24564b0af114SBjoern A. Zeeb } 24574b0af114SBjoern A. Zeeb 24586b4cac81SBjoern A. Zeeb static void 24596b4cac81SBjoern A. Zeeb lkpi_ic_vap_delete(struct ieee80211vap *vap) 24606b4cac81SBjoern A. Zeeb { 24616b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 24626b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 24636b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 24646b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 24656b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 24666b4cac81SBjoern A. Zeeb 24676b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 24686b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 24696b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 24706b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 24716b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 24726b4cac81SBjoern A. Zeeb 24738891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 24746b4cac81SBjoern A. Zeeb TAILQ_REMOVE(&lhw->lvif_head, lvif, lvif_entry); 24758891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 24766b4cac81SBjoern A. Zeeb 24776b4cac81SBjoern A. Zeeb ieee80211_ratectl_deinit(vap); 24786b4cac81SBjoern A. Zeeb ieee80211_vap_detach(vap); 2479dbf76919SBjoern A. Zeeb 2480dbf76919SBjoern A. Zeeb IMPROVE("clear up other bits in this state"); 2481dbf76919SBjoern A. Zeeb 2482dbf76919SBjoern A. Zeeb lkpi_80211_mo_remove_interface(hw, vif); 2483dbf76919SBjoern A. Zeeb 24846c38c6b1SBjoern A. Zeeb /* Single VAP, so we can do this here. */ 24856c38c6b1SBjoern A. Zeeb lkpi_80211_mo_stop(hw); 24866c38c6b1SBjoern A. Zeeb 24876b4cac81SBjoern A. Zeeb mtx_destroy(&lvif->mtx); 24886b4cac81SBjoern A. Zeeb free(lvif, M_80211_VAP); 24896b4cac81SBjoern A. Zeeb } 24906b4cac81SBjoern A. Zeeb 24916b4cac81SBjoern A. Zeeb static void 24926b4cac81SBjoern A. Zeeb lkpi_ic_update_mcast(struct ieee80211com *ic) 24936b4cac81SBjoern A. Zeeb { 24946b4cac81SBjoern A. Zeeb 24956b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(ic, false); 24966b4cac81SBjoern A. Zeeb TRACEOK(); 24976b4cac81SBjoern A. Zeeb } 24986b4cac81SBjoern A. Zeeb 24996b4cac81SBjoern A. Zeeb static void 25006b4cac81SBjoern A. Zeeb lkpi_ic_update_promisc(struct ieee80211com *ic) 25016b4cac81SBjoern A. Zeeb { 25026b4cac81SBjoern A. Zeeb 25036b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 25046b4cac81SBjoern A. Zeeb } 25056b4cac81SBjoern A. Zeeb 25066b4cac81SBjoern A. Zeeb static void 25076b4cac81SBjoern A. Zeeb lkpi_ic_update_chw(struct ieee80211com *ic) 25086b4cac81SBjoern A. Zeeb { 25096b4cac81SBjoern A. Zeeb 25106b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 25116b4cac81SBjoern A. Zeeb } 25126b4cac81SBjoern A. Zeeb 25136b4cac81SBjoern A. Zeeb /* Start / stop device. */ 25146b4cac81SBjoern A. Zeeb static void 25156b4cac81SBjoern A. Zeeb lkpi_ic_parent(struct ieee80211com *ic) 25166b4cac81SBjoern A. Zeeb { 25176b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 25188d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25196b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 25206b4cac81SBjoern A. Zeeb int error; 25218d58a057SBjoern A. Zeeb #endif 25226b4cac81SBjoern A. Zeeb bool start_all; 25236b4cac81SBjoern A. Zeeb 25246b4cac81SBjoern A. Zeeb IMPROVE(); 25256b4cac81SBjoern A. Zeeb 25266b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 25278d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25286b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 25298d58a057SBjoern A. Zeeb #endif 25306b4cac81SBjoern A. Zeeb start_all = false; 25316b4cac81SBjoern A. Zeeb 25328ac540d3SBjoern A. Zeeb /* IEEE80211_UNLOCK(ic); */ 25338ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 25346b4cac81SBjoern A. Zeeb if (ic->ic_nrunning > 0) { 25358d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25366b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_start(hw); 25376b4cac81SBjoern A. Zeeb if (error == 0) 25388d58a057SBjoern A. Zeeb #endif 25396b4cac81SBjoern A. Zeeb start_all = true; 25406b4cac81SBjoern A. Zeeb } else { 25418d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25426b4cac81SBjoern A. Zeeb lkpi_80211_mo_stop(hw); 25438d58a057SBjoern A. Zeeb #endif 25446b4cac81SBjoern A. Zeeb } 25458ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 25468ac540d3SBjoern A. Zeeb /* IEEE80211_LOCK(ic); */ 25476b4cac81SBjoern A. Zeeb 25486b4cac81SBjoern A. Zeeb if (start_all) 25496b4cac81SBjoern A. Zeeb ieee80211_start_all(ic); 25506b4cac81SBjoern A. Zeeb } 25516b4cac81SBjoern A. Zeeb 25526b4cac81SBjoern A. Zeeb bool 25536b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_is_ie_id_in_ie_buf(const u8 ie, const u8 *ie_ids, 25546b4cac81SBjoern A. Zeeb size_t ie_ids_len) 25556b4cac81SBjoern A. Zeeb { 25566b4cac81SBjoern A. Zeeb int i; 25576b4cac81SBjoern A. Zeeb 25586b4cac81SBjoern A. Zeeb for (i = 0; i < ie_ids_len; i++) { 25596b4cac81SBjoern A. Zeeb if (ie == *ie_ids) 25606b4cac81SBjoern A. Zeeb return (true); 25616b4cac81SBjoern A. Zeeb } 25626b4cac81SBjoern A. Zeeb 25636b4cac81SBjoern A. Zeeb return (false); 25646b4cac81SBjoern A. Zeeb } 25656b4cac81SBjoern A. Zeeb 25666b4cac81SBjoern A. Zeeb /* Return true if skipped; false if error. */ 25676b4cac81SBjoern A. Zeeb bool 25686b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ie_advance(size_t *xp, const u8 *ies, size_t ies_len) 25696b4cac81SBjoern A. Zeeb { 25706b4cac81SBjoern A. Zeeb size_t x; 25716b4cac81SBjoern A. Zeeb uint8_t l; 25726b4cac81SBjoern A. Zeeb 25736b4cac81SBjoern A. Zeeb x = *xp; 25746b4cac81SBjoern A. Zeeb 25756b4cac81SBjoern A. Zeeb KASSERT(x < ies_len, ("%s: x %zu ies_len %zu ies %p\n", 25766b4cac81SBjoern A. Zeeb __func__, x, ies_len, ies)); 25776b4cac81SBjoern A. Zeeb l = ies[x + 1]; 25786b4cac81SBjoern A. Zeeb x += 2 + l; 25796b4cac81SBjoern A. Zeeb 25806b4cac81SBjoern A. Zeeb if (x > ies_len) 25816b4cac81SBjoern A. Zeeb return (false); 25826b4cac81SBjoern A. Zeeb 25836b4cac81SBjoern A. Zeeb *xp = x; 25846b4cac81SBjoern A. Zeeb return (true); 25856b4cac81SBjoern A. Zeeb } 25866b4cac81SBjoern A. Zeeb 2587d9945d78SBjoern A. Zeeb static uint8_t * 2588d9945d78SBjoern A. Zeeb lkpi_scan_ies_add(uint8_t *p, struct ieee80211_scan_ies *scan_ies, 2589d9945d78SBjoern A. Zeeb uint32_t band_mask, struct ieee80211vap *vap, struct ieee80211_hw *hw) 25906b4cac81SBjoern A. Zeeb { 2591d9945d78SBjoern A. Zeeb struct ieee80211_supported_band *supband; 2592d9945d78SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 25933dd98026SBjoern A. Zeeb struct ieee80211com *ic; 2594d9945d78SBjoern A. Zeeb const struct ieee80211_channel *chan; 2595d9945d78SBjoern A. Zeeb const struct ieee80211_rateset *rs; 2596d9945d78SBjoern A. Zeeb uint8_t *pb; 2597d9945d78SBjoern A. Zeeb int band, i; 25986b4cac81SBjoern A. Zeeb 25993dd98026SBjoern A. Zeeb ic = vap->iv_ic; 2600d9945d78SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 2601d9945d78SBjoern A. Zeeb if ((band_mask & (1 << band)) == 0) 2602d9945d78SBjoern A. Zeeb continue; 2603d9945d78SBjoern A. Zeeb 2604d9945d78SBjoern A. Zeeb supband = hw->wiphy->bands[band]; 2605d9945d78SBjoern A. Zeeb /* 2606d9945d78SBjoern A. Zeeb * This should not happen; 2607d9945d78SBjoern A. Zeeb * band_mask is a bitmask of valid bands to scan on. 2608d9945d78SBjoern A. Zeeb */ 2609d9945d78SBjoern A. Zeeb if (supband == NULL || supband->n_channels == 0) 2610d9945d78SBjoern A. Zeeb continue; 2611d9945d78SBjoern A. Zeeb 2612d9945d78SBjoern A. Zeeb /* Find a first channel to get the mode and rates from. */ 2613d9945d78SBjoern A. Zeeb channels = supband->channels; 2614d9945d78SBjoern A. Zeeb chan = NULL; 2615d9945d78SBjoern A. Zeeb for (i = 0; i < supband->n_channels; i++) { 2616d9945d78SBjoern A. Zeeb 2617d9945d78SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) 2618d9945d78SBjoern A. Zeeb continue; 2619d9945d78SBjoern A. Zeeb 26203dd98026SBjoern A. Zeeb chan = ieee80211_find_channel(ic, 2621d9945d78SBjoern A. Zeeb channels[i].center_freq, 0); 2622d9945d78SBjoern A. Zeeb if (chan != NULL) 2623d9945d78SBjoern A. Zeeb break; 2624d9945d78SBjoern A. Zeeb } 2625d9945d78SBjoern A. Zeeb 2626d9945d78SBjoern A. Zeeb /* This really should not happen. */ 2627d9945d78SBjoern A. Zeeb if (chan == NULL) 2628d9945d78SBjoern A. Zeeb continue; 2629d9945d78SBjoern A. Zeeb 2630d9945d78SBjoern A. Zeeb pb = p; 26313dd98026SBjoern A. Zeeb rs = ieee80211_get_suprates(ic, chan); /* calls chan2mode */ 2632d9945d78SBjoern A. Zeeb p = ieee80211_add_rates(p, rs); 2633d9945d78SBjoern A. Zeeb p = ieee80211_add_xrates(p, rs); 2634d9945d78SBjoern A. Zeeb 26353dd98026SBjoern A. Zeeb #if defined(LKPI_80211_HT) 26363dd98026SBjoern A. Zeeb if ((vap->iv_flags_ht & IEEE80211_FHT_HT) != 0) { 26373dd98026SBjoern A. Zeeb struct ieee80211_channel *c; 26383dd98026SBjoern A. Zeeb 26393dd98026SBjoern A. Zeeb c = ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 26403dd98026SBjoern A. Zeeb vap->iv_flags_ht); 26413dd98026SBjoern A. Zeeb p = ieee80211_add_htcap_ch(p, vap, c); 26423dd98026SBjoern A. Zeeb } 26433dd98026SBjoern A. Zeeb #endif 26443dd98026SBjoern A. Zeeb #if defined(LKPI_80211_VHT) 26453dd98026SBjoern A. Zeeb if ((vap->iv_vht_flags & IEEE80211_FVHT_VHT) != 0) { 26463dd98026SBjoern A. Zeeb struct ieee80211_channel *c; 26473dd98026SBjoern A. Zeeb 26483dd98026SBjoern A. Zeeb c = ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 26493dd98026SBjoern A. Zeeb vap->iv_flags_ht); 26503dd98026SBjoern A. Zeeb c = ieee80211_vht_adjust_channel(ic, c, 26513dd98026SBjoern A. Zeeb vap->iv_vht_flags); 26523dd98026SBjoern A. Zeeb p = ieee80211_add_vhtcap_ch(p, vap, c); 26533dd98026SBjoern A. Zeeb } 26543dd98026SBjoern A. Zeeb #endif 26553dd98026SBjoern A. Zeeb 2656d9945d78SBjoern A. Zeeb scan_ies->ies[band] = pb; 2657d9945d78SBjoern A. Zeeb scan_ies->len[band] = p - pb; 2658d9945d78SBjoern A. Zeeb } 2659d9945d78SBjoern A. Zeeb 2660d9945d78SBjoern A. Zeeb /* Add common_ies */ 2661d9945d78SBjoern A. Zeeb pb = p; 2662d9945d78SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WPA1) != 0 && 2663d9945d78SBjoern A. Zeeb vap->iv_wpa_ie != NULL) { 2664d9945d78SBjoern A. Zeeb memcpy(p, vap->iv_wpa_ie, 2 + vap->iv_wpa_ie[1]); 2665d9945d78SBjoern A. Zeeb p += 2 + vap->iv_wpa_ie[1]; 2666d9945d78SBjoern A. Zeeb } 2667d9945d78SBjoern A. Zeeb if (vap->iv_appie_probereq != NULL) { 2668d9945d78SBjoern A. Zeeb memcpy(p, vap->iv_appie_probereq->ie_data, 2669d9945d78SBjoern A. Zeeb vap->iv_appie_probereq->ie_len); 2670d9945d78SBjoern A. Zeeb p += vap->iv_appie_probereq->ie_len; 2671d9945d78SBjoern A. Zeeb } 2672d9945d78SBjoern A. Zeeb scan_ies->common_ies = pb; 2673d9945d78SBjoern A. Zeeb scan_ies->common_ie_len = p - pb; 2674d9945d78SBjoern A. Zeeb 2675d9945d78SBjoern A. Zeeb return (p); 26766b4cac81SBjoern A. Zeeb } 26776b4cac81SBjoern A. Zeeb 26786b4cac81SBjoern A. Zeeb static void 26796b4cac81SBjoern A. Zeeb lkpi_ic_scan_start(struct ieee80211com *ic) 26806b4cac81SBjoern A. Zeeb { 26816b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 26826b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 26836b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 26846b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 26856b4cac81SBjoern A. Zeeb struct ieee80211_scan_state *ss; 26866b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 26876b4cac81SBjoern A. Zeeb int error; 26888ac540d3SBjoern A. Zeeb bool is_hw_scan; 26896b4cac81SBjoern A. Zeeb 26906b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 26918ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2692a486fbbdSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0) { 26936b4cac81SBjoern A. Zeeb /* A scan is still running. */ 26948ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 26956b4cac81SBjoern A. Zeeb return; 26966b4cac81SBjoern A. Zeeb } 26978ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 26988ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 26996b4cac81SBjoern A. Zeeb 27006b4cac81SBjoern A. Zeeb ss = ic->ic_scan; 27016b4cac81SBjoern A. Zeeb vap = ss->ss_vap; 27026b4cac81SBjoern A. Zeeb if (vap->iv_state != IEEE80211_S_SCAN) { 2703d3ef7fb4SBjoern A. Zeeb IMPROVE("We need to be able to scan if not in S_SCAN"); 27046b4cac81SBjoern A. Zeeb return; 27056b4cac81SBjoern A. Zeeb } 27066b4cac81SBjoern A. Zeeb 27076b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 27088ac540d3SBjoern A. Zeeb if (!is_hw_scan) { 2709a486fbbdSBjoern A. Zeeb /* If hw_scan is cleared clear FEXT_SCAN_OFFLOAD too. */ 2710a486fbbdSBjoern A. Zeeb vap->iv_flags_ext &= ~IEEE80211_FEXT_SCAN_OFFLOAD; 2711d3ef7fb4SBjoern A. Zeeb sw_scan: 27126b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 27136b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 2714086be6a8SBjoern A. Zeeb 2715086be6a8SBjoern A. Zeeb if (vap->iv_state == IEEE80211_S_SCAN) 2716086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, false); 2717086be6a8SBjoern A. Zeeb 27186b4cac81SBjoern A. Zeeb lkpi_80211_mo_sw_scan_start(hw, vif, vif->addr); 27196b4cac81SBjoern A. Zeeb /* net80211::scan_start() handled PS for us. */ 27206b4cac81SBjoern A. Zeeb IMPROVE(); 27216b4cac81SBjoern A. Zeeb /* XXX Also means it is too late to flush queues? 27226b4cac81SBjoern A. Zeeb * need to check iv_sta_ps or overload? */ 27236b4cac81SBjoern A. Zeeb /* XXX want to adjust ss end time/ maxdwell? */ 27246b4cac81SBjoern A. Zeeb 27256b4cac81SBjoern A. Zeeb } else { 27266b4cac81SBjoern A. Zeeb struct ieee80211_channel *c; 27276b4cac81SBjoern A. Zeeb struct ieee80211_scan_request *hw_req; 27286b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *lc, **cpp; 27296b4cac81SBjoern A. Zeeb struct cfg80211_ssid *ssids; 27306b4cac81SBjoern A. Zeeb struct cfg80211_scan_6ghz_params *s6gp; 27316b4cac81SBjoern A. Zeeb size_t chan_len, nchan, ssids_len, s6ghzlen; 2732d9945d78SBjoern A. Zeeb int band, i, ssid_count, common_ie_len; 2733d9945d78SBjoern A. Zeeb uint32_t band_mask; 2734d9945d78SBjoern A. Zeeb uint8_t *ie, *ieend; 27353206587aSBjoern A. Zeeb bool running; 2736d9945d78SBjoern A. Zeeb 2737d9945d78SBjoern A. Zeeb ssid_count = min(ss->ss_nssid, hw->wiphy->max_scan_ssids); 2738d9945d78SBjoern A. Zeeb ssids_len = ssid_count * sizeof(*ssids); 27396b4cac81SBjoern A. Zeeb s6ghzlen = 0 * (sizeof(*s6gp)); /* XXX-BZ */ 27406b4cac81SBjoern A. Zeeb 2741d9945d78SBjoern A. Zeeb band_mask = 0; 27426b4cac81SBjoern A. Zeeb nchan = 0; 2743d9945d78SBjoern A. Zeeb for (i = ss->ss_next; i < ss->ss_last; i++) { 27446b4cac81SBjoern A. Zeeb nchan++; 2745d9945d78SBjoern A. Zeeb band = lkpi_net80211_chan_to_nl80211_band( 2746d9945d78SBjoern A. Zeeb ss->ss_chans[ss->ss_next + i]); 2747d9945d78SBjoern A. Zeeb band_mask |= (1 << band); 2748d9945d78SBjoern A. Zeeb } 27493206587aSBjoern A. Zeeb 27503206587aSBjoern A. Zeeb if (!ieee80211_hw_check(hw, SINGLE_SCAN_ON_ALL_BANDS)) { 27513206587aSBjoern A. Zeeb IMPROVE("individual band scans not yet supported, only scanning first band"); 27523206587aSBjoern A. Zeeb /* In theory net80211 should drive this. */ 27533206587aSBjoern A. Zeeb /* Probably we need to add local logic for now; 27543206587aSBjoern A. Zeeb * need to deal with scan_complete 27553206587aSBjoern A. Zeeb * and cancel_scan and keep local state. 27563206587aSBjoern A. Zeeb * Also cut the nchan down above. 27573206587aSBjoern A. Zeeb */ 27583206587aSBjoern A. Zeeb /* XXX-BZ ath10k does not set this but still does it? &$%^ */ 27593206587aSBjoern A. Zeeb } 27603206587aSBjoern A. Zeeb 27616b4cac81SBjoern A. Zeeb chan_len = nchan * (sizeof(lc) + sizeof(*lc)); 27626b4cac81SBjoern A. Zeeb 2763d9945d78SBjoern A. Zeeb common_ie_len = 0; 2764d9945d78SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WPA1) != 0 && 2765d9945d78SBjoern A. Zeeb vap->iv_wpa_ie != NULL) 2766d9945d78SBjoern A. Zeeb common_ie_len += vap->iv_wpa_ie[1]; 2767d9945d78SBjoern A. Zeeb if (vap->iv_appie_probereq != NULL) 2768d9945d78SBjoern A. Zeeb common_ie_len += vap->iv_appie_probereq->ie_len; 2769d9945d78SBjoern A. Zeeb 2770d9945d78SBjoern A. Zeeb /* We would love to check this at an earlier stage... */ 2771d9945d78SBjoern A. Zeeb if (common_ie_len > hw->wiphy->max_scan_ie_len) { 2772d9945d78SBjoern A. Zeeb ic_printf(ic, "WARNING: %s: common_ie_len %d > " 2773d9945d78SBjoern A. Zeeb "wiphy->max_scan_ie_len %d\n", __func__, 2774d9945d78SBjoern A. Zeeb common_ie_len, hw->wiphy->max_scan_ie_len); 2775d9945d78SBjoern A. Zeeb } 2776d9945d78SBjoern A. Zeeb 27773206587aSBjoern A. Zeeb hw_req = malloc(sizeof(*hw_req) + ssids_len + 2778d9945d78SBjoern A. Zeeb s6ghzlen + chan_len + lhw->supbands * lhw->scan_ie_len + 2779d9945d78SBjoern A. Zeeb common_ie_len, M_LKPI80211, M_WAITOK | M_ZERO); 27806b4cac81SBjoern A. Zeeb 27816b4cac81SBjoern A. Zeeb hw_req->req.flags = 0; /* XXX ??? */ 27826b4cac81SBjoern A. Zeeb /* hw_req->req.wdev */ 27836b4cac81SBjoern A. Zeeb hw_req->req.wiphy = hw->wiphy; 27846b4cac81SBjoern A. Zeeb hw_req->req.no_cck = false; /* XXX */ 27856b4cac81SBjoern A. Zeeb #if 0 27866b4cac81SBjoern A. Zeeb /* This seems to pessimise default scanning behaviour. */ 27876b4cac81SBjoern A. Zeeb hw_req->req.duration_mandatory = TICKS_2_USEC(ss->ss_mindwell); 27886b4cac81SBjoern A. Zeeb hw_req->req.duration = TICKS_2_USEC(ss->ss_maxdwell); 27896b4cac81SBjoern A. Zeeb #endif 27906b4cac81SBjoern A. Zeeb #ifdef __notyet__ 27916b4cac81SBjoern A. Zeeb hw_req->req.flags |= NL80211_SCAN_FLAG_RANDOM_ADDR; 27926b4cac81SBjoern A. Zeeb memcpy(hw_req->req.mac_addr, xxx, IEEE80211_ADDR_LEN); 27936b4cac81SBjoern A. Zeeb memset(hw_req->req.mac_addr_mask, 0xxx, IEEE80211_ADDR_LEN); 27946b4cac81SBjoern A. Zeeb #endif 2795e1e90be0SBjoern A. Zeeb eth_broadcast_addr(hw_req->req.bssid); 27966b4cac81SBjoern A. Zeeb 27976b4cac81SBjoern A. Zeeb hw_req->req.n_channels = nchan; 27986b4cac81SBjoern A. Zeeb cpp = (struct linuxkpi_ieee80211_channel **)(hw_req + 1); 27996b4cac81SBjoern A. Zeeb lc = (struct linuxkpi_ieee80211_channel *)(cpp + nchan); 28006b4cac81SBjoern A. Zeeb for (i = 0; i < nchan; i++) { 28016b4cac81SBjoern A. Zeeb *(cpp + i) = 28026b4cac81SBjoern A. Zeeb (struct linuxkpi_ieee80211_channel *)(lc + i); 28036b4cac81SBjoern A. Zeeb } 28046b4cac81SBjoern A. Zeeb for (i = 0; i < nchan; i++) { 28056b4cac81SBjoern A. Zeeb c = ss->ss_chans[ss->ss_next + i]; 28066b4cac81SBjoern A. Zeeb 28076b4cac81SBjoern A. Zeeb lc->hw_value = c->ic_ieee; 28083206587aSBjoern A. Zeeb lc->center_freq = c->ic_freq; /* XXX */ 28096b4cac81SBjoern A. Zeeb /* lc->flags */ 28106b4cac81SBjoern A. Zeeb lc->band = lkpi_net80211_chan_to_nl80211_band(c); 28116b4cac81SBjoern A. Zeeb lc->max_power = c->ic_maxpower; 28126b4cac81SBjoern A. Zeeb /* lc-> ... */ 28136b4cac81SBjoern A. Zeeb lc++; 28146b4cac81SBjoern A. Zeeb } 28156b4cac81SBjoern A. Zeeb 2816d9945d78SBjoern A. Zeeb hw_req->req.n_ssids = ssid_count; 28176b4cac81SBjoern A. Zeeb if (hw_req->req.n_ssids > 0) { 28186b4cac81SBjoern A. Zeeb ssids = (struct cfg80211_ssid *)lc; 28196b4cac81SBjoern A. Zeeb hw_req->req.ssids = ssids; 2820d9945d78SBjoern A. Zeeb for (i = 0; i < ssid_count; i++) { 28216b4cac81SBjoern A. Zeeb ssids->ssid_len = ss->ss_ssid[i].len; 28226b4cac81SBjoern A. Zeeb memcpy(ssids->ssid, ss->ss_ssid[i].ssid, 28236b4cac81SBjoern A. Zeeb ss->ss_ssid[i].len); 28246b4cac81SBjoern A. Zeeb ssids++; 28256b4cac81SBjoern A. Zeeb } 28266b4cac81SBjoern A. Zeeb s6gp = (struct cfg80211_scan_6ghz_params *)ssids; 28276b4cac81SBjoern A. Zeeb } else { 28286b4cac81SBjoern A. Zeeb s6gp = (struct cfg80211_scan_6ghz_params *)lc; 28296b4cac81SBjoern A. Zeeb } 28306b4cac81SBjoern A. Zeeb 28316b4cac81SBjoern A. Zeeb /* 6GHz one day. */ 28326b4cac81SBjoern A. Zeeb hw_req->req.n_6ghz_params = 0; 28336b4cac81SBjoern A. Zeeb hw_req->req.scan_6ghz_params = NULL; 28346b4cac81SBjoern A. Zeeb hw_req->req.scan_6ghz = false; /* Weird boolean; not what you think. */ 28356b4cac81SBjoern A. Zeeb /* s6gp->... */ 28366b4cac81SBjoern A. Zeeb 2837d9945d78SBjoern A. Zeeb ie = ieend = (uint8_t *)s6gp; 2838d9945d78SBjoern A. Zeeb /* Copy per-band IEs, copy common IEs */ 2839d9945d78SBjoern A. Zeeb ieend = lkpi_scan_ies_add(ie, &hw_req->ies, band_mask, vap, hw); 2840d9945d78SBjoern A. Zeeb hw_req->req.ie = ie; 2841d9945d78SBjoern A. Zeeb hw_req->req.ie_len = ieend - ie; 2842d9945d78SBjoern A. Zeeb 28436b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 28446b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 28453206587aSBjoern A. Zeeb 28463206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 28473206587aSBjoern A. Zeeb /* Re-check under lock. */ 28483206587aSBjoern A. Zeeb running = (lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0; 28493206587aSBjoern A. Zeeb if (!running) { 28503206587aSBjoern A. Zeeb KASSERT(lhw->hw_req == NULL, ("%s: ic %p lhw %p hw_req %p " 28513206587aSBjoern A. Zeeb "!= NULL\n", __func__, ic, lhw, lhw->hw_req)); 28523206587aSBjoern A. Zeeb 28533206587aSBjoern A. Zeeb lhw->scan_flags |= LKPI_LHW_SCAN_RUNNING; 28543206587aSBjoern A. Zeeb lhw->hw_req = hw_req; 28553206587aSBjoern A. Zeeb } 28563206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 28573206587aSBjoern A. Zeeb if (running) { 28583206587aSBjoern A. Zeeb free(hw_req, M_LKPI80211); 28593206587aSBjoern A. Zeeb return; 28603206587aSBjoern A. Zeeb } 28613206587aSBjoern A. Zeeb 28626b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_hw_scan(hw, vif, hw_req); 28636b4cac81SBjoern A. Zeeb if (error != 0) { 2864d9945d78SBjoern A. Zeeb ieee80211_cancel_scan(vap); 2865d9945d78SBjoern A. Zeeb 28663206587aSBjoern A. Zeeb /* 28673206587aSBjoern A. Zeeb * ieee80211_scan_completed must be called in either 28683206587aSBjoern A. Zeeb * case of error or none. So let the free happen there 28693206587aSBjoern A. Zeeb * and only there. 28703206587aSBjoern A. Zeeb * That would be fine in theory but in practice drivers 28713206587aSBjoern A. Zeeb * behave differently: 28723206587aSBjoern A. Zeeb * ath10k does not return hw_scan until after scan_complete 28733206587aSBjoern A. Zeeb * and can then still return an error. 28743206587aSBjoern A. Zeeb * rtw88 can return 1 or -EBUSY without scan_complete 28753206587aSBjoern A. Zeeb * iwlwifi can return various errors before scan starts 28763206587aSBjoern A. Zeeb * ... 28773206587aSBjoern A. Zeeb * So we cannot rely on that behaviour and have to check 28783206587aSBjoern A. Zeeb * and balance between both code paths. 28793206587aSBjoern A. Zeeb */ 28803206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 28813206587aSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0) { 28823206587aSBjoern A. Zeeb free(lhw->hw_req, M_LKPI80211); 28836b4cac81SBjoern A. Zeeb lhw->hw_req = NULL; 28843206587aSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_RUNNING; 28853206587aSBjoern A. Zeeb } 28863206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 2887d3ef7fb4SBjoern A. Zeeb 2888d3ef7fb4SBjoern A. Zeeb /* 2889d3ef7fb4SBjoern A. Zeeb * XXX-SIGH magic number. 2890d3ef7fb4SBjoern A. Zeeb * rtw88 has a magic "return 1" if offloading scan is 2891d3ef7fb4SBjoern A. Zeeb * not possible. Fall back to sw scan in that case. 2892d3ef7fb4SBjoern A. Zeeb */ 2893196cfd0bSBjoern A. Zeeb if (error == 1) { 28948ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2895a486fbbdSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_HW; 28968ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 28973206587aSBjoern A. Zeeb /* 28983206587aSBjoern A. Zeeb * XXX If we clear this now and later a driver 28993206587aSBjoern A. Zeeb * thinks it * can do a hw_scan again, we will 29003206587aSBjoern A. Zeeb * currently not re-enable it? 29013206587aSBjoern A. Zeeb */ 29023206587aSBjoern A. Zeeb vap->iv_flags_ext &= ~IEEE80211_FEXT_SCAN_OFFLOAD; 2903196cfd0bSBjoern A. Zeeb ieee80211_start_scan(vap, 2904196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_ACTIVE | 2905196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_NOPICK | 2906196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_ONCE, 2907196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_FOREVER, 2908196cfd0bSBjoern A. Zeeb ss->ss_mindwell ? ss->ss_mindwell : msecs_to_ticks(20), 2909196cfd0bSBjoern A. Zeeb ss->ss_maxdwell ? ss->ss_maxdwell : msecs_to_ticks(200), 2910196cfd0bSBjoern A. Zeeb vap->iv_des_nssid, vap->iv_des_ssid); 2911d3ef7fb4SBjoern A. Zeeb goto sw_scan; 2912196cfd0bSBjoern A. Zeeb } 2913d3ef7fb4SBjoern A. Zeeb 2914d3ef7fb4SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: hw_scan returned %d\n", 2915d3ef7fb4SBjoern A. Zeeb __func__, error); 29166b4cac81SBjoern A. Zeeb } 29176b4cac81SBjoern A. Zeeb } 29186b4cac81SBjoern A. Zeeb } 29196b4cac81SBjoern A. Zeeb 29206b4cac81SBjoern A. Zeeb static void 29216b4cac81SBjoern A. Zeeb lkpi_ic_scan_end(struct ieee80211com *ic) 29226b4cac81SBjoern A. Zeeb { 29236b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 29248ac540d3SBjoern A. Zeeb bool is_hw_scan; 29256b4cac81SBjoern A. Zeeb 29266b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 29278ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2928a486fbbdSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) == 0) { 29298ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29306b4cac81SBjoern A. Zeeb return; 29316b4cac81SBjoern A. Zeeb } 29328ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29338ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29346b4cac81SBjoern A. Zeeb 29358ac540d3SBjoern A. Zeeb if (!is_hw_scan) { 2936a486fbbdSBjoern A. Zeeb struct ieee80211_scan_state *ss; 2937a486fbbdSBjoern A. Zeeb struct ieee80211vap *vap; 29386b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 29396b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 29406b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 29416b4cac81SBjoern A. Zeeb 2942a486fbbdSBjoern A. Zeeb ss = ic->ic_scan; 2943a486fbbdSBjoern A. Zeeb vap = ss->ss_vap; 29446b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 29456b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 29466b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 2947a486fbbdSBjoern A. Zeeb 29486b4cac81SBjoern A. Zeeb lkpi_80211_mo_sw_scan_complete(hw, vif); 29496b4cac81SBjoern A. Zeeb 29506b4cac81SBjoern A. Zeeb /* Send PS to stop buffering if n80211 does not for us? */ 2951086be6a8SBjoern A. Zeeb 2952086be6a8SBjoern A. Zeeb if (vap->iv_state == IEEE80211_S_SCAN) 2953086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, true); 29546b4cac81SBjoern A. Zeeb } 29556b4cac81SBjoern A. Zeeb } 29566b4cac81SBjoern A. Zeeb 29576b4cac81SBjoern A. Zeeb static void 2958a486fbbdSBjoern A. Zeeb lkpi_ic_scan_curchan(struct ieee80211_scan_state *ss, 2959a486fbbdSBjoern A. Zeeb unsigned long maxdwell) 2960a486fbbdSBjoern A. Zeeb { 2961a486fbbdSBjoern A. Zeeb struct lkpi_hw *lhw; 29628ac540d3SBjoern A. Zeeb bool is_hw_scan; 2963a486fbbdSBjoern A. Zeeb 2964a486fbbdSBjoern A. Zeeb lhw = ss->ss_ic->ic_softc; 29658ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 29668ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29678ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29688ac540d3SBjoern A. Zeeb if (!is_hw_scan) 2969a486fbbdSBjoern A. Zeeb lhw->ic_scan_curchan(ss, maxdwell); 2970a486fbbdSBjoern A. Zeeb } 2971a486fbbdSBjoern A. Zeeb 2972a486fbbdSBjoern A. Zeeb static void 2973a486fbbdSBjoern A. Zeeb lkpi_ic_scan_mindwell(struct ieee80211_scan_state *ss) 2974a486fbbdSBjoern A. Zeeb { 2975a486fbbdSBjoern A. Zeeb struct lkpi_hw *lhw; 29768ac540d3SBjoern A. Zeeb bool is_hw_scan; 2977a486fbbdSBjoern A. Zeeb 2978a486fbbdSBjoern A. Zeeb lhw = ss->ss_ic->ic_softc; 29798ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 29808ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29818ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29828ac540d3SBjoern A. Zeeb if (!is_hw_scan) 2983a486fbbdSBjoern A. Zeeb lhw->ic_scan_mindwell(ss); 2984a486fbbdSBjoern A. Zeeb } 2985a486fbbdSBjoern A. Zeeb 2986a486fbbdSBjoern A. Zeeb static void 29876b4cac81SBjoern A. Zeeb lkpi_ic_set_channel(struct ieee80211com *ic) 29886b4cac81SBjoern A. Zeeb { 29896b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 29906b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 2991b2cf3c21SBjoern A. Zeeb struct ieee80211_channel *c; 2992b2cf3c21SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 29936b4cac81SBjoern A. Zeeb int error; 29948ac540d3SBjoern A. Zeeb bool hw_scan_running; 29956b4cac81SBjoern A. Zeeb 29966b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 2997b2cf3c21SBjoern A. Zeeb 2998b2cf3c21SBjoern A. Zeeb /* If we do not support (*config)() save us the work. */ 2999b2cf3c21SBjoern A. Zeeb if (lhw->ops->config == NULL) 30006b4cac81SBjoern A. Zeeb return; 30016b4cac81SBjoern A. Zeeb 3002a486fbbdSBjoern A. Zeeb /* If we have a hw_scan running do not switch channels. */ 30038ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 30048ac540d3SBjoern A. Zeeb hw_scan_running = 30058ac540d3SBjoern A. Zeeb (lhw->scan_flags & (LKPI_LHW_SCAN_RUNNING|LKPI_LHW_SCAN_HW)) == 30068ac540d3SBjoern A. Zeeb (LKPI_LHW_SCAN_RUNNING|LKPI_LHW_SCAN_HW); 30078ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 30088ac540d3SBjoern A. Zeeb if (hw_scan_running) 3009a486fbbdSBjoern A. Zeeb return; 3010a486fbbdSBjoern A. Zeeb 3011b2cf3c21SBjoern A. Zeeb c = ic->ic_curchan; 3012b2cf3c21SBjoern A. Zeeb if (c == NULL || c == IEEE80211_CHAN_ANYC) { 30136b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: c %p ops->config %p\n", __func__, 30146b4cac81SBjoern A. Zeeb c, lhw->ops->config); 30156b4cac81SBjoern A. Zeeb return; 30166b4cac81SBjoern A. Zeeb } 30176b4cac81SBjoern A. Zeeb 30186b4cac81SBjoern A. Zeeb chan = lkpi_find_lkpi80211_chan(lhw, c); 30196b4cac81SBjoern A. Zeeb if (chan == NULL) { 30206b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: c %p chan %p\n", __func__, 30216b4cac81SBjoern A. Zeeb c, chan); 30226b4cac81SBjoern A. Zeeb return; 30236b4cac81SBjoern A. Zeeb } 30246b4cac81SBjoern A. Zeeb 30256b4cac81SBjoern A. Zeeb /* XXX max power for scanning? */ 30266b4cac81SBjoern A. Zeeb IMPROVE(); 30276b4cac81SBjoern A. Zeeb 30286b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 30294a07abdeSBjoern A. Zeeb cfg80211_chandef_create(&hw->conf.chandef, chan, 30304a07abdeSBjoern A. Zeeb NL80211_CHAN_NO_HT); 30316b4cac81SBjoern A. Zeeb 30326b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_config(hw, IEEE80211_CONF_CHANGE_CHANNEL); 30336b4cac81SBjoern A. Zeeb if (error != 0 && error != EOPNOTSUPP) { 30346b4cac81SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: config %#0x returned %d\n", 30356b4cac81SBjoern A. Zeeb __func__, IEEE80211_CONF_CHANGE_CHANNEL, error); 30366b4cac81SBjoern A. Zeeb /* XXX should we unroll to the previous chandef? */ 30376b4cac81SBjoern A. Zeeb IMPROVE(); 30386b4cac81SBjoern A. Zeeb } else { 30396b4cac81SBjoern A. Zeeb /* Update radiotap channels as well. */ 30406b4cac81SBjoern A. Zeeb lhw->rtap_tx.wt_chan_freq = htole16(c->ic_freq); 30416b4cac81SBjoern A. Zeeb lhw->rtap_tx.wt_chan_flags = htole16(c->ic_flags); 30426b4cac81SBjoern A. Zeeb lhw->rtap_rx.wr_chan_freq = htole16(c->ic_freq); 30436b4cac81SBjoern A. Zeeb lhw->rtap_rx.wr_chan_flags = htole16(c->ic_flags); 30446b4cac81SBjoern A. Zeeb } 30456b4cac81SBjoern A. Zeeb 30466b4cac81SBjoern A. Zeeb /* Currently PS is hard coded off! Not sure it belongs here. */ 30476b4cac81SBjoern A. Zeeb IMPROVE(); 30486b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, SUPPORTS_PS) && 30496b4cac81SBjoern A. Zeeb (hw->conf.flags & IEEE80211_CONF_PS) != 0) { 30506b4cac81SBjoern A. Zeeb hw->conf.flags &= ~IEEE80211_CONF_PS; 30516b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_config(hw, IEEE80211_CONF_CHANGE_PS); 30526b4cac81SBjoern A. Zeeb if (error != 0 && error != EOPNOTSUPP) 30536b4cac81SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: config %#0x returned " 30546b4cac81SBjoern A. Zeeb "%d\n", __func__, IEEE80211_CONF_CHANGE_PS, 30556b4cac81SBjoern A. Zeeb error); 30566b4cac81SBjoern A. Zeeb } 30576b4cac81SBjoern A. Zeeb } 30586b4cac81SBjoern A. Zeeb 30596b4cac81SBjoern A. Zeeb static struct ieee80211_node * 30606b4cac81SBjoern A. Zeeb lkpi_ic_node_alloc(struct ieee80211vap *vap, 30616b4cac81SBjoern A. Zeeb const uint8_t mac[IEEE80211_ADDR_LEN]) 30626b4cac81SBjoern A. Zeeb { 30636b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 30646b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 30654f61ef8bSBjoern A. Zeeb struct ieee80211_node *ni; 30666b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 30676b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 30686b4cac81SBjoern A. Zeeb 30696b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 30706b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 30716b4cac81SBjoern A. Zeeb 30726b4cac81SBjoern A. Zeeb /* We keep allocations de-coupled so we can deal with the two worlds. */ 30734f61ef8bSBjoern A. Zeeb if (lhw->ic_node_alloc == NULL) 30744f61ef8bSBjoern A. Zeeb return (NULL); 30754f61ef8bSBjoern A. Zeeb 30766b4cac81SBjoern A. Zeeb ni = lhw->ic_node_alloc(vap, mac); 30776b4cac81SBjoern A. Zeeb if (ni == NULL) 30786b4cac81SBjoern A. Zeeb return (NULL); 30796b4cac81SBjoern A. Zeeb 30806b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 30814f61ef8bSBjoern A. Zeeb lsta = lkpi_lsta_alloc(vap, mac, hw, ni); 30826b4cac81SBjoern A. Zeeb if (lsta == NULL) { 30836b4cac81SBjoern A. Zeeb if (lhw->ic_node_free != NULL) 30846b4cac81SBjoern A. Zeeb lhw->ic_node_free(ni); 30856b4cac81SBjoern A. Zeeb return (NULL); 30866b4cac81SBjoern A. Zeeb } 30876b4cac81SBjoern A. Zeeb 30886b4cac81SBjoern A. Zeeb return (ni); 30896b4cac81SBjoern A. Zeeb } 30906b4cac81SBjoern A. Zeeb 30916b4cac81SBjoern A. Zeeb static int 30926b4cac81SBjoern A. Zeeb lkpi_ic_node_init(struct ieee80211_node *ni) 30936b4cac81SBjoern A. Zeeb { 30946b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 30956b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 30966b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 30976b4cac81SBjoern A. Zeeb int error; 30986b4cac81SBjoern A. Zeeb 30996b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 31006b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 31016b4cac81SBjoern A. Zeeb 31026b4cac81SBjoern A. Zeeb if (lhw->ic_node_init != NULL) { 31036b4cac81SBjoern A. Zeeb error = lhw->ic_node_init(ni); 31046b4cac81SBjoern A. Zeeb if (error != 0) 31056b4cac81SBjoern A. Zeeb return (error); 31066b4cac81SBjoern A. Zeeb } 31076b4cac81SBjoern A. Zeeb 31086b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 31096b4cac81SBjoern A. Zeeb 31106b4cac81SBjoern A. Zeeb /* Now take the reference before linking it to the table. */ 31116b4cac81SBjoern A. Zeeb lsta->ni = ieee80211_ref_node(ni); 31126b4cac81SBjoern A. Zeeb 31136b4cac81SBjoern A. Zeeb /* XXX-BZ Sync other state over. */ 31146b4cac81SBjoern A. Zeeb IMPROVE(); 31156b4cac81SBjoern A. Zeeb 31166b4cac81SBjoern A. Zeeb return (0); 31176b4cac81SBjoern A. Zeeb } 31186b4cac81SBjoern A. Zeeb 31196b4cac81SBjoern A. Zeeb static void 31206b4cac81SBjoern A. Zeeb lkpi_ic_node_cleanup(struct ieee80211_node *ni) 31216b4cac81SBjoern A. Zeeb { 31226b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 31236b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 31246b4cac81SBjoern A. Zeeb 31256b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 31266b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 31276b4cac81SBjoern A. Zeeb 31286b4cac81SBjoern A. Zeeb /* XXX-BZ remove from driver, ... */ 31296b4cac81SBjoern A. Zeeb IMPROVE(); 31306b4cac81SBjoern A. Zeeb 31316b4cac81SBjoern A. Zeeb if (lhw->ic_node_cleanup != NULL) 31326b4cac81SBjoern A. Zeeb lhw->ic_node_cleanup(ni); 31336b4cac81SBjoern A. Zeeb } 31346b4cac81SBjoern A. Zeeb 31356b4cac81SBjoern A. Zeeb static void 31366b4cac81SBjoern A. Zeeb lkpi_ic_node_free(struct ieee80211_node *ni) 31376b4cac81SBjoern A. Zeeb { 31386b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 31396b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 31406b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 31416b4cac81SBjoern A. Zeeb 31426b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 31436b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 31446b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 3145d9f59799SBjoern A. Zeeb if (lsta == NULL) 3146d9f59799SBjoern A. Zeeb goto out; 31476b4cac81SBjoern A. Zeeb 31486b4cac81SBjoern A. Zeeb /* XXX-BZ free resources, ... */ 31496b4cac81SBjoern A. Zeeb IMPROVE(); 31506b4cac81SBjoern A. Zeeb 31516b4cac81SBjoern A. Zeeb /* Flush mbufq (make sure to release ni refs!). */ 31526b4cac81SBjoern A. Zeeb #ifdef __notyet__ 31536b4cac81SBjoern A. Zeeb KASSERT(mbufq_len(&lsta->txq) == 0, ("%s: lsta %p has txq len %d != 0\n", 31546b4cac81SBjoern A. Zeeb __func__, lsta, mbufq_len(&lsta->txq))); 31556b4cac81SBjoern A. Zeeb #endif 31566b4cac81SBjoern A. Zeeb /* Drain taskq. */ 31576b4cac81SBjoern A. Zeeb 31586b4cac81SBjoern A. Zeeb /* Drain sta->txq[] */ 31596b4cac81SBjoern A. Zeeb mtx_destroy(&lsta->txq_mtx); 31606b4cac81SBjoern A. Zeeb 31616b4cac81SBjoern A. Zeeb /* Remove lsta if added_to_drv. */ 3162e24e8103SBjoern A. Zeeb 31636b4cac81SBjoern A. Zeeb /* Remove lsta from vif */ 3164e24e8103SBjoern A. Zeeb /* Remove ref from lsta node... */ 3165d9f59799SBjoern A. Zeeb /* Free lsta. */ 3166e24e8103SBjoern A. Zeeb lkpi_lsta_remove(lsta, VAP_TO_LVIF(ni->ni_vap)); 3167d9f59799SBjoern A. Zeeb 3168d9f59799SBjoern A. Zeeb out: 31696b4cac81SBjoern A. Zeeb if (lhw->ic_node_free != NULL) 31706b4cac81SBjoern A. Zeeb lhw->ic_node_free(ni); 31716b4cac81SBjoern A. Zeeb } 31726b4cac81SBjoern A. Zeeb 31736b4cac81SBjoern A. Zeeb static int 31746b4cac81SBjoern A. Zeeb lkpi_ic_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 31756b4cac81SBjoern A. Zeeb const struct ieee80211_bpf_params *params __unused) 31766b4cac81SBjoern A. Zeeb { 31776b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 31786b4cac81SBjoern A. Zeeb 31796b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 31806b4cac81SBjoern A. Zeeb 31816b4cac81SBjoern A. Zeeb /* Queue the packet and enqueue the task to handle it. */ 31826b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_LOCK(lsta); 31836b4cac81SBjoern A. Zeeb mbufq_enqueue(&lsta->txq, m); 31846b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_UNLOCK(lsta); 31856b4cac81SBjoern A. Zeeb 31869d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 31879d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 31886b4cac81SBjoern A. Zeeb printf("%s:%d lsta %p ni %p %6D mbuf_qlen %d\n", 31896b4cac81SBjoern A. Zeeb __func__, __LINE__, lsta, ni, ni->ni_macaddr, ":", 31906b4cac81SBjoern A. Zeeb mbufq_len(&lsta->txq)); 31919d9ba2b7SBjoern A. Zeeb #endif 31926b4cac81SBjoern A. Zeeb 31936b4cac81SBjoern A. Zeeb taskqueue_enqueue(taskqueue_thread, &lsta->txq_task); 31946b4cac81SBjoern A. Zeeb return (0); 31956b4cac81SBjoern A. Zeeb } 31966b4cac81SBjoern A. Zeeb 31976b4cac81SBjoern A. Zeeb static void 31986b4cac81SBjoern A. Zeeb lkpi_80211_txq_tx_one(struct lkpi_sta *lsta, struct mbuf *m) 31996b4cac81SBjoern A. Zeeb { 32006b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 3201b35f6cd0SBjoern A. Zeeb #ifndef LKPI_80211_HW_CRYPTO 32026b4cac81SBjoern A. Zeeb struct ieee80211_frame *wh; 3203b35f6cd0SBjoern A. Zeeb #endif 32046b4cac81SBjoern A. Zeeb struct ieee80211_key *k; 32056b4cac81SBjoern A. Zeeb struct sk_buff *skb; 32066b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 32076b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 32086b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 32096b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 32106b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 32116b4cac81SBjoern A. Zeeb struct ieee80211_channel *c; 32126b4cac81SBjoern A. Zeeb struct ieee80211_tx_control control; 32136b4cac81SBjoern A. Zeeb struct ieee80211_tx_info *info; 32146b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 3215e3a0b120SBjoern A. Zeeb struct ieee80211_hdr *hdr; 32166b4cac81SBjoern A. Zeeb void *buf; 3217e3a0b120SBjoern A. Zeeb uint8_t ac, tid; 32186b4cac81SBjoern A. Zeeb 32196b4cac81SBjoern A. Zeeb M_ASSERTPKTHDR(m); 32206b4cac81SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 32219d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX_DUMP) 32226b4cac81SBjoern A. Zeeb hexdump(mtod(m, const void *), m->m_len, "RAW TX (plain) ", 0); 32236b4cac81SBjoern A. Zeeb #endif 32246b4cac81SBjoern A. Zeeb 32256b4cac81SBjoern A. Zeeb ni = lsta->ni; 3226b35f6cd0SBjoern A. Zeeb k = NULL; 3227b35f6cd0SBjoern A. Zeeb #ifndef LKPI_80211_HW_CRYPTO 32286b4cac81SBjoern A. Zeeb /* Encrypt the frame if need be; XXX-BZ info->control.hw_key. */ 32296b4cac81SBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame *); 32306b4cac81SBjoern A. Zeeb if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 32316b4cac81SBjoern A. Zeeb /* Retrieve key for TX && do software encryption. */ 32326b4cac81SBjoern A. Zeeb k = ieee80211_crypto_encap(ni, m); 32336b4cac81SBjoern A. Zeeb if (k == NULL) { 32346b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 32356b4cac81SBjoern A. Zeeb m_freem(m); 32366b4cac81SBjoern A. Zeeb return; 32376b4cac81SBjoern A. Zeeb } 32386b4cac81SBjoern A. Zeeb } 32396b4cac81SBjoern A. Zeeb #endif 32406b4cac81SBjoern A. Zeeb 32416b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 32426b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 32436b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 32446b4cac81SBjoern A. Zeeb c = ni->ni_chan; 32456b4cac81SBjoern A. Zeeb 32466b4cac81SBjoern A. Zeeb if (ieee80211_radiotap_active_vap(ni->ni_vap)) { 32476b4cac81SBjoern A. Zeeb struct lkpi_radiotap_tx_hdr *rtap; 32486b4cac81SBjoern A. Zeeb 32496b4cac81SBjoern A. Zeeb rtap = &lhw->rtap_tx; 32506b4cac81SBjoern A. Zeeb rtap->wt_flags = 0; 32516b4cac81SBjoern A. Zeeb if (k != NULL) 32526b4cac81SBjoern A. Zeeb rtap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 32536b4cac81SBjoern A. Zeeb if (m->m_flags & M_FRAG) 32546b4cac81SBjoern A. Zeeb rtap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG; 32556b4cac81SBjoern A. Zeeb IMPROVE(); 32566b4cac81SBjoern A. Zeeb rtap->wt_rate = 0; 32576b4cac81SBjoern A. Zeeb if (c != NULL && c != IEEE80211_CHAN_ANYC) { 32586b4cac81SBjoern A. Zeeb rtap->wt_chan_freq = htole16(c->ic_freq); 32596b4cac81SBjoern A. Zeeb rtap->wt_chan_flags = htole16(c->ic_flags); 32606b4cac81SBjoern A. Zeeb } 32616b4cac81SBjoern A. Zeeb 32626b4cac81SBjoern A. Zeeb ieee80211_radiotap_tx(ni->ni_vap, m); 32636b4cac81SBjoern A. Zeeb } 32646b4cac81SBjoern A. Zeeb 32656b4cac81SBjoern A. Zeeb /* 32666b4cac81SBjoern A. Zeeb * net80211 should handle hw->extra_tx_headroom. 32676b4cac81SBjoern A. Zeeb * Though for as long as we are copying we don't mind. 32683d09d310SBjoern A. Zeeb * XXX-BZ rtw88 asks for too much headroom for ipv6+tcp: 32693d09d310SBjoern A. Zeeb * https://lists.freebsd.org/archives/freebsd-transport/2022-February/000012.html 32706b4cac81SBjoern A. Zeeb */ 32716b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + m->m_pkthdr.len); 32726b4cac81SBjoern A. Zeeb if (skb == NULL) { 32733f0083c4SBjoern A. Zeeb ic_printf(ic, "ERROR %s: skb alloc failed\n", __func__); 32746b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 32756b4cac81SBjoern A. Zeeb m_freem(m); 32766b4cac81SBjoern A. Zeeb return; 32776b4cac81SBjoern A. Zeeb } 32786b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 32796b4cac81SBjoern A. Zeeb 32806b4cac81SBjoern A. Zeeb /* XXX-BZ we need a SKB version understanding mbuf. */ 32816b4cac81SBjoern A. Zeeb /* Save the mbuf for ieee80211_tx_complete(). */ 32826b4cac81SBjoern A. Zeeb skb->m_free_func = lkpi_ieee80211_free_skb_mbuf; 32836b4cac81SBjoern A. Zeeb skb->m = m; 32846b4cac81SBjoern A. Zeeb #if 0 32856b4cac81SBjoern A. Zeeb skb_put_data(skb, m->m_data, m->m_pkthdr.len); 32866b4cac81SBjoern A. Zeeb #else 32876b4cac81SBjoern A. Zeeb buf = skb_put(skb, m->m_pkthdr.len); 32886b4cac81SBjoern A. Zeeb m_copydata(m, 0, m->m_pkthdr.len, buf); 32896b4cac81SBjoern A. Zeeb #endif 32906b4cac81SBjoern A. Zeeb /* Save the ni. */ 32916b4cac81SBjoern A. Zeeb m->m_pkthdr.PH_loc.ptr = ni; 32926b4cac81SBjoern A. Zeeb 32936b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(ni->ni_vap); 32946b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 32956b4cac81SBjoern A. Zeeb 3296e3a0b120SBjoern A. Zeeb hdr = (void *)skb->data; 3297e3a0b120SBjoern A. Zeeb tid = linuxkpi_ieee80211_get_tid(hdr, true); 3298e3a0b120SBjoern A. Zeeb if (tid == IEEE80211_NONQOS_TID) { /* == IEEE80211_NUM_TIDS */ 3299e3a0b120SBjoern A. Zeeb skb->priority = 0; 3300e3a0b120SBjoern A. Zeeb ac = IEEE80211_AC_BE; 3301e3a0b120SBjoern A. Zeeb } else { 3302e3a0b120SBjoern A. Zeeb skb->priority = tid & IEEE80211_QOS_CTL_TID_MASK; 3303fb3c249eSBjoern A. Zeeb ac = ieee80211e_up_to_ac[tid & 7]; 3304e3a0b120SBjoern A. Zeeb } 33056b4cac81SBjoern A. Zeeb skb_set_queue_mapping(skb, ac); 33066b4cac81SBjoern A. Zeeb 33076b4cac81SBjoern A. Zeeb info = IEEE80211_SKB_CB(skb); 33086b4cac81SBjoern A. Zeeb info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS; 33096b4cac81SBjoern A. Zeeb /* Slight delay; probably only happens on scanning so fine? */ 33106b4cac81SBjoern A. Zeeb if (c == NULL || c == IEEE80211_CHAN_ANYC) 33116b4cac81SBjoern A. Zeeb c = ic->ic_curchan; 33126b4cac81SBjoern A. Zeeb info->band = lkpi_net80211_chan_to_nl80211_band(c); 3313e3a0b120SBjoern A. Zeeb info->hw_queue = vif->hw_queue[ac]; 33146b4cac81SBjoern A. Zeeb if (m->m_flags & M_EAPOL) 33156b4cac81SBjoern A. Zeeb info->control.flags |= IEEE80211_TX_CTRL_PORT_CTRL_PROTO; 33166b4cac81SBjoern A. Zeeb info->control.vif = vif; 33176b4cac81SBjoern A. Zeeb /* XXX-BZ info->control.rates */ 33186b4cac81SBjoern A. Zeeb 33196b4cac81SBjoern A. Zeeb lsta = lkpi_find_lsta_by_ni(lvif, ni); 33206b4cac81SBjoern A. Zeeb if (lsta != NULL) { 33216b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 3322b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 33236b4cac81SBjoern A. Zeeb info->control.hw_key = lsta->kc; 33246b4cac81SBjoern A. Zeeb #endif 33256b4cac81SBjoern A. Zeeb } else { 33266b4cac81SBjoern A. Zeeb sta = NULL; 33276b4cac81SBjoern A. Zeeb } 33286b4cac81SBjoern A. Zeeb 33296b4cac81SBjoern A. Zeeb IMPROVE(); 33306b4cac81SBjoern A. Zeeb 33316b4cac81SBjoern A. Zeeb if (sta != NULL) { 33326b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 33336b4cac81SBjoern A. Zeeb 3334e3a0b120SBjoern A. Zeeb ltxq = NULL; 3335e3a0b120SBjoern A. Zeeb if (!ieee80211_is_data_present(hdr->frame_control)) { 3336e3a0b120SBjoern A. Zeeb if (vif->type == NL80211_IFTYPE_STATION && 3337e3a0b120SBjoern A. Zeeb lsta->added_to_drv && 3338e3a0b120SBjoern A. Zeeb sta->txq[IEEE80211_NUM_TIDS] != NULL) 3339d0d29110SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[IEEE80211_NUM_TIDS]); 3340e3a0b120SBjoern A. Zeeb } else if (lsta->added_to_drv && 3341e3a0b120SBjoern A. Zeeb sta->txq[skb->priority] != NULL) { 3342e3a0b120SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[skb->priority]); 3343e3a0b120SBjoern A. Zeeb } 3344e3a0b120SBjoern A. Zeeb if (ltxq == NULL) 3345d0d29110SBjoern A. Zeeb goto ops_tx; 3346e3a0b120SBjoern A. Zeeb 3347d0d29110SBjoern A. Zeeb KASSERT(ltxq != NULL, ("%s: lsta %p sta %p m %p skb %p " 3348d0d29110SBjoern A. Zeeb "ltxq %p != NULL\n", __func__, lsta, sta, m, skb, ltxq)); 3349d0d29110SBjoern A. Zeeb 33506b4cac81SBjoern A. Zeeb skb_queue_tail(<xq->skbq, skb); 33519d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33529d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 3353d0d29110SBjoern A. Zeeb printf("%s:%d mo_wake_tx_queue :: %d %u lsta %p sta %p " 3354d0d29110SBjoern A. Zeeb "ni %p %6D skb %p lxtq %p { qlen %u, ac %d tid %u } " 3355d0d29110SBjoern A. Zeeb "WAKE_TX_Q ac %d prio %u qmap %u\n", 3356fb6eaf74SBjoern A. Zeeb __func__, __LINE__, 3357d0d29110SBjoern A. Zeeb curthread->td_tid, (unsigned int)ticks, 3358d0d29110SBjoern A. Zeeb lsta, sta, ni, ni->ni_macaddr, ":", skb, ltxq, 3359d0d29110SBjoern A. Zeeb skb_queue_len(<xq->skbq), ltxq->txq.ac, 3360d0d29110SBjoern A. Zeeb ltxq->txq.tid, ac, skb->priority, skb->qmap); 33619d9ba2b7SBjoern A. Zeeb #endif 3362d0d29110SBjoern A. Zeeb lkpi_80211_mo_wake_tx_queue(hw, <xq->txq); 33636b4cac81SBjoern A. Zeeb return; 33646b4cac81SBjoern A. Zeeb } 33656b4cac81SBjoern A. Zeeb 33666b4cac81SBjoern A. Zeeb ops_tx: 33679d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33689d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 3369d0d29110SBjoern A. Zeeb printf("%s:%d mo_tx :: lsta %p sta %p ni %p %6D skb %p " 3370d0d29110SBjoern A. Zeeb "TX ac %d prio %u qmap %u\n", 33716b4cac81SBjoern A. Zeeb __func__, __LINE__, lsta, sta, ni, ni->ni_macaddr, ":", 33726b4cac81SBjoern A. Zeeb skb, ac, skb->priority, skb->qmap); 33739d9ba2b7SBjoern A. Zeeb #endif 33746b4cac81SBjoern A. Zeeb memset(&control, 0, sizeof(control)); 33756b4cac81SBjoern A. Zeeb control.sta = sta; 33766b4cac81SBjoern A. Zeeb 33776b4cac81SBjoern A. Zeeb lkpi_80211_mo_tx(hw, &control, skb); 33786b4cac81SBjoern A. Zeeb return; 33796b4cac81SBjoern A. Zeeb } 33806b4cac81SBjoern A. Zeeb 33816b4cac81SBjoern A. Zeeb static void 33826b4cac81SBjoern A. Zeeb lkpi_80211_txq_task(void *ctx, int pending) 33836b4cac81SBjoern A. Zeeb { 33846b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 33856b4cac81SBjoern A. Zeeb struct mbufq mq; 33866b4cac81SBjoern A. Zeeb struct mbuf *m; 33876b4cac81SBjoern A. Zeeb 33886b4cac81SBjoern A. Zeeb lsta = ctx; 33896b4cac81SBjoern A. Zeeb 33909d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33919d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 33926b4cac81SBjoern A. Zeeb printf("%s:%d lsta %p ni %p %6D pending %d mbuf_qlen %d\n", 33939d9ba2b7SBjoern A. Zeeb __func__, __LINE__, lsta, lsta->ni, lsta->ni->ni_macaddr, ":", 33946b4cac81SBjoern A. Zeeb pending, mbufq_len(&lsta->txq)); 33959d9ba2b7SBjoern A. Zeeb #endif 33966b4cac81SBjoern A. Zeeb 33976b4cac81SBjoern A. Zeeb mbufq_init(&mq, IFQ_MAXLEN); 33986b4cac81SBjoern A. Zeeb 33996b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_LOCK(lsta); 34006b4cac81SBjoern A. Zeeb mbufq_concat(&mq, &lsta->txq); 34016b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_UNLOCK(lsta); 34026b4cac81SBjoern A. Zeeb 34036b4cac81SBjoern A. Zeeb m = mbufq_dequeue(&mq); 34046b4cac81SBjoern A. Zeeb while (m != NULL) { 34056b4cac81SBjoern A. Zeeb lkpi_80211_txq_tx_one(lsta, m); 34066b4cac81SBjoern A. Zeeb m = mbufq_dequeue(&mq); 34076b4cac81SBjoern A. Zeeb } 34086b4cac81SBjoern A. Zeeb } 34096b4cac81SBjoern A. Zeeb 34106b4cac81SBjoern A. Zeeb static int 34116b4cac81SBjoern A. Zeeb lkpi_ic_transmit(struct ieee80211com *ic, struct mbuf *m) 34126b4cac81SBjoern A. Zeeb { 34136b4cac81SBjoern A. Zeeb 34146b4cac81SBjoern A. Zeeb /* XXX TODO */ 34156b4cac81SBjoern A. Zeeb IMPROVE(); 34166b4cac81SBjoern A. Zeeb 34176b4cac81SBjoern A. Zeeb /* Quick and dirty cheating hack. */ 34186b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 34196b4cac81SBjoern A. Zeeb 34206b4cac81SBjoern A. Zeeb ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 34216b4cac81SBjoern A. Zeeb return (lkpi_ic_raw_xmit(ni, m, NULL)); 34226b4cac81SBjoern A. Zeeb } 34236b4cac81SBjoern A. Zeeb 34246b4cac81SBjoern A. Zeeb static void 34256b4cac81SBjoern A. Zeeb lkpi_ic_getradiocaps(struct ieee80211com *ic, int maxchan, 34266b4cac81SBjoern A. Zeeb int *n, struct ieee80211_channel *c) 34276b4cac81SBjoern A. Zeeb { 34286b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 34296b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 34306b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 34316b4cac81SBjoern A. Zeeb uint8_t bands[IEEE80211_MODE_BYTES]; 34326b4cac81SBjoern A. Zeeb int chan_flags, error, i, nchans; 34336b4cac81SBjoern A. Zeeb 34346b4cac81SBjoern A. Zeeb /* Channels */ 34356b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 34366b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 34376b4cac81SBjoern A. Zeeb 34386b4cac81SBjoern A. Zeeb /* NL80211_BAND_2GHZ */ 34396b4cac81SBjoern A. Zeeb nchans = 0; 34406b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_2GHZ] != NULL) 34416b4cac81SBjoern A. Zeeb nchans = hw->wiphy->bands[NL80211_BAND_2GHZ]->n_channels; 34426b4cac81SBjoern A. Zeeb if (nchans > 0) { 34436b4cac81SBjoern A. Zeeb memset(bands, 0, sizeof(bands)); 34446b4cac81SBjoern A. Zeeb chan_flags = 0; 34456b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11B); 34466b4cac81SBjoern A. Zeeb /* XXX-BZ unclear how to check for 11g. */ 34476b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11G); 34486b4cac81SBjoern A. Zeeb #ifdef __notyet__ 34496b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_2GHZ]->ht_cap.ht_supported) { 34506b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11NG); 34516b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_HT40; 34526b4cac81SBjoern A. Zeeb } 34536b4cac81SBjoern A. Zeeb #endif 34546b4cac81SBjoern A. Zeeb 34556b4cac81SBjoern A. Zeeb channels = hw->wiphy->bands[NL80211_BAND_2GHZ]->channels; 3456cee56e77SBjoern A. Zeeb for (i = 0; i < nchans && *n < maxchan; i++) { 34576b4cac81SBjoern A. Zeeb uint32_t nflags = 0; 34586b4cac81SBjoern A. Zeeb int cflags = chan_flags; 34596b4cac81SBjoern A. Zeeb 34606b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) { 34613f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Skipping disabled chan " 34623f0083c4SBjoern A. Zeeb "[%u/%u/%#x]\n", __func__, 34636b4cac81SBjoern A. Zeeb channels[i].hw_value, 34646b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags); 34656b4cac81SBjoern A. Zeeb continue; 34666b4cac81SBjoern A. Zeeb } 34676b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_IR) 34686b4cac81SBjoern A. Zeeb nflags |= (IEEE80211_CHAN_NOADHOC|IEEE80211_CHAN_PASSIVE); 34696b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_RADAR) 34706b4cac81SBjoern A. Zeeb nflags |= IEEE80211_CHAN_DFS; 34716b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_160MHZ) 34726b4cac81SBjoern A. Zeeb cflags &= ~(NET80211_CBW_FLAG_VHT160|NET80211_CBW_FLAG_VHT80P80); 34736b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_80MHZ) 34746b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_VHT80; 34756b4cac81SBjoern A. Zeeb /* XXX how to map the remaining enum ieee80211_channel_flags? */ 34766b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_HT40) 34776b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_HT40; 34786b4cac81SBjoern A. Zeeb 34796b4cac81SBjoern A. Zeeb error = ieee80211_add_channel_cbw(c, maxchan, n, 34806b4cac81SBjoern A. Zeeb channels[i].hw_value, channels[i].center_freq, 34816b4cac81SBjoern A. Zeeb channels[i].max_power, 34826b4cac81SBjoern A. Zeeb nflags, bands, chan_flags); 3483cee56e77SBjoern A. Zeeb /* net80211::ENOBUFS: *n >= maxchans */ 3484cee56e77SBjoern A. Zeeb if (error != 0 && error != ENOBUFS) 34853f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Adding chan %u/%u/%#x/%#x/%#x/%#x " 34863f0083c4SBjoern A. Zeeb "returned error %d\n", 34876b4cac81SBjoern A. Zeeb __func__, channels[i].hw_value, 34886b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags, 34896b4cac81SBjoern A. Zeeb nflags, chan_flags, cflags, error); 3490cee56e77SBjoern A. Zeeb if (error != 0) 34916b4cac81SBjoern A. Zeeb break; 34926b4cac81SBjoern A. Zeeb } 34936b4cac81SBjoern A. Zeeb } 34946b4cac81SBjoern A. Zeeb 34956b4cac81SBjoern A. Zeeb /* NL80211_BAND_5GHZ */ 34966b4cac81SBjoern A. Zeeb nchans = 0; 34976b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ] != NULL) 34986b4cac81SBjoern A. Zeeb nchans = hw->wiphy->bands[NL80211_BAND_5GHZ]->n_channels; 34996b4cac81SBjoern A. Zeeb if (nchans > 0) { 35006b4cac81SBjoern A. Zeeb memset(bands, 0, sizeof(bands)); 35016b4cac81SBjoern A. Zeeb chan_flags = 0; 35026b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11A); 35036b4cac81SBjoern A. Zeeb #ifdef __not_yet__ 35046b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ]->ht_cap.ht_supported) { 35056b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11NA); 35066b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_HT40; 35076b4cac81SBjoern A. Zeeb } 35086b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap.vht_supported){ 35096b4cac81SBjoern A. Zeeb 35106b4cac81SBjoern A. Zeeb ic->ic_flags_ext |= IEEE80211_FEXT_VHT; 35116b4cac81SBjoern A. Zeeb ic->ic_vhtcaps = 35126b4cac81SBjoern A. Zeeb hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap.cap; 35136b4cac81SBjoern A. Zeeb 35146b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_VHT_5GHZ); 35156b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT80; 35166b4cac81SBjoern A. Zeeb if (IEEE80211_VHTCAP_SUPP_CHAN_WIDTH_IS_160MHZ( 35176b4cac81SBjoern A. Zeeb ic->ic_vhtcaps)) 35186b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT160; 35196b4cac81SBjoern A. Zeeb if (IEEE80211_VHTCAP_SUPP_CHAN_WIDTH_IS_160_80P80MHZ( 35206b4cac81SBjoern A. Zeeb ic->ic_vhtcaps)) 35216b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT80P80; 35226b4cac81SBjoern A. Zeeb } 35236b4cac81SBjoern A. Zeeb #endif 35246b4cac81SBjoern A. Zeeb 35256b4cac81SBjoern A. Zeeb channels = hw->wiphy->bands[NL80211_BAND_5GHZ]->channels; 3526cee56e77SBjoern A. Zeeb for (i = 0; i < nchans && *n < maxchan; i++) { 35276b4cac81SBjoern A. Zeeb uint32_t nflags = 0; 35286b4cac81SBjoern A. Zeeb int cflags = chan_flags; 35296b4cac81SBjoern A. Zeeb 35306b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) { 35313f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Skipping disabled chan " 35323f0083c4SBjoern A. Zeeb "[%u/%u/%#x]\n", __func__, 35336b4cac81SBjoern A. Zeeb channels[i].hw_value, 35346b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags); 35356b4cac81SBjoern A. Zeeb continue; 35366b4cac81SBjoern A. Zeeb } 35376b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_IR) 35386b4cac81SBjoern A. Zeeb nflags |= (IEEE80211_CHAN_NOADHOC|IEEE80211_CHAN_PASSIVE); 35396b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_RADAR) 35406b4cac81SBjoern A. Zeeb nflags |= IEEE80211_CHAN_DFS; 35416b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_160MHZ) 35426b4cac81SBjoern A. Zeeb cflags &= ~(NET80211_CBW_FLAG_VHT160|NET80211_CBW_FLAG_VHT80P80); 35436b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_80MHZ) 35446b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_VHT80; 35456b4cac81SBjoern A. Zeeb /* XXX hwo to map the remaining enum ieee80211_channel_flags? */ 35466b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_HT40) 35476b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_HT40; 35486b4cac81SBjoern A. Zeeb 35496b4cac81SBjoern A. Zeeb error = ieee80211_add_channel_cbw(c, maxchan, n, 35506b4cac81SBjoern A. Zeeb channels[i].hw_value, channels[i].center_freq, 35516b4cac81SBjoern A. Zeeb channels[i].max_power, 35526b4cac81SBjoern A. Zeeb nflags, bands, chan_flags); 3553cee56e77SBjoern A. Zeeb /* net80211::ENOBUFS: *n >= maxchans */ 3554cee56e77SBjoern A. Zeeb if (error != 0 && error != ENOBUFS) 35553f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Adding chan %u/%u/%#x/%#x/%#x/%#x " 35563f0083c4SBjoern A. Zeeb "returned error %d\n", 35576b4cac81SBjoern A. Zeeb __func__, channels[i].hw_value, 35586b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags, 35596b4cac81SBjoern A. Zeeb nflags, chan_flags, cflags, error); 3560cee56e77SBjoern A. Zeeb if (error != 0) 35616b4cac81SBjoern A. Zeeb break; 35626b4cac81SBjoern A. Zeeb } 35636b4cac81SBjoern A. Zeeb } 35646b4cac81SBjoern A. Zeeb } 35656b4cac81SBjoern A. Zeeb 35666b4cac81SBjoern A. Zeeb static void * 35676b4cac81SBjoern A. Zeeb lkpi_ieee80211_ifalloc(void) 35686b4cac81SBjoern A. Zeeb { 35696b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 35706b4cac81SBjoern A. Zeeb 35716b4cac81SBjoern A. Zeeb ic = malloc(sizeof(*ic), M_LKPI80211, M_WAITOK | M_ZERO); 35726b4cac81SBjoern A. Zeeb if (ic == NULL) 35736b4cac81SBjoern A. Zeeb return (NULL); 35746b4cac81SBjoern A. Zeeb 35756b4cac81SBjoern A. Zeeb /* Setting these happens later when we have device information. */ 35766b4cac81SBjoern A. Zeeb ic->ic_softc = NULL; 35776b4cac81SBjoern A. Zeeb ic->ic_name = "linuxkpi"; 35786b4cac81SBjoern A. Zeeb 35796b4cac81SBjoern A. Zeeb return (ic); 35806b4cac81SBjoern A. Zeeb } 35816b4cac81SBjoern A. Zeeb 35826b4cac81SBjoern A. Zeeb struct ieee80211_hw * 35836b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_alloc_hw(size_t priv_len, const struct ieee80211_ops *ops) 35846b4cac81SBjoern A. Zeeb { 35856b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 35866b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 35876b4cac81SBjoern A. Zeeb struct wiphy *wiphy; 3588a5ae63edSBjoern A. Zeeb int ac; 35896b4cac81SBjoern A. Zeeb 35906b4cac81SBjoern A. Zeeb /* Get us and the driver data also allocated. */ 35916b4cac81SBjoern A. Zeeb wiphy = wiphy_new(&linuxkpi_mac80211cfgops, sizeof(*lhw) + priv_len); 35926b4cac81SBjoern A. Zeeb if (wiphy == NULL) 35936b4cac81SBjoern A. Zeeb return (NULL); 35946b4cac81SBjoern A. Zeeb 35956b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 35966b4cac81SBjoern A. Zeeb lhw->ops = ops; 3597652e22d3SBjoern A. Zeeb 35988ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK_INIT(lhw); 35998ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK_INIT(lhw); 36008891c455SBjoern A. Zeeb sx_init_flags(&lhw->lvif_sx, "lhw-lvif", SX_RECURSE | SX_DUPOK); 36016b4cac81SBjoern A. Zeeb TAILQ_INIT(&lhw->lvif_head); 3602a5ae63edSBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 3603a5ae63edSBjoern A. Zeeb lhw->txq_generation[ac] = 1; 3604a5ae63edSBjoern A. Zeeb TAILQ_INIT(&lhw->scheduled_txqs[ac]); 3605a5ae63edSBjoern A. Zeeb } 36066b4cac81SBjoern A. Zeeb 36076b4cac81SBjoern A. Zeeb /* 36086b4cac81SBjoern A. Zeeb * XXX-BZ TODO make sure there is a "_null" function to all ops 36096b4cac81SBjoern A. Zeeb * not initialized. 36106b4cac81SBjoern A. Zeeb */ 36116b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 36126b4cac81SBjoern A. Zeeb hw->wiphy = wiphy; 3613086be6a8SBjoern A. Zeeb hw->conf.flags |= IEEE80211_CONF_IDLE; 36146b4cac81SBjoern A. Zeeb hw->priv = (void *)(lhw + 1); 36156b4cac81SBjoern A. Zeeb 36166b4cac81SBjoern A. Zeeb /* BSD Specific. */ 36176b4cac81SBjoern A. Zeeb lhw->ic = lkpi_ieee80211_ifalloc(); 36186b4cac81SBjoern A. Zeeb if (lhw->ic == NULL) { 36196b4cac81SBjoern A. Zeeb ieee80211_free_hw(hw); 36206b4cac81SBjoern A. Zeeb return (NULL); 36216b4cac81SBjoern A. Zeeb } 36226b4cac81SBjoern A. Zeeb 36236b4cac81SBjoern A. Zeeb IMPROVE(); 36246b4cac81SBjoern A. Zeeb 36256b4cac81SBjoern A. Zeeb return (hw); 36266b4cac81SBjoern A. Zeeb } 36276b4cac81SBjoern A. Zeeb 36286b4cac81SBjoern A. Zeeb void 36296b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iffree(struct ieee80211_hw *hw) 36306b4cac81SBjoern A. Zeeb { 36316b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36326b4cac81SBjoern A. Zeeb 36336b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36346b4cac81SBjoern A. Zeeb free(lhw->ic, M_LKPI80211); 36356b4cac81SBjoern A. Zeeb lhw->ic = NULL; 36366b4cac81SBjoern A. Zeeb 36376b4cac81SBjoern A. Zeeb /* Cleanup more of lhw here or in wiphy_free()? */ 36388891c455SBjoern A. Zeeb sx_destroy(&lhw->lvif_sx); 36398ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK_DESTROY(lhw); 36408ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK_DESTROY(lhw); 36416b4cac81SBjoern A. Zeeb IMPROVE(); 36426b4cac81SBjoern A. Zeeb } 36436b4cac81SBjoern A. Zeeb 36446b4cac81SBjoern A. Zeeb void 36456b4cac81SBjoern A. Zeeb linuxkpi_set_ieee80211_dev(struct ieee80211_hw *hw, char *name) 36466b4cac81SBjoern A. Zeeb { 36476b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36486b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36496b4cac81SBjoern A. Zeeb 36506b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36516b4cac81SBjoern A. Zeeb ic = lhw->ic; 36526b4cac81SBjoern A. Zeeb 36536b4cac81SBjoern A. Zeeb /* Now set a proper name before ieee80211_ifattach(). */ 36546b4cac81SBjoern A. Zeeb ic->ic_softc = lhw; 36556b4cac81SBjoern A. Zeeb ic->ic_name = name; 36566b4cac81SBjoern A. Zeeb 36576b4cac81SBjoern A. Zeeb /* XXX-BZ do we also need to set wiphy name? */ 36586b4cac81SBjoern A. Zeeb } 36596b4cac81SBjoern A. Zeeb 36606b4cac81SBjoern A. Zeeb struct ieee80211_hw * 36616b4cac81SBjoern A. Zeeb linuxkpi_wiphy_to_ieee80211_hw(struct wiphy *wiphy) 36626b4cac81SBjoern A. Zeeb { 36636b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36646b4cac81SBjoern A. Zeeb 36656b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 36666b4cac81SBjoern A. Zeeb return (LHW_TO_HW(lhw)); 36676b4cac81SBjoern A. Zeeb } 36686b4cac81SBjoern A. Zeeb 36696b4cac81SBjoern A. Zeeb static void 36706b4cac81SBjoern A. Zeeb lkpi_radiotap_attach(struct lkpi_hw *lhw) 36716b4cac81SBjoern A. Zeeb { 36726b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36736b4cac81SBjoern A. Zeeb 36746b4cac81SBjoern A. Zeeb ic = lhw->ic; 36756b4cac81SBjoern A. Zeeb ieee80211_radiotap_attach(ic, 36766b4cac81SBjoern A. Zeeb &lhw->rtap_tx.wt_ihdr, sizeof(lhw->rtap_tx), 36776b4cac81SBjoern A. Zeeb LKPI_RTAP_TX_FLAGS_PRESENT, 36786b4cac81SBjoern A. Zeeb &lhw->rtap_rx.wr_ihdr, sizeof(lhw->rtap_rx), 36796b4cac81SBjoern A. Zeeb LKPI_RTAP_RX_FLAGS_PRESENT); 36806b4cac81SBjoern A. Zeeb } 36816b4cac81SBjoern A. Zeeb 36822e183d99SBjoern A. Zeeb int 36836b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ifattach(struct ieee80211_hw *hw) 36846b4cac81SBjoern A. Zeeb { 36856b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36866b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 3687c5b96b3eSBjoern A. Zeeb int band, i; 36886b4cac81SBjoern A. Zeeb 36896b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36906b4cac81SBjoern A. Zeeb ic = lhw->ic; 36916b4cac81SBjoern A. Zeeb 3692652e22d3SBjoern A. Zeeb /* We do it this late as wiphy->dev should be set for the name. */ 3693652e22d3SBjoern A. Zeeb lhw->workq = alloc_ordered_workqueue(wiphy_name(hw->wiphy), 0); 3694652e22d3SBjoern A. Zeeb if (lhw->workq == NULL) 3695652e22d3SBjoern A. Zeeb return (-EAGAIN); 3696652e22d3SBjoern A. Zeeb 36976b4cac81SBjoern A. Zeeb /* XXX-BZ figure this out how they count his... */ 36986b4cac81SBjoern A. Zeeb if (!is_zero_ether_addr(hw->wiphy->perm_addr)) { 36996b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(ic->ic_macaddr, 37006b4cac81SBjoern A. Zeeb hw->wiphy->perm_addr); 37016b4cac81SBjoern A. Zeeb } else if (hw->wiphy->n_addresses > 0) { 37026b4cac81SBjoern A. Zeeb /* We take the first one. */ 37036b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(ic->ic_macaddr, 37046b4cac81SBjoern A. Zeeb hw->wiphy->addresses[0].addr); 37056b4cac81SBjoern A. Zeeb } else { 37066b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: warning, no hardware address!\n", __func__); 37076b4cac81SBjoern A. Zeeb } 37086b4cac81SBjoern A. Zeeb 37093d09d310SBjoern A. Zeeb #ifdef __not_yet__ 37103d09d310SBjoern A. Zeeb /* See comment in lkpi_80211_txq_tx_one(). */ 37116b4cac81SBjoern A. Zeeb ic->ic_headroom = hw->extra_tx_headroom; 37123d09d310SBjoern A. Zeeb #endif 37136b4cac81SBjoern A. Zeeb 37146b4cac81SBjoern A. Zeeb ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 37156b4cac81SBjoern A. Zeeb ic->ic_opmode = IEEE80211_M_STA; 37166b4cac81SBjoern A. Zeeb 37176b4cac81SBjoern A. Zeeb /* Set device capabilities. */ 37186b4cac81SBjoern A. Zeeb /* XXX-BZ we need to get these from linux80211/drivers and convert. */ 37196b4cac81SBjoern A. Zeeb ic->ic_caps = 37206b4cac81SBjoern A. Zeeb IEEE80211_C_STA | 37216b4cac81SBjoern A. Zeeb IEEE80211_C_MONITOR | 37226b4cac81SBjoern A. Zeeb IEEE80211_C_WPA | /* WPA/RSN */ 37234a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 37246b4cac81SBjoern A. Zeeb IEEE80211_C_WME | 37254a67f1dfSBjoern A. Zeeb #endif 37266b4cac81SBjoern A. Zeeb #if 0 37276b4cac81SBjoern A. Zeeb IEEE80211_C_PMGT | 37286b4cac81SBjoern A. Zeeb #endif 37296b4cac81SBjoern A. Zeeb IEEE80211_C_SHSLOT | /* short slot time supported */ 37306b4cac81SBjoern A. Zeeb IEEE80211_C_SHPREAMBLE /* short preamble supported */ 37316b4cac81SBjoern A. Zeeb ; 37326b4cac81SBjoern A. Zeeb #if 0 37336b4cac81SBjoern A. Zeeb /* Scanning is a different kind of beast to re-work. */ 37346b4cac81SBjoern A. Zeeb ic->ic_caps |= IEEE80211_C_BGSCAN; 37356b4cac81SBjoern A. Zeeb #endif 3736cc4e78d5SBjoern A. Zeeb if (lhw->ops->hw_scan) { 3737cc4e78d5SBjoern A. Zeeb /* 3738cc4e78d5SBjoern A. Zeeb * Advertise full-offload scanning. 3739cc4e78d5SBjoern A. Zeeb * 3740cc4e78d5SBjoern A. Zeeb * Not limiting to SINGLE_SCAN_ON_ALL_BANDS here as otherwise 3741cc4e78d5SBjoern A. Zeeb * we essentially disable hw_scan for all drivers not setting 3742cc4e78d5SBjoern A. Zeeb * the flag. 3743cc4e78d5SBjoern A. Zeeb */ 37446b4cac81SBjoern A. Zeeb ic->ic_flags_ext |= IEEE80211_FEXT_SCAN_OFFLOAD; 3745a486fbbdSBjoern A. Zeeb lhw->scan_flags |= LKPI_LHW_SCAN_HW; 37466b4cac81SBjoern A. Zeeb } 37476b4cac81SBjoern A. Zeeb 37486b4cac81SBjoern A. Zeeb #ifdef __notyet__ 37496b4cac81SBjoern A. Zeeb ic->ic_htcaps = IEEE80211_HTC_HT /* HT operation */ 37506b4cac81SBjoern A. Zeeb | IEEE80211_HTC_AMPDU /* A-MPDU tx/rx */ 37516b4cac81SBjoern A. Zeeb | IEEE80211_HTC_AMSDU /* A-MSDU tx/rx */ 37526b4cac81SBjoern A. Zeeb | IEEE80211_HTCAP_MAXAMSDU_3839 37536b4cac81SBjoern A. Zeeb /* max A-MSDU length */ 37546b4cac81SBjoern A. Zeeb | IEEE80211_HTCAP_SMPS_OFF; /* SM power save off */ 37556b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_SHORTGI20; 37566b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_CHWIDTH40 | IEEE80211_HTCAP_SHORTGI40; 37576b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_TXSTBC; 37586b4cac81SBjoern A. Zeeb #endif 37596b4cac81SBjoern A. Zeeb 3760527687a9SBjoern A. Zeeb /* 3761527687a9SBjoern A. Zeeb * The wiphy variables report bitmasks of avail antennas. 3762527687a9SBjoern A. Zeeb * (*get_antenna) get the current bitmask sets which can be 3763527687a9SBjoern A. Zeeb * altered by (*set_antenna) for some drivers. 3764527687a9SBjoern A. Zeeb * XXX-BZ will the count alone do us much good long-term in net80211? 3765527687a9SBjoern A. Zeeb */ 3766527687a9SBjoern A. Zeeb if (hw->wiphy->available_antennas_rx || 3767527687a9SBjoern A. Zeeb hw->wiphy->available_antennas_tx) { 3768527687a9SBjoern A. Zeeb uint32_t rxs, txs; 3769527687a9SBjoern A. Zeeb 3770527687a9SBjoern A. Zeeb if (lkpi_80211_mo_get_antenna(hw, &txs, &rxs) == 0) { 3771527687a9SBjoern A. Zeeb ic->ic_rxstream = bitcount32(rxs); 3772527687a9SBjoern A. Zeeb ic->ic_txstream = bitcount32(txs); 3773527687a9SBjoern A. Zeeb } 3774527687a9SBjoern A. Zeeb } 3775527687a9SBjoern A. Zeeb 37766b4cac81SBjoern A. Zeeb ic->ic_cryptocaps = 0; 3777b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 37786b4cac81SBjoern A. Zeeb if (hw->wiphy->n_cipher_suites > 0) { 37796b4cac81SBjoern A. Zeeb for (i = 0; i < hw->wiphy->n_cipher_suites; i++) 37806b4cac81SBjoern A. Zeeb ic->ic_cryptocaps |= lkpi_l80211_to_net80211_cyphers( 37816b4cac81SBjoern A. Zeeb hw->wiphy->cipher_suites[i]); 37826b4cac81SBjoern A. Zeeb } 37836b4cac81SBjoern A. Zeeb #endif 37846b4cac81SBjoern A. Zeeb 37856b4cac81SBjoern A. Zeeb lkpi_ic_getradiocaps(ic, IEEE80211_CHAN_MAX, &ic->ic_nchans, 37866b4cac81SBjoern A. Zeeb ic->ic_channels); 37876b4cac81SBjoern A. Zeeb 37886b4cac81SBjoern A. Zeeb ieee80211_ifattach(ic); 37896b4cac81SBjoern A. Zeeb 37906b4cac81SBjoern A. Zeeb ic->ic_update_mcast = lkpi_ic_update_mcast; 37916b4cac81SBjoern A. Zeeb ic->ic_update_promisc = lkpi_ic_update_promisc; 37926b4cac81SBjoern A. Zeeb ic->ic_update_chw = lkpi_ic_update_chw; 37936b4cac81SBjoern A. Zeeb ic->ic_parent = lkpi_ic_parent; 37946b4cac81SBjoern A. Zeeb ic->ic_scan_start = lkpi_ic_scan_start; 37956b4cac81SBjoern A. Zeeb ic->ic_scan_end = lkpi_ic_scan_end; 37966b4cac81SBjoern A. Zeeb ic->ic_set_channel = lkpi_ic_set_channel; 37976b4cac81SBjoern A. Zeeb ic->ic_transmit = lkpi_ic_transmit; 37986b4cac81SBjoern A. Zeeb ic->ic_raw_xmit = lkpi_ic_raw_xmit; 37996b4cac81SBjoern A. Zeeb ic->ic_vap_create = lkpi_ic_vap_create; 38006b4cac81SBjoern A. Zeeb ic->ic_vap_delete = lkpi_ic_vap_delete; 38016b4cac81SBjoern A. Zeeb ic->ic_getradiocaps = lkpi_ic_getradiocaps; 38026b4cac81SBjoern A. Zeeb ic->ic_wme.wme_update = lkpi_ic_wme_update; 38036b4cac81SBjoern A. Zeeb 3804a486fbbdSBjoern A. Zeeb lhw->ic_scan_curchan = ic->ic_scan_curchan; 3805a486fbbdSBjoern A. Zeeb ic->ic_scan_curchan = lkpi_ic_scan_curchan; 3806a486fbbdSBjoern A. Zeeb lhw->ic_scan_mindwell = ic->ic_scan_mindwell; 3807a486fbbdSBjoern A. Zeeb ic->ic_scan_mindwell = lkpi_ic_scan_mindwell; 3808a486fbbdSBjoern A. Zeeb 38096b4cac81SBjoern A. Zeeb lhw->ic_node_alloc = ic->ic_node_alloc; 38106b4cac81SBjoern A. Zeeb ic->ic_node_alloc = lkpi_ic_node_alloc; 38116b4cac81SBjoern A. Zeeb lhw->ic_node_init = ic->ic_node_init; 38126b4cac81SBjoern A. Zeeb ic->ic_node_init = lkpi_ic_node_init; 38136b4cac81SBjoern A. Zeeb lhw->ic_node_cleanup = ic->ic_node_cleanup; 38146b4cac81SBjoern A. Zeeb ic->ic_node_cleanup = lkpi_ic_node_cleanup; 38156b4cac81SBjoern A. Zeeb lhw->ic_node_free = ic->ic_node_free; 38166b4cac81SBjoern A. Zeeb ic->ic_node_free = lkpi_ic_node_free; 38176b4cac81SBjoern A. Zeeb 38186b4cac81SBjoern A. Zeeb lkpi_radiotap_attach(lhw); 38196b4cac81SBjoern A. Zeeb 3820c5b96b3eSBjoern A. Zeeb /* 3821c5b96b3eSBjoern A. Zeeb * Assign the first possible channel for now; seems Realtek drivers 3822c5b96b3eSBjoern A. Zeeb * expect one. 3823d9945d78SBjoern A. Zeeb * Also remember the amount of bands we support and the most rates 3824d9945d78SBjoern A. Zeeb * in any band so we can scale [(ext) sup rates] IE(s) accordingly. 3825c5b96b3eSBjoern A. Zeeb */ 3826d9945d78SBjoern A. Zeeb lhw->supbands = lhw->max_rates = 0; 3827f454a4a1SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 3828c5b96b3eSBjoern A. Zeeb struct ieee80211_supported_band *supband; 3829c5b96b3eSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 3830c5b96b3eSBjoern A. Zeeb 3831c5b96b3eSBjoern A. Zeeb supband = hw->wiphy->bands[band]; 3832c5b96b3eSBjoern A. Zeeb if (supband == NULL || supband->n_channels == 0) 3833c5b96b3eSBjoern A. Zeeb continue; 3834c5b96b3eSBjoern A. Zeeb 3835d9945d78SBjoern A. Zeeb lhw->supbands++; 3836d9945d78SBjoern A. Zeeb lhw->max_rates = max(lhw->max_rates, supband->n_bitrates); 3837d9945d78SBjoern A. Zeeb 3838f454a4a1SBjoern A. Zeeb /* If we have a channel, we need to keep counting supbands. */ 3839f454a4a1SBjoern A. Zeeb if (hw->conf.chandef.chan != NULL) 3840f454a4a1SBjoern A. Zeeb continue; 3841f454a4a1SBjoern A. Zeeb 3842c5b96b3eSBjoern A. Zeeb channels = supband->channels; 3843c5b96b3eSBjoern A. Zeeb for (i = 0; i < supband->n_channels; i++) { 3844c5b96b3eSBjoern A. Zeeb 3845c5b96b3eSBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) 3846c5b96b3eSBjoern A. Zeeb continue; 3847c5b96b3eSBjoern A. Zeeb 38484a07abdeSBjoern A. Zeeb cfg80211_chandef_create(&hw->conf.chandef, &channels[i], 3849c5b96b3eSBjoern A. Zeeb NL80211_CHAN_NO_HT); 3850c5b96b3eSBjoern A. Zeeb break; 3851c5b96b3eSBjoern A. Zeeb } 3852c5b96b3eSBjoern A. Zeeb } 3853c5b96b3eSBjoern A. Zeeb 3854d9945d78SBjoern A. Zeeb IMPROVE("see net80211::ieee80211_chan_init vs. wiphy->bands[].bitrates possibly in lkpi_ic_getradiocaps?"); 3855d9945d78SBjoern A. Zeeb 3856d9945d78SBjoern A. Zeeb /* Make sure we do not support more than net80211 is willing to take. */ 3857d9945d78SBjoern A. Zeeb if (lhw->max_rates > IEEE80211_RATE_MAXSIZE) { 3858d9945d78SBjoern A. Zeeb ic_printf(ic, "%s: limiting max_rates %d to %d!\n", __func__, 3859d9945d78SBjoern A. Zeeb lhw->max_rates, IEEE80211_RATE_MAXSIZE); 3860d9945d78SBjoern A. Zeeb lhw->max_rates = IEEE80211_RATE_MAXSIZE; 3861d9945d78SBjoern A. Zeeb } 3862d9945d78SBjoern A. Zeeb 3863d9945d78SBjoern A. Zeeb /* 3864d9945d78SBjoern A. Zeeb * The maximum supported bitrates on any band + size for 3865d9945d78SBjoern A. Zeeb * DSSS Parameter Set give our per-band IE size. 3866d9945d78SBjoern A. Zeeb * XXX-BZ FIXME add HT VHT ... later 3867d9945d78SBjoern A. Zeeb * SSID is the responsibility of the driver and goes on the side. 3868d9945d78SBjoern A. Zeeb * The user specified bits coming from the vap go into the 3869d9945d78SBjoern A. Zeeb * "common ies" fields. 3870d9945d78SBjoern A. Zeeb */ 3871d9945d78SBjoern A. Zeeb lhw->scan_ie_len = 2 + IEEE80211_RATE_SIZE; 3872d9945d78SBjoern A. Zeeb if (lhw->max_rates > IEEE80211_RATE_SIZE) 3873d9945d78SBjoern A. Zeeb lhw->scan_ie_len += 2 + (lhw->max_rates - IEEE80211_RATE_SIZE); 3874d9945d78SBjoern A. Zeeb /* 3875d9945d78SBjoern A. Zeeb * net80211 does not seem to support the DSSS Parameter Set but some of 3876d9945d78SBjoern A. Zeeb * the drivers insert it so calculate the extra fixed space in. 3877d9945d78SBjoern A. Zeeb */ 3878d9945d78SBjoern A. Zeeb lhw->scan_ie_len += 2 + 1; 3879d9945d78SBjoern A. Zeeb 3880d9945d78SBjoern A. Zeeb /* Reduce the max_scan_ie_len "left" by the amount we consume already. */ 3881d9945d78SBjoern A. Zeeb if (hw->wiphy->max_scan_ie_len > 0) 3882d9945d78SBjoern A. Zeeb hw->wiphy->max_scan_ie_len -= lhw->scan_ie_len; 3883d9945d78SBjoern A. Zeeb 38846b4cac81SBjoern A. Zeeb if (bootverbose) 38856b4cac81SBjoern A. Zeeb ieee80211_announce(ic); 38862e183d99SBjoern A. Zeeb 38872e183d99SBjoern A. Zeeb return (0); 38886b4cac81SBjoern A. Zeeb } 38896b4cac81SBjoern A. Zeeb 38906b4cac81SBjoern A. Zeeb void 38916b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ifdetach(struct ieee80211_hw *hw) 38926b4cac81SBjoern A. Zeeb { 38936b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 38946b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 38956b4cac81SBjoern A. Zeeb 38966b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 38976b4cac81SBjoern A. Zeeb ic = lhw->ic; 38986b4cac81SBjoern A. Zeeb ieee80211_ifdetach(ic); 38996b4cac81SBjoern A. Zeeb } 39006b4cac81SBjoern A. Zeeb 39016b4cac81SBjoern A. Zeeb void 39026b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_interfaces(struct ieee80211_hw *hw, 39036b4cac81SBjoern A. Zeeb enum ieee80211_iface_iter flags, 39046b4cac81SBjoern A. Zeeb void(*iterfunc)(void *, uint8_t *, struct ieee80211_vif *), 39056b4cac81SBjoern A. Zeeb void *arg) 39066b4cac81SBjoern A. Zeeb { 39076b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 39086b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 39096b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 391061a68e50SBjoern A. Zeeb bool active, atomic, nin_drv; 39116b4cac81SBjoern A. Zeeb 39126b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 39136b4cac81SBjoern A. Zeeb 39146b4cac81SBjoern A. Zeeb if (flags & ~(IEEE80211_IFACE_ITER_NORMAL| 39156b4cac81SBjoern A. Zeeb IEEE80211_IFACE_ITER_RESUME_ALL| 391661a68e50SBjoern A. Zeeb IEEE80211_IFACE_SKIP_SDATA_NOT_IN_DRIVER| 3917adff403fSBjoern A. Zeeb IEEE80211_IFACE_ITER_ACTIVE|IEEE80211_IFACE_ITER__ATOMIC)) { 39186b4cac81SBjoern A. Zeeb ic_printf(lhw->ic, "XXX TODO %s flags(%#x) not yet supported.\n", 39196b4cac81SBjoern A. Zeeb __func__, flags); 39206b4cac81SBjoern A. Zeeb } 39216b4cac81SBjoern A. Zeeb 3922adff403fSBjoern A. Zeeb active = (flags & IEEE80211_IFACE_ITER_ACTIVE) != 0; 39236b4cac81SBjoern A. Zeeb atomic = (flags & IEEE80211_IFACE_ITER__ATOMIC) != 0; 392461a68e50SBjoern A. Zeeb nin_drv = (flags & IEEE80211_IFACE_SKIP_SDATA_NOT_IN_DRIVER) != 0; 39256b4cac81SBjoern A. Zeeb 39266b4cac81SBjoern A. Zeeb if (atomic) 39278891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 39286b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 39296b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 39306b4cac81SBjoern A. Zeeb 39316b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 39326b4cac81SBjoern A. Zeeb 39336b4cac81SBjoern A. Zeeb /* 39346b4cac81SBjoern A. Zeeb * If we want "active" interfaces, we need to distinguish on 39356b4cac81SBjoern A. Zeeb * whether the driver knows about them or not to be able to 39366b4cac81SBjoern A. Zeeb * handle the "resume" case correctly. Skip the ones the 39376b4cac81SBjoern A. Zeeb * driver does not know about. 39386b4cac81SBjoern A. Zeeb */ 39396b4cac81SBjoern A. Zeeb if (active && !lvif->added_to_drv && 39406b4cac81SBjoern A. Zeeb (flags & IEEE80211_IFACE_ITER_RESUME_ALL) != 0) 39416b4cac81SBjoern A. Zeeb continue; 39426b4cac81SBjoern A. Zeeb 39436b4cac81SBjoern A. Zeeb /* 394461a68e50SBjoern A. Zeeb * If we shall skip interfaces not added to the driver do so 394561a68e50SBjoern A. Zeeb * if we haven't yet. 394661a68e50SBjoern A. Zeeb */ 394761a68e50SBjoern A. Zeeb if (nin_drv && !lvif->added_to_drv) 394861a68e50SBjoern A. Zeeb continue; 394961a68e50SBjoern A. Zeeb 395061a68e50SBjoern A. Zeeb /* 39516b4cac81SBjoern A. Zeeb * Run the iterator function if we are either not asking 39526b4cac81SBjoern A. Zeeb * asking for active only or if the VAP is "running". 39536b4cac81SBjoern A. Zeeb */ 39546b4cac81SBjoern A. Zeeb /* XXX-BZ probably should have state in the lvif as well. */ 39556b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 39566b4cac81SBjoern A. Zeeb if (!active || (vap->iv_state != IEEE80211_S_INIT)) 39576b4cac81SBjoern A. Zeeb iterfunc(arg, vif->addr, vif); 39586b4cac81SBjoern A. Zeeb } 39596b4cac81SBjoern A. Zeeb if (atomic) 39608891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 39616b4cac81SBjoern A. Zeeb } 39626b4cac81SBjoern A. Zeeb 39636b4cac81SBjoern A. Zeeb void 39646b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_keys(struct ieee80211_hw *hw, 39656b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif, 39666b4cac81SBjoern A. Zeeb void(*iterfunc)(struct ieee80211_hw *, struct ieee80211_vif *, 39676b4cac81SBjoern A. Zeeb struct ieee80211_sta *, struct ieee80211_key_conf *, void *), 39686b4cac81SBjoern A. Zeeb void *arg) 39696b4cac81SBjoern A. Zeeb { 39706b4cac81SBjoern A. Zeeb 39716b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 39726b4cac81SBjoern A. Zeeb } 39736b4cac81SBjoern A. Zeeb 39746b4cac81SBjoern A. Zeeb void 39756b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_chan_contexts(struct ieee80211_hw *hw, 39766b4cac81SBjoern A. Zeeb void(*iterfunc)(struct ieee80211_hw *, struct ieee80211_chanctx_conf *, 39776b4cac81SBjoern A. Zeeb void *), 39786b4cac81SBjoern A. Zeeb void *arg) 39796b4cac81SBjoern A. Zeeb { 3980c5e25798SBjoern A. Zeeb struct lkpi_hw *lhw; 3981c5e25798SBjoern A. Zeeb struct lkpi_vif *lvif; 3982c5e25798SBjoern A. Zeeb struct ieee80211_vif *vif; 3983c5e25798SBjoern A. Zeeb struct lkpi_chanctx *lchanctx; 39846b4cac81SBjoern A. Zeeb 3985c5e25798SBjoern A. Zeeb KASSERT(hw != NULL && iterfunc != NULL, 3986c5e25798SBjoern A. Zeeb ("%s: hw %p iterfunc %p arg %p\n", __func__, hw, iterfunc, arg)); 3987c5e25798SBjoern A. Zeeb 3988c5e25798SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 3989c5e25798SBjoern A. Zeeb 3990c5e25798SBjoern A. Zeeb IMPROVE("lchanctx should be its own list somewhere"); 3991c5e25798SBjoern A. Zeeb 3992c5e25798SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 3993c5e25798SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 3994c5e25798SBjoern A. Zeeb 3995c5e25798SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 3996c5e25798SBjoern A. Zeeb if (vif->chanctx_conf == NULL) 3997c5e25798SBjoern A. Zeeb continue; 3998c5e25798SBjoern A. Zeeb 3999c5e25798SBjoern A. Zeeb lchanctx = CHANCTX_CONF_TO_LCHANCTX(vif->chanctx_conf); 4000c5e25798SBjoern A. Zeeb if (!lchanctx->added_to_drv) 4001c5e25798SBjoern A. Zeeb continue; 4002c5e25798SBjoern A. Zeeb 4003c5e25798SBjoern A. Zeeb iterfunc(hw, &lchanctx->conf, arg); 4004c5e25798SBjoern A. Zeeb } 4005c5e25798SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 40066b4cac81SBjoern A. Zeeb } 40076b4cac81SBjoern A. Zeeb 40086b4cac81SBjoern A. Zeeb void 40096b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_stations_atomic(struct ieee80211_hw *hw, 40106b4cac81SBjoern A. Zeeb void (*iterfunc)(void *, struct ieee80211_sta *), void *arg) 40116b4cac81SBjoern A. Zeeb { 40126b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40136b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 40146b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 40156b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 40166b4cac81SBjoern A. Zeeb 40176b4cac81SBjoern A. Zeeb KASSERT(hw != NULL && iterfunc != NULL, 40186b4cac81SBjoern A. Zeeb ("%s: hw %p iterfunc %p arg %p\n", __func__, hw, iterfunc, arg)); 40196b4cac81SBjoern A. Zeeb 40206b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 40216b4cac81SBjoern A. Zeeb 40228891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 40236b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 40246b4cac81SBjoern A. Zeeb 40256b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 40266b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lsta, &lvif->lsta_head, lsta_entry) { 40276b4cac81SBjoern A. Zeeb if (!lsta->added_to_drv) 40286b4cac81SBjoern A. Zeeb continue; 40296b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 40306b4cac81SBjoern A. Zeeb iterfunc(arg, sta); 40316b4cac81SBjoern A. Zeeb } 40326b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 40336b4cac81SBjoern A. Zeeb } 40348891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 40356b4cac81SBjoern A. Zeeb } 40366b4cac81SBjoern A. Zeeb 4037673d62fcSBjoern A. Zeeb struct linuxkpi_ieee80211_regdomain * 4038673d62fcSBjoern A. Zeeb lkpi_get_linuxkpi_ieee80211_regdomain(size_t n) 4039673d62fcSBjoern A. Zeeb { 4040673d62fcSBjoern A. Zeeb struct linuxkpi_ieee80211_regdomain *regd; 4041673d62fcSBjoern A. Zeeb 4042673d62fcSBjoern A. Zeeb regd = kzalloc(sizeof(*regd) + n * sizeof(struct ieee80211_reg_rule), 4043673d62fcSBjoern A. Zeeb GFP_KERNEL); 4044673d62fcSBjoern A. Zeeb return (regd); 4045673d62fcSBjoern A. Zeeb } 4046673d62fcSBjoern A. Zeeb 40476b4cac81SBjoern A. Zeeb int 40486b4cac81SBjoern A. Zeeb linuxkpi_regulatory_set_wiphy_regd_sync(struct wiphy *wiphy, 40496b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_regdomain *regd) 40506b4cac81SBjoern A. Zeeb { 40516b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40526b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 40536b4cac81SBjoern A. Zeeb struct ieee80211_regdomain *rd; 40546b4cac81SBjoern A. Zeeb 40556b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 40566b4cac81SBjoern A. Zeeb ic = lhw->ic; 40576b4cac81SBjoern A. Zeeb 40586b4cac81SBjoern A. Zeeb rd = &ic->ic_regdomain; 40596b4cac81SBjoern A. Zeeb if (rd->isocc[0] == '\0') { 40606b4cac81SBjoern A. Zeeb rd->isocc[0] = regd->alpha2[0]; 40616b4cac81SBjoern A. Zeeb rd->isocc[1] = regd->alpha2[1]; 40626b4cac81SBjoern A. Zeeb } 40636b4cac81SBjoern A. Zeeb 40646b4cac81SBjoern A. Zeeb TODO(); 40656b4cac81SBjoern A. Zeeb /* XXX-BZ finish the rest. */ 40666b4cac81SBjoern A. Zeeb 40676b4cac81SBjoern A. Zeeb return (0); 40686b4cac81SBjoern A. Zeeb } 40696b4cac81SBjoern A. Zeeb 40706b4cac81SBjoern A. Zeeb void 40716b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_scan_completed(struct ieee80211_hw *hw, 40726b4cac81SBjoern A. Zeeb struct cfg80211_scan_info *info) 40736b4cac81SBjoern A. Zeeb { 40746b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40756b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 40766b4cac81SBjoern A. Zeeb struct ieee80211_scan_state *ss; 40776b4cac81SBjoern A. Zeeb 40786b4cac81SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 40796b4cac81SBjoern A. Zeeb ic = lhw->ic; 40806b4cac81SBjoern A. Zeeb ss = ic->ic_scan; 40816b4cac81SBjoern A. Zeeb 40826b4cac81SBjoern A. Zeeb ieee80211_scan_done(ss->ss_vap); 40836b4cac81SBjoern A. Zeeb 40848ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 40856b4cac81SBjoern A. Zeeb free(lhw->hw_req, M_LKPI80211); 40866b4cac81SBjoern A. Zeeb lhw->hw_req = NULL; 4087a486fbbdSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_RUNNING; 40886b4cac81SBjoern A. Zeeb wakeup(lhw); 40898ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 40906b4cac81SBjoern A. Zeeb 40916b4cac81SBjoern A. Zeeb return; 40926b4cac81SBjoern A. Zeeb } 40936b4cac81SBjoern A. Zeeb 4094e30e05d3SBjoern A. Zeeb /* For %list see comment towards the end of the function. */ 40956b4cac81SBjoern A. Zeeb void 40966b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_rx(struct ieee80211_hw *hw, struct sk_buff *skb, 4097e30e05d3SBjoern A. Zeeb struct ieee80211_sta *sta, struct napi_struct *napi __unused, 4098e30e05d3SBjoern A. Zeeb struct list_head *list __unused) 40996b4cac81SBjoern A. Zeeb { 41006b4cac81SBjoern A. Zeeb struct epoch_tracker et; 41016b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 41026b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 41036b4cac81SBjoern A. Zeeb struct mbuf *m; 41046b4cac81SBjoern A. Zeeb struct skb_shared_info *shinfo; 41056b4cac81SBjoern A. Zeeb struct ieee80211_rx_status *rx_status; 41066b4cac81SBjoern A. Zeeb struct ieee80211_rx_stats rx_stats; 41076b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 41086b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 41096b4cac81SBjoern A. Zeeb struct ieee80211_hdr *hdr; 41106b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 41119d9ba2b7SBjoern A. Zeeb int i, offset, ok; 4112170acccfSBjoern A. Zeeb int8_t rssi; 4113c0cadd99SBjoern A. Zeeb bool is_beacon; 41146b4cac81SBjoern A. Zeeb 41156b4cac81SBjoern A. Zeeb if (skb->len < 2) { 41166b4cac81SBjoern A. Zeeb /* Need 80211 stats here. */ 41176b4cac81SBjoern A. Zeeb IMPROVE(); 41186b4cac81SBjoern A. Zeeb goto err; 41196b4cac81SBjoern A. Zeeb } 41206b4cac81SBjoern A. Zeeb 41216b4cac81SBjoern A. Zeeb /* 41226b4cac81SBjoern A. Zeeb * For now do the data copy; we can later improve things. Might even 41236b4cac81SBjoern A. Zeeb * have an mbuf backing the skb data then? 41246b4cac81SBjoern A. Zeeb */ 41256b4cac81SBjoern A. Zeeb m = m_get2(skb->len, M_NOWAIT, MT_DATA, M_PKTHDR); 41266b4cac81SBjoern A. Zeeb if (m == NULL) 41276b4cac81SBjoern A. Zeeb goto err; 41286b4cac81SBjoern A. Zeeb m_copyback(m, 0, skb->tail - skb->data, skb->data); 41296b4cac81SBjoern A. Zeeb 41306b4cac81SBjoern A. Zeeb shinfo = skb_shinfo(skb); 41316b4cac81SBjoern A. Zeeb offset = m->m_len; 41326b4cac81SBjoern A. Zeeb for (i = 0; i < shinfo->nr_frags; i++) { 41336b4cac81SBjoern A. Zeeb m_copyback(m, offset, shinfo->frags[i].size, 41346b4cac81SBjoern A. Zeeb (uint8_t *)linux_page_address(shinfo->frags[i].page) + 41356b4cac81SBjoern A. Zeeb shinfo->frags[i].offset); 41366b4cac81SBjoern A. Zeeb offset += shinfo->frags[i].size; 41376b4cac81SBjoern A. Zeeb } 41386b4cac81SBjoern A. Zeeb 41396b4cac81SBjoern A. Zeeb rx_status = IEEE80211_SKB_RXCB(skb); 41406b4cac81SBjoern A. Zeeb 41416b4cac81SBjoern A. Zeeb hdr = (void *)skb->data; 4142c0cadd99SBjoern A. Zeeb is_beacon = ieee80211_is_beacon(hdr->frame_control); 4143c0cadd99SBjoern A. Zeeb 4144c0cadd99SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 41459d9ba2b7SBjoern A. Zeeb if (is_beacon && (linuxkpi_debug_80211 & D80211_TRACE_RX_BEACONS) == 0) 41466b4cac81SBjoern A. Zeeb goto no_trace_beacons; 41476b4cac81SBjoern A. Zeeb 41489d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 41496b4cac81SBjoern A. Zeeb printf("TRACE-RX: %s: skb %p a/l/d/t-len (%u/%u/%u/%u) " 4150c0cadd99SBjoern A. Zeeb "h %p d %p t %p e %p sh %p (%u) m %p plen %u len %u%s\n", 41516b4cac81SBjoern A. Zeeb __func__, skb, skb->_alloc_len, skb->len, skb->data_len, 41526b4cac81SBjoern A. Zeeb skb->truesize, skb->head, skb->data, skb->tail, skb->end, 41536b4cac81SBjoern A. Zeeb shinfo, shinfo->nr_frags, 4154c0cadd99SBjoern A. Zeeb m, m->m_pkthdr.len, m->m_len, is_beacon ? " beacon" : ""); 41556b4cac81SBjoern A. Zeeb 41569d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX_DUMP) 41576b4cac81SBjoern A. Zeeb hexdump(mtod(m, const void *), m->m_len, "RX (raw) ", 0); 41586b4cac81SBjoern A. Zeeb 41596b4cac81SBjoern A. Zeeb /* Implement a dump_rxcb() !!! */ 41609d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 4161c8dafefaSBjoern A. Zeeb printf("TRACE %s: RXCB: %ju %ju %u, %#0x, %u, %#0x, %#0x, " 416260970a32SBjoern A. Zeeb "%u band %u, %u { %d %d %d %d }, %d, %#x %#x %#x %#x %u %u %u\n", 41636b4cac81SBjoern A. Zeeb __func__, 4164c8dafefaSBjoern A. Zeeb (uintmax_t)rx_status->boottime_ns, 4165c8dafefaSBjoern A. Zeeb (uintmax_t)rx_status->mactime, 41666b4cac81SBjoern A. Zeeb rx_status->device_timestamp, 41676b4cac81SBjoern A. Zeeb rx_status->flag, 41686b4cac81SBjoern A. Zeeb rx_status->freq, 41696b4cac81SBjoern A. Zeeb rx_status->bw, 41706b4cac81SBjoern A. Zeeb rx_status->encoding, 41716b4cac81SBjoern A. Zeeb rx_status->ampdu_reference, 41726b4cac81SBjoern A. Zeeb rx_status->band, 41736b4cac81SBjoern A. Zeeb rx_status->chains, 41746b4cac81SBjoern A. Zeeb rx_status->chain_signal[0], 41756b4cac81SBjoern A. Zeeb rx_status->chain_signal[1], 41766b4cac81SBjoern A. Zeeb rx_status->chain_signal[2], 417760970a32SBjoern A. Zeeb rx_status->chain_signal[3], 41786b4cac81SBjoern A. Zeeb rx_status->signal, 41796b4cac81SBjoern A. Zeeb rx_status->enc_flags, 41806b4cac81SBjoern A. Zeeb rx_status->he_dcm, 41816b4cac81SBjoern A. Zeeb rx_status->he_gi, 41826b4cac81SBjoern A. Zeeb rx_status->he_ru, 41836b4cac81SBjoern A. Zeeb rx_status->zero_length_psdu_type, 41846b4cac81SBjoern A. Zeeb rx_status->nss, 41856b4cac81SBjoern A. Zeeb rx_status->rate_idx); 41866b4cac81SBjoern A. Zeeb no_trace_beacons: 41876b4cac81SBjoern A. Zeeb #endif 41886b4cac81SBjoern A. Zeeb 41896b4cac81SBjoern A. Zeeb memset(&rx_stats, 0, sizeof(rx_stats)); 41906b4cac81SBjoern A. Zeeb rx_stats.r_flags = IEEE80211_R_NF | IEEE80211_R_RSSI; 419160970a32SBjoern A. Zeeb /* XXX-BZ correct hardcoded rssi and noise floor, how? survey? */ 419260970a32SBjoern A. Zeeb rx_stats.c_nf = -96; 41936b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, SIGNAL_DBM) && 41946b4cac81SBjoern A. Zeeb !(rx_status->flag & RX_FLAG_NO_SIGNAL_VAL)) 4195170acccfSBjoern A. Zeeb rssi = rx_status->signal; 41966b4cac81SBjoern A. Zeeb else 4197170acccfSBjoern A. Zeeb rssi = rx_stats.c_nf; 4198170acccfSBjoern A. Zeeb /* 4199170acccfSBjoern A. Zeeb * net80211 signal strength data are in .5 dBm units relative to 4200170acccfSBjoern A. Zeeb * the current noise floor (see comment in ieee80211_node.h). 4201170acccfSBjoern A. Zeeb */ 4202170acccfSBjoern A. Zeeb rssi -= rx_stats.c_nf; 4203170acccfSBjoern A. Zeeb rx_stats.c_rssi = rssi * 2; 42046b4cac81SBjoern A. Zeeb rx_stats.r_flags |= IEEE80211_R_BAND; 42056b4cac81SBjoern A. Zeeb rx_stats.c_band = 42066b4cac81SBjoern A. Zeeb lkpi_nl80211_band_to_net80211_band(rx_status->band); 42076b4cac81SBjoern A. Zeeb rx_stats.r_flags |= IEEE80211_R_FREQ | IEEE80211_R_IEEE; 42086b4cac81SBjoern A. Zeeb rx_stats.c_freq = rx_status->freq; 42096b4cac81SBjoern A. Zeeb rx_stats.c_ieee = ieee80211_mhz2ieee(rx_stats.c_freq, rx_stats.c_band); 42106b4cac81SBjoern A. Zeeb 42116b4cac81SBjoern A. Zeeb /* XXX (*sta_statistics)() to get to some of that? */ 42126b4cac81SBjoern A. Zeeb /* XXX-BZ dump the FreeBSD version of rx_stats as well! */ 42136b4cac81SBjoern A. Zeeb 42146b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 42156b4cac81SBjoern A. Zeeb ic = lhw->ic; 42166b4cac81SBjoern A. Zeeb 42176b4cac81SBjoern A. Zeeb ok = ieee80211_add_rx_params(m, &rx_stats); 42186b4cac81SBjoern A. Zeeb if (ok == 0) { 4219dbc06dd9SBjoern A. Zeeb m_freem(m); 42206b4cac81SBjoern A. Zeeb counter_u64_add(ic->ic_ierrors, 1); 42216b4cac81SBjoern A. Zeeb goto err; 42226b4cac81SBjoern A. Zeeb } 42236b4cac81SBjoern A. Zeeb 42246b4cac81SBjoern A. Zeeb if (sta != NULL) { 42256b4cac81SBjoern A. Zeeb lsta = STA_TO_LSTA(sta); 42266b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(lsta->ni); 42276b4cac81SBjoern A. Zeeb } else { 4228c8dafefaSBjoern A. Zeeb struct ieee80211_frame_min *wh; 4229c8dafefaSBjoern A. Zeeb 42306b4cac81SBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame_min *); 42316b4cac81SBjoern A. Zeeb ni = ieee80211_find_rxnode(ic, wh); 42326b4cac81SBjoern A. Zeeb if (ni != NULL) 42336b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 42346b4cac81SBjoern A. Zeeb } 42356b4cac81SBjoern A. Zeeb 42366b4cac81SBjoern A. Zeeb if (ni != NULL) 42376b4cac81SBjoern A. Zeeb vap = ni->ni_vap; 42386b4cac81SBjoern A. Zeeb else 42396b4cac81SBjoern A. Zeeb /* 42406b4cac81SBjoern A. Zeeb * XXX-BZ can we improve this by looking at the frame hdr 42416b4cac81SBjoern A. Zeeb * or other meta-data passed up? 42426b4cac81SBjoern A. Zeeb */ 42436b4cac81SBjoern A. Zeeb vap = TAILQ_FIRST(&ic->ic_vaps); 42446b4cac81SBjoern A. Zeeb 42459d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 42469d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 4247c0cadd99SBjoern A. Zeeb printf("TRACE %s: sta %p lsta %p state %d ni %p vap %p%s\n", 4248c0cadd99SBjoern A. Zeeb __func__, sta, lsta, (lsta != NULL) ? lsta->state : -1, 4249c0cadd99SBjoern A. Zeeb ni, vap, is_beacon ? " beacon" : ""); 42509d9ba2b7SBjoern A. Zeeb #endif 42516b4cac81SBjoern A. Zeeb 4252c0cadd99SBjoern A. Zeeb if (ni != NULL && vap != NULL && is_beacon && 4253c8dafefaSBjoern A. Zeeb rx_status->device_timestamp > 0 && 4254c8dafefaSBjoern A. Zeeb m->m_pkthdr.len >= sizeof(struct ieee80211_frame)) { 4255c8dafefaSBjoern A. Zeeb struct lkpi_vif *lvif; 4256c8dafefaSBjoern A. Zeeb struct ieee80211_vif *vif; 4257c8dafefaSBjoern A. Zeeb struct ieee80211_frame *wh; 4258c8dafefaSBjoern A. Zeeb 4259c8dafefaSBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame *); 4260c8dafefaSBjoern A. Zeeb if (!IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid)) 4261c8dafefaSBjoern A. Zeeb goto skip_device_ts; 4262c8dafefaSBjoern A. Zeeb 4263c8dafefaSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 4264c8dafefaSBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 4265c8dafefaSBjoern A. Zeeb 4266c8dafefaSBjoern A. Zeeb IMPROVE("TIMING_BEACON_ONLY?"); 4267c8dafefaSBjoern A. Zeeb /* mac80211 specific (not net80211) so keep it here. */ 4268c8dafefaSBjoern A. Zeeb vif->bss_conf.sync_device_ts = rx_status->device_timestamp; 4269c8dafefaSBjoern A. Zeeb /* 4270c8dafefaSBjoern A. Zeeb * net80211 should take care of the other information (sync_tsf, 4271c8dafefaSBjoern A. Zeeb * sync_dtim_count) as otherwise we need to parse the beacon. 4272c8dafefaSBjoern A. Zeeb */ 4273c8dafefaSBjoern A. Zeeb } 4274c8dafefaSBjoern A. Zeeb skip_device_ts: 4275c8dafefaSBjoern A. Zeeb 42766b4cac81SBjoern A. Zeeb if (vap != NULL && vap->iv_state > IEEE80211_S_INIT && 42776b4cac81SBjoern A. Zeeb ieee80211_radiotap_active_vap(vap)) { 42786b4cac81SBjoern A. Zeeb struct lkpi_radiotap_rx_hdr *rtap; 42796b4cac81SBjoern A. Zeeb 42806b4cac81SBjoern A. Zeeb rtap = &lhw->rtap_rx; 42816b4cac81SBjoern A. Zeeb rtap->wr_tsft = rx_status->device_timestamp; 42826b4cac81SBjoern A. Zeeb rtap->wr_flags = 0; 42836b4cac81SBjoern A. Zeeb if (rx_status->enc_flags & RX_ENC_FLAG_SHORTPRE) 42846b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE; 42856b4cac81SBjoern A. Zeeb if (rx_status->enc_flags & RX_ENC_FLAG_SHORT_GI) 42866b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTGI; 42876b4cac81SBjoern A. Zeeb #if 0 /* .. or it does not given we strip it below. */ 42886b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, RX_INCLUDES_FCS)) 42896b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_FCS; 42906b4cac81SBjoern A. Zeeb #endif 42916b4cac81SBjoern A. Zeeb if (rx_status->flag & RX_FLAG_FAILED_FCS_CRC) 42926b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS; 42936b4cac81SBjoern A. Zeeb rtap->wr_rate = 0; 42946b4cac81SBjoern A. Zeeb IMPROVE(); 42956b4cac81SBjoern A. Zeeb /* XXX TODO status->encoding / rate_index / bw */ 42966b4cac81SBjoern A. Zeeb rtap->wr_chan_freq = htole16(rx_stats.c_freq); 42976b4cac81SBjoern A. Zeeb if (ic->ic_curchan->ic_ieee == rx_stats.c_ieee) 42986b4cac81SBjoern A. Zeeb rtap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 4299170acccfSBjoern A. Zeeb rtap->wr_dbm_antsignal = rssi; 43006b4cac81SBjoern A. Zeeb rtap->wr_dbm_antnoise = rx_stats.c_nf; 43016b4cac81SBjoern A. Zeeb } 43026b4cac81SBjoern A. Zeeb 43036b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, RX_INCLUDES_FCS)) 43046b4cac81SBjoern A. Zeeb m_adj(m, -IEEE80211_CRC_LEN); 43056b4cac81SBjoern A. Zeeb 4306e30e05d3SBjoern A. Zeeb #if 0 4307e30e05d3SBjoern A. Zeeb if (list != NULL) { 4308e30e05d3SBjoern A. Zeeb /* 4309e30e05d3SBjoern A. Zeeb * Normally this would be queued up and delivered by 4310e30e05d3SBjoern A. Zeeb * netif_receive_skb_list(), napi_gro_receive(), or the like. 4311e30e05d3SBjoern A. Zeeb * See mt76::mac80211.c as only current possible consumer. 4312e30e05d3SBjoern A. Zeeb */ 4313e30e05d3SBjoern A. Zeeb IMPROVE("we simply pass the packet to net80211 to deal with."); 4314e30e05d3SBjoern A. Zeeb } 4315e30e05d3SBjoern A. Zeeb #endif 4316e30e05d3SBjoern A. Zeeb 43176b4cac81SBjoern A. Zeeb NET_EPOCH_ENTER(et); 43186b4cac81SBjoern A. Zeeb if (ni != NULL) { 43199d9ba2b7SBjoern A. Zeeb ok = ieee80211_input_mimo(ni, m); 43206b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 4321dbc06dd9SBjoern A. Zeeb if (ok < 0) 4322dbc06dd9SBjoern A. Zeeb m_freem(m); 43236b4cac81SBjoern A. Zeeb } else { 43249d9ba2b7SBjoern A. Zeeb ok = ieee80211_input_mimo_all(ic, m); 4325dbc06dd9SBjoern A. Zeeb /* mbuf got consumed. */ 43266b4cac81SBjoern A. Zeeb } 43276b4cac81SBjoern A. Zeeb NET_EPOCH_EXIT(et); 43286b4cac81SBjoern A. Zeeb 43299d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 43309d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 43319d9ba2b7SBjoern A. Zeeb printf("TRACE %s: handled frame type %#0x\n", __func__, ok); 43329d9ba2b7SBjoern A. Zeeb #endif 43336b4cac81SBjoern A. Zeeb 43346b4cac81SBjoern A. Zeeb IMPROVE(); 43356b4cac81SBjoern A. Zeeb 43366b4cac81SBjoern A. Zeeb err: 43376b4cac81SBjoern A. Zeeb /* The skb is ours so we can free it :-) */ 43386b4cac81SBjoern A. Zeeb kfree_skb(skb); 43396b4cac81SBjoern A. Zeeb } 43406b4cac81SBjoern A. Zeeb 43416b4cac81SBjoern A. Zeeb uint8_t 4342ec190d91SBjoern A. Zeeb linuxkpi_ieee80211_get_tid(struct ieee80211_hdr *hdr, bool nonqos_ok) 43436b4cac81SBjoern A. Zeeb { 43446b4cac81SBjoern A. Zeeb const struct ieee80211_frame *wh; 4345ec190d91SBjoern A. Zeeb uint8_t tid; 4346ec190d91SBjoern A. Zeeb 4347ec190d91SBjoern A. Zeeb /* Linux seems to assume this is a QOS-Data-Frame */ 4348ec190d91SBjoern A. Zeeb KASSERT(nonqos_ok || ieee80211_is_data_qos(hdr->frame_control), 4349ec190d91SBjoern A. Zeeb ("%s: hdr %p fc %#06x not qos_data\n", __func__, hdr, 4350ec190d91SBjoern A. Zeeb hdr->frame_control)); 43516b4cac81SBjoern A. Zeeb 43526b4cac81SBjoern A. Zeeb wh = (const struct ieee80211_frame *)hdr; 4353ec190d91SBjoern A. Zeeb tid = ieee80211_gettid(wh); 4354ec190d91SBjoern A. Zeeb KASSERT(nonqos_ok || tid == (tid & IEEE80211_QOS_TID), ("%s: tid %u " 4355ec190d91SBjoern A. Zeeb "not expected (%u?)\n", __func__, tid, IEEE80211_NONQOS_TID)); 4356ec190d91SBjoern A. Zeeb 4357ec190d91SBjoern A. Zeeb return (tid); 43586b4cac81SBjoern A. Zeeb } 43596b4cac81SBjoern A. Zeeb 43606b4cac81SBjoern A. Zeeb struct wiphy * 43616b4cac81SBjoern A. Zeeb linuxkpi_wiphy_new(const struct cfg80211_ops *ops, size_t priv_len) 43626b4cac81SBjoern A. Zeeb { 43636b4cac81SBjoern A. Zeeb struct lkpi_wiphy *lwiphy; 43646b4cac81SBjoern A. Zeeb 43656b4cac81SBjoern A. Zeeb lwiphy = kzalloc(sizeof(*lwiphy) + priv_len, GFP_KERNEL); 43666b4cac81SBjoern A. Zeeb if (lwiphy == NULL) 43676b4cac81SBjoern A. Zeeb return (NULL); 43686b4cac81SBjoern A. Zeeb lwiphy->ops = ops; 43696b4cac81SBjoern A. Zeeb 43706b4cac81SBjoern A. Zeeb /* XXX TODO */ 43716b4cac81SBjoern A. Zeeb return (LWIPHY_TO_WIPHY(lwiphy)); 43726b4cac81SBjoern A. Zeeb } 43736b4cac81SBjoern A. Zeeb 43746b4cac81SBjoern A. Zeeb void 43756b4cac81SBjoern A. Zeeb linuxkpi_wiphy_free(struct wiphy *wiphy) 43766b4cac81SBjoern A. Zeeb { 43776b4cac81SBjoern A. Zeeb struct lkpi_wiphy *lwiphy; 43786b4cac81SBjoern A. Zeeb 43796b4cac81SBjoern A. Zeeb if (wiphy == NULL) 43806b4cac81SBjoern A. Zeeb return; 43816b4cac81SBjoern A. Zeeb 43826b4cac81SBjoern A. Zeeb lwiphy = WIPHY_TO_LWIPHY(wiphy); 43836b4cac81SBjoern A. Zeeb kfree(lwiphy); 43846b4cac81SBjoern A. Zeeb } 43856b4cac81SBjoern A. Zeeb 43866b4cac81SBjoern A. Zeeb uint32_t 43876b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_channel_to_frequency(uint32_t channel, 43886b4cac81SBjoern A. Zeeb enum nl80211_band band) 43896b4cac81SBjoern A. Zeeb { 43906b4cac81SBjoern A. Zeeb 43916b4cac81SBjoern A. Zeeb switch (band) { 43926b4cac81SBjoern A. Zeeb case NL80211_BAND_2GHZ: 43936b4cac81SBjoern A. Zeeb return (ieee80211_ieee2mhz(channel, IEEE80211_CHAN_2GHZ)); 43946b4cac81SBjoern A. Zeeb break; 43956b4cac81SBjoern A. Zeeb case NL80211_BAND_5GHZ: 43966b4cac81SBjoern A. Zeeb return (ieee80211_ieee2mhz(channel, IEEE80211_CHAN_5GHZ)); 43976b4cac81SBjoern A. Zeeb break; 43986b4cac81SBjoern A. Zeeb default: 43996b4cac81SBjoern A. Zeeb /* XXX abort, retry, error, panic? */ 44006b4cac81SBjoern A. Zeeb break; 44016b4cac81SBjoern A. Zeeb } 44026b4cac81SBjoern A. Zeeb 44036b4cac81SBjoern A. Zeeb return (0); 44046b4cac81SBjoern A. Zeeb } 44056b4cac81SBjoern A. Zeeb 44066b4cac81SBjoern A. Zeeb uint32_t 44076b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_frequency_to_channel(uint32_t freq, uint32_t flags __unused) 44086b4cac81SBjoern A. Zeeb { 44096b4cac81SBjoern A. Zeeb 44106b4cac81SBjoern A. Zeeb return (ieee80211_mhz2ieee(freq, 0)); 44116b4cac81SBjoern A. Zeeb } 44126b4cac81SBjoern A. Zeeb 44136b4cac81SBjoern A. Zeeb static struct lkpi_sta * 44146b4cac81SBjoern A. Zeeb lkpi_find_lsta_by_ni(struct lkpi_vif *lvif, struct ieee80211_node *ni) 44156b4cac81SBjoern A. Zeeb { 44166b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta, *temp; 44176b4cac81SBjoern A. Zeeb 44186b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 44196b4cac81SBjoern A. Zeeb TAILQ_FOREACH_SAFE(lsta, &lvif->lsta_head, lsta_entry, temp) { 44206b4cac81SBjoern A. Zeeb if (lsta->ni == ni) { 44216b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 44226b4cac81SBjoern A. Zeeb return (lsta); 44236b4cac81SBjoern A. Zeeb } 44246b4cac81SBjoern A. Zeeb } 44256b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 44266b4cac81SBjoern A. Zeeb 44276b4cac81SBjoern A. Zeeb return (NULL); 44286b4cac81SBjoern A. Zeeb } 44296b4cac81SBjoern A. Zeeb 44306b4cac81SBjoern A. Zeeb struct ieee80211_sta * 44316b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_find_sta(struct ieee80211_vif *vif, const u8 *peer) 44326b4cac81SBjoern A. Zeeb { 44336b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 44346b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta, *temp; 44356b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 44366b4cac81SBjoern A. Zeeb 44376b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 44386b4cac81SBjoern A. Zeeb 44396b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 44406b4cac81SBjoern A. Zeeb TAILQ_FOREACH_SAFE(lsta, &lvif->lsta_head, lsta_entry, temp) { 44416b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 44426b4cac81SBjoern A. Zeeb if (IEEE80211_ADDR_EQ(sta->addr, peer)) { 44436b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 44446b4cac81SBjoern A. Zeeb return (sta); 44456b4cac81SBjoern A. Zeeb } 44466b4cac81SBjoern A. Zeeb } 44476b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 44486b4cac81SBjoern A. Zeeb return (NULL); 44496b4cac81SBjoern A. Zeeb } 44506b4cac81SBjoern A. Zeeb 44516b4cac81SBjoern A. Zeeb struct ieee80211_sta * 44522e183d99SBjoern A. Zeeb linuxkpi_ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw, 44532e183d99SBjoern A. Zeeb const uint8_t *addr, const uint8_t *ourvifaddr) 44546b4cac81SBjoern A. Zeeb { 44556b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 44566b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 44576b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 44586b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 44596b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 44606b4cac81SBjoern A. Zeeb 44616b4cac81SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 44626b4cac81SBjoern A. Zeeb sta = NULL; 44636b4cac81SBjoern A. Zeeb 44648891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 44656b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 44666b4cac81SBjoern A. Zeeb 44676b4cac81SBjoern A. Zeeb /* XXX-BZ check our address from the vif. */ 44686b4cac81SBjoern A. Zeeb 44696b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 44706b4cac81SBjoern A. Zeeb if (ourvifaddr != NULL && 44716b4cac81SBjoern A. Zeeb !IEEE80211_ADDR_EQ(vif->addr, ourvifaddr)) 44726b4cac81SBjoern A. Zeeb continue; 44736b4cac81SBjoern A. Zeeb sta = linuxkpi_ieee80211_find_sta(vif, addr); 44746b4cac81SBjoern A. Zeeb if (sta != NULL) 44756b4cac81SBjoern A. Zeeb break; 44766b4cac81SBjoern A. Zeeb } 44778891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 44786b4cac81SBjoern A. Zeeb 44796b4cac81SBjoern A. Zeeb if (sta != NULL) { 44806b4cac81SBjoern A. Zeeb lsta = STA_TO_LSTA(sta); 44816b4cac81SBjoern A. Zeeb if (!lsta->added_to_drv) 44826b4cac81SBjoern A. Zeeb return (NULL); 44836b4cac81SBjoern A. Zeeb } 44846b4cac81SBjoern A. Zeeb 44856b4cac81SBjoern A. Zeeb return (sta); 44866b4cac81SBjoern A. Zeeb } 44876b4cac81SBjoern A. Zeeb 44886b4cac81SBjoern A. Zeeb struct sk_buff * 44896b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_tx_dequeue(struct ieee80211_hw *hw, 44906b4cac81SBjoern A. Zeeb struct ieee80211_txq *txq) 44916b4cac81SBjoern A. Zeeb { 44926b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 44930cbcfa19SBjoern A. Zeeb struct lkpi_vif *lvif; 44946b4cac81SBjoern A. Zeeb struct sk_buff *skb; 44956b4cac81SBjoern A. Zeeb 44960cbcfa19SBjoern A. Zeeb skb = NULL; 44976b4cac81SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 44986b4cac81SBjoern A. Zeeb ltxq->seen_dequeue = true; 44996b4cac81SBjoern A. Zeeb 45000cbcfa19SBjoern A. Zeeb if (ltxq->stopped) 45010cbcfa19SBjoern A. Zeeb goto stopped; 45020cbcfa19SBjoern A. Zeeb 45030cbcfa19SBjoern A. Zeeb lvif = VIF_TO_LVIF(ltxq->txq.vif); 45040cbcfa19SBjoern A. Zeeb if (lvif->hw_queue_stopped[ltxq->txq.ac]) { 45050cbcfa19SBjoern A. Zeeb ltxq->stopped = true; 45060cbcfa19SBjoern A. Zeeb goto stopped; 45070cbcfa19SBjoern A. Zeeb } 45080cbcfa19SBjoern A. Zeeb 45096b4cac81SBjoern A. Zeeb skb = skb_dequeue(<xq->skbq); 45106b4cac81SBjoern A. Zeeb 45110cbcfa19SBjoern A. Zeeb stopped: 45126b4cac81SBjoern A. Zeeb return (skb); 45136b4cac81SBjoern A. Zeeb } 45146b4cac81SBjoern A. Zeeb 45156b4cac81SBjoern A. Zeeb void 45166b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_txq_get_depth(struct ieee80211_txq *txq, 451786220d3cSBjoern A. Zeeb unsigned long *frame_cnt, unsigned long *byte_cnt) 45186b4cac81SBjoern A. Zeeb { 45196b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 45206b4cac81SBjoern A. Zeeb struct sk_buff *skb; 452186220d3cSBjoern A. Zeeb unsigned long fc, bc; 45226b4cac81SBjoern A. Zeeb 45236b4cac81SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 45246b4cac81SBjoern A. Zeeb 45256b4cac81SBjoern A. Zeeb fc = bc = 0; 45266b4cac81SBjoern A. Zeeb skb_queue_walk(<xq->skbq, skb) { 45276b4cac81SBjoern A. Zeeb fc++; 45286b4cac81SBjoern A. Zeeb bc += skb->len; 45296b4cac81SBjoern A. Zeeb } 45306b4cac81SBjoern A. Zeeb if (frame_cnt) 45316b4cac81SBjoern A. Zeeb *frame_cnt = fc; 45326b4cac81SBjoern A. Zeeb if (byte_cnt) 45336b4cac81SBjoern A. Zeeb *byte_cnt = bc; 45346b4cac81SBjoern A. Zeeb 45356b4cac81SBjoern A. Zeeb /* Validate that this is doing the correct thing. */ 45366b4cac81SBjoern A. Zeeb /* Should we keep track on en/dequeue? */ 45376b4cac81SBjoern A. Zeeb IMPROVE(); 45386b4cac81SBjoern A. Zeeb } 45396b4cac81SBjoern A. Zeeb 45406b4cac81SBjoern A. Zeeb /* 45416b4cac81SBjoern A. Zeeb * We are called from ieee80211_free_txskb() or ieee80211_tx_status(). 45426b4cac81SBjoern A. Zeeb * The latter tries to derive the success status from the info flags 45436b4cac81SBjoern A. Zeeb * passed back from the driver. rawx_mit() saves the ni on the m and the 45446b4cac81SBjoern A. Zeeb * m on the skb for us to be able to give feedback to net80211. 45456b4cac81SBjoern A. Zeeb */ 4546a8397571SBjoern A. Zeeb static void 4547a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb, 45486b4cac81SBjoern A. Zeeb int status) 45496b4cac81SBjoern A. Zeeb { 45506b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 45516b4cac81SBjoern A. Zeeb struct mbuf *m; 45526b4cac81SBjoern A. Zeeb 45536b4cac81SBjoern A. Zeeb m = skb->m; 45546b4cac81SBjoern A. Zeeb skb->m = NULL; 45556b4cac81SBjoern A. Zeeb 45566b4cac81SBjoern A. Zeeb if (m != NULL) { 45576b4cac81SBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 45586b4cac81SBjoern A. Zeeb /* Status: 0 is ok, != 0 is error. */ 45596b4cac81SBjoern A. Zeeb ieee80211_tx_complete(ni, m, status); 45606b4cac81SBjoern A. Zeeb /* ni & mbuf were consumed. */ 45616b4cac81SBjoern A. Zeeb } 4562a8397571SBjoern A. Zeeb } 45636b4cac81SBjoern A. Zeeb 4564a8397571SBjoern A. Zeeb void 4565a8397571SBjoern A. Zeeb linuxkpi_ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb, 4566a8397571SBjoern A. Zeeb int status) 4567a8397571SBjoern A. Zeeb { 4568a8397571SBjoern A. Zeeb 4569a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(hw, skb, status); 45706b4cac81SBjoern A. Zeeb kfree_skb(skb); 45716b4cac81SBjoern A. Zeeb } 45726b4cac81SBjoern A. Zeeb 4573383b3e8fSBjoern A. Zeeb void 4574a8397571SBjoern A. Zeeb linuxkpi_ieee80211_tx_status_ext(struct ieee80211_hw *hw, 4575a8397571SBjoern A. Zeeb struct ieee80211_tx_status *txstat) 4576383b3e8fSBjoern A. Zeeb { 4577a8397571SBjoern A. Zeeb struct sk_buff *skb; 4578383b3e8fSBjoern A. Zeeb struct ieee80211_tx_info *info; 4579383b3e8fSBjoern A. Zeeb struct ieee80211_ratectl_tx_status txs; 4580383b3e8fSBjoern A. Zeeb struct ieee80211_node *ni; 4581383b3e8fSBjoern A. Zeeb int status; 4582383b3e8fSBjoern A. Zeeb 4583a8397571SBjoern A. Zeeb skb = txstat->skb; 4584383b3e8fSBjoern A. Zeeb if (skb->m != NULL) { 4585383b3e8fSBjoern A. Zeeb struct mbuf *m; 4586383b3e8fSBjoern A. Zeeb 4587383b3e8fSBjoern A. Zeeb m = skb->m; 4588383b3e8fSBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 4589383b3e8fSBjoern A. Zeeb memset(&txs, 0, sizeof(txs)); 4590383b3e8fSBjoern A. Zeeb } else { 4591383b3e8fSBjoern A. Zeeb ni = NULL; 4592383b3e8fSBjoern A. Zeeb } 4593383b3e8fSBjoern A. Zeeb 4594a8397571SBjoern A. Zeeb info = txstat->info; 4595383b3e8fSBjoern A. Zeeb if (info->flags & IEEE80211_TX_STAT_ACK) { 4596383b3e8fSBjoern A. Zeeb status = 0; /* No error. */ 4597383b3e8fSBjoern A. Zeeb txs.status = IEEE80211_RATECTL_TX_SUCCESS; 4598383b3e8fSBjoern A. Zeeb } else { 4599383b3e8fSBjoern A. Zeeb status = 1; 4600383b3e8fSBjoern A. Zeeb txs.status = IEEE80211_RATECTL_TX_FAIL_UNSPECIFIED; 4601383b3e8fSBjoern A. Zeeb } 4602383b3e8fSBjoern A. Zeeb 4603383b3e8fSBjoern A. Zeeb if (ni != NULL) { 4604e2c5ab09SJohn Baldwin int ridx __unused; 4605383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4606383b3e8fSBjoern A. Zeeb int old_rate; 4607383b3e8fSBjoern A. Zeeb 4608383b3e8fSBjoern A. Zeeb old_rate = ni->ni_vap->iv_bss->ni_txrate; 4609383b3e8fSBjoern A. Zeeb #endif 4610383b3e8fSBjoern A. Zeeb txs.pktlen = skb->len; 4611383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_PKTLEN; 4612383b3e8fSBjoern A. Zeeb if (info->status.rates[0].count > 1) { 4613383b3e8fSBjoern A. Zeeb txs.long_retries = info->status.rates[0].count - 1; /* 1 + retries in drivers. */ 4614383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_LONG_RETRY; 4615383b3e8fSBjoern A. Zeeb } 4616383b3e8fSBjoern A. Zeeb #if 0 /* Unused in net80211 currently. */ 4617a8397571SBjoern A. Zeeb /* XXX-BZ convert check .flags for MCS/VHT/.. */ 4618383b3e8fSBjoern A. Zeeb txs.final_rate = info->status.rates[0].idx; 4619383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_FINAL_RATE; 4620383b3e8fSBjoern A. Zeeb #endif 4621adff403fSBjoern A. Zeeb if (info->status.flags & IEEE80211_TX_STATUS_ACK_SIGNAL_VALID) { 4622383b3e8fSBjoern A. Zeeb txs.rssi = info->status.ack_signal; /* XXX-BZ CONVERT? */ 4623383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_RSSI; 4624383b3e8fSBjoern A. Zeeb } 4625383b3e8fSBjoern A. Zeeb 4626383b3e8fSBjoern A. Zeeb IMPROVE("only update of rate matches but that requires us to get a proper rate"); 4627383b3e8fSBjoern A. Zeeb ieee80211_ratectl_tx_complete(ni, &txs); 4628383b3e8fSBjoern A. Zeeb ridx = ieee80211_ratectl_rate(ni->ni_vap->iv_bss, NULL, 0); 4629383b3e8fSBjoern A. Zeeb 4630383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4631383b3e8fSBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) { 4632383b3e8fSBjoern A. Zeeb printf("TX-RATE: %s: old %d new %d ridx %d, " 4633383b3e8fSBjoern A. Zeeb "long_retries %d\n", __func__, 4634383b3e8fSBjoern A. Zeeb old_rate, ni->ni_vap->iv_bss->ni_txrate, 4635383b3e8fSBjoern A. Zeeb ridx, txs.long_retries); 4636383b3e8fSBjoern A. Zeeb } 4637383b3e8fSBjoern A. Zeeb #endif 4638383b3e8fSBjoern A. Zeeb } 4639383b3e8fSBjoern A. Zeeb 4640383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4641383b3e8fSBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 4642383b3e8fSBjoern A. Zeeb printf("TX-STATUS: %s: hw %p skb %p status %d : flags %#x " 4643383b3e8fSBjoern A. Zeeb "band %u hw_queue %u tx_time_est %d : " 4644383b3e8fSBjoern A. Zeeb "rates [ %u %u %#x, %u %u %#x, %u %u %#x, %u %u %#x ] " 4645383b3e8fSBjoern A. Zeeb "ack_signal %u ampdu_ack_len %u ampdu_len %u antenna %u " 4646adff403fSBjoern A. Zeeb "tx_time %u flags %#x " 4647383b3e8fSBjoern A. Zeeb "status_driver_data [ %p %p ]\n", 4648383b3e8fSBjoern A. Zeeb __func__, hw, skb, status, info->flags, 4649383b3e8fSBjoern A. Zeeb info->band, info->hw_queue, info->tx_time_est, 4650383b3e8fSBjoern A. Zeeb info->status.rates[0].idx, info->status.rates[0].count, 4651383b3e8fSBjoern A. Zeeb info->status.rates[0].flags, 4652383b3e8fSBjoern A. Zeeb info->status.rates[1].idx, info->status.rates[1].count, 4653383b3e8fSBjoern A. Zeeb info->status.rates[1].flags, 4654383b3e8fSBjoern A. Zeeb info->status.rates[2].idx, info->status.rates[2].count, 4655383b3e8fSBjoern A. Zeeb info->status.rates[2].flags, 4656383b3e8fSBjoern A. Zeeb info->status.rates[3].idx, info->status.rates[3].count, 4657383b3e8fSBjoern A. Zeeb info->status.rates[3].flags, 4658383b3e8fSBjoern A. Zeeb info->status.ack_signal, info->status.ampdu_ack_len, 4659383b3e8fSBjoern A. Zeeb info->status.ampdu_len, info->status.antenna, 4660adff403fSBjoern A. Zeeb info->status.tx_time, info->status.flags, 4661383b3e8fSBjoern A. Zeeb info->status.status_driver_data[0], 4662383b3e8fSBjoern A. Zeeb info->status.status_driver_data[1]); 4663383b3e8fSBjoern A. Zeeb #endif 4664383b3e8fSBjoern A. Zeeb 4665a8397571SBjoern A. Zeeb if (txstat->free_list) { 4666a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(hw, skb, status); 4667a8397571SBjoern A. Zeeb list_add_tail(&skb->list, txstat->free_list); 4668a8397571SBjoern A. Zeeb } else { 4669383b3e8fSBjoern A. Zeeb linuxkpi_ieee80211_free_txskb(hw, skb, status); 4670383b3e8fSBjoern A. Zeeb } 4671a8397571SBjoern A. Zeeb } 4672a8397571SBjoern A. Zeeb 4673a8397571SBjoern A. Zeeb void 4674a8397571SBjoern A. Zeeb linuxkpi_ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb) 4675a8397571SBjoern A. Zeeb { 4676a8397571SBjoern A. Zeeb struct ieee80211_tx_status status; 4677a8397571SBjoern A. Zeeb 4678a8397571SBjoern A. Zeeb memset(&status, 0, sizeof(status)); 4679a8397571SBjoern A. Zeeb status.info = IEEE80211_SKB_CB(skb); 4680a8397571SBjoern A. Zeeb status.skb = skb; 4681a8397571SBjoern A. Zeeb /* sta, n_rates, rates, free_list? */ 4682a8397571SBjoern A. Zeeb 4683a8397571SBjoern A. Zeeb ieee80211_tx_status_ext(hw, &status); 4684a8397571SBjoern A. Zeeb } 4685383b3e8fSBjoern A. Zeeb 46866b4cac81SBjoern A. Zeeb /* 46876b4cac81SBjoern A. Zeeb * This is an internal bandaid for the moment for the way we glue 46886b4cac81SBjoern A. Zeeb * skbs and mbufs together for TX. Once we have skbs backed by 46896b4cac81SBjoern A. Zeeb * mbufs this should go away. 46906b4cac81SBjoern A. Zeeb * This is a public function but kept on the private KPI (lkpi_) 46916b4cac81SBjoern A. Zeeb * and is not exposed by a header file. 46926b4cac81SBjoern A. Zeeb */ 46936b4cac81SBjoern A. Zeeb static void 46946b4cac81SBjoern A. Zeeb lkpi_ieee80211_free_skb_mbuf(void *p) 46956b4cac81SBjoern A. Zeeb { 46966b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 46976b4cac81SBjoern A. Zeeb struct mbuf *m; 46986b4cac81SBjoern A. Zeeb 46996b4cac81SBjoern A. Zeeb if (p == NULL) 47006b4cac81SBjoern A. Zeeb return; 47016b4cac81SBjoern A. Zeeb 47026b4cac81SBjoern A. Zeeb m = (struct mbuf *)p; 47036b4cac81SBjoern A. Zeeb M_ASSERTPKTHDR(m); 47046b4cac81SBjoern A. Zeeb 47056b4cac81SBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 47066b4cac81SBjoern A. Zeeb m->m_pkthdr.PH_loc.ptr = NULL; 47076b4cac81SBjoern A. Zeeb if (ni != NULL) 47086b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 47096b4cac81SBjoern A. Zeeb m_freem(m); 47106b4cac81SBjoern A. Zeeb } 47116b4cac81SBjoern A. Zeeb 47126b4cac81SBjoern A. Zeeb void 47136b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_queue_delayed_work(struct ieee80211_hw *hw, 47146b4cac81SBjoern A. Zeeb struct delayed_work *w, int delay) 47156b4cac81SBjoern A. Zeeb { 47166b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 47176b4cac81SBjoern A. Zeeb 47186b4cac81SBjoern A. Zeeb /* Need to make sure hw is in a stable (non-suspended) state. */ 47196b4cac81SBjoern A. Zeeb IMPROVE(); 47206b4cac81SBjoern A. Zeeb 47216b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 47226b4cac81SBjoern A. Zeeb queue_delayed_work(lhw->workq, w, delay); 47236b4cac81SBjoern A. Zeeb } 47246b4cac81SBjoern A. Zeeb 47256b4cac81SBjoern A. Zeeb void 47266b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_queue_work(struct ieee80211_hw *hw, 47276b4cac81SBjoern A. Zeeb struct work_struct *w) 47286b4cac81SBjoern A. Zeeb { 47296b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 47306b4cac81SBjoern A. Zeeb 47316b4cac81SBjoern A. Zeeb /* Need to make sure hw is in a stable (non-suspended) state. */ 47326b4cac81SBjoern A. Zeeb IMPROVE(); 47336b4cac81SBjoern A. Zeeb 47346b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 47356b4cac81SBjoern A. Zeeb queue_work(lhw->workq, w); 47366b4cac81SBjoern A. Zeeb } 47376b4cac81SBjoern A. Zeeb 47386b4cac81SBjoern A. Zeeb struct sk_buff * 4739ade774b1SBjoern A. Zeeb linuxkpi_ieee80211_probereq_get(struct ieee80211_hw *hw, uint8_t *addr, 4740ade774b1SBjoern A. Zeeb uint8_t *ssid, size_t ssid_len, size_t tailroom) 4741ade774b1SBjoern A. Zeeb { 4742ade774b1SBjoern A. Zeeb struct sk_buff *skb; 4743ade774b1SBjoern A. Zeeb struct ieee80211_frame *wh; 4744ade774b1SBjoern A. Zeeb uint8_t *p; 4745ade774b1SBjoern A. Zeeb size_t len; 4746ade774b1SBjoern A. Zeeb 4747ade774b1SBjoern A. Zeeb len = sizeof(*wh); 4748ade774b1SBjoern A. Zeeb len += 2 + ssid_len; 4749ade774b1SBjoern A. Zeeb 4750ade774b1SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + len + tailroom); 4751ade774b1SBjoern A. Zeeb if (skb == NULL) 4752ade774b1SBjoern A. Zeeb return (NULL); 4753ade774b1SBjoern A. Zeeb 4754ade774b1SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 4755ade774b1SBjoern A. Zeeb 4756ade774b1SBjoern A. Zeeb wh = skb_put_zero(skb, sizeof(*wh)); 4757ade774b1SBjoern A. Zeeb wh->i_fc[0] = IEEE80211_FC0_VERSION_0; 4758ade774b1SBjoern A. Zeeb wh->i_fc[0] |= IEEE80211_FC0_SUBTYPE_PROBE_REQ | IEEE80211_FC0_TYPE_MGT; 4759ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr1, ieee80211broadcastaddr); 4760ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr2, addr); 4761ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr3, ieee80211broadcastaddr); 4762ade774b1SBjoern A. Zeeb 4763ade774b1SBjoern A. Zeeb p = skb_put(skb, 2 + ssid_len); 4764ade774b1SBjoern A. Zeeb *p++ = IEEE80211_ELEMID_SSID; 4765ade774b1SBjoern A. Zeeb *p++ = ssid_len; 4766ade774b1SBjoern A. Zeeb if (ssid_len > 0) 4767ade774b1SBjoern A. Zeeb memcpy(p, ssid, ssid_len); 4768ade774b1SBjoern A. Zeeb 4769ade774b1SBjoern A. Zeeb return (skb); 4770ade774b1SBjoern A. Zeeb } 4771ade774b1SBjoern A. Zeeb 4772ade774b1SBjoern A. Zeeb struct sk_buff * 47736b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_pspoll_get(struct ieee80211_hw *hw, 47746b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif) 47756b4cac81SBjoern A. Zeeb { 47766b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 47776b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 47786b4cac81SBjoern A. Zeeb struct sk_buff *skb; 47796b4cac81SBjoern A. Zeeb struct ieee80211_frame_pspoll *psp; 47806b4cac81SBjoern A. Zeeb uint16_t v; 47816b4cac81SBjoern A. Zeeb 47826b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + sizeof(*psp)); 47836b4cac81SBjoern A. Zeeb if (skb == NULL) 47846b4cac81SBjoern A. Zeeb return (NULL); 47856b4cac81SBjoern A. Zeeb 47866b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 47876b4cac81SBjoern A. Zeeb 47886b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 47896b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 47906b4cac81SBjoern A. Zeeb 47916b4cac81SBjoern A. Zeeb psp = skb_put_zero(skb, sizeof(*psp)); 47926b4cac81SBjoern A. Zeeb psp->i_fc[0] = IEEE80211_FC0_VERSION_0; 47936b4cac81SBjoern A. Zeeb psp->i_fc[0] |= IEEE80211_FC0_SUBTYPE_PS_POLL | IEEE80211_FC0_TYPE_CTL; 4794616e1330SBjoern A. Zeeb v = htole16(vif->cfg.aid | 1<<15 | 1<<16); 47956b4cac81SBjoern A. Zeeb memcpy(&psp->i_aid, &v, sizeof(v)); 47966b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(psp->i_bssid, vap->iv_bss->ni_macaddr); 47976b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(psp->i_ta, vif->addr); 47986b4cac81SBjoern A. Zeeb 47996b4cac81SBjoern A. Zeeb return (skb); 48006b4cac81SBjoern A. Zeeb } 48016b4cac81SBjoern A. Zeeb 48026b4cac81SBjoern A. Zeeb struct sk_buff * 48036b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_nullfunc_get(struct ieee80211_hw *hw, 4804adff403fSBjoern A. Zeeb struct ieee80211_vif *vif, int linkid, bool qos) 48056b4cac81SBjoern A. Zeeb { 48066b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 48076b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 48086b4cac81SBjoern A. Zeeb struct sk_buff *skb; 48096b4cac81SBjoern A. Zeeb struct ieee80211_frame *nullf; 48106b4cac81SBjoern A. Zeeb 4811adff403fSBjoern A. Zeeb IMPROVE("linkid"); 4812adff403fSBjoern A. Zeeb 48136b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + sizeof(*nullf)); 48146b4cac81SBjoern A. Zeeb if (skb == NULL) 48156b4cac81SBjoern A. Zeeb return (NULL); 48166b4cac81SBjoern A. Zeeb 48176b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 48186b4cac81SBjoern A. Zeeb 48196b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 48206b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 48216b4cac81SBjoern A. Zeeb 48226b4cac81SBjoern A. Zeeb nullf = skb_put_zero(skb, sizeof(*nullf)); 48236b4cac81SBjoern A. Zeeb nullf->i_fc[0] = IEEE80211_FC0_VERSION_0; 48246b4cac81SBjoern A. Zeeb nullf->i_fc[0] |= IEEE80211_FC0_SUBTYPE_NODATA | IEEE80211_FC0_TYPE_DATA; 48256b4cac81SBjoern A. Zeeb nullf->i_fc[1] = IEEE80211_FC1_DIR_TODS; 48266b4cac81SBjoern A. Zeeb 48276b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr1, vap->iv_bss->ni_bssid); 48286b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr2, vif->addr); 48296b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr3, vap->iv_bss->ni_macaddr); 48306b4cac81SBjoern A. Zeeb 48316b4cac81SBjoern A. Zeeb return (skb); 48326b4cac81SBjoern A. Zeeb } 48336b4cac81SBjoern A. Zeeb 48346b4cac81SBjoern A. Zeeb struct wireless_dev * 48356b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_vif_to_wdev(struct ieee80211_vif *vif) 48366b4cac81SBjoern A. Zeeb { 48376b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 48386b4cac81SBjoern A. Zeeb 48396b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 48406b4cac81SBjoern A. Zeeb return (&lvif->wdev); 48416b4cac81SBjoern A. Zeeb } 48426b4cac81SBjoern A. Zeeb 48436b4cac81SBjoern A. Zeeb void 48446b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_connection_loss(struct ieee80211_vif *vif) 48456b4cac81SBjoern A. Zeeb { 48466b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 48476b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 48486b4cac81SBjoern A. Zeeb enum ieee80211_state nstate; 48496b4cac81SBjoern A. Zeeb int arg; 48506b4cac81SBjoern A. Zeeb 48516b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 48526b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 48536b4cac81SBjoern A. Zeeb 48546b4cac81SBjoern A. Zeeb /* 4855f3229b62SBjoern A. Zeeb * Go to init; otherwise we need to elaborately check state and 48566b4cac81SBjoern A. Zeeb * handle accordingly, e.g., if in RUN we could call iv_bmiss. 48576b4cac81SBjoern A. Zeeb * Let the statemachine handle all neccessary changes. 48586b4cac81SBjoern A. Zeeb */ 4859f3229b62SBjoern A. Zeeb nstate = IEEE80211_S_INIT; 4860bb81db90SBjoern A. Zeeb arg = 0; /* Not a valid reason. */ 48616b4cac81SBjoern A. Zeeb 48629d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 48639d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 48646b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: vif %p\n", __func__, vif); 48659d9ba2b7SBjoern A. Zeeb #endif 48666b4cac81SBjoern A. Zeeb ieee80211_new_state(vap, nstate, arg); 48676b4cac81SBjoern A. Zeeb } 48686b4cac81SBjoern A. Zeeb 4869bb81db90SBjoern A. Zeeb void 4870bb81db90SBjoern A. Zeeb linuxkpi_ieee80211_beacon_loss(struct ieee80211_vif *vif) 4871bb81db90SBjoern A. Zeeb { 4872bb81db90SBjoern A. Zeeb struct lkpi_vif *lvif; 4873bb81db90SBjoern A. Zeeb struct ieee80211vap *vap; 4874bb81db90SBjoern A. Zeeb 4875bb81db90SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 4876bb81db90SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 4877bb81db90SBjoern A. Zeeb 48789d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 48799d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE || vap->iv_state != IEEE80211_S_RUN) 4880bb81db90SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: vif %p vap %p state %s\n", __func__, 4881bb81db90SBjoern A. Zeeb vif, vap, ieee80211_state_name[vap->iv_state]); 48829d9ba2b7SBjoern A. Zeeb #endif 48833540911bSBjoern A. Zeeb ieee80211_beacon_miss(vap->iv_ic); 4884bb81db90SBjoern A. Zeeb } 4885bb81db90SBjoern A. Zeeb 48865edde07cSBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 48875edde07cSBjoern A. Zeeb 48885a9a0d78SBjoern A. Zeeb void 48895a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queue(struct ieee80211_hw *hw, int qnum) 48905a9a0d78SBjoern A. Zeeb { 48915a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 48925a9a0d78SBjoern A. Zeeb struct lkpi_vif *lvif; 48935a9a0d78SBjoern A. Zeeb struct ieee80211_vif *vif; 48945a9a0d78SBjoern A. Zeeb int ac_count, ac; 48955a9a0d78SBjoern A. Zeeb 48965a9a0d78SBjoern A. Zeeb KASSERT(qnum < hw->queues, ("%s: qnum %d >= hw->queues %d, hw %p\n", 48975a9a0d78SBjoern A. Zeeb __func__, qnum, hw->queues, hw)); 48985a9a0d78SBjoern A. Zeeb 48995a9a0d78SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 49005a9a0d78SBjoern A. Zeeb 49015a9a0d78SBjoern A. Zeeb /* See lkpi_ic_vap_create(). */ 49025a9a0d78SBjoern A. Zeeb if (hw->queues >= IEEE80211_NUM_ACS) 49035a9a0d78SBjoern A. Zeeb ac_count = IEEE80211_NUM_ACS; 49045a9a0d78SBjoern A. Zeeb else 49055a9a0d78SBjoern A. Zeeb ac_count = 1; 49065a9a0d78SBjoern A. Zeeb 49075a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 49085a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 49095a9a0d78SBjoern A. Zeeb 49105a9a0d78SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 49115a9a0d78SBjoern A. Zeeb for (ac = 0; ac < ac_count; ac++) { 49125a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 49135a9a0d78SBjoern A. Zeeb if (qnum == vif->hw_queue[ac]) { 4914*0d2cb6a6SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 49155a9a0d78SBjoern A. Zeeb /* 49165a9a0d78SBjoern A. Zeeb * For now log this to better understand 49175a9a0d78SBjoern A. Zeeb * how this is supposed to work. 49185a9a0d78SBjoern A. Zeeb */ 4919*0d2cb6a6SBjoern A. Zeeb if (lvif->hw_queue_stopped[ac] && 4920*0d2cb6a6SBjoern A. Zeeb (linuxkpi_debug_80211 & D80211_IMPROVE_TXQ) != 0) 49215a9a0d78SBjoern A. Zeeb ic_printf(lhw->ic, "%s:%d: lhw %p hw %p " 49225a9a0d78SBjoern A. Zeeb "lvif %p vif %p ac %d qnum %d already " 49235a9a0d78SBjoern A. Zeeb "stopped\n", __func__, __LINE__, 49245a9a0d78SBjoern A. Zeeb lhw, hw, lvif, vif, ac, qnum); 4925*0d2cb6a6SBjoern A. Zeeb #endif 49265a9a0d78SBjoern A. Zeeb lvif->hw_queue_stopped[ac] = true; 49275a9a0d78SBjoern A. Zeeb } 49285a9a0d78SBjoern A. Zeeb } 49295a9a0d78SBjoern A. Zeeb } 49305a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 49315a9a0d78SBjoern A. Zeeb } 49325a9a0d78SBjoern A. Zeeb 49335a9a0d78SBjoern A. Zeeb void 49345a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queues(struct ieee80211_hw *hw) 49355a9a0d78SBjoern A. Zeeb { 49365a9a0d78SBjoern A. Zeeb int i; 49375a9a0d78SBjoern A. Zeeb 49385a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Locking; do we need further info?"); 49395a9a0d78SBjoern A. Zeeb for (i = 0; i < hw->queues; i++) 49405a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queue(hw, i); 49415a9a0d78SBjoern A. Zeeb } 49425a9a0d78SBjoern A. Zeeb 49435a9a0d78SBjoern A. Zeeb 49445a9a0d78SBjoern A. Zeeb static void 49455a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(struct ieee80211_hw *hw, int hwq) 49465a9a0d78SBjoern A. Zeeb { 49475a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 49485a9a0d78SBjoern A. Zeeb struct lkpi_vif *lvif; 49495a9a0d78SBjoern A. Zeeb struct lkpi_sta *lsta; 49505a9a0d78SBjoern A. Zeeb int ac_count, ac, tid; 49515a9a0d78SBjoern A. Zeeb 49525a9a0d78SBjoern A. Zeeb /* See lkpi_ic_vap_create(). */ 49535a9a0d78SBjoern A. Zeeb if (hw->queues >= IEEE80211_NUM_ACS) 49545a9a0d78SBjoern A. Zeeb ac_count = IEEE80211_NUM_ACS; 49555a9a0d78SBjoern A. Zeeb else 49565a9a0d78SBjoern A. Zeeb ac_count = 1; 49575a9a0d78SBjoern A. Zeeb 49585a9a0d78SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 49595a9a0d78SBjoern A. Zeeb 49605a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Locking"); 49615a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 49625a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 49635a9a0d78SBjoern A. Zeeb struct ieee80211_vif *vif; 49645a9a0d78SBjoern A. Zeeb 49655a9a0d78SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 49665a9a0d78SBjoern A. Zeeb for (ac = 0; ac < ac_count; ac++) { 49675a9a0d78SBjoern A. Zeeb 49685a9a0d78SBjoern A. Zeeb if (hwq == vif->hw_queue[ac]) { 49695a9a0d78SBjoern A. Zeeb 49705a9a0d78SBjoern A. Zeeb /* XXX-BZ what about software scan? */ 49715a9a0d78SBjoern A. Zeeb 4972*0d2cb6a6SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 49735a9a0d78SBjoern A. Zeeb /* 49745a9a0d78SBjoern A. Zeeb * For now log this to better understand 49755a9a0d78SBjoern A. Zeeb * how this is supposed to work. 49765a9a0d78SBjoern A. Zeeb */ 4977*0d2cb6a6SBjoern A. Zeeb if (!lvif->hw_queue_stopped[ac] && 4978*0d2cb6a6SBjoern A. Zeeb (linuxkpi_debug_80211 & D80211_IMPROVE_TXQ) != 0) 49795a9a0d78SBjoern A. Zeeb ic_printf(lhw->ic, "%s:%d: lhw %p hw %p " 49805a9a0d78SBjoern A. Zeeb "lvif %p vif %p ac %d hw_q not stopped\n", 49815a9a0d78SBjoern A. Zeeb __func__, __LINE__, 49825a9a0d78SBjoern A. Zeeb lhw, hw, lvif, vif, ac); 4983*0d2cb6a6SBjoern A. Zeeb #endif 49845a9a0d78SBjoern A. Zeeb lvif->hw_queue_stopped[ac] = false; 49855a9a0d78SBjoern A. Zeeb 49865a9a0d78SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 49875a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lsta, &lvif->lsta_head, lsta_entry) { 49885a9a0d78SBjoern A. Zeeb struct ieee80211_sta *sta; 49895a9a0d78SBjoern A. Zeeb 49905a9a0d78SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 49915a9a0d78SBjoern A. Zeeb for (tid = 0; tid < nitems(sta->txq); tid++) { 49925a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 49935a9a0d78SBjoern A. Zeeb 49945a9a0d78SBjoern A. Zeeb if (sta->txq[tid] == NULL) 49955a9a0d78SBjoern A. Zeeb continue; 49965a9a0d78SBjoern A. Zeeb 49975a9a0d78SBjoern A. Zeeb if (sta->txq[tid]->ac != ac) 49985a9a0d78SBjoern A. Zeeb continue; 49995a9a0d78SBjoern A. Zeeb 50005a9a0d78SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[tid]); 50015a9a0d78SBjoern A. Zeeb if (!ltxq->stopped) 50025a9a0d78SBjoern A. Zeeb continue; 50035a9a0d78SBjoern A. Zeeb 50045a9a0d78SBjoern A. Zeeb ltxq->stopped = false; 50055a9a0d78SBjoern A. Zeeb 50065a9a0d78SBjoern A. Zeeb /* XXX-BZ see when this explodes with all the locking. taskq? */ 50075a9a0d78SBjoern A. Zeeb lkpi_80211_mo_wake_tx_queue(hw, sta->txq[tid]); 50085a9a0d78SBjoern A. Zeeb } 50095a9a0d78SBjoern A. Zeeb } 50105a9a0d78SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 50115a9a0d78SBjoern A. Zeeb } 50125a9a0d78SBjoern A. Zeeb } 50135a9a0d78SBjoern A. Zeeb } 50145a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 50155a9a0d78SBjoern A. Zeeb } 50165a9a0d78SBjoern A. Zeeb 50175a9a0d78SBjoern A. Zeeb void 50185a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_wake_queues(struct ieee80211_hw *hw) 50195a9a0d78SBjoern A. Zeeb { 50205a9a0d78SBjoern A. Zeeb int i; 50215a9a0d78SBjoern A. Zeeb 50225a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Is this all/enough here?"); 50235a9a0d78SBjoern A. Zeeb for (i = 0; i < hw->queues; i++) 50245a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(hw, i); 50255a9a0d78SBjoern A. Zeeb } 50265a9a0d78SBjoern A. Zeeb 50275a9a0d78SBjoern A. Zeeb void 50285a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_wake_queue(struct ieee80211_hw *hw, int qnum) 50295a9a0d78SBjoern A. Zeeb { 50305a9a0d78SBjoern A. Zeeb 50315a9a0d78SBjoern A. Zeeb KASSERT(qnum < hw->queues, ("%s: qnum %d >= hw->queues %d, hw %p\n", 50325a9a0d78SBjoern A. Zeeb __func__, qnum, hw->queues, hw)); 50335a9a0d78SBjoern A. Zeeb 50345a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(hw, qnum); 50355a9a0d78SBjoern A. Zeeb } 50365a9a0d78SBjoern A. Zeeb 50375a9a0d78SBjoern A. Zeeb /* This is just hardware queues. */ 50385a9a0d78SBjoern A. Zeeb void 50395a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_txq_schedule_start(struct ieee80211_hw *hw, uint8_t ac) 50405a9a0d78SBjoern A. Zeeb { 50415a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 50425a9a0d78SBjoern A. Zeeb 50435a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 50445a9a0d78SBjoern A. Zeeb 50455a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Are there reasons why we wouldn't schedule?"); 50465a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 50475a9a0d78SBjoern A. Zeeb if (++lhw->txq_generation[ac] == 0) 50485a9a0d78SBjoern A. Zeeb lhw->txq_generation[ac]++; 50495a9a0d78SBjoern A. Zeeb } 50505a9a0d78SBjoern A. Zeeb 50515a9a0d78SBjoern A. Zeeb struct ieee80211_txq * 50525a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_next_txq(struct ieee80211_hw *hw, uint8_t ac) 50535a9a0d78SBjoern A. Zeeb { 50545a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 50555a9a0d78SBjoern A. Zeeb struct ieee80211_txq *txq; 50565a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 50575a9a0d78SBjoern A. Zeeb 50585a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 50595a9a0d78SBjoern A. Zeeb txq = NULL; 50605a9a0d78SBjoern A. Zeeb 50615a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 50625a9a0d78SBjoern A. Zeeb 50635a9a0d78SBjoern A. Zeeb /* Check that we are scheduled. */ 50645a9a0d78SBjoern A. Zeeb if (lhw->txq_generation[ac] == 0) 50655a9a0d78SBjoern A. Zeeb goto out; 50665a9a0d78SBjoern A. Zeeb 50675a9a0d78SBjoern A. Zeeb ltxq = TAILQ_FIRST(&lhw->scheduled_txqs[ac]); 50685a9a0d78SBjoern A. Zeeb if (ltxq == NULL) 50695a9a0d78SBjoern A. Zeeb goto out; 50705a9a0d78SBjoern A. Zeeb if (ltxq->txq_generation == lhw->txq_generation[ac]) 50715a9a0d78SBjoern A. Zeeb goto out; 50725a9a0d78SBjoern A. Zeeb 50735a9a0d78SBjoern A. Zeeb ltxq->txq_generation = lhw->txq_generation[ac]; 50745a9a0d78SBjoern A. Zeeb TAILQ_REMOVE(&lhw->scheduled_txqs[ac], ltxq, txq_entry); 50755a9a0d78SBjoern A. Zeeb txq = <xq->txq; 50765a9a0d78SBjoern A. Zeeb TAILQ_ELEM_INIT(ltxq, txq_entry); 50775a9a0d78SBjoern A. Zeeb 50785a9a0d78SBjoern A. Zeeb out: 50795a9a0d78SBjoern A. Zeeb return (txq); 50805a9a0d78SBjoern A. Zeeb } 50815a9a0d78SBjoern A. Zeeb 50825a9a0d78SBjoern A. Zeeb void linuxkpi_ieee80211_schedule_txq(struct ieee80211_hw *hw, 50835a9a0d78SBjoern A. Zeeb struct ieee80211_txq *txq, bool withoutpkts) 50845a9a0d78SBjoern A. Zeeb { 50855a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 50865a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 50875a9a0d78SBjoern A. Zeeb 50885a9a0d78SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 50895a9a0d78SBjoern A. Zeeb 50905a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 50915a9a0d78SBjoern A. Zeeb 50925a9a0d78SBjoern A. Zeeb /* Only schedule if work to do or asked to anyway. */ 50935a9a0d78SBjoern A. Zeeb if (!withoutpkts && skb_queue_empty(<xq->skbq)) 50945a9a0d78SBjoern A. Zeeb goto out; 50955a9a0d78SBjoern A. Zeeb 50965a9a0d78SBjoern A. Zeeb /* Make sure we do not double-schedule. */ 50975a9a0d78SBjoern A. Zeeb if (ltxq->txq_entry.tqe_next != NULL) 50985a9a0d78SBjoern A. Zeeb goto out; 50995a9a0d78SBjoern A. Zeeb 51005a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 51015a9a0d78SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lhw->scheduled_txqs[txq->ac], ltxq, txq_entry); 51025a9a0d78SBjoern A. Zeeb out: 51035a9a0d78SBjoern A. Zeeb return; 51045a9a0d78SBjoern A. Zeeb } 51055a9a0d78SBjoern A. Zeeb 51065a9a0d78SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 51075a9a0d78SBjoern A. Zeeb 51085edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss { 51095edde07cSBjoern A. Zeeb u_int refcnt; 51105edde07cSBjoern A. Zeeb struct cfg80211_bss bss; 51115edde07cSBjoern A. Zeeb }; 51125edde07cSBjoern A. Zeeb 51135edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup { 51145edde07cSBjoern A. Zeeb struct wiphy *wiphy; 51155edde07cSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 51165edde07cSBjoern A. Zeeb const uint8_t *bssid; 51175edde07cSBjoern A. Zeeb const uint8_t *ssid; 51185edde07cSBjoern A. Zeeb size_t ssid_len; 51195edde07cSBjoern A. Zeeb enum ieee80211_bss_type bss_type; 51205edde07cSBjoern A. Zeeb enum ieee80211_privacy privacy; 51215edde07cSBjoern A. Zeeb 51225edde07cSBjoern A. Zeeb /* 51235edde07cSBjoern A. Zeeb * Something to store a copy of the result as the net80211 scan cache 51245edde07cSBjoern A. Zeeb * is not refoucnted so a scan entry might go away any time. 51255edde07cSBjoern A. Zeeb */ 51265edde07cSBjoern A. Zeeb bool match; 51275edde07cSBjoern A. Zeeb struct cfg80211_bss *bss; 51285edde07cSBjoern A. Zeeb }; 51295edde07cSBjoern A. Zeeb 51305edde07cSBjoern A. Zeeb static void 51315edde07cSBjoern A. Zeeb lkpi_cfg80211_get_bss_iterf(void *arg, const struct ieee80211_scan_entry *se) 51325edde07cSBjoern A. Zeeb { 51335edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup *lookup; 51345edde07cSBjoern A. Zeeb size_t ielen; 51355edde07cSBjoern A. Zeeb 51365edde07cSBjoern A. Zeeb lookup = arg; 51375edde07cSBjoern A. Zeeb 51385edde07cSBjoern A. Zeeb /* Do not try to find another match. */ 51395edde07cSBjoern A. Zeeb if (lookup->match) 51405edde07cSBjoern A. Zeeb return; 51415edde07cSBjoern A. Zeeb 51425edde07cSBjoern A. Zeeb /* Nothing to store result. */ 51435edde07cSBjoern A. Zeeb if (lookup->bss == NULL) 51445edde07cSBjoern A. Zeeb return; 51455edde07cSBjoern A. Zeeb 51465edde07cSBjoern A. Zeeb if (lookup->privacy != IEEE80211_PRIVACY_ANY) { 51475edde07cSBjoern A. Zeeb /* if (se->se_capinfo & IEEE80211_CAPINFO_PRIVACY) */ 51485edde07cSBjoern A. Zeeb /* We have no idea what to compare to as the drivers only request ANY */ 51495edde07cSBjoern A. Zeeb return; 51505edde07cSBjoern A. Zeeb } 51515edde07cSBjoern A. Zeeb 51525edde07cSBjoern A. Zeeb if (lookup->bss_type != IEEE80211_BSS_TYPE_ANY) { 51535edde07cSBjoern A. Zeeb /* if (se->se_capinfo & (IEEE80211_CAPINFO_IBSS|IEEE80211_CAPINFO_ESS)) */ 51545edde07cSBjoern A. Zeeb /* We have no idea what to compare to as the drivers only request ANY */ 51555edde07cSBjoern A. Zeeb return; 51565edde07cSBjoern A. Zeeb } 51575edde07cSBjoern A. Zeeb 51585edde07cSBjoern A. Zeeb if (lookup->chan != NULL) { 51595edde07cSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 51605edde07cSBjoern A. Zeeb 51615edde07cSBjoern A. Zeeb chan = linuxkpi_ieee80211_get_channel(lookup->wiphy, 51625edde07cSBjoern A. Zeeb se->se_chan->ic_freq); 51635edde07cSBjoern A. Zeeb if (chan == NULL || chan != lookup->chan) 51645edde07cSBjoern A. Zeeb return; 51655edde07cSBjoern A. Zeeb } 51665edde07cSBjoern A. Zeeb 51675edde07cSBjoern A. Zeeb if (lookup->bssid && !IEEE80211_ADDR_EQ(lookup->bssid, se->se_bssid)) 51685edde07cSBjoern A. Zeeb return; 51695edde07cSBjoern A. Zeeb 51705edde07cSBjoern A. Zeeb if (lookup->ssid) { 51715edde07cSBjoern A. Zeeb if (lookup->ssid_len != se->se_ssid[1] || 51725edde07cSBjoern A. Zeeb se->se_ssid[1] == 0) 51735edde07cSBjoern A. Zeeb return; 51745edde07cSBjoern A. Zeeb if (memcmp(lookup->ssid, se->se_ssid+2, lookup->ssid_len) != 0) 51755edde07cSBjoern A. Zeeb return; 51765edde07cSBjoern A. Zeeb } 51775edde07cSBjoern A. Zeeb 51785edde07cSBjoern A. Zeeb ielen = se->se_ies.len; 51795edde07cSBjoern A. Zeeb 51805edde07cSBjoern A. Zeeb lookup->bss->ies = malloc(sizeof(*lookup->bss->ies) + ielen, 51815edde07cSBjoern A. Zeeb M_LKPI80211, M_NOWAIT | M_ZERO); 51825edde07cSBjoern A. Zeeb if (lookup->bss->ies == NULL) 51835edde07cSBjoern A. Zeeb return; 51845edde07cSBjoern A. Zeeb 51855edde07cSBjoern A. Zeeb lookup->bss->ies->data = (uint8_t *)lookup->bss->ies + sizeof(*lookup->bss->ies); 51865edde07cSBjoern A. Zeeb lookup->bss->ies->len = ielen; 51875edde07cSBjoern A. Zeeb if (ielen) 51885edde07cSBjoern A. Zeeb memcpy(lookup->bss->ies->data, se->se_ies.data, ielen); 51895edde07cSBjoern A. Zeeb 51905edde07cSBjoern A. Zeeb lookup->match = true; 51915edde07cSBjoern A. Zeeb } 51925edde07cSBjoern A. Zeeb 51935edde07cSBjoern A. Zeeb struct cfg80211_bss * 51945edde07cSBjoern A. Zeeb linuxkpi_cfg80211_get_bss(struct wiphy *wiphy, struct linuxkpi_ieee80211_channel *chan, 51955edde07cSBjoern A. Zeeb const uint8_t *bssid, const uint8_t *ssid, size_t ssid_len, 51965edde07cSBjoern A. Zeeb enum ieee80211_bss_type bss_type, enum ieee80211_privacy privacy) 51975edde07cSBjoern A. Zeeb { 51985edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss *lbss; 51995edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup lookup; 52005edde07cSBjoern A. Zeeb struct lkpi_hw *lhw; 52015edde07cSBjoern A. Zeeb struct ieee80211vap *vap; 52025edde07cSBjoern A. Zeeb 52035edde07cSBjoern A. Zeeb lhw = wiphy_priv(wiphy); 52045edde07cSBjoern A. Zeeb 52055edde07cSBjoern A. Zeeb /* Let's hope we can alloc. */ 52065edde07cSBjoern A. Zeeb lbss = malloc(sizeof(*lbss), M_LKPI80211, M_NOWAIT | M_ZERO); 52075edde07cSBjoern A. Zeeb if (lbss == NULL) { 52085edde07cSBjoern A. Zeeb ic_printf(lhw->ic, "%s: alloc failed.\n", __func__); 52095edde07cSBjoern A. Zeeb return (NULL); 52105edde07cSBjoern A. Zeeb } 52115edde07cSBjoern A. Zeeb 52125edde07cSBjoern A. Zeeb lookup.wiphy = wiphy; 52135edde07cSBjoern A. Zeeb lookup.chan = chan; 52145edde07cSBjoern A. Zeeb lookup.bssid = bssid; 52155edde07cSBjoern A. Zeeb lookup.ssid = ssid; 52165edde07cSBjoern A. Zeeb lookup.ssid_len = ssid_len; 52175edde07cSBjoern A. Zeeb lookup.bss_type = bss_type; 52185edde07cSBjoern A. Zeeb lookup.privacy = privacy; 52195edde07cSBjoern A. Zeeb lookup.match = false; 52205edde07cSBjoern A. Zeeb lookup.bss = &lbss->bss; 52215edde07cSBjoern A. Zeeb 52225edde07cSBjoern A. Zeeb IMPROVE("Iterate over all VAPs comparing perm_addr and addresses?"); 52235edde07cSBjoern A. Zeeb vap = TAILQ_FIRST(&lhw->ic->ic_vaps); 52245edde07cSBjoern A. Zeeb ieee80211_scan_iterate(vap, lkpi_cfg80211_get_bss_iterf, &lookup); 52255edde07cSBjoern A. Zeeb if (!lookup.match) { 52265edde07cSBjoern A. Zeeb free(lbss, M_LKPI80211); 52275edde07cSBjoern A. Zeeb return (NULL); 52285edde07cSBjoern A. Zeeb } 52295edde07cSBjoern A. Zeeb 52305edde07cSBjoern A. Zeeb refcount_init(&lbss->refcnt, 1); 52315edde07cSBjoern A. Zeeb return (&lbss->bss); 52325edde07cSBjoern A. Zeeb } 52335edde07cSBjoern A. Zeeb 52345edde07cSBjoern A. Zeeb void 52355edde07cSBjoern A. Zeeb linuxkpi_cfg80211_put_bss(struct wiphy *wiphy, struct cfg80211_bss *bss) 52365edde07cSBjoern A. Zeeb { 52375edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss *lbss; 52385edde07cSBjoern A. Zeeb 52395edde07cSBjoern A. Zeeb lbss = container_of(bss, struct lkpi_cfg80211_bss, bss); 52405edde07cSBjoern A. Zeeb 52415edde07cSBjoern A. Zeeb /* Free everything again on refcount ... */ 52425edde07cSBjoern A. Zeeb if (refcount_release(&lbss->refcnt)) { 52435edde07cSBjoern A. Zeeb free(lbss->bss.ies, M_LKPI80211); 52445edde07cSBjoern A. Zeeb free(lbss, M_LKPI80211); 52455edde07cSBjoern A. Zeeb } 52465edde07cSBjoern A. Zeeb } 52475edde07cSBjoern A. Zeeb 52485edde07cSBjoern A. Zeeb void 52495edde07cSBjoern A. Zeeb linuxkpi_cfg80211_bss_flush(struct wiphy *wiphy) 52505edde07cSBjoern A. Zeeb { 52515edde07cSBjoern A. Zeeb struct lkpi_hw *lhw; 52525edde07cSBjoern A. Zeeb struct ieee80211com *ic; 52535edde07cSBjoern A. Zeeb struct ieee80211vap *vap; 52545edde07cSBjoern A. Zeeb 52555edde07cSBjoern A. Zeeb lhw = wiphy_priv(wiphy); 52565edde07cSBjoern A. Zeeb ic = lhw->ic; 52575edde07cSBjoern A. Zeeb 52585edde07cSBjoern A. Zeeb /* 52595edde07cSBjoern A. Zeeb * If we haven't called ieee80211_ifattach() yet 52605edde07cSBjoern A. Zeeb * or there is no VAP, there are no scans to flush. 52615edde07cSBjoern A. Zeeb */ 52625edde07cSBjoern A. Zeeb if (ic == NULL || 52635edde07cSBjoern A. Zeeb (lhw->sc_flags & LKPI_MAC80211_DRV_STARTED) == 0) 52645edde07cSBjoern A. Zeeb return; 52655edde07cSBjoern A. Zeeb 52665edde07cSBjoern A. Zeeb /* Should only happen on the current one? Not seen it late enough. */ 52675edde07cSBjoern A. Zeeb IEEE80211_LOCK(ic); 52685edde07cSBjoern A. Zeeb TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) 52695edde07cSBjoern A. Zeeb ieee80211_scan_flush(vap); 52705edde07cSBjoern A. Zeeb IEEE80211_UNLOCK(ic); 52715edde07cSBjoern A. Zeeb } 52725edde07cSBjoern A. Zeeb 52735edde07cSBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 52745edde07cSBjoern A. Zeeb 52756b4cac81SBjoern A. Zeeb MODULE_VERSION(linuxkpi_wlan, 1); 52766b4cac81SBjoern A. Zeeb MODULE_DEPEND(linuxkpi_wlan, linuxkpi, 1, 1, 1); 52776b4cac81SBjoern A. Zeeb MODULE_DEPEND(linuxkpi_wlan, wlan, 1, 1, 1); 5278