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 116*fb3c249eSBjoern A. Zeeb /* IEEE 802.11e Table 20i-UP-to-AC mappings. */ 117*fb3c249eSBjoern 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 { 243*fb3c249eSBjoern 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; 9256b4cac81SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 9266b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 9276b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 9286b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 9296b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 9306b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 9316b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 9326b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 9336b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 9346b4cac81SBjoern A. Zeeb uint32_t changed; 9356b4cac81SBjoern A. Zeeb int error; 9366b4cac81SBjoern A. Zeeb 9376b4cac81SBjoern A. Zeeb chan = lkpi_get_lkpi80211_chan(vap->iv_ic, vap->iv_bss); 9386b4cac81SBjoern A. Zeeb if (chan == NULL) { 9396b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: failed to get channel\n", __func__); 9406b4cac81SBjoern A. Zeeb return (ESRCH); 9416b4cac81SBjoern A. Zeeb } 9426b4cac81SBjoern A. Zeeb 9436b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 9446b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 9456b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 9466b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 9476b4cac81SBjoern A. Zeeb 948d9f59799SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 949d9f59799SBjoern A. Zeeb 9506b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 9518ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 9526b4cac81SBjoern A. Zeeb 9536b4cac81SBjoern A. Zeeb /* Add chanctx (or if exists, change it). */ 9546b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 9556b4cac81SBjoern A. Zeeb conf = vif->chanctx_conf; 9566b4cac81SBjoern A. Zeeb IMPROVE("diff changes for changed, working on live copy, rcu"); 9576b4cac81SBjoern A. Zeeb } else { 9586b4cac81SBjoern A. Zeeb /* Keep separate alloc as in Linux this is rcu managed? */ 9596b4cac81SBjoern A. Zeeb conf = malloc(sizeof(*conf) + hw->chanctx_data_size, 9606b4cac81SBjoern A. Zeeb M_LKPI80211, M_WAITOK | M_ZERO); 9616b4cac81SBjoern A. Zeeb } 9626b4cac81SBjoern A. Zeeb 9636b4cac81SBjoern A. Zeeb conf->rx_chains_dynamic = 1; 9646b4cac81SBjoern A. Zeeb conf->rx_chains_static = 1; 9656b4cac81SBjoern A. Zeeb conf->radar_enabled = 9666b4cac81SBjoern A. Zeeb (chan->flags & IEEE80211_CHAN_RADAR) ? true : false; 9676b4cac81SBjoern A. Zeeb conf->def.chan = chan; 9686b4cac81SBjoern A. Zeeb conf->def.width = NL80211_CHAN_WIDTH_20_NOHT; 9696b4cac81SBjoern A. Zeeb conf->def.center_freq1 = chan->center_freq; 9706b4cac81SBjoern A. Zeeb conf->def.center_freq2 = 0; 9716b4cac81SBjoern A. Zeeb /* Responder ... */ 9726b4cac81SBjoern A. Zeeb conf->min_def.chan = chan; 9736b4cac81SBjoern A. Zeeb conf->min_def.width = NL80211_CHAN_WIDTH_20_NOHT; 9746b4cac81SBjoern A. Zeeb conf->min_def.center_freq1 = chan->center_freq; 9756b4cac81SBjoern A. Zeeb conf->min_def.center_freq2 = 0; 9766b4cac81SBjoern A. Zeeb IMPROVE("currently 20_NOHT only"); 9776b4cac81SBjoern A. Zeeb 9786ffb7bd4SBjoern A. Zeeb /* Set bss info (bss_info_changed). */ 9796ffb7bd4SBjoern A. Zeeb bss_changed = 0; 9806ffb7bd4SBjoern A. Zeeb vif->bss_conf.bssid = ni->ni_bssid; 9816ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 9826ffb7bd4SBjoern A. Zeeb vif->bss_conf.txpower = ni->ni_txpower; 9836ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_TXPOWER; 9846ffb7bd4SBjoern A. Zeeb vif->cfg.idle = false; 9856ffb7bd4SBjoern A. Zeeb bss_changed |= BSS_CHANGED_IDLE; 9866ffb7bd4SBjoern A. Zeeb 9876ffb7bd4SBjoern A. Zeeb /* vif->bss_conf.basic_rates ? Where exactly? */ 9886ffb7bd4SBjoern A. Zeeb 9896ffb7bd4SBjoern A. Zeeb /* Should almost assert it is this. */ 9906ffb7bd4SBjoern A. Zeeb vif->cfg.assoc = false; 9916ffb7bd4SBjoern A. Zeeb vif->cfg.aid = 0; 9926ffb7bd4SBjoern A. Zeeb 9936ffb7bd4SBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 9946ffb7bd4SBjoern A. Zeeb 9956b4cac81SBjoern A. Zeeb error = 0; 9966b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 9976b4cac81SBjoern A. Zeeb changed = IEEE80211_CHANCTX_CHANGE_MIN_WIDTH; 9986b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_RADAR; 9996b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_RX_CHAINS; 10006b4cac81SBjoern A. Zeeb changed |= IEEE80211_CHANCTX_CHANGE_WIDTH; 10016b4cac81SBjoern A. Zeeb lkpi_80211_mo_change_chanctx(hw, conf, changed); 10026b4cac81SBjoern A. Zeeb } else { 10036b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_add_chanctx(hw, conf); 10046b4cac81SBjoern A. Zeeb if (error == 0 || error == EOPNOTSUPP) { 10056b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.chan = conf->def.chan; 10066b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.width = conf->def.width; 10076b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.center_freq1 = 10086b4cac81SBjoern A. Zeeb conf->def.center_freq1; 10096b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.center_freq2 = 10106b4cac81SBjoern A. Zeeb conf->def.center_freq2; 10116b4cac81SBjoern A. Zeeb } else { 10126b4cac81SBjoern A. Zeeb goto out; 10136b4cac81SBjoern A. Zeeb } 10146ffb7bd4SBjoern A. Zeeb 10156ffb7bd4SBjoern A. Zeeb vif->bss_conf.chanctx_conf = conf; 10166ffb7bd4SBjoern A. Zeeb 10176b4cac81SBjoern A. Zeeb /* Assign vif chanctx. */ 10186b4cac81SBjoern A. Zeeb if (error == 0) 101968541546SBjoern A. Zeeb error = lkpi_80211_mo_assign_vif_chanctx(hw, vif, 102068541546SBjoern A. Zeeb &vif->bss_conf, conf); 10216b4cac81SBjoern A. Zeeb if (error == EOPNOTSUPP) 10226b4cac81SBjoern A. Zeeb error = 0; 10236b4cac81SBjoern A. Zeeb if (error != 0) { 10246b4cac81SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 10256b4cac81SBjoern A. Zeeb free(conf, M_LKPI80211); 10266b4cac81SBjoern A. Zeeb goto out; 10276b4cac81SBjoern A. Zeeb } 10286b4cac81SBjoern A. Zeeb } 10296b4cac81SBjoern A. Zeeb IMPROVE("update radiotap chan fields too"); 10306b4cac81SBjoern A. Zeeb 10316b4cac81SBjoern A. Zeeb /* RATES */ 10326b4cac81SBjoern A. Zeeb IMPROVE("bss info: not all needs to come now and rates are missing"); 10336b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 10346b4cac81SBjoern A. Zeeb 1035d9f59799SBjoern A. Zeeb /* 1036d9f59799SBjoern A. Zeeb * This is a bandaid for now. If we went through (*iv_update_bss)() 1037d9f59799SBjoern A. Zeeb * and then removed the lsta we end up here without a lsta and have 1038d9f59799SBjoern A. Zeeb * to manually allocate and link it in as lkpi_ic_node_alloc()/init() 1039d9f59799SBjoern A. Zeeb * would normally do. 1040d9f59799SBjoern A. Zeeb * XXX-BZ I do not like this but currently we have no good way of 1041d9f59799SBjoern A. Zeeb * intercepting the bss swap and state changes and packets going out 1042d9f59799SBjoern A. Zeeb * workflow so live with this. It is a compat layer after all. 1043d9f59799SBjoern A. Zeeb */ 1044d9f59799SBjoern A. Zeeb if (ni->ni_drv_data == NULL) { 1045d9f59799SBjoern A. Zeeb lsta = lkpi_lsta_alloc(vap, ni->ni_macaddr, hw, ni); 1046d9f59799SBjoern A. Zeeb if (lsta == NULL) { 1047d9f59799SBjoern A. Zeeb error = ENOMEM; 1048d9f59799SBjoern A. Zeeb goto out; 1049d9f59799SBjoern A. Zeeb } 1050d9f59799SBjoern A. Zeeb lsta->ni = ieee80211_ref_node(ni); 1051d9f59799SBjoern A. Zeeb } else { 10526b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 1053d9f59799SBjoern A. Zeeb } 1054e24e8103SBjoern A. Zeeb 1055e24e8103SBjoern A. Zeeb /* Insert the [l]sta into the list of known stations. */ 1056e24e8103SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 1057e24e8103SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lvif->lsta_head, lsta, lsta_entry); 1058e24e8103SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 1059e24e8103SBjoern A. Zeeb 1060d9f59799SBjoern A. Zeeb /* Add (or adjust) sta and change state (from NOTEXIST) to NONE. */ 10616b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 10626b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NOTEXIST, ("%s: lsta %p state not " 10636b4cac81SBjoern A. Zeeb "NOTEXIST: %#x\n", __func__, lsta, lsta->state)); 1064e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 10656b4cac81SBjoern A. Zeeb if (error != 0) { 10666b4cac81SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 10676b4cac81SBjoern A. Zeeb goto out; 10686b4cac81SBjoern A. Zeeb } 10696b4cac81SBjoern A. Zeeb #if 0 10706b4cac81SBjoern A. Zeeb lsta->added_to_drv = true; /* mo manages. */ 10716b4cac81SBjoern A. Zeeb #endif 10726b4cac81SBjoern A. Zeeb 10739d9ba2b7SBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 10749d9ba2b7SBjoern A. Zeeb 10756b4cac81SBjoern A. Zeeb /* 10766b4cac81SBjoern A. Zeeb * Wakeup all queues now that sta is there so we have as much time to 10776b4cac81SBjoern A. Zeeb * possibly prepare the queue in the driver to be ready for the 1st 10786b4cac81SBjoern A. Zeeb * packet; lkpi_80211_txq_tx_one() still has a workaround as there 10796b4cac81SBjoern A. Zeeb * is no guarantee or way to check. 1080d9f59799SBjoern A. Zeeb * XXX-BZ and by now we know that this does not work on all drivers 1081d9f59799SBjoern A. Zeeb * for all queues. 10826b4cac81SBjoern A. Zeeb */ 1083e7fe0373SBjoern A. Zeeb lkpi_wake_tx_queues(hw, LSTA_TO_STA(lsta), false, false); 10846b4cac81SBjoern A. Zeeb 10856b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 10866b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 10876b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 10886b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 10896b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 10906b4cac81SBjoern A. Zeeb 10916b4cac81SBjoern A. Zeeb /* 10926b4cac81SBjoern A. Zeeb * What is going to happen next: 10936b4cac81SBjoern A. Zeeb * - <twiddle> .. we should end up in "auth_to_assoc" 10946b4cac81SBjoern A. Zeeb * - event_callback 10956b4cac81SBjoern A. Zeeb * - update sta_state (NONE to AUTH) 10966b4cac81SBjoern A. Zeeb * - mgd_complete_tx 10976b4cac81SBjoern A. Zeeb * (ideally we'd do that on a callback for something else ...) 10986b4cac81SBjoern A. Zeeb */ 10996b4cac81SBjoern A. Zeeb 11006b4cac81SBjoern A. Zeeb out: 11018ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 11026b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 11036b4cac81SBjoern A. Zeeb if (ni != NULL) 11046b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 11056b4cac81SBjoern A. Zeeb return (error); 11066b4cac81SBjoern A. Zeeb } 11076b4cac81SBjoern A. Zeeb 11086b4cac81SBjoern A. Zeeb static int 11096b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 11106b4cac81SBjoern A. Zeeb { 11116b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 11126b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 11136b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 11146b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 11156b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 11166b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 11176b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 11186b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 11196b4cac81SBjoern A. Zeeb int error; 11206b4cac81SBjoern A. Zeeb 11216b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 11226b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 11236b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 11246b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 11256b4cac81SBjoern A. Zeeb 11266b4cac81SBjoern A. Zeeb /* Keep ni around. */ 11276b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 11286b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 11296b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 11306b4cac81SBjoern A. Zeeb 113167674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 11326b4cac81SBjoern A. Zeeb 11336b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 11348ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 11356b4cac81SBjoern A. Zeeb 1136d9f59799SBjoern A. Zeeb /* flush, drop. */ 1137d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1138d9f59799SBjoern A. Zeeb 11396b4cac81SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 11406b4cac81SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 11416b4cac81SBjoern A. Zeeb 11426b4cac81SBjoern A. Zeeb /* flush, no drop */ 11436b4cac81SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 11446b4cac81SBjoern A. Zeeb 11456b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 11466b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 11476b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 11486b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 11496b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 11506b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 11516b4cac81SBjoern A. Zeeb } 11526b4cac81SBjoern A. Zeeb 11536b4cac81SBjoern A. Zeeb /* sync_rx_queues */ 11546b4cac81SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 11556b4cac81SBjoern A. Zeeb 11566b4cac81SBjoern A. Zeeb /* sta_pre_rcu_remove */ 11576b4cac81SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1158d9f59799SBjoern A. Zeeb 1159d9f59799SBjoern A. Zeeb /* Take the station down. */ 11606b4cac81SBjoern A. Zeeb 11616b4cac81SBjoern A. Zeeb /* Adjust sta and change state (from NONE) to NOTEXIST. */ 11626b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 11636b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1164d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1165e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 11666b4cac81SBjoern A. Zeeb if (error != 0) { 11676b4cac81SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 11686b4cac81SBjoern A. Zeeb goto out; 11696b4cac81SBjoern A. Zeeb } 11706b4cac81SBjoern A. Zeeb #if 0 11716b4cac81SBjoern A. Zeeb lsta->added_to_drv = false; /* mo manages. */ 11726b4cac81SBjoern A. Zeeb #endif 11736b4cac81SBjoern A. Zeeb 117467674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 11756b4cac81SBjoern A. Zeeb 1176d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1177d9f59799SBjoern A. Zeeb 1178d9f59799SBjoern A. Zeeb /* conf_tx */ 1179d9f59799SBjoern A. Zeeb 1180d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 11816b4cac81SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 11826b4cac81SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 11836b4cac81SBjoern A. Zeeb 11846b4cac81SBjoern A. Zeeb conf = vif->chanctx_conf; 11856b4cac81SBjoern A. Zeeb /* Remove vif context. */ 118668541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 11876b4cac81SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 11886b4cac81SBjoern A. Zeeb 11896b4cac81SBjoern A. Zeeb /* Remove chan ctx. */ 11906b4cac81SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 11916b4cac81SBjoern A. Zeeb free(conf, M_LKPI80211); 11926b4cac81SBjoern A. Zeeb } 11936b4cac81SBjoern A. Zeeb 11946b4cac81SBjoern A. Zeeb out: 11958ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 11966b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 11976b4cac81SBjoern A. Zeeb if (ni != NULL) 11986b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 11996b4cac81SBjoern A. Zeeb return (error); 12006b4cac81SBjoern A. Zeeb } 12016b4cac81SBjoern A. Zeeb 12026b4cac81SBjoern A. Zeeb static int 12036b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12046b4cac81SBjoern A. Zeeb { 12056b4cac81SBjoern A. Zeeb int error; 12066b4cac81SBjoern A. Zeeb 12076b4cac81SBjoern A. Zeeb error = lkpi_sta_auth_to_scan(vap, nstate, arg); 12086b4cac81SBjoern A. Zeeb if (error == 0) 12096b4cac81SBjoern A. Zeeb error = lkpi_sta_scan_to_init(vap, nstate, arg); 12106b4cac81SBjoern A. Zeeb return (error); 12116b4cac81SBjoern A. Zeeb } 12126b4cac81SBjoern A. Zeeb 12136b4cac81SBjoern A. Zeeb static int 12146b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_assoc(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12156b4cac81SBjoern A. Zeeb { 12166b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 12176b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 12186b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 12196b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 12206b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 12216b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 12226b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 12236b4cac81SBjoern A. Zeeb int error; 12246b4cac81SBjoern A. Zeeb 12256b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 12266b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 12276b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 12286b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 12296b4cac81SBjoern A. Zeeb 12306b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 12318ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 12326b4cac81SBjoern A. Zeeb ni = NULL; 12336b4cac81SBjoern A. Zeeb 12346b4cac81SBjoern A. Zeeb /* Finish auth. */ 12356b4cac81SBjoern A. Zeeb IMPROVE("event callback"); 12366b4cac81SBjoern A. Zeeb 12376b4cac81SBjoern A. Zeeb /* Update sta_state (NONE to AUTH). */ 12386b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 12396b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 12406b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 12416b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 12426b4cac81SBjoern A. Zeeb "NONE: %#x\n", __func__, lsta, lsta->state)); 1243e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 12446b4cac81SBjoern A. Zeeb if (error != 0) 12456b4cac81SBjoern A. Zeeb goto out; 12466b4cac81SBjoern A. Zeeb 12476b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 12486b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 12496b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 12506b4cac81SBjoern A. Zeeb prep_tx_info.success = true; 12516b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 12526b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 12536b4cac81SBjoern A. Zeeb } 12546b4cac81SBjoern A. Zeeb 12556b4cac81SBjoern A. Zeeb /* Now start assoc. */ 12566b4cac81SBjoern A. Zeeb 12576b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 12586b4cac81SBjoern A. Zeeb if (!lsta->in_mgd) { 12596b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 12606b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 12616b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 12626b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 12636b4cac81SBjoern A. Zeeb } 12646b4cac81SBjoern A. Zeeb 12656b4cac81SBjoern A. Zeeb /* Wake tx queue to get packet out. */ 1266e7fe0373SBjoern A. Zeeb lkpi_wake_tx_queues(hw, LSTA_TO_STA(lsta), true, true); 12676b4cac81SBjoern A. Zeeb 12686b4cac81SBjoern A. Zeeb /* 12696b4cac81SBjoern A. Zeeb * <twiddle> .. we end up in "assoc_to_run" 12706b4cac81SBjoern A. Zeeb * - update sta_state (AUTH to ASSOC) 12716b4cac81SBjoern A. Zeeb * - conf_tx [all] 12726b4cac81SBjoern A. Zeeb * - bss_info_changed (assoc, aid, ssid, ..) 12736b4cac81SBjoern A. Zeeb * - change_chanctx (if needed) 12746b4cac81SBjoern A. Zeeb * - event_callback 12756b4cac81SBjoern A. Zeeb * - mgd_complete_tx 12766b4cac81SBjoern A. Zeeb */ 12776b4cac81SBjoern A. Zeeb 12786b4cac81SBjoern A. Zeeb out: 12798ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 12806b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 12816b4cac81SBjoern A. Zeeb if (ni != NULL) 12826b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 12836b4cac81SBjoern A. Zeeb return (error); 12846b4cac81SBjoern A. Zeeb } 12856b4cac81SBjoern A. Zeeb 12866b4cac81SBjoern A. Zeeb /* auth_to_auth, assoc_to_assoc. */ 12876b4cac81SBjoern A. Zeeb static int 12886b4cac81SBjoern A. Zeeb lkpi_sta_a_to_a(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 12896b4cac81SBjoern A. Zeeb { 12906b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 12916b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 12926b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 12936b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 12946b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 12956b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 12966b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 12976b4cac81SBjoern A. Zeeb 12986b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 12996b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 13006b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 13016b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 13026b4cac81SBjoern A. Zeeb 13036b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 13046b4cac81SBjoern A. Zeeb 13056b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13068ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 13076b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 13086b4cac81SBjoern A. Zeeb 13096b4cac81SBjoern A. Zeeb IMPROVE("event callback?"); 13106b4cac81SBjoern A. Zeeb 13116b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 13126b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 13136b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 13146b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 13156b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 13166b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 13176b4cac81SBjoern A. Zeeb } 13186b4cac81SBjoern A. Zeeb 13196b4cac81SBjoern A. Zeeb /* Now start assoc. */ 13206b4cac81SBjoern A. Zeeb 13216b4cac81SBjoern A. Zeeb /* Start mgd_prepare_tx. */ 13226b4cac81SBjoern A. Zeeb if (!lsta->in_mgd) { 13236b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 13246b4cac81SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 13256b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 13266b4cac81SBjoern A. Zeeb lsta->in_mgd = true; 13276b4cac81SBjoern A. Zeeb } 13286b4cac81SBjoern A. Zeeb 13298ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 13306b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 13316b4cac81SBjoern A. Zeeb if (ni != NULL) 13326b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 13336b4cac81SBjoern A. Zeeb 13346b4cac81SBjoern A. Zeeb return (0); 13356b4cac81SBjoern A. Zeeb } 13366b4cac81SBjoern A. Zeeb 13376b4cac81SBjoern A. Zeeb static int 1338d9f59799SBjoern A. Zeeb _lkpi_sta_assoc_to_down(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 13396b4cac81SBjoern A. Zeeb { 13406b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 13416b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 13426b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 13436b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 13446b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 13456b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 13466b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 13476b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1348d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 13496b4cac81SBjoern A. Zeeb int error; 13506b4cac81SBjoern A. Zeeb 13516b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 13526b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 13536b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 13546b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 13556b4cac81SBjoern A. Zeeb 13566b4cac81SBjoern A. Zeeb /* Keep ni around. */ 13576b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 13586b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 13596b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 13606b4cac81SBjoern A. Zeeb 136167674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1362d9f59799SBjoern A. Zeeb 1363d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13648ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1365d9f59799SBjoern A. Zeeb 1366d9f59799SBjoern A. Zeeb /* flush, drop. */ 1367d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1368d9f59799SBjoern A. Zeeb 1369d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1370d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1371d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1372d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1373d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1374d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1375d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1376d9f59799SBjoern A. Zeeb } 1377d9f59799SBjoern A. Zeeb 13788ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1379d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1380d9f59799SBjoern A. Zeeb 1381d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1382d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1383d9f59799SBjoern A. Zeeb if (error != 0) 1384d9f59799SBjoern A. Zeeb goto outni; 1385d9f59799SBjoern A. Zeeb 1386d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 13878ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1388d9f59799SBjoern A. Zeeb 138967674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1390d9f59799SBjoern A. Zeeb 1391d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1392d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1393d9f59799SBjoern A. Zeeb 1394d9f59799SBjoern A. Zeeb /* flush, no drop */ 1395d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1396d9f59799SBjoern A. Zeeb 13976b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 13986b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 13996b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 14006b4cac81SBjoern A. Zeeb prep_tx_info.success = false; 14016b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 14026b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 14036b4cac81SBjoern A. Zeeb } 14046b4cac81SBjoern A. Zeeb 1405d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1406d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1407d9f59799SBjoern A. Zeeb 1408d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1409d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1410d9f59799SBjoern A. Zeeb 1411d9f59799SBjoern A. Zeeb /* Take the station down. */ 1412d9f59799SBjoern A. Zeeb 14136b4cac81SBjoern A. Zeeb /* Update sta and change state (from AUTH) to NONE. */ 14146b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 14156b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 14166b4cac81SBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 1417e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 14186b4cac81SBjoern A. Zeeb if (error != 0) 14196b4cac81SBjoern A. Zeeb goto out; 14206b4cac81SBjoern A. Zeeb 142167674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 14226b4cac81SBjoern A. Zeeb 1423d9f59799SBjoern A. Zeeb /* Adjust sta and change state (from NONE) to NOTEXIST. */ 1424d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1425d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1426d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1427e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 1428d9f59799SBjoern A. Zeeb if (error != 0) { 1429d9f59799SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 1430d9f59799SBjoern A. Zeeb goto out; 1431d9f59799SBjoern A. Zeeb } 1432d9f59799SBjoern A. Zeeb #if 0 1433d9f59799SBjoern A. Zeeb lsta->added_to_drv = false; /* mo manages. */ 1434d9f59799SBjoern A. Zeeb #endif 1435d9f59799SBjoern A. Zeeb 143667674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1437d9f59799SBjoern A. Zeeb 1438d9f59799SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 1439d9f59799SBjoern A. Zeeb /* We need to do this now, can only do after sta is IEEE80211_STA_NOTEXIST. */ 1440d9f59799SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 1441d9f59799SBjoern A. Zeeb 1442d9f59799SBjoern A. Zeeb IMPROVE("Any bss_info changes to announce?"); 1443d9f59799SBjoern A. Zeeb bss_changed = 0; 1444d9f59799SBjoern A. Zeeb vif->bss_conf.qos = 0; 1445d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 1446616e1330SBjoern A. Zeeb vif->cfg.ssid_len = 0; 1447616e1330SBjoern A. Zeeb memset(vif->cfg.ssid, '\0', sizeof(vif->cfg.ssid)); 1448d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 1449d9f59799SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1450d9f59799SBjoern A. Zeeb 1451d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1452d9f59799SBjoern A. Zeeb 1453d9f59799SBjoern A. Zeeb /* conf_tx */ 1454d9f59799SBjoern A. Zeeb 1455d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 1456d9f59799SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 1457d9f59799SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 1458d9f59799SBjoern A. Zeeb 1459d9f59799SBjoern A. Zeeb conf = vif->chanctx_conf; 1460d9f59799SBjoern A. Zeeb /* Remove vif context. */ 146168541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 1462d9f59799SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 1463d9f59799SBjoern A. Zeeb 1464d9f59799SBjoern A. Zeeb /* Remove chan ctx. */ 1465d9f59799SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1466d9f59799SBjoern A. Zeeb free(conf, M_LKPI80211); 1467d9f59799SBjoern A. Zeeb } 1468d9f59799SBjoern A. Zeeb 1469d9f59799SBjoern A. Zeeb error = EALREADY; 14706b4cac81SBjoern A. Zeeb out: 14718ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 14726b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1473d9f59799SBjoern A. Zeeb outni: 14746b4cac81SBjoern A. Zeeb if (ni != NULL) 14756b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 14766b4cac81SBjoern A. Zeeb return (error); 14776b4cac81SBjoern A. Zeeb } 14786b4cac81SBjoern A. Zeeb 14796b4cac81SBjoern A. Zeeb static int 1480d9f59799SBjoern A. Zeeb lkpi_sta_assoc_to_auth(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1481d9f59799SBjoern A. Zeeb { 1482d9f59799SBjoern A. Zeeb int error; 1483d9f59799SBjoern A. Zeeb 1484d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 1485d9f59799SBjoern A. Zeeb if (error != 0 && error != EALREADY) 1486d9f59799SBjoern A. Zeeb return (error); 1487d9f59799SBjoern A. Zeeb 1488d9f59799SBjoern A. Zeeb /* At this point iv_bss is long a new node! */ 1489d9f59799SBjoern A. Zeeb 1490d9f59799SBjoern A. Zeeb error |= lkpi_sta_scan_to_auth(vap, nstate, 0); 1491d9f59799SBjoern A. Zeeb return (error); 1492d9f59799SBjoern A. Zeeb } 1493d9f59799SBjoern A. Zeeb 1494d9f59799SBjoern A. Zeeb static int 14956b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 14966b4cac81SBjoern A. Zeeb { 14976b4cac81SBjoern A. Zeeb int error; 14986b4cac81SBjoern A. Zeeb 1499d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 15006b4cac81SBjoern A. Zeeb return (error); 15016b4cac81SBjoern A. Zeeb } 15026b4cac81SBjoern A. Zeeb 15036b4cac81SBjoern A. Zeeb static int 15046b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 15056b4cac81SBjoern A. Zeeb { 15066b4cac81SBjoern A. Zeeb int error; 15076b4cac81SBjoern A. Zeeb 1508d9f59799SBjoern A. Zeeb error = _lkpi_sta_assoc_to_down(vap, nstate, arg); 15096b4cac81SBjoern A. Zeeb return (error); 15106b4cac81SBjoern A. Zeeb } 15116b4cac81SBjoern A. Zeeb 15126b4cac81SBjoern A. Zeeb static int 15136b4cac81SBjoern A. Zeeb lkpi_sta_assoc_to_run(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 15146b4cac81SBjoern A. Zeeb { 15156b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 15166b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 15176b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 15186b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 15196b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 15206b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 15216b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 15226b4cac81SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 15236b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 15246b4cac81SBjoern A. Zeeb int error; 15256b4cac81SBjoern A. Zeeb 15266b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 15276b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 15286b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 15296b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 15306b4cac81SBjoern A. Zeeb 15316b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 15328ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 15339597f7cbSBjoern A. Zeeb ni = NULL; 15346b4cac81SBjoern A. Zeeb 15356b4cac81SBjoern A. Zeeb IMPROVE("ponder some of this moved to ic_newassoc, scan_assoc_success, " 15366b4cac81SBjoern A. Zeeb "and to lesser extend ieee80211_notify_node_join"); 15376b4cac81SBjoern A. Zeeb 15389597f7cbSBjoern A. Zeeb /* Finish assoc. */ 15399597f7cbSBjoern A. Zeeb /* Update sta_state (AUTH to ASSOC) and set aid. */ 15406b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 15416b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 15426b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 15439597f7cbSBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 15449597f7cbSBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 15456b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 15469597f7cbSBjoern A. Zeeb sta->aid = IEEE80211_NODE_AID(ni); 15474a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 15484a67f1dfSBjoern A. Zeeb if (vap->iv_flags & IEEE80211_F_WME) 15494a67f1dfSBjoern A. Zeeb sta->wme = true; 15504a67f1dfSBjoern A. Zeeb #endif 1551e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 15529597f7cbSBjoern A. Zeeb if (error != 0) 15539597f7cbSBjoern A. Zeeb goto out; 15546b4cac81SBjoern A. Zeeb 15556b4cac81SBjoern A. Zeeb IMPROVE("wme / conf_tx [all]"); 15566b4cac81SBjoern A. Zeeb 15576b4cac81SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 15586b4cac81SBjoern A. Zeeb bss_changed = 0; 15594a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 15604a67f1dfSBjoern A. Zeeb bss_changed |= lkpi_wme_update(lhw, vap, true); 15614a67f1dfSBjoern A. Zeeb #endif 1562616e1330SBjoern A. Zeeb if (!vif->cfg.assoc || vif->cfg.aid != IEEE80211_NODE_AID(ni)) { 1563616e1330SBjoern A. Zeeb vif->cfg.assoc = true; 1564616e1330SBjoern A. Zeeb vif->cfg.aid = IEEE80211_NODE_AID(ni); 15656b4cac81SBjoern A. Zeeb bss_changed |= BSS_CHANGED_ASSOC; 15666b4cac81SBjoern A. Zeeb } 15676b4cac81SBjoern A. Zeeb /* We set SSID but this is not BSSID! */ 1568616e1330SBjoern A. Zeeb vif->cfg.ssid_len = ni->ni_esslen; 1569616e1330SBjoern A. Zeeb memcpy(vif->cfg.ssid, ni->ni_essid, ni->ni_esslen); 15706b4cac81SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_SHPREAMBLE) != 15716b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble) { 15726b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble ^= 1; 15736b4cac81SBjoern A. Zeeb /* bss_changed |= BSS_CHANGED_??? */ 15746b4cac81SBjoern A. Zeeb } 15756b4cac81SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_SHSLOT) != 15766b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot) { 15776b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot ^= 1; 15786b4cac81SBjoern A. Zeeb /* bss_changed |= BSS_CHANGED_??? */ 15796b4cac81SBjoern A. Zeeb } 15806b4cac81SBjoern A. Zeeb if ((ni->ni_flags & IEEE80211_NODE_QOS) != 15816b4cac81SBjoern A. Zeeb vif->bss_conf.qos) { 15826b4cac81SBjoern A. Zeeb vif->bss_conf.qos ^= 1; 15836b4cac81SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 15846b4cac81SBjoern A. Zeeb } 1585fa8f007dSBjoern A. Zeeb 1586fa8f007dSBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 1587fa8f007dSBjoern A. Zeeb 15886b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 15896b4cac81SBjoern A. Zeeb 15906b4cac81SBjoern A. Zeeb /* - change_chanctx (if needed) 15916b4cac81SBjoern A. Zeeb * - event_callback 15926b4cac81SBjoern A. Zeeb */ 15936b4cac81SBjoern A. Zeeb 15946b4cac81SBjoern A. Zeeb /* End mgd_complete_tx. */ 15956b4cac81SBjoern A. Zeeb if (lsta->in_mgd) { 15966b4cac81SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 15976b4cac81SBjoern A. Zeeb prep_tx_info.success = true; 15986b4cac81SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 15996b4cac81SBjoern A. Zeeb lsta->in_mgd = false; 16006b4cac81SBjoern A. Zeeb } 16016b4cac81SBjoern A. Zeeb 1602086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, false); 1603086be6a8SBjoern A. Zeeb 16046b4cac81SBjoern A. Zeeb /* 16056b4cac81SBjoern A. Zeeb * And then: 16066b4cac81SBjoern A. Zeeb * - (more packets)? 16076b4cac81SBjoern A. Zeeb * - set_key 16086b4cac81SBjoern A. Zeeb * - set_default_unicast_key 16096b4cac81SBjoern A. Zeeb * - set_key (?) 16106b4cac81SBjoern A. Zeeb * - ipv6_addr_change (?) 16116b4cac81SBjoern A. Zeeb */ 16126b4cac81SBjoern A. Zeeb /* Prepare_multicast && configure_filter. */ 16136b4cac81SBjoern A. Zeeb lhw->update_mc = true; 16146b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(vap->iv_ic, true); 16156b4cac81SBjoern A. Zeeb 16166b4cac81SBjoern A. Zeeb if (!ieee80211_node_is_authorized(ni)) { 16176b4cac81SBjoern A. Zeeb IMPROVE("net80211 does not consider node authorized"); 16186b4cac81SBjoern A. Zeeb } 16196b4cac81SBjoern A. Zeeb 16206b4cac81SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTHORIZED). */ 16216b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 16226b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 16236b4cac81SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1624e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTHORIZED); 16256b4cac81SBjoern A. Zeeb if (error != 0) { 16266b4cac81SBjoern A. Zeeb IMPROVE("undo some changes?"); 16276b4cac81SBjoern A. Zeeb goto out; 16286b4cac81SBjoern A. Zeeb } 16296b4cac81SBjoern A. Zeeb 16306b4cac81SBjoern A. Zeeb /* - drv_config (?) 16316b4cac81SBjoern A. Zeeb * - bss_info_changed 16326b4cac81SBjoern A. Zeeb * - set_rekey_data (?) 16336b4cac81SBjoern A. Zeeb * 16346b4cac81SBjoern A. Zeeb * And now we should be passing packets. 16356b4cac81SBjoern A. Zeeb */ 16366b4cac81SBjoern A. Zeeb IMPROVE("Need that bssid setting, and the keys"); 16376b4cac81SBjoern A. Zeeb 1638fa8f007dSBjoern A. Zeeb bss_changed = 0; 1639fa8f007dSBjoern A. Zeeb bss_changed |= lkpi_update_dtim_tsf(vif, ni, vap, __func__, __LINE__); 1640fa8f007dSBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1641fa8f007dSBjoern A. Zeeb 16426b4cac81SBjoern A. Zeeb out: 16438ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 16446b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 16456b4cac81SBjoern A. Zeeb if (ni != NULL) 16466b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 16476b4cac81SBjoern A. Zeeb return (error); 16486b4cac81SBjoern A. Zeeb } 16496b4cac81SBjoern A. Zeeb 16506b4cac81SBjoern A. Zeeb static int 16516b4cac81SBjoern A. Zeeb lkpi_sta_auth_to_run(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 16526b4cac81SBjoern A. Zeeb { 16536b4cac81SBjoern A. Zeeb int error; 16546b4cac81SBjoern A. Zeeb 16556b4cac81SBjoern A. Zeeb error = lkpi_sta_auth_to_assoc(vap, nstate, arg); 16566b4cac81SBjoern A. Zeeb if (error == 0) 16576b4cac81SBjoern A. Zeeb error = lkpi_sta_assoc_to_run(vap, nstate, arg); 16586b4cac81SBjoern A. Zeeb return (error); 16596b4cac81SBjoern A. Zeeb } 16606b4cac81SBjoern A. Zeeb 16616b4cac81SBjoern A. Zeeb static int 16626b4cac81SBjoern A. Zeeb lkpi_sta_run_to_assoc(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 16636b4cac81SBjoern A. Zeeb { 16646b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 16656b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 16666b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 16676b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 16686b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 16696b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 16706b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 1671d9f59799SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1672d9f59799SBjoern A. Zeeb #if 0 1673d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 1674d9f59799SBjoern A. Zeeb #endif 16756b4cac81SBjoern A. Zeeb int error; 16766b4cac81SBjoern A. Zeeb 16776b4cac81SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 16786b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 16796b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 16806b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 16816b4cac81SBjoern A. Zeeb 16826b4cac81SBjoern A. Zeeb /* Keep ni around. */ 16836b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 16846b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 16856b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 16866b4cac81SBjoern A. Zeeb 168767674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1688d9f59799SBjoern A. Zeeb 1689d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 16908ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1691d9f59799SBjoern A. Zeeb 1692d9f59799SBjoern A. Zeeb /* flush, drop. */ 1693d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1694d9f59799SBjoern A. Zeeb 1695d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1696d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1697d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1698d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1699d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1700d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1701d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1702d9f59799SBjoern A. Zeeb } 1703d9f59799SBjoern A. Zeeb 17048ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1705d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1706d9f59799SBjoern A. Zeeb 1707d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1708d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1709d9f59799SBjoern A. Zeeb if (error != 0) 1710d9f59799SBjoern A. Zeeb goto outni; 1711d9f59799SBjoern A. Zeeb 1712d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 17138ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1714d9f59799SBjoern A. Zeeb 171567674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1716d9f59799SBjoern A. Zeeb 1717d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1718d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1719d9f59799SBjoern A. Zeeb 1720d9f59799SBjoern A. Zeeb /* flush, no drop */ 1721d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1722d9f59799SBjoern A. Zeeb 1723d9f59799SBjoern A. Zeeb /* End mgd_complete_tx. */ 1724d9f59799SBjoern A. Zeeb if (lsta->in_mgd) { 1725d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1726d9f59799SBjoern A. Zeeb prep_tx_info.success = false; 1727d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 1728d9f59799SBjoern A. Zeeb lsta->in_mgd = false; 1729d9f59799SBjoern A. Zeeb } 1730d9f59799SBjoern A. Zeeb 1731d9f59799SBjoern A. Zeeb #if 0 1732d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1733d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1734d9f59799SBjoern A. Zeeb 1735d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1736d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1737d9f59799SBjoern A. Zeeb #endif 1738d9f59799SBjoern A. Zeeb 1739d9f59799SBjoern A. Zeeb /* Take the station down. */ 1740d9f59799SBjoern A. Zeeb 17416b4cac81SBjoern A. Zeeb /* Adjust sta and change state (from AUTHORIZED) to ASSOC. */ 17426b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 17436b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTHORIZED, ("%s: lsta %p state not " 17446b4cac81SBjoern A. Zeeb "AUTHORIZED: %#x\n", __func__, lsta, lsta->state)); 1745e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 17466b4cac81SBjoern A. Zeeb if (error != 0) 17476b4cac81SBjoern A. Zeeb goto out; 17486b4cac81SBjoern A. Zeeb 174967674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 17506b4cac81SBjoern A. Zeeb 17516b4cac81SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTH). */ 17526b4cac81SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 17536b4cac81SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 17546b4cac81SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1755e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 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 1761d9f59799SBjoern A. Zeeb #if 0 1762d9f59799SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 1763d9f59799SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 1764d9f59799SBjoern A. Zeeb #endif 1765d9f59799SBjoern A. Zeeb 1766d9f59799SBjoern A. Zeeb error = EALREADY; 17676b4cac81SBjoern A. Zeeb out: 17688ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 17696b4cac81SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1770d9f59799SBjoern A. Zeeb outni: 17716b4cac81SBjoern A. Zeeb if (ni != NULL) 17726b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 17736b4cac81SBjoern A. Zeeb return (error); 17746b4cac81SBjoern A. Zeeb } 17756b4cac81SBjoern A. Zeeb 17766b4cac81SBjoern A. Zeeb static int 1777d9f59799SBjoern A. Zeeb lkpi_sta_run_to_init(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1778d9f59799SBjoern A. Zeeb { 1779d9f59799SBjoern A. Zeeb struct lkpi_hw *lhw; 1780d9f59799SBjoern A. Zeeb struct ieee80211_hw *hw; 1781d9f59799SBjoern A. Zeeb struct lkpi_vif *lvif; 1782d9f59799SBjoern A. Zeeb struct ieee80211_vif *vif; 1783d9f59799SBjoern A. Zeeb struct ieee80211_node *ni; 1784d9f59799SBjoern A. Zeeb struct lkpi_sta *lsta; 1785d9f59799SBjoern A. Zeeb struct ieee80211_sta *sta; 1786d9f59799SBjoern A. Zeeb struct ieee80211_prep_tx_info prep_tx_info; 1787d9f59799SBjoern A. Zeeb enum ieee80211_bss_changed bss_changed; 1788d9f59799SBjoern A. Zeeb int error; 1789d9f59799SBjoern A. Zeeb 1790d9f59799SBjoern A. Zeeb lhw = vap->iv_ic->ic_softc; 1791d9f59799SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 1792d9f59799SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 1793d9f59799SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 1794d9f59799SBjoern A. Zeeb 1795d9f59799SBjoern A. Zeeb /* Keep ni around. */ 1796d9f59799SBjoern A. Zeeb ni = ieee80211_ref_node(vap->iv_bss); 1797d9f59799SBjoern A. Zeeb lsta = ni->ni_drv_data; 1798d9f59799SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 1799d9f59799SBjoern A. Zeeb 180067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1801d9f59799SBjoern A. Zeeb 1802d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 18038ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1804d9f59799SBjoern A. Zeeb 1805d9f59799SBjoern A. Zeeb /* flush, drop. */ 1806d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), true); 1807d9f59799SBjoern A. Zeeb 1808d9f59799SBjoern A. Zeeb IMPROVE("What are the proper conditions for DEAUTH_NEED_MGD_TX_PREP?"); 1809d9f59799SBjoern A. Zeeb if (ieee80211_hw_check(hw, DEAUTH_NEED_MGD_TX_PREP) && 1810d9f59799SBjoern A. Zeeb !lsta->in_mgd) { 1811d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1812d9f59799SBjoern A. Zeeb prep_tx_info.duration = PREP_TX_INFO_DURATION; 1813d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_prepare_tx(hw, vif, &prep_tx_info); 1814d9f59799SBjoern A. Zeeb lsta->in_mgd = true; 1815d9f59799SBjoern A. Zeeb } 1816d9f59799SBjoern A. Zeeb 18178ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1818d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1819d9f59799SBjoern A. Zeeb 1820d9f59799SBjoern A. Zeeb /* Call iv_newstate first so we get potential DISASSOC packet out. */ 1821d9f59799SBjoern A. Zeeb error = lvif->iv_newstate(vap, nstate, arg); 1822d9f59799SBjoern A. Zeeb if (error != 0) 1823d9f59799SBjoern A. Zeeb goto outni; 1824d9f59799SBjoern A. Zeeb 1825d9f59799SBjoern A. Zeeb IEEE80211_UNLOCK(vap->iv_ic); 18268ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 1827d9f59799SBjoern A. Zeeb 182867674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1829d9f59799SBjoern A. Zeeb 1830d9f59799SBjoern A. Zeeb /* Wake tx queues to get packet(s) out. */ 1831d9f59799SBjoern A. Zeeb lkpi_wake_tx_queues(hw, sta, true, true); 1832d9f59799SBjoern A. Zeeb 1833d9f59799SBjoern A. Zeeb /* flush, no drop */ 1834d9f59799SBjoern A. Zeeb lkpi_80211_mo_flush(hw, vif, nitems(sta->txq), false); 1835d9f59799SBjoern A. Zeeb 1836d9f59799SBjoern A. Zeeb /* End mgd_complete_tx. */ 1837d9f59799SBjoern A. Zeeb if (lsta->in_mgd) { 1838d9f59799SBjoern A. Zeeb memset(&prep_tx_info, 0, sizeof(prep_tx_info)); 1839d9f59799SBjoern A. Zeeb prep_tx_info.success = false; 1840d9f59799SBjoern A. Zeeb lkpi_80211_mo_mgd_complete_tx(hw, vif, &prep_tx_info); 1841d9f59799SBjoern A. Zeeb lsta->in_mgd = false; 1842d9f59799SBjoern A. Zeeb } 1843d9f59799SBjoern A. Zeeb 1844d9f59799SBjoern A. Zeeb /* sync_rx_queues */ 1845d9f59799SBjoern A. Zeeb lkpi_80211_mo_sync_rx_queues(hw); 1846d9f59799SBjoern A. Zeeb 1847d9f59799SBjoern A. Zeeb /* sta_pre_rcu_remove */ 1848d9f59799SBjoern A. Zeeb lkpi_80211_mo_sta_pre_rcu_remove(hw, vif, sta); 1849d9f59799SBjoern A. Zeeb 1850d9f59799SBjoern A. Zeeb /* Take the station down. */ 1851d9f59799SBjoern A. Zeeb 1852d9f59799SBjoern A. Zeeb /* Adjust sta and change state (from AUTHORIZED) to ASSOC. */ 1853d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1854d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTHORIZED, ("%s: lsta %p state not " 1855d9f59799SBjoern A. Zeeb "AUTHORIZED: %#x\n", __func__, lsta, lsta->state)); 1856e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_ASSOC); 1857d9f59799SBjoern A. Zeeb if (error != 0) 1858d9f59799SBjoern A. Zeeb goto out; 1859d9f59799SBjoern A. Zeeb 186067674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1861d9f59799SBjoern A. Zeeb 1862d9f59799SBjoern A. Zeeb /* Update sta_state (ASSOC to AUTH). */ 1863d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1864d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_ASSOC, ("%s: lsta %p state not " 1865d9f59799SBjoern A. Zeeb "ASSOC: %#x\n", __func__, lsta, lsta->state)); 1866e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_AUTH); 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 and change state (from AUTH) to NONE. */ 1873d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1874d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_AUTH, ("%s: lsta %p state not " 1875d9f59799SBjoern A. Zeeb "AUTH: %#x\n", __func__, lsta, lsta->state)); 1876e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NONE); 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 /* Adjust sta and change state (from NONE) to NOTEXIST. */ 1883d9f59799SBjoern A. Zeeb KASSERT(lsta != NULL, ("%s: ni %p lsta is NULL\n", __func__, ni)); 1884d9f59799SBjoern A. Zeeb KASSERT(lsta->state == IEEE80211_STA_NONE, ("%s: lsta %p state not " 1885d9f59799SBjoern A. Zeeb "NONE: %#x, nstate %d arg %d\n", __func__, lsta, lsta->state, nstate, arg)); 1886e7fe0373SBjoern A. Zeeb error = lkpi_80211_mo_sta_state(hw, vif, lsta, IEEE80211_STA_NOTEXIST); 1887d9f59799SBjoern A. Zeeb if (error != 0) { 1888d9f59799SBjoern A. Zeeb IMPROVE("do we need to undo the chan ctx?"); 1889d9f59799SBjoern A. Zeeb goto out; 1890d9f59799SBjoern A. Zeeb } 1891d9f59799SBjoern A. Zeeb #if 0 1892d9f59799SBjoern A. Zeeb lsta->added_to_drv = false; /* mo manages. */ 1893d9f59799SBjoern A. Zeeb #endif 1894d9f59799SBjoern A. Zeeb 189567674c1cSBjoern A. Zeeb lkpi_lsta_dump(lsta, ni, __func__, __LINE__); 1896d9f59799SBjoern A. Zeeb 1897d9f59799SBjoern A. Zeeb /* Update bss info (bss_info_changed) (assoc, aid, ..). */ 1898d9f59799SBjoern A. Zeeb /* 1899d9f59799SBjoern A. Zeeb * One would expect this to happen when going off AUTHORIZED. 1900d9f59799SBjoern A. Zeeb * See comment there; removes the sta from fw. 1901d9f59799SBjoern A. Zeeb */ 1902d9f59799SBjoern A. Zeeb lkpi_disassoc(sta, vif, lhw); 1903d9f59799SBjoern A. Zeeb 1904d9f59799SBjoern A. Zeeb IMPROVE("Any bss_info changes to announce?"); 1905d9f59799SBjoern A. Zeeb bss_changed = 0; 1906d9f59799SBjoern A. Zeeb vif->bss_conf.qos = 0; 1907d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_QOS; 1908616e1330SBjoern A. Zeeb vif->cfg.ssid_len = 0; 1909616e1330SBjoern A. Zeeb memset(vif->cfg.ssid, '\0', sizeof(vif->cfg.ssid)); 1910d9f59799SBjoern A. Zeeb bss_changed |= BSS_CHANGED_BSSID; 1911d9f59799SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, bss_changed); 1912d9f59799SBjoern A. Zeeb 1913d9f59799SBjoern A. Zeeb lkpi_lsta_remove(lsta, lvif); 1914d9f59799SBjoern A. Zeeb 1915d9f59799SBjoern A. Zeeb /* conf_tx */ 1916d9f59799SBjoern A. Zeeb 1917d9f59799SBjoern A. Zeeb /* Take the chan ctx down. */ 1918d9f59799SBjoern A. Zeeb if (vif->chanctx_conf != NULL) { 1919d9f59799SBjoern A. Zeeb struct ieee80211_chanctx_conf *conf; 1920d9f59799SBjoern A. Zeeb 1921d9f59799SBjoern A. Zeeb conf = vif->chanctx_conf; 1922d9f59799SBjoern A. Zeeb /* Remove vif context. */ 192368541546SBjoern A. Zeeb lkpi_80211_mo_unassign_vif_chanctx(hw, vif, &vif->bss_conf, &vif->chanctx_conf); 1924d9f59799SBjoern A. Zeeb /* NB: vif->chanctx_conf is NULL now. */ 1925d9f59799SBjoern A. Zeeb 1926d9f59799SBjoern A. Zeeb /* Remove chan ctx. */ 1927d9f59799SBjoern A. Zeeb lkpi_80211_mo_remove_chanctx(hw, conf); 1928d9f59799SBjoern A. Zeeb free(conf, M_LKPI80211); 1929d9f59799SBjoern A. Zeeb } 1930d9f59799SBjoern A. Zeeb 1931d9f59799SBjoern A. Zeeb error = EALREADY; 1932d9f59799SBjoern A. Zeeb out: 19338ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 1934d9f59799SBjoern A. Zeeb IEEE80211_LOCK(vap->iv_ic); 1935d9f59799SBjoern A. Zeeb outni: 1936d9f59799SBjoern A. Zeeb if (ni != NULL) 1937d9f59799SBjoern A. Zeeb ieee80211_free_node(ni); 1938d9f59799SBjoern A. Zeeb return (error); 1939d9f59799SBjoern A. Zeeb } 1940d9f59799SBjoern A. Zeeb 1941d9f59799SBjoern A. Zeeb static int 1942d9f59799SBjoern A. Zeeb lkpi_sta_run_to_scan(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1943d9f59799SBjoern A. Zeeb { 1944d9f59799SBjoern A. Zeeb 1945d9f59799SBjoern A. Zeeb return (lkpi_sta_run_to_init(vap, nstate, arg)); 1946d9f59799SBjoern A. Zeeb } 1947d9f59799SBjoern A. Zeeb 1948d9f59799SBjoern A. Zeeb static int 19496b4cac81SBjoern A. Zeeb lkpi_sta_run_to_auth(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 19506b4cac81SBjoern A. Zeeb { 19516b4cac81SBjoern A. Zeeb int error; 19526b4cac81SBjoern A. Zeeb 1953d9f59799SBjoern A. Zeeb error = lkpi_sta_run_to_init(vap, nstate, arg); 1954d9f59799SBjoern A. Zeeb if (error != 0 && error != EALREADY) 1955d9f59799SBjoern A. Zeeb return (error); 1956d9f59799SBjoern A. Zeeb 1957d9f59799SBjoern A. Zeeb /* At this point iv_bss is long a new node! */ 1958d9f59799SBjoern A. Zeeb 1959d9f59799SBjoern A. Zeeb error |= lkpi_sta_scan_to_auth(vap, nstate, 0); 19606b4cac81SBjoern A. Zeeb return (error); 19616b4cac81SBjoern A. Zeeb } 19626b4cac81SBjoern A. Zeeb 1963d9f59799SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 19646b4cac81SBjoern A. Zeeb 19656b4cac81SBjoern A. Zeeb /* 19666b4cac81SBjoern A. Zeeb * The matches the documented state changes in net80211::sta_newstate(). 19676b4cac81SBjoern A. Zeeb * XXX (1) without CSA and SLEEP yet, * XXX (2) not all unhandled cases 19686b4cac81SBjoern A. Zeeb * there are "invalid" (so there is a room for failure here). 19696b4cac81SBjoern A. Zeeb */ 19706b4cac81SBjoern A. Zeeb struct fsm_state { 19716b4cac81SBjoern A. Zeeb /* INIT, SCAN, AUTH, ASSOC, CAC, RUN, CSA, SLEEP */ 19726b4cac81SBjoern A. Zeeb enum ieee80211_state ostate; 19736b4cac81SBjoern A. Zeeb enum ieee80211_state nstate; 19746b4cac81SBjoern A. Zeeb int (*handler)(struct ieee80211vap *, enum ieee80211_state, int); 19756b4cac81SBjoern A. Zeeb } sta_state_fsm[] = { 19766b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_INIT, lkpi_sta_state_do_nada }, 19776b4cac81SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_INIT, lkpi_sta_state_do_nada }, /* scan_to_init */ 19786b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_INIT, lkpi_sta_auth_to_init }, /* not explicitly in sta_newstate() */ 1979d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_INIT, lkpi_sta_assoc_to_init }, /* Send DEAUTH. */ 1980d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_INIT, lkpi_sta_run_to_init }, /* Send DISASSOC. */ 19816b4cac81SBjoern A. Zeeb 19826b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_SCAN, lkpi_sta_state_do_nada }, 19836b4cac81SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_SCAN, lkpi_sta_state_do_nada }, 19846b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_SCAN, lkpi_sta_auth_to_scan }, 19856b4cac81SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_SCAN, lkpi_sta_assoc_to_scan }, 1986d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_SCAN, lkpi_sta_run_to_scan }, /* Beacon miss. */ 19876b4cac81SBjoern A. Zeeb 1988d9f59799SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_AUTH, lkpi_sta_scan_to_auth }, /* Send AUTH. */ 1989d9f59799SBjoern A. Zeeb { IEEE80211_S_SCAN, IEEE80211_S_AUTH, lkpi_sta_scan_to_auth }, /* Send AUTH. */ 1990d9f59799SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_AUTH, lkpi_sta_a_to_a }, /* Send ?AUTH. */ 1991d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_AUTH, lkpi_sta_assoc_to_auth }, /* Send ?AUTH. */ 1992d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_AUTH, lkpi_sta_run_to_auth }, /* Send ?AUTH. */ 19936b4cac81SBjoern A. Zeeb 1994d9f59799SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_ASSOC, lkpi_sta_auth_to_assoc }, /* Send ASSOCREQ. */ 1995d9f59799SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_ASSOC, lkpi_sta_a_to_a }, /* Send ASSOCREQ. */ 1996d9f59799SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_ASSOC, lkpi_sta_run_to_assoc }, /* Send ASSOCREQ/REASSOCREQ. */ 19976b4cac81SBjoern A. Zeeb 19986b4cac81SBjoern A. Zeeb { IEEE80211_S_AUTH, IEEE80211_S_RUN, lkpi_sta_auth_to_run }, 19996b4cac81SBjoern A. Zeeb { IEEE80211_S_ASSOC, IEEE80211_S_RUN, lkpi_sta_assoc_to_run }, 20006b4cac81SBjoern A. Zeeb { IEEE80211_S_RUN, IEEE80211_S_RUN, lkpi_sta_state_do_nada }, 20016b4cac81SBjoern A. Zeeb 20026b4cac81SBjoern A. Zeeb /* Dummy at the end without handler. */ 20036b4cac81SBjoern A. Zeeb { IEEE80211_S_INIT, IEEE80211_S_INIT, NULL }, 20046b4cac81SBjoern A. Zeeb }; 20056b4cac81SBjoern A. Zeeb 20066b4cac81SBjoern A. Zeeb static int 20076b4cac81SBjoern A. Zeeb lkpi_iv_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 20086b4cac81SBjoern A. Zeeb { 20096b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 20106b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 20116b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 20126b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 20136b4cac81SBjoern A. Zeeb struct fsm_state *s; 20146b4cac81SBjoern A. Zeeb enum ieee80211_state ostate; 20156b4cac81SBjoern A. Zeeb int error; 20166b4cac81SBjoern A. Zeeb 20176b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 20186b4cac81SBjoern A. Zeeb IEEE80211_LOCK_ASSERT(ic); 20196b4cac81SBjoern A. Zeeb ostate = vap->iv_state; 20206b4cac81SBjoern A. Zeeb 20219d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20229d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 20236b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s:%d: vap %p nstate %#x arg %#x\n", 20246b4cac81SBjoern A. Zeeb __func__, __LINE__, vap, nstate, arg); 20259d9ba2b7SBjoern A. Zeeb #endif 20266b4cac81SBjoern A. Zeeb 20276b4cac81SBjoern A. Zeeb if (vap->iv_opmode == IEEE80211_M_STA) { 20286b4cac81SBjoern A. Zeeb 20296b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 20306b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 20316b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 20326b4cac81SBjoern A. Zeeb 20336b4cac81SBjoern A. Zeeb /* No need to replicate this in most state handlers. */ 20346b4cac81SBjoern A. Zeeb if (ostate == IEEE80211_S_SCAN && nstate != IEEE80211_S_SCAN) 20356b4cac81SBjoern A. Zeeb lkpi_stop_hw_scan(lhw, vif); 20366b4cac81SBjoern A. Zeeb 20376b4cac81SBjoern A. Zeeb s = sta_state_fsm; 20386b4cac81SBjoern A. Zeeb 20396b4cac81SBjoern A. Zeeb } else { 20406b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: only station mode currently supported: " 20416b4cac81SBjoern A. Zeeb "cap %p iv_opmode %d\n", __func__, vap, vap->iv_opmode); 20426b4cac81SBjoern A. Zeeb return (ENOSYS); 20436b4cac81SBjoern A. Zeeb } 20446b4cac81SBjoern A. Zeeb 20456b4cac81SBjoern A. Zeeb error = 0; 20466b4cac81SBjoern A. Zeeb for (; s->handler != NULL; s++) { 20476b4cac81SBjoern A. Zeeb if (ostate == s->ostate && nstate == s->nstate) { 20489d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20499d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2050d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: new state %d (%s) ->" 2051d9f59799SBjoern A. Zeeb " %d (%s): arg %d.\n", __func__, 2052d9f59799SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 2053d9f59799SBjoern A. Zeeb nstate, ieee80211_state_name[nstate], arg); 20549d9ba2b7SBjoern A. Zeeb #endif 20556b4cac81SBjoern A. Zeeb error = s->handler(vap, nstate, arg); 20566b4cac81SBjoern A. Zeeb break; 20576b4cac81SBjoern A. Zeeb } 20586b4cac81SBjoern A. Zeeb } 20596b4cac81SBjoern A. Zeeb IEEE80211_LOCK_ASSERT(vap->iv_ic); 20606b4cac81SBjoern A. Zeeb 20616b4cac81SBjoern A. Zeeb if (s->handler == NULL) { 2062d9f59799SBjoern A. Zeeb IMPROVE("turn this into a KASSERT\n"); 20636b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: unsupported state transition " 20646b4cac81SBjoern A. Zeeb "%d (%s) -> %d (%s)\n", __func__, 20656b4cac81SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 20666b4cac81SBjoern A. Zeeb nstate, ieee80211_state_name[nstate]); 20676b4cac81SBjoern A. Zeeb return (ENOSYS); 20686b4cac81SBjoern A. Zeeb } 20696b4cac81SBjoern A. Zeeb 20706b4cac81SBjoern A. Zeeb if (error == EALREADY) { 20719d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20729d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2073d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: state transition %d (%s) -> " 2074d9f59799SBjoern A. Zeeb "%d (%s): iv_newstate already handled: %d.\n", 2075d9f59799SBjoern A. Zeeb __func__, ostate, ieee80211_state_name[ostate], 2076d9f59799SBjoern A. Zeeb nstate, ieee80211_state_name[nstate], error); 20779d9ba2b7SBjoern A. Zeeb #endif 20786b4cac81SBjoern A. Zeeb return (0); 20796b4cac81SBjoern A. Zeeb } 20806b4cac81SBjoern A. Zeeb 20816b4cac81SBjoern A. Zeeb if (error != 0) { 20826b4cac81SBjoern A. Zeeb /* XXX-BZ currently expected so ignore. */ 20836b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: error %d during state transition " 20846b4cac81SBjoern A. Zeeb "%d (%s) -> %d (%s)\n", __func__, error, 20856b4cac81SBjoern A. Zeeb ostate, ieee80211_state_name[ostate], 20866b4cac81SBjoern A. Zeeb nstate, ieee80211_state_name[nstate]); 20876b4cac81SBjoern A. Zeeb /* return (error); */ 20886b4cac81SBjoern A. Zeeb } 20896b4cac81SBjoern A. Zeeb 20909d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 20919d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 2092d9f59799SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s:%d: vap %p nstate %#x arg %#x " 2093d9f59799SBjoern A. Zeeb "calling net80211 parent\n", 20946b4cac81SBjoern A. Zeeb __func__, __LINE__, vap, nstate, arg); 20959d9ba2b7SBjoern A. Zeeb #endif 20966b4cac81SBjoern A. Zeeb 20976b4cac81SBjoern A. Zeeb return (lvif->iv_newstate(vap, nstate, arg)); 20986b4cac81SBjoern A. Zeeb } 20996b4cac81SBjoern A. Zeeb 21006b4cac81SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 21016b4cac81SBjoern A. Zeeb 2102d9f59799SBjoern A. Zeeb /* 2103d9f59799SBjoern A. Zeeb * We overload (*iv_update_bss) as otherwise we have cases in, e.g., 2104d9f59799SBjoern A. Zeeb * net80211::ieee80211_sta_join1() where vap->iv_bss gets replaced by a 2105d9f59799SBjoern A. Zeeb * new node without us knowing and thus our ni/lsta are out of sync. 2106d9f59799SBjoern A. Zeeb */ 2107d9f59799SBjoern A. Zeeb static struct ieee80211_node * 2108d9f59799SBjoern A. Zeeb lkpi_iv_update_bss(struct ieee80211vap *vap, struct ieee80211_node *ni) 2109d9f59799SBjoern A. Zeeb { 2110d9f59799SBjoern A. Zeeb struct lkpi_vif *lvif; 2111d9f59799SBjoern A. Zeeb struct ieee80211_node *obss; 2112d9f59799SBjoern A. Zeeb struct lkpi_sta *lsta; 2113ed3ef56bSBjoern A. Zeeb struct ieee80211_sta *sta; 2114d9f59799SBjoern A. Zeeb 2115d9f59799SBjoern A. Zeeb obss = vap->iv_bss; 2116d9f59799SBjoern A. Zeeb 21179d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 21189d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 21199d9ba2b7SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: obss %p ni_drv_data %p " 21209d9ba2b7SBjoern A. Zeeb "ni %p ni_drv_data %p\n", __func__, 21219d9ba2b7SBjoern A. Zeeb obss, (obss != NULL) ? obss->ni_drv_data : NULL, 21229d9ba2b7SBjoern A. Zeeb ni, (ni != NULL) ? ni->ni_drv_data : NULL); 21239d9ba2b7SBjoern A. Zeeb #endif 21249d9ba2b7SBjoern A. Zeeb 2125d9f59799SBjoern A. Zeeb /* Nothing to copy from. Just return. */ 2126d9f59799SBjoern A. Zeeb if (obss == NULL || obss->ni_drv_data == NULL) 2127d9f59799SBjoern A. Zeeb goto out; 2128d9f59799SBjoern A. Zeeb 2129d9f59799SBjoern A. Zeeb /* Nothing to copy to. Just return. */ 2130d9f59799SBjoern A. Zeeb IMPROVE("clearing the obss might still be needed?"); 2131d9f59799SBjoern A. Zeeb if (ni == NULL) 2132d9f59799SBjoern A. Zeeb goto out; 2133d9f59799SBjoern A. Zeeb 2134d9f59799SBjoern A. Zeeb /* Nothing changed? panic? */ 2135d9f59799SBjoern A. Zeeb if (obss == ni) 2136d9f59799SBjoern A. Zeeb goto out; 2137d9f59799SBjoern A. Zeeb 2138d9f59799SBjoern A. Zeeb lsta = obss->ni_drv_data; 2139d9f59799SBjoern A. Zeeb obss->ni_drv_data = ni->ni_drv_data; 2140d9f59799SBjoern A. Zeeb ni->ni_drv_data = lsta; 2141ed3ef56bSBjoern A. Zeeb if (lsta != NULL) { 2142d9f59799SBjoern A. Zeeb lsta->ni = ni; 2143ed3ef56bSBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 2144ed3ef56bSBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->addr, lsta->ni->ni_macaddr); 21456ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->deflink.addr, sta->addr); 2146ed3ef56bSBjoern A. Zeeb } 2147d9f59799SBjoern A. Zeeb lsta = obss->ni_drv_data; 2148ed3ef56bSBjoern A. Zeeb if (lsta != NULL) { 2149d9f59799SBjoern A. Zeeb lsta->ni = obss; 2150ed3ef56bSBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 2151ed3ef56bSBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->addr, lsta->ni->ni_macaddr); 21526ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(sta->deflink.addr, sta->addr); 2153ed3ef56bSBjoern A. Zeeb } 2154d9f59799SBjoern A. Zeeb 2155d9f59799SBjoern A. Zeeb out: 2156ed3ef56bSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 2157d9f59799SBjoern A. Zeeb return (lvif->iv_update_bss(vap, ni)); 2158d9f59799SBjoern A. Zeeb } 2159d9f59799SBjoern A. Zeeb 21604a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 21616b4cac81SBjoern A. Zeeb static int 21624a67f1dfSBjoern A. Zeeb lkpi_wme_update(struct lkpi_hw *lhw, struct ieee80211vap *vap, bool planned) 21636b4cac81SBjoern A. Zeeb { 21644a67f1dfSBjoern A. Zeeb struct ieee80211com *ic; 21656b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 21666b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 21676b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 21686b4cac81SBjoern A. Zeeb struct chanAccParams chp; 21696b4cac81SBjoern A. Zeeb struct wmeParams wmeparr[WME_NUM_AC]; 21706b4cac81SBjoern A. Zeeb struct ieee80211_tx_queue_params txqp; 21716b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed changed; 21726b4cac81SBjoern A. Zeeb int error; 21736b4cac81SBjoern A. Zeeb uint16_t ac; 21746b4cac81SBjoern A. Zeeb 21756b4cac81SBjoern A. Zeeb IMPROVE(); 21766b4cac81SBjoern A. Zeeb KASSERT(WME_NUM_AC == IEEE80211_NUM_ACS, ("%s: WME_NUM_AC %d != " 21776b4cac81SBjoern A. Zeeb "IEEE80211_NUM_ACS %d\n", __func__, WME_NUM_AC, IEEE80211_NUM_ACS)); 21786b4cac81SBjoern A. Zeeb 21796b4cac81SBjoern A. Zeeb if (vap == NULL) 21806b4cac81SBjoern A. Zeeb return (0); 21816b4cac81SBjoern A. Zeeb 21824a67f1dfSBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WME) == 0) 21834a67f1dfSBjoern A. Zeeb return (0); 21844a67f1dfSBjoern A. Zeeb 21856b4cac81SBjoern A. Zeeb if (lhw->ops->conf_tx == NULL) 21866b4cac81SBjoern A. Zeeb return (0); 21876b4cac81SBjoern A. Zeeb 21884a67f1dfSBjoern A. Zeeb if (!planned && (vap->iv_state != IEEE80211_S_RUN)) { 21894a67f1dfSBjoern A. Zeeb lhw->update_wme = true; 21904a67f1dfSBjoern A. Zeeb return (0); 21914a67f1dfSBjoern A. Zeeb } 21924a67f1dfSBjoern A. Zeeb lhw->update_wme = false; 21936b4cac81SBjoern A. Zeeb 21944a67f1dfSBjoern A. Zeeb ic = lhw->ic; 21956b4cac81SBjoern A. Zeeb ieee80211_wme_ic_getparams(ic, &chp); 21966b4cac81SBjoern A. Zeeb IEEE80211_LOCK(ic); 21976b4cac81SBjoern A. Zeeb for (ac = 0; ac < WME_NUM_AC; ac++) 21986b4cac81SBjoern A. Zeeb wmeparr[ac] = chp.cap_wmeParams[ac]; 21996b4cac81SBjoern A. Zeeb IEEE80211_UNLOCK(ic); 22006b4cac81SBjoern A. Zeeb 22014a67f1dfSBjoern A. Zeeb hw = LHW_TO_HW(lhw); 22024a67f1dfSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 22034a67f1dfSBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 22044a67f1dfSBjoern A. Zeeb 22056b4cac81SBjoern A. Zeeb /* Configure tx queues (conf_tx) & send BSS_CHANGED_QOS. */ 22066b4cac81SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 22076b4cac81SBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 22086b4cac81SBjoern A. Zeeb struct wmeParams *wmep; 22096b4cac81SBjoern A. Zeeb 22106b4cac81SBjoern A. Zeeb wmep = &wmeparr[ac]; 22116b4cac81SBjoern A. Zeeb bzero(&txqp, sizeof(txqp)); 22126b4cac81SBjoern A. Zeeb txqp.cw_min = wmep->wmep_logcwmin; 22136b4cac81SBjoern A. Zeeb txqp.cw_max = wmep->wmep_logcwmax; 22146b4cac81SBjoern A. Zeeb txqp.txop = wmep->wmep_txopLimit; 22156b4cac81SBjoern A. Zeeb txqp.aifs = wmep->wmep_aifsn; 221668541546SBjoern A. Zeeb error = lkpi_80211_mo_conf_tx(hw, vif, /* link_id */0, ac, &txqp); 22176b4cac81SBjoern A. Zeeb if (error != 0) 22183f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: conf_tx ac %u failed %d\n", 22196b4cac81SBjoern A. Zeeb __func__, ac, error); 22206b4cac81SBjoern A. Zeeb } 22216b4cac81SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 22226b4cac81SBjoern A. Zeeb changed = BSS_CHANGED_QOS; 22234a67f1dfSBjoern A. Zeeb if (!planned) 22246b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 22254a67f1dfSBjoern A. Zeeb 22264a67f1dfSBjoern A. Zeeb return (changed); 22274a67f1dfSBjoern A. Zeeb } 22286b4cac81SBjoern A. Zeeb #endif 22296b4cac81SBjoern A. Zeeb 22304a67f1dfSBjoern A. Zeeb static int 22314a67f1dfSBjoern A. Zeeb lkpi_ic_wme_update(struct ieee80211com *ic) 22324a67f1dfSBjoern A. Zeeb { 22334a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 22344a67f1dfSBjoern A. Zeeb struct ieee80211vap *vap; 22354a67f1dfSBjoern A. Zeeb struct lkpi_hw *lhw; 22364a67f1dfSBjoern A. Zeeb 22374a67f1dfSBjoern A. Zeeb IMPROVE("Use the per-VAP callback in net80211."); 22384a67f1dfSBjoern A. Zeeb vap = TAILQ_FIRST(&ic->ic_vaps); 22394a67f1dfSBjoern A. Zeeb if (vap == NULL) 22406b4cac81SBjoern A. Zeeb return (0); 22414a67f1dfSBjoern A. Zeeb 22424a67f1dfSBjoern A. Zeeb lhw = ic->ic_softc; 22434a67f1dfSBjoern A. Zeeb 22444a67f1dfSBjoern A. Zeeb lkpi_wme_update(lhw, vap, false); 22454a67f1dfSBjoern A. Zeeb #endif 22464a67f1dfSBjoern A. Zeeb return (0); /* unused */ 22476b4cac81SBjoern A. Zeeb } 22486b4cac81SBjoern A. Zeeb 22496b4cac81SBjoern A. Zeeb static struct ieee80211vap * 22506b4cac81SBjoern A. Zeeb lkpi_ic_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], 22516b4cac81SBjoern A. Zeeb int unit, enum ieee80211_opmode opmode, int flags, 22526b4cac81SBjoern A. Zeeb const uint8_t bssid[IEEE80211_ADDR_LEN], 22536b4cac81SBjoern A. Zeeb const uint8_t mac[IEEE80211_ADDR_LEN]) 22546b4cac81SBjoern A. Zeeb { 22556b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 22566b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 22576b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 22586b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 22596b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 2260a6042e17SBjoern A. Zeeb struct ieee80211_tx_queue_params txqp; 22616b4cac81SBjoern A. Zeeb enum ieee80211_bss_changed changed; 22626b4cac81SBjoern A. Zeeb size_t len; 2263e3a0b120SBjoern A. Zeeb int error, i; 2264a6042e17SBjoern A. Zeeb uint16_t ac; 22656b4cac81SBjoern A. Zeeb 22666b4cac81SBjoern A. Zeeb if (!TAILQ_EMPTY(&ic->ic_vaps)) /* 1 so far. Add <n> once this works. */ 22676b4cac81SBjoern A. Zeeb return (NULL); 22686b4cac81SBjoern A. Zeeb 22696b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 22706b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 22716b4cac81SBjoern A. Zeeb 22726b4cac81SBjoern A. Zeeb len = sizeof(*lvif); 22736b4cac81SBjoern A. Zeeb len += hw->vif_data_size; /* vif->drv_priv */ 22746b4cac81SBjoern A. Zeeb 22756b4cac81SBjoern A. Zeeb lvif = malloc(len, M_80211_VAP, M_WAITOK | M_ZERO); 22766b4cac81SBjoern A. Zeeb mtx_init(&lvif->mtx, "lvif", NULL, MTX_DEF); 22776b4cac81SBjoern A. Zeeb TAILQ_INIT(&lvif->lsta_head); 22786b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 22796b4cac81SBjoern A. Zeeb 22806b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 22816b4cac81SBjoern A. Zeeb memcpy(vif->addr, mac, IEEE80211_ADDR_LEN); 22826b4cac81SBjoern A. Zeeb vif->p2p = false; 22836b4cac81SBjoern A. Zeeb vif->probe_req_reg = false; 22846b4cac81SBjoern A. Zeeb vif->type = lkpi_opmode_to_vif_type(opmode); 22856b4cac81SBjoern A. Zeeb lvif->wdev.iftype = vif->type; 22866b4cac81SBjoern A. Zeeb /* Need to fill in other fields as well. */ 22876b4cac81SBjoern A. Zeeb IMPROVE(); 22886b4cac81SBjoern A. Zeeb 22896b4cac81SBjoern A. Zeeb /* XXX-BZ hardcoded for now! */ 22906b4cac81SBjoern A. Zeeb #if 1 22916b4cac81SBjoern A. Zeeb vif->chanctx_conf = NULL; 2292adff403fSBjoern A. Zeeb vif->bss_conf.vif = vif; 22936ffb7bd4SBjoern A. Zeeb /* vap->iv_myaddr is not set until net80211::vap_setup or vap_attach. */ 22946ffb7bd4SBjoern A. Zeeb IEEE80211_ADDR_COPY(vif->bss_conf.addr, mac); 22956ffb7bd4SBjoern A. Zeeb vif->bss_conf.link_id = 0; /* Non-MLO operation. */ 22966b4cac81SBjoern A. Zeeb vif->bss_conf.chandef.width = NL80211_CHAN_WIDTH_20_NOHT; 22976b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_preamble = false; /* vap->iv_flags IEEE80211_F_SHPREAMBLE */ 22986b4cac81SBjoern A. Zeeb vif->bss_conf.use_short_slot = false; /* vap->iv_flags IEEE80211_F_SHSLOT */ 22996b4cac81SBjoern A. Zeeb vif->bss_conf.qos = false; 23006b4cac81SBjoern A. Zeeb vif->bss_conf.use_cts_prot = false; /* vap->iv_protmode */ 23016b4cac81SBjoern A. Zeeb vif->bss_conf.ht_operation_mode = IEEE80211_HT_OP_MODE_PROTECTION_NONE; 2302616e1330SBjoern A. Zeeb vif->cfg.aid = 0; 2303616e1330SBjoern A. Zeeb vif->cfg.assoc = false; 2304616e1330SBjoern A. Zeeb vif->cfg.idle = true; 2305616e1330SBjoern A. Zeeb vif->cfg.ps = false; 23066ffb7bd4SBjoern A. Zeeb IMPROVE("Check other fields and then figure out whats is left elsewhere of them"); 2307caaa79c3SBjoern A. Zeeb /* 2308caaa79c3SBjoern A. Zeeb * We need to initialize it to something as the bss_info_changed call 2309caaa79c3SBjoern A. Zeeb * will try to copy from it in iwlwifi and NULL is a panic. 2310caaa79c3SBjoern A. Zeeb * We will set the proper one in scan_to_auth() before being assoc. 2311caaa79c3SBjoern A. Zeeb */ 23126ffb7bd4SBjoern A. Zeeb vif->bss_conf.bssid = ieee80211broadcastaddr; 23136b4cac81SBjoern A. Zeeb #endif 23146b4cac81SBjoern A. Zeeb #if 0 23156b4cac81SBjoern A. Zeeb vif->bss_conf.dtim_period = 0; /* IEEE80211_DTIM_DEFAULT ; must stay 0. */ 23166b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(vif->bss_conf.bssid, bssid); 23176b4cac81SBjoern A. Zeeb vif->bss_conf.beacon_int = ic->ic_bintval; 23186b4cac81SBjoern A. Zeeb /* iwlwifi bug. */ 23196b4cac81SBjoern A. Zeeb if (vif->bss_conf.beacon_int < 16) 23206b4cac81SBjoern A. Zeeb vif->bss_conf.beacon_int = 16; 23216b4cac81SBjoern A. Zeeb #endif 2322e3a0b120SBjoern A. Zeeb 23236ffb7bd4SBjoern A. Zeeb /* Link Config */ 23246ffb7bd4SBjoern A. Zeeb vif->link_conf[0] = &vif->bss_conf; 23256ffb7bd4SBjoern A. Zeeb for (i = 0; i < nitems(vif->link_conf); i++) { 23266ffb7bd4SBjoern A. Zeeb IMPROVE("more than 1 link one day"); 23276ffb7bd4SBjoern A. Zeeb } 23286ffb7bd4SBjoern A. Zeeb 2329e3a0b120SBjoern A. Zeeb /* Setup queue defaults; driver may override in (*add_interface). */ 2330e3a0b120SBjoern A. Zeeb for (i = 0; i < IEEE80211_NUM_ACS; i++) { 2331e3a0b120SBjoern A. Zeeb if (ieee80211_hw_check(hw, QUEUE_CONTROL)) 2332e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = IEEE80211_INVAL_HW_QUEUE; 2333e3a0b120SBjoern A. Zeeb else if (hw->queues >= IEEE80211_NUM_ACS) 2334e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = i; 2335e3a0b120SBjoern A. Zeeb else 2336e3a0b120SBjoern A. Zeeb vif->hw_queue[i] = 0; 23370cbcfa19SBjoern A. Zeeb 23380cbcfa19SBjoern A. Zeeb /* Initialize the queue to running. Stopped? */ 23390cbcfa19SBjoern A. Zeeb lvif->hw_queue_stopped[i] = false; 2340e3a0b120SBjoern A. Zeeb } 2341e3a0b120SBjoern A. Zeeb vif->cab_queue = IEEE80211_INVAL_HW_QUEUE; 2342e3a0b120SBjoern A. Zeeb 23436b4cac81SBjoern A. Zeeb IMPROVE(); 23446b4cac81SBjoern A. Zeeb 23456b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_start(hw); 23466b4cac81SBjoern A. Zeeb if (error != 0) { 23473f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: failed to start hw: %d\n", __func__, error); 23486b4cac81SBjoern A. Zeeb mtx_destroy(&lvif->mtx); 23496b4cac81SBjoern A. Zeeb free(lvif, M_80211_VAP); 23506b4cac81SBjoern A. Zeeb return (NULL); 23516b4cac81SBjoern A. Zeeb } 23526b4cac81SBjoern A. Zeeb 23536b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_add_interface(hw, vif); 23546b4cac81SBjoern A. Zeeb if (error != 0) { 23556b4cac81SBjoern A. Zeeb IMPROVE(); /* XXX-BZ mo_stop()? */ 23563f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: failed to add interface: %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 23628891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 23636b4cac81SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lhw->lvif_head, lvif, lvif_entry); 23648891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 23656b4cac81SBjoern A. Zeeb 23666b4cac81SBjoern A. Zeeb /* Set bss_info. */ 23676b4cac81SBjoern A. Zeeb changed = 0; 23686b4cac81SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 23696b4cac81SBjoern A. Zeeb 2370a6042e17SBjoern A. Zeeb /* Configure tx queues (conf_tx), default WME & send BSS_CHANGED_QOS. */ 2371a6042e17SBjoern A. Zeeb IMPROVE("Hardcoded values; to fix see 802.11-2016, 9.4.2.29 EDCA Parameter Set element"); 2372a6042e17SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 2373a6042e17SBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 2374a6042e17SBjoern A. Zeeb 2375a6042e17SBjoern A. Zeeb bzero(&txqp, sizeof(txqp)); 2376a6042e17SBjoern A. Zeeb txqp.cw_min = 15; 2377a6042e17SBjoern A. Zeeb txqp.cw_max = 1023; 2378a6042e17SBjoern A. Zeeb txqp.txop = 0; 2379a6042e17SBjoern A. Zeeb txqp.aifs = 2; 2380a6042e17SBjoern A. Zeeb error = lkpi_80211_mo_conf_tx(hw, vif, /* link_id */0, ac, &txqp); 2381a6042e17SBjoern A. Zeeb if (error != 0) 2382a6042e17SBjoern A. Zeeb ic_printf(ic, "%s: conf_tx ac %u failed %d\n", 2383a6042e17SBjoern A. Zeeb __func__, ac, error); 2384a6042e17SBjoern A. Zeeb } 2385a6042e17SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 2386a6042e17SBjoern A. Zeeb changed = BSS_CHANGED_QOS; 2387a6042e17SBjoern A. Zeeb lkpi_80211_mo_bss_info_changed(hw, vif, &vif->bss_conf, changed); 23886b4cac81SBjoern A. Zeeb 23896b4cac81SBjoern A. Zeeb /* Force MC init. */ 23906b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(ic, true); 23916b4cac81SBjoern A. Zeeb 23926b4cac81SBjoern A. Zeeb IMPROVE(); 23936b4cac81SBjoern A. Zeeb 23946b4cac81SBjoern A. Zeeb ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid); 23956b4cac81SBjoern A. Zeeb 23966b4cac81SBjoern A. Zeeb /* Override with LinuxKPI method so we can drive mac80211/cfg80211. */ 23976b4cac81SBjoern A. Zeeb lvif->iv_newstate = vap->iv_newstate; 23986b4cac81SBjoern A. Zeeb vap->iv_newstate = lkpi_iv_newstate; 2399d9f59799SBjoern A. Zeeb lvif->iv_update_bss = vap->iv_update_bss; 2400d9f59799SBjoern A. Zeeb vap->iv_update_bss = lkpi_iv_update_bss; 24016b4cac81SBjoern A. Zeeb 24026b4cac81SBjoern A. Zeeb /* Key management. */ 24036b4cac81SBjoern A. Zeeb if (lhw->ops->set_key != NULL) { 2404b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 24056b4cac81SBjoern A. Zeeb vap->iv_key_set = lkpi_iv_key_set; 24066b4cac81SBjoern A. Zeeb vap->iv_key_delete = lkpi_iv_key_delete; 24076b4cac81SBjoern A. Zeeb #endif 24086b4cac81SBjoern A. Zeeb } 24096b4cac81SBjoern A. Zeeb 24106b4cac81SBjoern A. Zeeb ieee80211_ratectl_init(vap); 24116b4cac81SBjoern A. Zeeb 24126b4cac81SBjoern A. Zeeb /* Complete setup. */ 24136b4cac81SBjoern A. Zeeb ieee80211_vap_attach(vap, ieee80211_media_change, 24146b4cac81SBjoern A. Zeeb ieee80211_media_status, mac); 24156b4cac81SBjoern A. Zeeb 24166b4cac81SBjoern A. Zeeb if (hw->max_listen_interval == 0) 24176b4cac81SBjoern A. Zeeb hw->max_listen_interval = 7 * (ic->ic_lintval / ic->ic_bintval); 24186b4cac81SBjoern A. Zeeb hw->conf.listen_interval = hw->max_listen_interval; 24196b4cac81SBjoern A. Zeeb ic->ic_set_channel(ic); 24206b4cac81SBjoern A. Zeeb 24216b4cac81SBjoern A. Zeeb /* XXX-BZ do we need to be able to update these? */ 24226b4cac81SBjoern A. Zeeb hw->wiphy->frag_threshold = vap->iv_fragthreshold; 24236b4cac81SBjoern A. Zeeb lkpi_80211_mo_set_frag_threshold(hw, vap->iv_fragthreshold); 24246b4cac81SBjoern A. Zeeb hw->wiphy->rts_threshold = vap->iv_rtsthreshold; 24256b4cac81SBjoern A. Zeeb lkpi_80211_mo_set_rts_threshold(hw, vap->iv_rtsthreshold); 24266b4cac81SBjoern A. Zeeb /* any others? */ 24276b4cac81SBjoern A. Zeeb IMPROVE(); 24286b4cac81SBjoern A. Zeeb 24296b4cac81SBjoern A. Zeeb return (vap); 24306b4cac81SBjoern A. Zeeb } 24316b4cac81SBjoern A. Zeeb 24324b0af114SBjoern A. Zeeb void 24334b0af114SBjoern A. Zeeb linuxkpi_ieee80211_unregister_hw(struct ieee80211_hw *hw) 24344b0af114SBjoern A. Zeeb { 24354b0af114SBjoern A. Zeeb 24364b0af114SBjoern A. Zeeb wiphy_unregister(hw->wiphy); 24374b0af114SBjoern A. Zeeb linuxkpi_ieee80211_ifdetach(hw); 24384b0af114SBjoern A. Zeeb 24394b0af114SBjoern A. Zeeb IMPROVE(); 24404b0af114SBjoern A. Zeeb } 24414b0af114SBjoern A. Zeeb 24424b0af114SBjoern A. Zeeb void 24434b0af114SBjoern A. Zeeb linuxkpi_ieee80211_restart_hw(struct ieee80211_hw *hw) 24444b0af114SBjoern A. Zeeb { 24454b0af114SBjoern A. Zeeb 24464b0af114SBjoern A. Zeeb TODO(); 24474b0af114SBjoern A. Zeeb } 24484b0af114SBjoern A. Zeeb 24496b4cac81SBjoern A. Zeeb static void 24506b4cac81SBjoern A. Zeeb lkpi_ic_vap_delete(struct ieee80211vap *vap) 24516b4cac81SBjoern A. Zeeb { 24526b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 24536b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 24546b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 24556b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 24566b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 24576b4cac81SBjoern A. Zeeb 24586b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 24596b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 24606b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 24616b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 24626b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 24636b4cac81SBjoern A. Zeeb 24648891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 24656b4cac81SBjoern A. Zeeb TAILQ_REMOVE(&lhw->lvif_head, lvif, lvif_entry); 24668891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 24676b4cac81SBjoern A. Zeeb lkpi_80211_mo_remove_interface(hw, vif); 24686b4cac81SBjoern A. Zeeb 24696b4cac81SBjoern A. Zeeb ieee80211_ratectl_deinit(vap); 24706b4cac81SBjoern A. Zeeb ieee80211_vap_detach(vap); 24716b4cac81SBjoern A. Zeeb mtx_destroy(&lvif->mtx); 24726b4cac81SBjoern A. Zeeb free(lvif, M_80211_VAP); 24736b4cac81SBjoern A. Zeeb } 24746b4cac81SBjoern A. Zeeb 24756b4cac81SBjoern A. Zeeb static void 24766b4cac81SBjoern A. Zeeb lkpi_ic_update_mcast(struct ieee80211com *ic) 24776b4cac81SBjoern A. Zeeb { 24786b4cac81SBjoern A. Zeeb 24796b4cac81SBjoern A. Zeeb lkpi_update_mcast_filter(ic, false); 24806b4cac81SBjoern A. Zeeb TRACEOK(); 24816b4cac81SBjoern A. Zeeb } 24826b4cac81SBjoern A. Zeeb 24836b4cac81SBjoern A. Zeeb static void 24846b4cac81SBjoern A. Zeeb lkpi_ic_update_promisc(struct ieee80211com *ic) 24856b4cac81SBjoern A. Zeeb { 24866b4cac81SBjoern A. Zeeb 24876b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 24886b4cac81SBjoern A. Zeeb } 24896b4cac81SBjoern A. Zeeb 24906b4cac81SBjoern A. Zeeb static void 24916b4cac81SBjoern A. Zeeb lkpi_ic_update_chw(struct ieee80211com *ic) 24926b4cac81SBjoern A. Zeeb { 24936b4cac81SBjoern A. Zeeb 24946b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 24956b4cac81SBjoern A. Zeeb } 24966b4cac81SBjoern A. Zeeb 24976b4cac81SBjoern A. Zeeb /* Start / stop device. */ 24986b4cac81SBjoern A. Zeeb static void 24996b4cac81SBjoern A. Zeeb lkpi_ic_parent(struct ieee80211com *ic) 25006b4cac81SBjoern A. Zeeb { 25016b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 25028d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25036b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 25046b4cac81SBjoern A. Zeeb int error; 25058d58a057SBjoern A. Zeeb #endif 25066b4cac81SBjoern A. Zeeb bool start_all; 25076b4cac81SBjoern A. Zeeb 25086b4cac81SBjoern A. Zeeb IMPROVE(); 25096b4cac81SBjoern A. Zeeb 25106b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 25118d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25126b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 25138d58a057SBjoern A. Zeeb #endif 25146b4cac81SBjoern A. Zeeb start_all = false; 25156b4cac81SBjoern A. Zeeb 25168ac540d3SBjoern A. Zeeb /* IEEE80211_UNLOCK(ic); */ 25178ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK(lhw); 25186b4cac81SBjoern A. Zeeb if (ic->ic_nrunning > 0) { 25198d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25206b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_start(hw); 25216b4cac81SBjoern A. Zeeb if (error == 0) 25228d58a057SBjoern A. Zeeb #endif 25236b4cac81SBjoern A. Zeeb start_all = true; 25246b4cac81SBjoern A. Zeeb } else { 25258d58a057SBjoern A. Zeeb #ifdef HW_START_STOP 25266b4cac81SBjoern A. Zeeb lkpi_80211_mo_stop(hw); 25278d58a057SBjoern A. Zeeb #endif 25286b4cac81SBjoern A. Zeeb } 25298ac540d3SBjoern A. Zeeb LKPI_80211_LHW_UNLOCK(lhw); 25308ac540d3SBjoern A. Zeeb /* IEEE80211_LOCK(ic); */ 25316b4cac81SBjoern A. Zeeb 25326b4cac81SBjoern A. Zeeb if (start_all) 25336b4cac81SBjoern A. Zeeb ieee80211_start_all(ic); 25346b4cac81SBjoern A. Zeeb } 25356b4cac81SBjoern A. Zeeb 25366b4cac81SBjoern A. Zeeb bool 25376b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_is_ie_id_in_ie_buf(const u8 ie, const u8 *ie_ids, 25386b4cac81SBjoern A. Zeeb size_t ie_ids_len) 25396b4cac81SBjoern A. Zeeb { 25406b4cac81SBjoern A. Zeeb int i; 25416b4cac81SBjoern A. Zeeb 25426b4cac81SBjoern A. Zeeb for (i = 0; i < ie_ids_len; i++) { 25436b4cac81SBjoern A. Zeeb if (ie == *ie_ids) 25446b4cac81SBjoern A. Zeeb return (true); 25456b4cac81SBjoern A. Zeeb } 25466b4cac81SBjoern A. Zeeb 25476b4cac81SBjoern A. Zeeb return (false); 25486b4cac81SBjoern A. Zeeb } 25496b4cac81SBjoern A. Zeeb 25506b4cac81SBjoern A. Zeeb /* Return true if skipped; false if error. */ 25516b4cac81SBjoern A. Zeeb bool 25526b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ie_advance(size_t *xp, const u8 *ies, size_t ies_len) 25536b4cac81SBjoern A. Zeeb { 25546b4cac81SBjoern A. Zeeb size_t x; 25556b4cac81SBjoern A. Zeeb uint8_t l; 25566b4cac81SBjoern A. Zeeb 25576b4cac81SBjoern A. Zeeb x = *xp; 25586b4cac81SBjoern A. Zeeb 25596b4cac81SBjoern A. Zeeb KASSERT(x < ies_len, ("%s: x %zu ies_len %zu ies %p\n", 25606b4cac81SBjoern A. Zeeb __func__, x, ies_len, ies)); 25616b4cac81SBjoern A. Zeeb l = ies[x + 1]; 25626b4cac81SBjoern A. Zeeb x += 2 + l; 25636b4cac81SBjoern A. Zeeb 25646b4cac81SBjoern A. Zeeb if (x > ies_len) 25656b4cac81SBjoern A. Zeeb return (false); 25666b4cac81SBjoern A. Zeeb 25676b4cac81SBjoern A. Zeeb *xp = x; 25686b4cac81SBjoern A. Zeeb return (true); 25696b4cac81SBjoern A. Zeeb } 25706b4cac81SBjoern A. Zeeb 2571d9945d78SBjoern A. Zeeb static uint8_t * 2572d9945d78SBjoern A. Zeeb lkpi_scan_ies_add(uint8_t *p, struct ieee80211_scan_ies *scan_ies, 2573d9945d78SBjoern A. Zeeb uint32_t band_mask, struct ieee80211vap *vap, struct ieee80211_hw *hw) 25746b4cac81SBjoern A. Zeeb { 2575d9945d78SBjoern A. Zeeb struct ieee80211_supported_band *supband; 2576d9945d78SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 25773dd98026SBjoern A. Zeeb struct ieee80211com *ic; 2578d9945d78SBjoern A. Zeeb const struct ieee80211_channel *chan; 2579d9945d78SBjoern A. Zeeb const struct ieee80211_rateset *rs; 2580d9945d78SBjoern A. Zeeb uint8_t *pb; 2581d9945d78SBjoern A. Zeeb int band, i; 25826b4cac81SBjoern A. Zeeb 25833dd98026SBjoern A. Zeeb ic = vap->iv_ic; 2584d9945d78SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 2585d9945d78SBjoern A. Zeeb if ((band_mask & (1 << band)) == 0) 2586d9945d78SBjoern A. Zeeb continue; 2587d9945d78SBjoern A. Zeeb 2588d9945d78SBjoern A. Zeeb supband = hw->wiphy->bands[band]; 2589d9945d78SBjoern A. Zeeb /* 2590d9945d78SBjoern A. Zeeb * This should not happen; 2591d9945d78SBjoern A. Zeeb * band_mask is a bitmask of valid bands to scan on. 2592d9945d78SBjoern A. Zeeb */ 2593d9945d78SBjoern A. Zeeb if (supband == NULL || supband->n_channels == 0) 2594d9945d78SBjoern A. Zeeb continue; 2595d9945d78SBjoern A. Zeeb 2596d9945d78SBjoern A. Zeeb /* Find a first channel to get the mode and rates from. */ 2597d9945d78SBjoern A. Zeeb channels = supband->channels; 2598d9945d78SBjoern A. Zeeb chan = NULL; 2599d9945d78SBjoern A. Zeeb for (i = 0; i < supband->n_channels; i++) { 2600d9945d78SBjoern A. Zeeb 2601d9945d78SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) 2602d9945d78SBjoern A. Zeeb continue; 2603d9945d78SBjoern A. Zeeb 26043dd98026SBjoern A. Zeeb chan = ieee80211_find_channel(ic, 2605d9945d78SBjoern A. Zeeb channels[i].center_freq, 0); 2606d9945d78SBjoern A. Zeeb if (chan != NULL) 2607d9945d78SBjoern A. Zeeb break; 2608d9945d78SBjoern A. Zeeb } 2609d9945d78SBjoern A. Zeeb 2610d9945d78SBjoern A. Zeeb /* This really should not happen. */ 2611d9945d78SBjoern A. Zeeb if (chan == NULL) 2612d9945d78SBjoern A. Zeeb continue; 2613d9945d78SBjoern A. Zeeb 2614d9945d78SBjoern A. Zeeb pb = p; 26153dd98026SBjoern A. Zeeb rs = ieee80211_get_suprates(ic, chan); /* calls chan2mode */ 2616d9945d78SBjoern A. Zeeb p = ieee80211_add_rates(p, rs); 2617d9945d78SBjoern A. Zeeb p = ieee80211_add_xrates(p, rs); 2618d9945d78SBjoern A. Zeeb 26193dd98026SBjoern A. Zeeb #if defined(LKPI_80211_HT) 26203dd98026SBjoern A. Zeeb if ((vap->iv_flags_ht & IEEE80211_FHT_HT) != 0) { 26213dd98026SBjoern A. Zeeb struct ieee80211_channel *c; 26223dd98026SBjoern A. Zeeb 26233dd98026SBjoern A. Zeeb c = ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 26243dd98026SBjoern A. Zeeb vap->iv_flags_ht); 26253dd98026SBjoern A. Zeeb p = ieee80211_add_htcap_ch(p, vap, c); 26263dd98026SBjoern A. Zeeb } 26273dd98026SBjoern A. Zeeb #endif 26283dd98026SBjoern A. Zeeb #if defined(LKPI_80211_VHT) 26293dd98026SBjoern A. Zeeb if ((vap->iv_vht_flags & IEEE80211_FVHT_VHT) != 0) { 26303dd98026SBjoern A. Zeeb struct ieee80211_channel *c; 26313dd98026SBjoern A. Zeeb 26323dd98026SBjoern A. Zeeb c = ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 26333dd98026SBjoern A. Zeeb vap->iv_flags_ht); 26343dd98026SBjoern A. Zeeb c = ieee80211_vht_adjust_channel(ic, c, 26353dd98026SBjoern A. Zeeb vap->iv_vht_flags); 26363dd98026SBjoern A. Zeeb p = ieee80211_add_vhtcap_ch(p, vap, c); 26373dd98026SBjoern A. Zeeb } 26383dd98026SBjoern A. Zeeb #endif 26393dd98026SBjoern A. Zeeb 2640d9945d78SBjoern A. Zeeb scan_ies->ies[band] = pb; 2641d9945d78SBjoern A. Zeeb scan_ies->len[band] = p - pb; 2642d9945d78SBjoern A. Zeeb } 2643d9945d78SBjoern A. Zeeb 2644d9945d78SBjoern A. Zeeb /* Add common_ies */ 2645d9945d78SBjoern A. Zeeb pb = p; 2646d9945d78SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WPA1) != 0 && 2647d9945d78SBjoern A. Zeeb vap->iv_wpa_ie != NULL) { 2648d9945d78SBjoern A. Zeeb memcpy(p, vap->iv_wpa_ie, 2 + vap->iv_wpa_ie[1]); 2649d9945d78SBjoern A. Zeeb p += 2 + vap->iv_wpa_ie[1]; 2650d9945d78SBjoern A. Zeeb } 2651d9945d78SBjoern A. Zeeb if (vap->iv_appie_probereq != NULL) { 2652d9945d78SBjoern A. Zeeb memcpy(p, vap->iv_appie_probereq->ie_data, 2653d9945d78SBjoern A. Zeeb vap->iv_appie_probereq->ie_len); 2654d9945d78SBjoern A. Zeeb p += vap->iv_appie_probereq->ie_len; 2655d9945d78SBjoern A. Zeeb } 2656d9945d78SBjoern A. Zeeb scan_ies->common_ies = pb; 2657d9945d78SBjoern A. Zeeb scan_ies->common_ie_len = p - pb; 2658d9945d78SBjoern A. Zeeb 2659d9945d78SBjoern A. Zeeb return (p); 26606b4cac81SBjoern A. Zeeb } 26616b4cac81SBjoern A. Zeeb 26626b4cac81SBjoern A. Zeeb static void 26636b4cac81SBjoern A. Zeeb lkpi_ic_scan_start(struct ieee80211com *ic) 26646b4cac81SBjoern A. Zeeb { 26656b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 26666b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 26676b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 26686b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 26696b4cac81SBjoern A. Zeeb struct ieee80211_scan_state *ss; 26706b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 26716b4cac81SBjoern A. Zeeb int error; 26728ac540d3SBjoern A. Zeeb bool is_hw_scan; 26736b4cac81SBjoern A. Zeeb 26746b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 26758ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2676a486fbbdSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0) { 26776b4cac81SBjoern A. Zeeb /* A scan is still running. */ 26788ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 26796b4cac81SBjoern A. Zeeb return; 26806b4cac81SBjoern A. Zeeb } 26818ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 26828ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 26836b4cac81SBjoern A. Zeeb 26846b4cac81SBjoern A. Zeeb ss = ic->ic_scan; 26856b4cac81SBjoern A. Zeeb vap = ss->ss_vap; 26866b4cac81SBjoern A. Zeeb if (vap->iv_state != IEEE80211_S_SCAN) { 2687d3ef7fb4SBjoern A. Zeeb IMPROVE("We need to be able to scan if not in S_SCAN"); 26886b4cac81SBjoern A. Zeeb return; 26896b4cac81SBjoern A. Zeeb } 26906b4cac81SBjoern A. Zeeb 26916b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 26928ac540d3SBjoern A. Zeeb if (!is_hw_scan) { 2693a486fbbdSBjoern A. Zeeb /* If hw_scan is cleared clear FEXT_SCAN_OFFLOAD too. */ 2694a486fbbdSBjoern A. Zeeb vap->iv_flags_ext &= ~IEEE80211_FEXT_SCAN_OFFLOAD; 2695d3ef7fb4SBjoern A. Zeeb sw_scan: 26966b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 26976b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 2698086be6a8SBjoern A. Zeeb 2699086be6a8SBjoern A. Zeeb if (vap->iv_state == IEEE80211_S_SCAN) 2700086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, false); 2701086be6a8SBjoern A. Zeeb 27026b4cac81SBjoern A. Zeeb lkpi_80211_mo_sw_scan_start(hw, vif, vif->addr); 27036b4cac81SBjoern A. Zeeb /* net80211::scan_start() handled PS for us. */ 27046b4cac81SBjoern A. Zeeb IMPROVE(); 27056b4cac81SBjoern A. Zeeb /* XXX Also means it is too late to flush queues? 27066b4cac81SBjoern A. Zeeb * need to check iv_sta_ps or overload? */ 27076b4cac81SBjoern A. Zeeb /* XXX want to adjust ss end time/ maxdwell? */ 27086b4cac81SBjoern A. Zeeb 27096b4cac81SBjoern A. Zeeb } else { 27106b4cac81SBjoern A. Zeeb struct ieee80211_channel *c; 27116b4cac81SBjoern A. Zeeb struct ieee80211_scan_request *hw_req; 27126b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *lc, **cpp; 27136b4cac81SBjoern A. Zeeb struct cfg80211_ssid *ssids; 27146b4cac81SBjoern A. Zeeb struct cfg80211_scan_6ghz_params *s6gp; 27156b4cac81SBjoern A. Zeeb size_t chan_len, nchan, ssids_len, s6ghzlen; 2716d9945d78SBjoern A. Zeeb int band, i, ssid_count, common_ie_len; 2717d9945d78SBjoern A. Zeeb uint32_t band_mask; 2718d9945d78SBjoern A. Zeeb uint8_t *ie, *ieend; 27193206587aSBjoern A. Zeeb bool running; 2720d9945d78SBjoern A. Zeeb 2721d9945d78SBjoern A. Zeeb ssid_count = min(ss->ss_nssid, hw->wiphy->max_scan_ssids); 2722d9945d78SBjoern A. Zeeb ssids_len = ssid_count * sizeof(*ssids); 27236b4cac81SBjoern A. Zeeb s6ghzlen = 0 * (sizeof(*s6gp)); /* XXX-BZ */ 27246b4cac81SBjoern A. Zeeb 2725d9945d78SBjoern A. Zeeb band_mask = 0; 27266b4cac81SBjoern A. Zeeb nchan = 0; 2727d9945d78SBjoern A. Zeeb for (i = ss->ss_next; i < ss->ss_last; i++) { 27286b4cac81SBjoern A. Zeeb nchan++; 2729d9945d78SBjoern A. Zeeb band = lkpi_net80211_chan_to_nl80211_band( 2730d9945d78SBjoern A. Zeeb ss->ss_chans[ss->ss_next + i]); 2731d9945d78SBjoern A. Zeeb band_mask |= (1 << band); 2732d9945d78SBjoern A. Zeeb } 27333206587aSBjoern A. Zeeb 27343206587aSBjoern A. Zeeb if (!ieee80211_hw_check(hw, SINGLE_SCAN_ON_ALL_BANDS)) { 27353206587aSBjoern A. Zeeb IMPROVE("individual band scans not yet supported, only scanning first band"); 27363206587aSBjoern A. Zeeb /* In theory net80211 should drive this. */ 27373206587aSBjoern A. Zeeb /* Probably we need to add local logic for now; 27383206587aSBjoern A. Zeeb * need to deal with scan_complete 27393206587aSBjoern A. Zeeb * and cancel_scan and keep local state. 27403206587aSBjoern A. Zeeb * Also cut the nchan down above. 27413206587aSBjoern A. Zeeb */ 27423206587aSBjoern A. Zeeb /* XXX-BZ ath10k does not set this but still does it? &$%^ */ 27433206587aSBjoern A. Zeeb } 27443206587aSBjoern A. Zeeb 27456b4cac81SBjoern A. Zeeb chan_len = nchan * (sizeof(lc) + sizeof(*lc)); 27466b4cac81SBjoern A. Zeeb 2747d9945d78SBjoern A. Zeeb common_ie_len = 0; 2748d9945d78SBjoern A. Zeeb if ((vap->iv_flags & IEEE80211_F_WPA1) != 0 && 2749d9945d78SBjoern A. Zeeb vap->iv_wpa_ie != NULL) 2750d9945d78SBjoern A. Zeeb common_ie_len += vap->iv_wpa_ie[1]; 2751d9945d78SBjoern A. Zeeb if (vap->iv_appie_probereq != NULL) 2752d9945d78SBjoern A. Zeeb common_ie_len += vap->iv_appie_probereq->ie_len; 2753d9945d78SBjoern A. Zeeb 2754d9945d78SBjoern A. Zeeb /* We would love to check this at an earlier stage... */ 2755d9945d78SBjoern A. Zeeb if (common_ie_len > hw->wiphy->max_scan_ie_len) { 2756d9945d78SBjoern A. Zeeb ic_printf(ic, "WARNING: %s: common_ie_len %d > " 2757d9945d78SBjoern A. Zeeb "wiphy->max_scan_ie_len %d\n", __func__, 2758d9945d78SBjoern A. Zeeb common_ie_len, hw->wiphy->max_scan_ie_len); 2759d9945d78SBjoern A. Zeeb } 2760d9945d78SBjoern A. Zeeb 27613206587aSBjoern A. Zeeb hw_req = malloc(sizeof(*hw_req) + ssids_len + 2762d9945d78SBjoern A. Zeeb s6ghzlen + chan_len + lhw->supbands * lhw->scan_ie_len + 2763d9945d78SBjoern A. Zeeb common_ie_len, M_LKPI80211, M_WAITOK | M_ZERO); 27646b4cac81SBjoern A. Zeeb 27656b4cac81SBjoern A. Zeeb hw_req->req.flags = 0; /* XXX ??? */ 27666b4cac81SBjoern A. Zeeb /* hw_req->req.wdev */ 27676b4cac81SBjoern A. Zeeb hw_req->req.wiphy = hw->wiphy; 27686b4cac81SBjoern A. Zeeb hw_req->req.no_cck = false; /* XXX */ 27696b4cac81SBjoern A. Zeeb #if 0 27706b4cac81SBjoern A. Zeeb /* This seems to pessimise default scanning behaviour. */ 27716b4cac81SBjoern A. Zeeb hw_req->req.duration_mandatory = TICKS_2_USEC(ss->ss_mindwell); 27726b4cac81SBjoern A. Zeeb hw_req->req.duration = TICKS_2_USEC(ss->ss_maxdwell); 27736b4cac81SBjoern A. Zeeb #endif 27746b4cac81SBjoern A. Zeeb #ifdef __notyet__ 27756b4cac81SBjoern A. Zeeb hw_req->req.flags |= NL80211_SCAN_FLAG_RANDOM_ADDR; 27766b4cac81SBjoern A. Zeeb memcpy(hw_req->req.mac_addr, xxx, IEEE80211_ADDR_LEN); 27776b4cac81SBjoern A. Zeeb memset(hw_req->req.mac_addr_mask, 0xxx, IEEE80211_ADDR_LEN); 27786b4cac81SBjoern A. Zeeb #endif 2779e1e90be0SBjoern A. Zeeb eth_broadcast_addr(hw_req->req.bssid); 27806b4cac81SBjoern A. Zeeb 27816b4cac81SBjoern A. Zeeb hw_req->req.n_channels = nchan; 27826b4cac81SBjoern A. Zeeb cpp = (struct linuxkpi_ieee80211_channel **)(hw_req + 1); 27836b4cac81SBjoern A. Zeeb lc = (struct linuxkpi_ieee80211_channel *)(cpp + nchan); 27846b4cac81SBjoern A. Zeeb for (i = 0; i < nchan; i++) { 27856b4cac81SBjoern A. Zeeb *(cpp + i) = 27866b4cac81SBjoern A. Zeeb (struct linuxkpi_ieee80211_channel *)(lc + i); 27876b4cac81SBjoern A. Zeeb } 27886b4cac81SBjoern A. Zeeb for (i = 0; i < nchan; i++) { 27896b4cac81SBjoern A. Zeeb c = ss->ss_chans[ss->ss_next + i]; 27906b4cac81SBjoern A. Zeeb 27916b4cac81SBjoern A. Zeeb lc->hw_value = c->ic_ieee; 27923206587aSBjoern A. Zeeb lc->center_freq = c->ic_freq; /* XXX */ 27936b4cac81SBjoern A. Zeeb /* lc->flags */ 27946b4cac81SBjoern A. Zeeb lc->band = lkpi_net80211_chan_to_nl80211_band(c); 27956b4cac81SBjoern A. Zeeb lc->max_power = c->ic_maxpower; 27966b4cac81SBjoern A. Zeeb /* lc-> ... */ 27976b4cac81SBjoern A. Zeeb lc++; 27986b4cac81SBjoern A. Zeeb } 27996b4cac81SBjoern A. Zeeb 2800d9945d78SBjoern A. Zeeb hw_req->req.n_ssids = ssid_count; 28016b4cac81SBjoern A. Zeeb if (hw_req->req.n_ssids > 0) { 28026b4cac81SBjoern A. Zeeb ssids = (struct cfg80211_ssid *)lc; 28036b4cac81SBjoern A. Zeeb hw_req->req.ssids = ssids; 2804d9945d78SBjoern A. Zeeb for (i = 0; i < ssid_count; i++) { 28056b4cac81SBjoern A. Zeeb ssids->ssid_len = ss->ss_ssid[i].len; 28066b4cac81SBjoern A. Zeeb memcpy(ssids->ssid, ss->ss_ssid[i].ssid, 28076b4cac81SBjoern A. Zeeb ss->ss_ssid[i].len); 28086b4cac81SBjoern A. Zeeb ssids++; 28096b4cac81SBjoern A. Zeeb } 28106b4cac81SBjoern A. Zeeb s6gp = (struct cfg80211_scan_6ghz_params *)ssids; 28116b4cac81SBjoern A. Zeeb } else { 28126b4cac81SBjoern A. Zeeb s6gp = (struct cfg80211_scan_6ghz_params *)lc; 28136b4cac81SBjoern A. Zeeb } 28146b4cac81SBjoern A. Zeeb 28156b4cac81SBjoern A. Zeeb /* 6GHz one day. */ 28166b4cac81SBjoern A. Zeeb hw_req->req.n_6ghz_params = 0; 28176b4cac81SBjoern A. Zeeb hw_req->req.scan_6ghz_params = NULL; 28186b4cac81SBjoern A. Zeeb hw_req->req.scan_6ghz = false; /* Weird boolean; not what you think. */ 28196b4cac81SBjoern A. Zeeb /* s6gp->... */ 28206b4cac81SBjoern A. Zeeb 2821d9945d78SBjoern A. Zeeb ie = ieend = (uint8_t *)s6gp; 2822d9945d78SBjoern A. Zeeb /* Copy per-band IEs, copy common IEs */ 2823d9945d78SBjoern A. Zeeb ieend = lkpi_scan_ies_add(ie, &hw_req->ies, band_mask, vap, hw); 2824d9945d78SBjoern A. Zeeb hw_req->req.ie = ie; 2825d9945d78SBjoern A. Zeeb hw_req->req.ie_len = ieend - ie; 2826d9945d78SBjoern A. Zeeb 28276b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 28286b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 28293206587aSBjoern A. Zeeb 28303206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 28313206587aSBjoern A. Zeeb /* Re-check under lock. */ 28323206587aSBjoern A. Zeeb running = (lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0; 28333206587aSBjoern A. Zeeb if (!running) { 28343206587aSBjoern A. Zeeb KASSERT(lhw->hw_req == NULL, ("%s: ic %p lhw %p hw_req %p " 28353206587aSBjoern A. Zeeb "!= NULL\n", __func__, ic, lhw, lhw->hw_req)); 28363206587aSBjoern A. Zeeb 28373206587aSBjoern A. Zeeb lhw->scan_flags |= LKPI_LHW_SCAN_RUNNING; 28383206587aSBjoern A. Zeeb lhw->hw_req = hw_req; 28393206587aSBjoern A. Zeeb } 28403206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 28413206587aSBjoern A. Zeeb if (running) { 28423206587aSBjoern A. Zeeb free(hw_req, M_LKPI80211); 28433206587aSBjoern A. Zeeb return; 28443206587aSBjoern A. Zeeb } 28453206587aSBjoern A. Zeeb 28466b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_hw_scan(hw, vif, hw_req); 28476b4cac81SBjoern A. Zeeb if (error != 0) { 2848d9945d78SBjoern A. Zeeb ieee80211_cancel_scan(vap); 2849d9945d78SBjoern A. Zeeb 28503206587aSBjoern A. Zeeb /* 28513206587aSBjoern A. Zeeb * ieee80211_scan_completed must be called in either 28523206587aSBjoern A. Zeeb * case of error or none. So let the free happen there 28533206587aSBjoern A. Zeeb * and only there. 28543206587aSBjoern A. Zeeb * That would be fine in theory but in practice drivers 28553206587aSBjoern A. Zeeb * behave differently: 28563206587aSBjoern A. Zeeb * ath10k does not return hw_scan until after scan_complete 28573206587aSBjoern A. Zeeb * and can then still return an error. 28583206587aSBjoern A. Zeeb * rtw88 can return 1 or -EBUSY without scan_complete 28593206587aSBjoern A. Zeeb * iwlwifi can return various errors before scan starts 28603206587aSBjoern A. Zeeb * ... 28613206587aSBjoern A. Zeeb * So we cannot rely on that behaviour and have to check 28623206587aSBjoern A. Zeeb * and balance between both code paths. 28633206587aSBjoern A. Zeeb */ 28643206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 28653206587aSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) != 0) { 28663206587aSBjoern A. Zeeb free(lhw->hw_req, M_LKPI80211); 28676b4cac81SBjoern A. Zeeb lhw->hw_req = NULL; 28683206587aSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_RUNNING; 28693206587aSBjoern A. Zeeb } 28703206587aSBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 2871d3ef7fb4SBjoern A. Zeeb 2872d3ef7fb4SBjoern A. Zeeb /* 2873d3ef7fb4SBjoern A. Zeeb * XXX-SIGH magic number. 2874d3ef7fb4SBjoern A. Zeeb * rtw88 has a magic "return 1" if offloading scan is 2875d3ef7fb4SBjoern A. Zeeb * not possible. Fall back to sw scan in that case. 2876d3ef7fb4SBjoern A. Zeeb */ 2877196cfd0bSBjoern A. Zeeb if (error == 1) { 28788ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2879a486fbbdSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_HW; 28808ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 28813206587aSBjoern A. Zeeb /* 28823206587aSBjoern A. Zeeb * XXX If we clear this now and later a driver 28833206587aSBjoern A. Zeeb * thinks it * can do a hw_scan again, we will 28843206587aSBjoern A. Zeeb * currently not re-enable it? 28853206587aSBjoern A. Zeeb */ 28863206587aSBjoern A. Zeeb vap->iv_flags_ext &= ~IEEE80211_FEXT_SCAN_OFFLOAD; 2887196cfd0bSBjoern A. Zeeb ieee80211_start_scan(vap, 2888196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_ACTIVE | 2889196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_NOPICK | 2890196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_ONCE, 2891196cfd0bSBjoern A. Zeeb IEEE80211_SCAN_FOREVER, 2892196cfd0bSBjoern A. Zeeb ss->ss_mindwell ? ss->ss_mindwell : msecs_to_ticks(20), 2893196cfd0bSBjoern A. Zeeb ss->ss_maxdwell ? ss->ss_maxdwell : msecs_to_ticks(200), 2894196cfd0bSBjoern A. Zeeb vap->iv_des_nssid, vap->iv_des_ssid); 2895d3ef7fb4SBjoern A. Zeeb goto sw_scan; 2896196cfd0bSBjoern A. Zeeb } 2897d3ef7fb4SBjoern A. Zeeb 2898d3ef7fb4SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: hw_scan returned %d\n", 2899d3ef7fb4SBjoern A. Zeeb __func__, error); 29006b4cac81SBjoern A. Zeeb } 29016b4cac81SBjoern A. Zeeb } 29026b4cac81SBjoern A. Zeeb } 29036b4cac81SBjoern A. Zeeb 29046b4cac81SBjoern A. Zeeb static void 29056b4cac81SBjoern A. Zeeb lkpi_ic_scan_end(struct ieee80211com *ic) 29066b4cac81SBjoern A. Zeeb { 29076b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 29088ac540d3SBjoern A. Zeeb bool is_hw_scan; 29096b4cac81SBjoern A. Zeeb 29106b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 29118ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 2912a486fbbdSBjoern A. Zeeb if ((lhw->scan_flags & LKPI_LHW_SCAN_RUNNING) == 0) { 29138ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29146b4cac81SBjoern A. Zeeb return; 29156b4cac81SBjoern A. Zeeb } 29168ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29178ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29186b4cac81SBjoern A. Zeeb 29198ac540d3SBjoern A. Zeeb if (!is_hw_scan) { 2920a486fbbdSBjoern A. Zeeb struct ieee80211_scan_state *ss; 2921a486fbbdSBjoern A. Zeeb struct ieee80211vap *vap; 29226b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 29236b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 29246b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 29256b4cac81SBjoern A. Zeeb 2926a486fbbdSBjoern A. Zeeb ss = ic->ic_scan; 2927a486fbbdSBjoern A. Zeeb vap = ss->ss_vap; 29286b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 29296b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 29306b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 2931a486fbbdSBjoern A. Zeeb 29326b4cac81SBjoern A. Zeeb lkpi_80211_mo_sw_scan_complete(hw, vif); 29336b4cac81SBjoern A. Zeeb 29346b4cac81SBjoern A. Zeeb /* Send PS to stop buffering if n80211 does not for us? */ 2935086be6a8SBjoern A. Zeeb 2936086be6a8SBjoern A. Zeeb if (vap->iv_state == IEEE80211_S_SCAN) 2937086be6a8SBjoern A. Zeeb lkpi_hw_conf_idle(hw, true); 29386b4cac81SBjoern A. Zeeb } 29396b4cac81SBjoern A. Zeeb } 29406b4cac81SBjoern A. Zeeb 29416b4cac81SBjoern A. Zeeb static void 2942a486fbbdSBjoern A. Zeeb lkpi_ic_scan_curchan(struct ieee80211_scan_state *ss, 2943a486fbbdSBjoern A. Zeeb unsigned long maxdwell) 2944a486fbbdSBjoern A. Zeeb { 2945a486fbbdSBjoern A. Zeeb struct lkpi_hw *lhw; 29468ac540d3SBjoern A. Zeeb bool is_hw_scan; 2947a486fbbdSBjoern A. Zeeb 2948a486fbbdSBjoern A. Zeeb lhw = ss->ss_ic->ic_softc; 29498ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 29508ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29518ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29528ac540d3SBjoern A. Zeeb if (!is_hw_scan) 2953a486fbbdSBjoern A. Zeeb lhw->ic_scan_curchan(ss, maxdwell); 2954a486fbbdSBjoern A. Zeeb } 2955a486fbbdSBjoern A. Zeeb 2956a486fbbdSBjoern A. Zeeb static void 2957a486fbbdSBjoern A. Zeeb lkpi_ic_scan_mindwell(struct ieee80211_scan_state *ss) 2958a486fbbdSBjoern A. Zeeb { 2959a486fbbdSBjoern A. Zeeb struct lkpi_hw *lhw; 29608ac540d3SBjoern A. Zeeb bool is_hw_scan; 2961a486fbbdSBjoern A. Zeeb 2962a486fbbdSBjoern A. Zeeb lhw = ss->ss_ic->ic_softc; 29638ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 29648ac540d3SBjoern A. Zeeb is_hw_scan = (lhw->scan_flags & LKPI_LHW_SCAN_HW) != 0; 29658ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29668ac540d3SBjoern A. Zeeb if (!is_hw_scan) 2967a486fbbdSBjoern A. Zeeb lhw->ic_scan_mindwell(ss); 2968a486fbbdSBjoern A. Zeeb } 2969a486fbbdSBjoern A. Zeeb 2970a486fbbdSBjoern A. Zeeb static void 29716b4cac81SBjoern A. Zeeb lkpi_ic_set_channel(struct ieee80211com *ic) 29726b4cac81SBjoern A. Zeeb { 29736b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 29746b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 2975b2cf3c21SBjoern A. Zeeb struct ieee80211_channel *c; 2976b2cf3c21SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 29776b4cac81SBjoern A. Zeeb int error; 29788ac540d3SBjoern A. Zeeb bool hw_scan_running; 29796b4cac81SBjoern A. Zeeb 29806b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 2981b2cf3c21SBjoern A. Zeeb 2982b2cf3c21SBjoern A. Zeeb /* If we do not support (*config)() save us the work. */ 2983b2cf3c21SBjoern A. Zeeb if (lhw->ops->config == NULL) 29846b4cac81SBjoern A. Zeeb return; 29856b4cac81SBjoern A. Zeeb 2986a486fbbdSBjoern A. Zeeb /* If we have a hw_scan running do not switch channels. */ 29878ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 29888ac540d3SBjoern A. Zeeb hw_scan_running = 29898ac540d3SBjoern A. Zeeb (lhw->scan_flags & (LKPI_LHW_SCAN_RUNNING|LKPI_LHW_SCAN_HW)) == 29908ac540d3SBjoern A. Zeeb (LKPI_LHW_SCAN_RUNNING|LKPI_LHW_SCAN_HW); 29918ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 29928ac540d3SBjoern A. Zeeb if (hw_scan_running) 2993a486fbbdSBjoern A. Zeeb return; 2994a486fbbdSBjoern A. Zeeb 2995b2cf3c21SBjoern A. Zeeb c = ic->ic_curchan; 2996b2cf3c21SBjoern A. Zeeb if (c == NULL || c == IEEE80211_CHAN_ANYC) { 29976b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: c %p ops->config %p\n", __func__, 29986b4cac81SBjoern A. Zeeb c, lhw->ops->config); 29996b4cac81SBjoern A. Zeeb return; 30006b4cac81SBjoern A. Zeeb } 30016b4cac81SBjoern A. Zeeb 30026b4cac81SBjoern A. Zeeb chan = lkpi_find_lkpi80211_chan(lhw, c); 30036b4cac81SBjoern A. Zeeb if (chan == NULL) { 30046b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: c %p chan %p\n", __func__, 30056b4cac81SBjoern A. Zeeb c, chan); 30066b4cac81SBjoern A. Zeeb return; 30076b4cac81SBjoern A. Zeeb } 30086b4cac81SBjoern A. Zeeb 30096b4cac81SBjoern A. Zeeb /* XXX max power for scanning? */ 30106b4cac81SBjoern A. Zeeb IMPROVE(); 30116b4cac81SBjoern A. Zeeb 30126b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 30134a07abdeSBjoern A. Zeeb cfg80211_chandef_create(&hw->conf.chandef, chan, 30144a07abdeSBjoern A. Zeeb NL80211_CHAN_NO_HT); 30156b4cac81SBjoern A. Zeeb 30166b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_config(hw, IEEE80211_CONF_CHANGE_CHANNEL); 30176b4cac81SBjoern A. Zeeb if (error != 0 && error != EOPNOTSUPP) { 30186b4cac81SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: config %#0x returned %d\n", 30196b4cac81SBjoern A. Zeeb __func__, IEEE80211_CONF_CHANGE_CHANNEL, error); 30206b4cac81SBjoern A. Zeeb /* XXX should we unroll to the previous chandef? */ 30216b4cac81SBjoern A. Zeeb IMPROVE(); 30226b4cac81SBjoern A. Zeeb } else { 30236b4cac81SBjoern A. Zeeb /* Update radiotap channels as well. */ 30246b4cac81SBjoern A. Zeeb lhw->rtap_tx.wt_chan_freq = htole16(c->ic_freq); 30256b4cac81SBjoern A. Zeeb lhw->rtap_tx.wt_chan_flags = htole16(c->ic_flags); 30266b4cac81SBjoern A. Zeeb lhw->rtap_rx.wr_chan_freq = htole16(c->ic_freq); 30276b4cac81SBjoern A. Zeeb lhw->rtap_rx.wr_chan_flags = htole16(c->ic_flags); 30286b4cac81SBjoern A. Zeeb } 30296b4cac81SBjoern A. Zeeb 30306b4cac81SBjoern A. Zeeb /* Currently PS is hard coded off! Not sure it belongs here. */ 30316b4cac81SBjoern A. Zeeb IMPROVE(); 30326b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, SUPPORTS_PS) && 30336b4cac81SBjoern A. Zeeb (hw->conf.flags & IEEE80211_CONF_PS) != 0) { 30346b4cac81SBjoern A. Zeeb hw->conf.flags &= ~IEEE80211_CONF_PS; 30356b4cac81SBjoern A. Zeeb error = lkpi_80211_mo_config(hw, IEEE80211_CONF_CHANGE_PS); 30366b4cac81SBjoern A. Zeeb if (error != 0 && error != EOPNOTSUPP) 30376b4cac81SBjoern A. Zeeb ic_printf(ic, "ERROR: %s: config %#0x returned " 30386b4cac81SBjoern A. Zeeb "%d\n", __func__, IEEE80211_CONF_CHANGE_PS, 30396b4cac81SBjoern A. Zeeb error); 30406b4cac81SBjoern A. Zeeb } 30416b4cac81SBjoern A. Zeeb } 30426b4cac81SBjoern A. Zeeb 30436b4cac81SBjoern A. Zeeb static struct ieee80211_node * 30446b4cac81SBjoern A. Zeeb lkpi_ic_node_alloc(struct ieee80211vap *vap, 30456b4cac81SBjoern A. Zeeb const uint8_t mac[IEEE80211_ADDR_LEN]) 30466b4cac81SBjoern A. Zeeb { 30476b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 30486b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 30494f61ef8bSBjoern A. Zeeb struct ieee80211_node *ni; 30506b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 30516b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 30526b4cac81SBjoern A. Zeeb 30536b4cac81SBjoern A. Zeeb ic = vap->iv_ic; 30546b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 30556b4cac81SBjoern A. Zeeb 30566b4cac81SBjoern A. Zeeb /* We keep allocations de-coupled so we can deal with the two worlds. */ 30574f61ef8bSBjoern A. Zeeb if (lhw->ic_node_alloc == NULL) 30584f61ef8bSBjoern A. Zeeb return (NULL); 30594f61ef8bSBjoern A. Zeeb 30606b4cac81SBjoern A. Zeeb ni = lhw->ic_node_alloc(vap, mac); 30616b4cac81SBjoern A. Zeeb if (ni == NULL) 30626b4cac81SBjoern A. Zeeb return (NULL); 30636b4cac81SBjoern A. Zeeb 30646b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 30654f61ef8bSBjoern A. Zeeb lsta = lkpi_lsta_alloc(vap, mac, hw, ni); 30666b4cac81SBjoern A. Zeeb if (lsta == NULL) { 30676b4cac81SBjoern A. Zeeb if (lhw->ic_node_free != NULL) 30686b4cac81SBjoern A. Zeeb lhw->ic_node_free(ni); 30696b4cac81SBjoern A. Zeeb return (NULL); 30706b4cac81SBjoern A. Zeeb } 30716b4cac81SBjoern A. Zeeb 30726b4cac81SBjoern A. Zeeb return (ni); 30736b4cac81SBjoern A. Zeeb } 30746b4cac81SBjoern A. Zeeb 30756b4cac81SBjoern A. Zeeb static int 30766b4cac81SBjoern A. Zeeb lkpi_ic_node_init(struct ieee80211_node *ni) 30776b4cac81SBjoern A. Zeeb { 30786b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 30796b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 30806b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 30816b4cac81SBjoern A. Zeeb int error; 30826b4cac81SBjoern A. Zeeb 30836b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 30846b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 30856b4cac81SBjoern A. Zeeb 30866b4cac81SBjoern A. Zeeb if (lhw->ic_node_init != NULL) { 30876b4cac81SBjoern A. Zeeb error = lhw->ic_node_init(ni); 30886b4cac81SBjoern A. Zeeb if (error != 0) 30896b4cac81SBjoern A. Zeeb return (error); 30906b4cac81SBjoern A. Zeeb } 30916b4cac81SBjoern A. Zeeb 30926b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 30936b4cac81SBjoern A. Zeeb 30946b4cac81SBjoern A. Zeeb /* Now take the reference before linking it to the table. */ 30956b4cac81SBjoern A. Zeeb lsta->ni = ieee80211_ref_node(ni); 30966b4cac81SBjoern A. Zeeb 30976b4cac81SBjoern A. Zeeb /* XXX-BZ Sync other state over. */ 30986b4cac81SBjoern A. Zeeb IMPROVE(); 30996b4cac81SBjoern A. Zeeb 31006b4cac81SBjoern A. Zeeb return (0); 31016b4cac81SBjoern A. Zeeb } 31026b4cac81SBjoern A. Zeeb 31036b4cac81SBjoern A. Zeeb static void 31046b4cac81SBjoern A. Zeeb lkpi_ic_node_cleanup(struct ieee80211_node *ni) 31056b4cac81SBjoern A. Zeeb { 31066b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 31076b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 31086b4cac81SBjoern A. Zeeb 31096b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 31106b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 31116b4cac81SBjoern A. Zeeb 31126b4cac81SBjoern A. Zeeb /* XXX-BZ remove from driver, ... */ 31136b4cac81SBjoern A. Zeeb IMPROVE(); 31146b4cac81SBjoern A. Zeeb 31156b4cac81SBjoern A. Zeeb if (lhw->ic_node_cleanup != NULL) 31166b4cac81SBjoern A. Zeeb lhw->ic_node_cleanup(ni); 31176b4cac81SBjoern A. Zeeb } 31186b4cac81SBjoern A. Zeeb 31196b4cac81SBjoern A. Zeeb static void 31206b4cac81SBjoern A. Zeeb lkpi_ic_node_free(struct ieee80211_node *ni) 31216b4cac81SBjoern A. Zeeb { 31226b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 31236b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 31246b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 31256b4cac81SBjoern A. Zeeb 31266b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 31276b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 31286b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 3129d9f59799SBjoern A. Zeeb if (lsta == NULL) 3130d9f59799SBjoern A. Zeeb goto out; 31316b4cac81SBjoern A. Zeeb 31326b4cac81SBjoern A. Zeeb /* XXX-BZ free resources, ... */ 31336b4cac81SBjoern A. Zeeb IMPROVE(); 31346b4cac81SBjoern A. Zeeb 31356b4cac81SBjoern A. Zeeb /* Flush mbufq (make sure to release ni refs!). */ 31366b4cac81SBjoern A. Zeeb #ifdef __notyet__ 31376b4cac81SBjoern A. Zeeb KASSERT(mbufq_len(&lsta->txq) == 0, ("%s: lsta %p has txq len %d != 0\n", 31386b4cac81SBjoern A. Zeeb __func__, lsta, mbufq_len(&lsta->txq))); 31396b4cac81SBjoern A. Zeeb #endif 31406b4cac81SBjoern A. Zeeb /* Drain taskq. */ 31416b4cac81SBjoern A. Zeeb 31426b4cac81SBjoern A. Zeeb /* Drain sta->txq[] */ 31436b4cac81SBjoern A. Zeeb mtx_destroy(&lsta->txq_mtx); 31446b4cac81SBjoern A. Zeeb 31456b4cac81SBjoern A. Zeeb /* Remove lsta if added_to_drv. */ 3146e24e8103SBjoern A. Zeeb 31476b4cac81SBjoern A. Zeeb /* Remove lsta from vif */ 3148e24e8103SBjoern A. Zeeb /* Remove ref from lsta node... */ 3149d9f59799SBjoern A. Zeeb /* Free lsta. */ 3150e24e8103SBjoern A. Zeeb lkpi_lsta_remove(lsta, VAP_TO_LVIF(ni->ni_vap)); 3151d9f59799SBjoern A. Zeeb 3152d9f59799SBjoern A. Zeeb out: 31536b4cac81SBjoern A. Zeeb if (lhw->ic_node_free != NULL) 31546b4cac81SBjoern A. Zeeb lhw->ic_node_free(ni); 31556b4cac81SBjoern A. Zeeb } 31566b4cac81SBjoern A. Zeeb 31576b4cac81SBjoern A. Zeeb static int 31586b4cac81SBjoern A. Zeeb lkpi_ic_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 31596b4cac81SBjoern A. Zeeb const struct ieee80211_bpf_params *params __unused) 31606b4cac81SBjoern A. Zeeb { 31616b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 31626b4cac81SBjoern A. Zeeb 31636b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 31646b4cac81SBjoern A. Zeeb 31656b4cac81SBjoern A. Zeeb /* Queue the packet and enqueue the task to handle it. */ 31666b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_LOCK(lsta); 31676b4cac81SBjoern A. Zeeb mbufq_enqueue(&lsta->txq, m); 31686b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_UNLOCK(lsta); 31696b4cac81SBjoern A. Zeeb 31709d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 31719d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 31726b4cac81SBjoern A. Zeeb printf("%s:%d lsta %p ni %p %6D mbuf_qlen %d\n", 31736b4cac81SBjoern A. Zeeb __func__, __LINE__, lsta, ni, ni->ni_macaddr, ":", 31746b4cac81SBjoern A. Zeeb mbufq_len(&lsta->txq)); 31759d9ba2b7SBjoern A. Zeeb #endif 31766b4cac81SBjoern A. Zeeb 31776b4cac81SBjoern A. Zeeb taskqueue_enqueue(taskqueue_thread, &lsta->txq_task); 31786b4cac81SBjoern A. Zeeb return (0); 31796b4cac81SBjoern A. Zeeb } 31806b4cac81SBjoern A. Zeeb 31816b4cac81SBjoern A. Zeeb static void 31826b4cac81SBjoern A. Zeeb lkpi_80211_txq_tx_one(struct lkpi_sta *lsta, struct mbuf *m) 31836b4cac81SBjoern A. Zeeb { 31846b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 3185b35f6cd0SBjoern A. Zeeb #ifndef LKPI_80211_HW_CRYPTO 31866b4cac81SBjoern A. Zeeb struct ieee80211_frame *wh; 3187b35f6cd0SBjoern A. Zeeb #endif 31886b4cac81SBjoern A. Zeeb struct ieee80211_key *k; 31896b4cac81SBjoern A. Zeeb struct sk_buff *skb; 31906b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 31916b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 31926b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 31936b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 31946b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 31956b4cac81SBjoern A. Zeeb struct ieee80211_channel *c; 31966b4cac81SBjoern A. Zeeb struct ieee80211_tx_control control; 31976b4cac81SBjoern A. Zeeb struct ieee80211_tx_info *info; 31986b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 3199e3a0b120SBjoern A. Zeeb struct ieee80211_hdr *hdr; 32006b4cac81SBjoern A. Zeeb void *buf; 3201e3a0b120SBjoern A. Zeeb uint8_t ac, tid; 32026b4cac81SBjoern A. Zeeb 32036b4cac81SBjoern A. Zeeb M_ASSERTPKTHDR(m); 32046b4cac81SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 32059d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX_DUMP) 32066b4cac81SBjoern A. Zeeb hexdump(mtod(m, const void *), m->m_len, "RAW TX (plain) ", 0); 32076b4cac81SBjoern A. Zeeb #endif 32086b4cac81SBjoern A. Zeeb 32096b4cac81SBjoern A. Zeeb ni = lsta->ni; 3210b35f6cd0SBjoern A. Zeeb k = NULL; 3211b35f6cd0SBjoern A. Zeeb #ifndef LKPI_80211_HW_CRYPTO 32126b4cac81SBjoern A. Zeeb /* Encrypt the frame if need be; XXX-BZ info->control.hw_key. */ 32136b4cac81SBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame *); 32146b4cac81SBjoern A. Zeeb if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 32156b4cac81SBjoern A. Zeeb /* Retrieve key for TX && do software encryption. */ 32166b4cac81SBjoern A. Zeeb k = ieee80211_crypto_encap(ni, m); 32176b4cac81SBjoern A. Zeeb if (k == NULL) { 32186b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 32196b4cac81SBjoern A. Zeeb m_freem(m); 32206b4cac81SBjoern A. Zeeb return; 32216b4cac81SBjoern A. Zeeb } 32226b4cac81SBjoern A. Zeeb } 32236b4cac81SBjoern A. Zeeb #endif 32246b4cac81SBjoern A. Zeeb 32256b4cac81SBjoern A. Zeeb ic = ni->ni_ic; 32266b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 32276b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 32286b4cac81SBjoern A. Zeeb c = ni->ni_chan; 32296b4cac81SBjoern A. Zeeb 32306b4cac81SBjoern A. Zeeb if (ieee80211_radiotap_active_vap(ni->ni_vap)) { 32316b4cac81SBjoern A. Zeeb struct lkpi_radiotap_tx_hdr *rtap; 32326b4cac81SBjoern A. Zeeb 32336b4cac81SBjoern A. Zeeb rtap = &lhw->rtap_tx; 32346b4cac81SBjoern A. Zeeb rtap->wt_flags = 0; 32356b4cac81SBjoern A. Zeeb if (k != NULL) 32366b4cac81SBjoern A. Zeeb rtap->wt_flags |= IEEE80211_RADIOTAP_F_WEP; 32376b4cac81SBjoern A. Zeeb if (m->m_flags & M_FRAG) 32386b4cac81SBjoern A. Zeeb rtap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG; 32396b4cac81SBjoern A. Zeeb IMPROVE(); 32406b4cac81SBjoern A. Zeeb rtap->wt_rate = 0; 32416b4cac81SBjoern A. Zeeb if (c != NULL && c != IEEE80211_CHAN_ANYC) { 32426b4cac81SBjoern A. Zeeb rtap->wt_chan_freq = htole16(c->ic_freq); 32436b4cac81SBjoern A. Zeeb rtap->wt_chan_flags = htole16(c->ic_flags); 32446b4cac81SBjoern A. Zeeb } 32456b4cac81SBjoern A. Zeeb 32466b4cac81SBjoern A. Zeeb ieee80211_radiotap_tx(ni->ni_vap, m); 32476b4cac81SBjoern A. Zeeb } 32486b4cac81SBjoern A. Zeeb 32496b4cac81SBjoern A. Zeeb /* 32506b4cac81SBjoern A. Zeeb * net80211 should handle hw->extra_tx_headroom. 32516b4cac81SBjoern A. Zeeb * Though for as long as we are copying we don't mind. 32523d09d310SBjoern A. Zeeb * XXX-BZ rtw88 asks for too much headroom for ipv6+tcp: 32533d09d310SBjoern A. Zeeb * https://lists.freebsd.org/archives/freebsd-transport/2022-February/000012.html 32546b4cac81SBjoern A. Zeeb */ 32556b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + m->m_pkthdr.len); 32566b4cac81SBjoern A. Zeeb if (skb == NULL) { 32573f0083c4SBjoern A. Zeeb ic_printf(ic, "ERROR %s: skb alloc failed\n", __func__); 32586b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 32596b4cac81SBjoern A. Zeeb m_freem(m); 32606b4cac81SBjoern A. Zeeb return; 32616b4cac81SBjoern A. Zeeb } 32626b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 32636b4cac81SBjoern A. Zeeb 32646b4cac81SBjoern A. Zeeb /* XXX-BZ we need a SKB version understanding mbuf. */ 32656b4cac81SBjoern A. Zeeb /* Save the mbuf for ieee80211_tx_complete(). */ 32666b4cac81SBjoern A. Zeeb skb->m_free_func = lkpi_ieee80211_free_skb_mbuf; 32676b4cac81SBjoern A. Zeeb skb->m = m; 32686b4cac81SBjoern A. Zeeb #if 0 32696b4cac81SBjoern A. Zeeb skb_put_data(skb, m->m_data, m->m_pkthdr.len); 32706b4cac81SBjoern A. Zeeb #else 32716b4cac81SBjoern A. Zeeb buf = skb_put(skb, m->m_pkthdr.len); 32726b4cac81SBjoern A. Zeeb m_copydata(m, 0, m->m_pkthdr.len, buf); 32736b4cac81SBjoern A. Zeeb #endif 32746b4cac81SBjoern A. Zeeb /* Save the ni. */ 32756b4cac81SBjoern A. Zeeb m->m_pkthdr.PH_loc.ptr = ni; 32766b4cac81SBjoern A. Zeeb 32776b4cac81SBjoern A. Zeeb lvif = VAP_TO_LVIF(ni->ni_vap); 32786b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 32796b4cac81SBjoern A. Zeeb 3280e3a0b120SBjoern A. Zeeb hdr = (void *)skb->data; 3281e3a0b120SBjoern A. Zeeb tid = linuxkpi_ieee80211_get_tid(hdr, true); 3282e3a0b120SBjoern A. Zeeb if (tid == IEEE80211_NONQOS_TID) { /* == IEEE80211_NUM_TIDS */ 3283e3a0b120SBjoern A. Zeeb skb->priority = 0; 3284e3a0b120SBjoern A. Zeeb ac = IEEE80211_AC_BE; 3285e3a0b120SBjoern A. Zeeb } else { 3286e3a0b120SBjoern A. Zeeb skb->priority = tid & IEEE80211_QOS_CTL_TID_MASK; 3287*fb3c249eSBjoern A. Zeeb ac = ieee80211e_up_to_ac[tid & 7]; 3288e3a0b120SBjoern A. Zeeb } 32896b4cac81SBjoern A. Zeeb skb_set_queue_mapping(skb, ac); 32906b4cac81SBjoern A. Zeeb 32916b4cac81SBjoern A. Zeeb info = IEEE80211_SKB_CB(skb); 32926b4cac81SBjoern A. Zeeb info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS; 32936b4cac81SBjoern A. Zeeb /* Slight delay; probably only happens on scanning so fine? */ 32946b4cac81SBjoern A. Zeeb if (c == NULL || c == IEEE80211_CHAN_ANYC) 32956b4cac81SBjoern A. Zeeb c = ic->ic_curchan; 32966b4cac81SBjoern A. Zeeb info->band = lkpi_net80211_chan_to_nl80211_band(c); 3297e3a0b120SBjoern A. Zeeb info->hw_queue = vif->hw_queue[ac]; 32986b4cac81SBjoern A. Zeeb if (m->m_flags & M_EAPOL) 32996b4cac81SBjoern A. Zeeb info->control.flags |= IEEE80211_TX_CTRL_PORT_CTRL_PROTO; 33006b4cac81SBjoern A. Zeeb info->control.vif = vif; 33016b4cac81SBjoern A. Zeeb /* XXX-BZ info->control.rates */ 33026b4cac81SBjoern A. Zeeb 33036b4cac81SBjoern A. Zeeb lsta = lkpi_find_lsta_by_ni(lvif, ni); 33046b4cac81SBjoern A. Zeeb if (lsta != NULL) { 33056b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 3306b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 33076b4cac81SBjoern A. Zeeb info->control.hw_key = lsta->kc; 33086b4cac81SBjoern A. Zeeb #endif 33096b4cac81SBjoern A. Zeeb } else { 33106b4cac81SBjoern A. Zeeb sta = NULL; 33116b4cac81SBjoern A. Zeeb } 33126b4cac81SBjoern A. Zeeb 33136b4cac81SBjoern A. Zeeb IMPROVE(); 33146b4cac81SBjoern A. Zeeb 33156b4cac81SBjoern A. Zeeb if (sta != NULL) { 33166b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 33176b4cac81SBjoern A. Zeeb 3318e3a0b120SBjoern A. Zeeb ltxq = NULL; 3319e3a0b120SBjoern A. Zeeb if (!ieee80211_is_data_present(hdr->frame_control)) { 3320e3a0b120SBjoern A. Zeeb if (vif->type == NL80211_IFTYPE_STATION && 3321e3a0b120SBjoern A. Zeeb lsta->added_to_drv && 3322e3a0b120SBjoern A. Zeeb sta->txq[IEEE80211_NUM_TIDS] != NULL) 3323d0d29110SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[IEEE80211_NUM_TIDS]); 3324e3a0b120SBjoern A. Zeeb } else if (lsta->added_to_drv && 3325e3a0b120SBjoern A. Zeeb sta->txq[skb->priority] != NULL) { 3326e3a0b120SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[skb->priority]); 3327e3a0b120SBjoern A. Zeeb } 3328e3a0b120SBjoern A. Zeeb if (ltxq == NULL) 3329d0d29110SBjoern A. Zeeb goto ops_tx; 3330e3a0b120SBjoern A. Zeeb 3331d0d29110SBjoern A. Zeeb KASSERT(ltxq != NULL, ("%s: lsta %p sta %p m %p skb %p " 3332d0d29110SBjoern A. Zeeb "ltxq %p != NULL\n", __func__, lsta, sta, m, skb, ltxq)); 3333d0d29110SBjoern A. Zeeb 33346b4cac81SBjoern A. Zeeb skb_queue_tail(<xq->skbq, skb); 33359d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33369d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 3337d0d29110SBjoern A. Zeeb printf("%s:%d mo_wake_tx_queue :: %d %u lsta %p sta %p " 3338d0d29110SBjoern A. Zeeb "ni %p %6D skb %p lxtq %p { qlen %u, ac %d tid %u } " 3339d0d29110SBjoern A. Zeeb "WAKE_TX_Q ac %d prio %u qmap %u\n", 3340fb6eaf74SBjoern A. Zeeb __func__, __LINE__, 3341d0d29110SBjoern A. Zeeb curthread->td_tid, (unsigned int)ticks, 3342d0d29110SBjoern A. Zeeb lsta, sta, ni, ni->ni_macaddr, ":", skb, ltxq, 3343d0d29110SBjoern A. Zeeb skb_queue_len(<xq->skbq), ltxq->txq.ac, 3344d0d29110SBjoern A. Zeeb ltxq->txq.tid, ac, skb->priority, skb->qmap); 33459d9ba2b7SBjoern A. Zeeb #endif 3346d0d29110SBjoern A. Zeeb lkpi_80211_mo_wake_tx_queue(hw, <xq->txq); 33476b4cac81SBjoern A. Zeeb return; 33486b4cac81SBjoern A. Zeeb } 33496b4cac81SBjoern A. Zeeb 33506b4cac81SBjoern A. Zeeb ops_tx: 33519d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33529d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 3353d0d29110SBjoern A. Zeeb printf("%s:%d mo_tx :: lsta %p sta %p ni %p %6D skb %p " 3354d0d29110SBjoern A. Zeeb "TX ac %d prio %u qmap %u\n", 33556b4cac81SBjoern A. Zeeb __func__, __LINE__, lsta, sta, ni, ni->ni_macaddr, ":", 33566b4cac81SBjoern A. Zeeb skb, ac, skb->priority, skb->qmap); 33579d9ba2b7SBjoern A. Zeeb #endif 33586b4cac81SBjoern A. Zeeb memset(&control, 0, sizeof(control)); 33596b4cac81SBjoern A. Zeeb control.sta = sta; 33606b4cac81SBjoern A. Zeeb 33616b4cac81SBjoern A. Zeeb lkpi_80211_mo_tx(hw, &control, skb); 33626b4cac81SBjoern A. Zeeb return; 33636b4cac81SBjoern A. Zeeb } 33646b4cac81SBjoern A. Zeeb 33656b4cac81SBjoern A. Zeeb static void 33666b4cac81SBjoern A. Zeeb lkpi_80211_txq_task(void *ctx, int pending) 33676b4cac81SBjoern A. Zeeb { 33686b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 33696b4cac81SBjoern A. Zeeb struct mbufq mq; 33706b4cac81SBjoern A. Zeeb struct mbuf *m; 33716b4cac81SBjoern A. Zeeb 33726b4cac81SBjoern A. Zeeb lsta = ctx; 33736b4cac81SBjoern A. Zeeb 33749d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 33759d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 33766b4cac81SBjoern A. Zeeb printf("%s:%d lsta %p ni %p %6D pending %d mbuf_qlen %d\n", 33779d9ba2b7SBjoern A. Zeeb __func__, __LINE__, lsta, lsta->ni, lsta->ni->ni_macaddr, ":", 33786b4cac81SBjoern A. Zeeb pending, mbufq_len(&lsta->txq)); 33799d9ba2b7SBjoern A. Zeeb #endif 33806b4cac81SBjoern A. Zeeb 33816b4cac81SBjoern A. Zeeb mbufq_init(&mq, IFQ_MAXLEN); 33826b4cac81SBjoern A. Zeeb 33836b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_LOCK(lsta); 33846b4cac81SBjoern A. Zeeb mbufq_concat(&mq, &lsta->txq); 33856b4cac81SBjoern A. Zeeb LKPI_80211_LSTA_UNLOCK(lsta); 33866b4cac81SBjoern A. Zeeb 33876b4cac81SBjoern A. Zeeb m = mbufq_dequeue(&mq); 33886b4cac81SBjoern A. Zeeb while (m != NULL) { 33896b4cac81SBjoern A. Zeeb lkpi_80211_txq_tx_one(lsta, m); 33906b4cac81SBjoern A. Zeeb m = mbufq_dequeue(&mq); 33916b4cac81SBjoern A. Zeeb } 33926b4cac81SBjoern A. Zeeb } 33936b4cac81SBjoern A. Zeeb 33946b4cac81SBjoern A. Zeeb static int 33956b4cac81SBjoern A. Zeeb lkpi_ic_transmit(struct ieee80211com *ic, struct mbuf *m) 33966b4cac81SBjoern A. Zeeb { 33976b4cac81SBjoern A. Zeeb 33986b4cac81SBjoern A. Zeeb /* XXX TODO */ 33996b4cac81SBjoern A. Zeeb IMPROVE(); 34006b4cac81SBjoern A. Zeeb 34016b4cac81SBjoern A. Zeeb /* Quick and dirty cheating hack. */ 34026b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 34036b4cac81SBjoern A. Zeeb 34046b4cac81SBjoern A. Zeeb ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 34056b4cac81SBjoern A. Zeeb return (lkpi_ic_raw_xmit(ni, m, NULL)); 34066b4cac81SBjoern A. Zeeb } 34076b4cac81SBjoern A. Zeeb 34086b4cac81SBjoern A. Zeeb static void 34096b4cac81SBjoern A. Zeeb lkpi_ic_getradiocaps(struct ieee80211com *ic, int maxchan, 34106b4cac81SBjoern A. Zeeb int *n, struct ieee80211_channel *c) 34116b4cac81SBjoern A. Zeeb { 34126b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 34136b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 34146b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 34156b4cac81SBjoern A. Zeeb uint8_t bands[IEEE80211_MODE_BYTES]; 34166b4cac81SBjoern A. Zeeb int chan_flags, error, i, nchans; 34176b4cac81SBjoern A. Zeeb 34186b4cac81SBjoern A. Zeeb /* Channels */ 34196b4cac81SBjoern A. Zeeb lhw = ic->ic_softc; 34206b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 34216b4cac81SBjoern A. Zeeb 34226b4cac81SBjoern A. Zeeb /* NL80211_BAND_2GHZ */ 34236b4cac81SBjoern A. Zeeb nchans = 0; 34246b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_2GHZ] != NULL) 34256b4cac81SBjoern A. Zeeb nchans = hw->wiphy->bands[NL80211_BAND_2GHZ]->n_channels; 34266b4cac81SBjoern A. Zeeb if (nchans > 0) { 34276b4cac81SBjoern A. Zeeb memset(bands, 0, sizeof(bands)); 34286b4cac81SBjoern A. Zeeb chan_flags = 0; 34296b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11B); 34306b4cac81SBjoern A. Zeeb /* XXX-BZ unclear how to check for 11g. */ 34316b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11G); 34326b4cac81SBjoern A. Zeeb #ifdef __notyet__ 34336b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_2GHZ]->ht_cap.ht_supported) { 34346b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11NG); 34356b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_HT40; 34366b4cac81SBjoern A. Zeeb } 34376b4cac81SBjoern A. Zeeb #endif 34386b4cac81SBjoern A. Zeeb 34396b4cac81SBjoern A. Zeeb channels = hw->wiphy->bands[NL80211_BAND_2GHZ]->channels; 3440cee56e77SBjoern A. Zeeb for (i = 0; i < nchans && *n < maxchan; i++) { 34416b4cac81SBjoern A. Zeeb uint32_t nflags = 0; 34426b4cac81SBjoern A. Zeeb int cflags = chan_flags; 34436b4cac81SBjoern A. Zeeb 34446b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) { 34453f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Skipping disabled chan " 34463f0083c4SBjoern A. Zeeb "[%u/%u/%#x]\n", __func__, 34476b4cac81SBjoern A. Zeeb channels[i].hw_value, 34486b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags); 34496b4cac81SBjoern A. Zeeb continue; 34506b4cac81SBjoern A. Zeeb } 34516b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_IR) 34526b4cac81SBjoern A. Zeeb nflags |= (IEEE80211_CHAN_NOADHOC|IEEE80211_CHAN_PASSIVE); 34536b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_RADAR) 34546b4cac81SBjoern A. Zeeb nflags |= IEEE80211_CHAN_DFS; 34556b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_160MHZ) 34566b4cac81SBjoern A. Zeeb cflags &= ~(NET80211_CBW_FLAG_VHT160|NET80211_CBW_FLAG_VHT80P80); 34576b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_80MHZ) 34586b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_VHT80; 34596b4cac81SBjoern A. Zeeb /* XXX how to map the remaining enum ieee80211_channel_flags? */ 34606b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_HT40) 34616b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_HT40; 34626b4cac81SBjoern A. Zeeb 34636b4cac81SBjoern A. Zeeb error = ieee80211_add_channel_cbw(c, maxchan, n, 34646b4cac81SBjoern A. Zeeb channels[i].hw_value, channels[i].center_freq, 34656b4cac81SBjoern A. Zeeb channels[i].max_power, 34666b4cac81SBjoern A. Zeeb nflags, bands, chan_flags); 3467cee56e77SBjoern A. Zeeb /* net80211::ENOBUFS: *n >= maxchans */ 3468cee56e77SBjoern A. Zeeb if (error != 0 && error != ENOBUFS) 34693f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Adding chan %u/%u/%#x/%#x/%#x/%#x " 34703f0083c4SBjoern A. Zeeb "returned error %d\n", 34716b4cac81SBjoern A. Zeeb __func__, channels[i].hw_value, 34726b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags, 34736b4cac81SBjoern A. Zeeb nflags, chan_flags, cflags, error); 3474cee56e77SBjoern A. Zeeb if (error != 0) 34756b4cac81SBjoern A. Zeeb break; 34766b4cac81SBjoern A. Zeeb } 34776b4cac81SBjoern A. Zeeb } 34786b4cac81SBjoern A. Zeeb 34796b4cac81SBjoern A. Zeeb /* NL80211_BAND_5GHZ */ 34806b4cac81SBjoern A. Zeeb nchans = 0; 34816b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ] != NULL) 34826b4cac81SBjoern A. Zeeb nchans = hw->wiphy->bands[NL80211_BAND_5GHZ]->n_channels; 34836b4cac81SBjoern A. Zeeb if (nchans > 0) { 34846b4cac81SBjoern A. Zeeb memset(bands, 0, sizeof(bands)); 34856b4cac81SBjoern A. Zeeb chan_flags = 0; 34866b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11A); 34876b4cac81SBjoern A. Zeeb #ifdef __not_yet__ 34886b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ]->ht_cap.ht_supported) { 34896b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_11NA); 34906b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_HT40; 34916b4cac81SBjoern A. Zeeb } 34926b4cac81SBjoern A. Zeeb if (hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap.vht_supported){ 34936b4cac81SBjoern A. Zeeb 34946b4cac81SBjoern A. Zeeb ic->ic_flags_ext |= IEEE80211_FEXT_VHT; 34956b4cac81SBjoern A. Zeeb ic->ic_vhtcaps = 34966b4cac81SBjoern A. Zeeb hw->wiphy->bands[NL80211_BAND_5GHZ]->vht_cap.cap; 34976b4cac81SBjoern A. Zeeb 34986b4cac81SBjoern A. Zeeb setbit(bands, IEEE80211_MODE_VHT_5GHZ); 34996b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT80; 35006b4cac81SBjoern A. Zeeb if (IEEE80211_VHTCAP_SUPP_CHAN_WIDTH_IS_160MHZ( 35016b4cac81SBjoern A. Zeeb ic->ic_vhtcaps)) 35026b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT160; 35036b4cac81SBjoern A. Zeeb if (IEEE80211_VHTCAP_SUPP_CHAN_WIDTH_IS_160_80P80MHZ( 35046b4cac81SBjoern A. Zeeb ic->ic_vhtcaps)) 35056b4cac81SBjoern A. Zeeb chan_flags |= NET80211_CBW_FLAG_VHT80P80; 35066b4cac81SBjoern A. Zeeb } 35076b4cac81SBjoern A. Zeeb #endif 35086b4cac81SBjoern A. Zeeb 35096b4cac81SBjoern A. Zeeb channels = hw->wiphy->bands[NL80211_BAND_5GHZ]->channels; 3510cee56e77SBjoern A. Zeeb for (i = 0; i < nchans && *n < maxchan; i++) { 35116b4cac81SBjoern A. Zeeb uint32_t nflags = 0; 35126b4cac81SBjoern A. Zeeb int cflags = chan_flags; 35136b4cac81SBjoern A. Zeeb 35146b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) { 35153f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Skipping disabled chan " 35163f0083c4SBjoern A. Zeeb "[%u/%u/%#x]\n", __func__, 35176b4cac81SBjoern A. Zeeb channels[i].hw_value, 35186b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags); 35196b4cac81SBjoern A. Zeeb continue; 35206b4cac81SBjoern A. Zeeb } 35216b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_IR) 35226b4cac81SBjoern A. Zeeb nflags |= (IEEE80211_CHAN_NOADHOC|IEEE80211_CHAN_PASSIVE); 35236b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_RADAR) 35246b4cac81SBjoern A. Zeeb nflags |= IEEE80211_CHAN_DFS; 35256b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_160MHZ) 35266b4cac81SBjoern A. Zeeb cflags &= ~(NET80211_CBW_FLAG_VHT160|NET80211_CBW_FLAG_VHT80P80); 35276b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_80MHZ) 35286b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_VHT80; 35296b4cac81SBjoern A. Zeeb /* XXX hwo to map the remaining enum ieee80211_channel_flags? */ 35306b4cac81SBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_NO_HT40) 35316b4cac81SBjoern A. Zeeb cflags &= ~NET80211_CBW_FLAG_HT40; 35326b4cac81SBjoern A. Zeeb 35336b4cac81SBjoern A. Zeeb error = ieee80211_add_channel_cbw(c, maxchan, n, 35346b4cac81SBjoern A. Zeeb channels[i].hw_value, channels[i].center_freq, 35356b4cac81SBjoern A. Zeeb channels[i].max_power, 35366b4cac81SBjoern A. Zeeb nflags, bands, chan_flags); 3537cee56e77SBjoern A. Zeeb /* net80211::ENOBUFS: *n >= maxchans */ 3538cee56e77SBjoern A. Zeeb if (error != 0 && error != ENOBUFS) 35393f0083c4SBjoern A. Zeeb ic_printf(ic, "%s: Adding chan %u/%u/%#x/%#x/%#x/%#x " 35403f0083c4SBjoern A. Zeeb "returned error %d\n", 35416b4cac81SBjoern A. Zeeb __func__, channels[i].hw_value, 35426b4cac81SBjoern A. Zeeb channels[i].center_freq, channels[i].flags, 35436b4cac81SBjoern A. Zeeb nflags, chan_flags, cflags, error); 3544cee56e77SBjoern A. Zeeb if (error != 0) 35456b4cac81SBjoern A. Zeeb break; 35466b4cac81SBjoern A. Zeeb } 35476b4cac81SBjoern A. Zeeb } 35486b4cac81SBjoern A. Zeeb } 35496b4cac81SBjoern A. Zeeb 35506b4cac81SBjoern A. Zeeb static void * 35516b4cac81SBjoern A. Zeeb lkpi_ieee80211_ifalloc(void) 35526b4cac81SBjoern A. Zeeb { 35536b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 35546b4cac81SBjoern A. Zeeb 35556b4cac81SBjoern A. Zeeb ic = malloc(sizeof(*ic), M_LKPI80211, M_WAITOK | M_ZERO); 35566b4cac81SBjoern A. Zeeb if (ic == NULL) 35576b4cac81SBjoern A. Zeeb return (NULL); 35586b4cac81SBjoern A. Zeeb 35596b4cac81SBjoern A. Zeeb /* Setting these happens later when we have device information. */ 35606b4cac81SBjoern A. Zeeb ic->ic_softc = NULL; 35616b4cac81SBjoern A. Zeeb ic->ic_name = "linuxkpi"; 35626b4cac81SBjoern A. Zeeb 35636b4cac81SBjoern A. Zeeb return (ic); 35646b4cac81SBjoern A. Zeeb } 35656b4cac81SBjoern A. Zeeb 35666b4cac81SBjoern A. Zeeb struct ieee80211_hw * 35676b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_alloc_hw(size_t priv_len, const struct ieee80211_ops *ops) 35686b4cac81SBjoern A. Zeeb { 35696b4cac81SBjoern A. Zeeb struct ieee80211_hw *hw; 35706b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 35716b4cac81SBjoern A. Zeeb struct wiphy *wiphy; 3572a5ae63edSBjoern A. Zeeb int ac; 35736b4cac81SBjoern A. Zeeb 35746b4cac81SBjoern A. Zeeb /* Get us and the driver data also allocated. */ 35756b4cac81SBjoern A. Zeeb wiphy = wiphy_new(&linuxkpi_mac80211cfgops, sizeof(*lhw) + priv_len); 35766b4cac81SBjoern A. Zeeb if (wiphy == NULL) 35776b4cac81SBjoern A. Zeeb return (NULL); 35786b4cac81SBjoern A. Zeeb 35796b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 35806b4cac81SBjoern A. Zeeb lhw->ops = ops; 3581652e22d3SBjoern A. Zeeb 35828ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK_INIT(lhw); 35838ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK_INIT(lhw); 35848891c455SBjoern A. Zeeb sx_init_flags(&lhw->lvif_sx, "lhw-lvif", SX_RECURSE | SX_DUPOK); 35856b4cac81SBjoern A. Zeeb TAILQ_INIT(&lhw->lvif_head); 3586a5ae63edSBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { 3587a5ae63edSBjoern A. Zeeb lhw->txq_generation[ac] = 1; 3588a5ae63edSBjoern A. Zeeb TAILQ_INIT(&lhw->scheduled_txqs[ac]); 3589a5ae63edSBjoern A. Zeeb } 35906b4cac81SBjoern A. Zeeb 35916b4cac81SBjoern A. Zeeb /* 35926b4cac81SBjoern A. Zeeb * XXX-BZ TODO make sure there is a "_null" function to all ops 35936b4cac81SBjoern A. Zeeb * not initialized. 35946b4cac81SBjoern A. Zeeb */ 35956b4cac81SBjoern A. Zeeb hw = LHW_TO_HW(lhw); 35966b4cac81SBjoern A. Zeeb hw->wiphy = wiphy; 3597086be6a8SBjoern A. Zeeb hw->conf.flags |= IEEE80211_CONF_IDLE; 35986b4cac81SBjoern A. Zeeb hw->priv = (void *)(lhw + 1); 35996b4cac81SBjoern A. Zeeb 36006b4cac81SBjoern A. Zeeb /* BSD Specific. */ 36016b4cac81SBjoern A. Zeeb lhw->ic = lkpi_ieee80211_ifalloc(); 36026b4cac81SBjoern A. Zeeb if (lhw->ic == NULL) { 36036b4cac81SBjoern A. Zeeb ieee80211_free_hw(hw); 36046b4cac81SBjoern A. Zeeb return (NULL); 36056b4cac81SBjoern A. Zeeb } 36066b4cac81SBjoern A. Zeeb 36076b4cac81SBjoern A. Zeeb IMPROVE(); 36086b4cac81SBjoern A. Zeeb 36096b4cac81SBjoern A. Zeeb return (hw); 36106b4cac81SBjoern A. Zeeb } 36116b4cac81SBjoern A. Zeeb 36126b4cac81SBjoern A. Zeeb void 36136b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iffree(struct ieee80211_hw *hw) 36146b4cac81SBjoern A. Zeeb { 36156b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36166b4cac81SBjoern A. Zeeb 36176b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36186b4cac81SBjoern A. Zeeb free(lhw->ic, M_LKPI80211); 36196b4cac81SBjoern A. Zeeb lhw->ic = NULL; 36206b4cac81SBjoern A. Zeeb 36216b4cac81SBjoern A. Zeeb /* Cleanup more of lhw here or in wiphy_free()? */ 36228891c455SBjoern A. Zeeb sx_destroy(&lhw->lvif_sx); 36238ac540d3SBjoern A. Zeeb LKPI_80211_LHW_LOCK_DESTROY(lhw); 36248ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK_DESTROY(lhw); 36256b4cac81SBjoern A. Zeeb IMPROVE(); 36266b4cac81SBjoern A. Zeeb } 36276b4cac81SBjoern A. Zeeb 36286b4cac81SBjoern A. Zeeb void 36296b4cac81SBjoern A. Zeeb linuxkpi_set_ieee80211_dev(struct ieee80211_hw *hw, char *name) 36306b4cac81SBjoern A. Zeeb { 36316b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36326b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36336b4cac81SBjoern A. Zeeb 36346b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36356b4cac81SBjoern A. Zeeb ic = lhw->ic; 36366b4cac81SBjoern A. Zeeb 36376b4cac81SBjoern A. Zeeb /* Now set a proper name before ieee80211_ifattach(). */ 36386b4cac81SBjoern A. Zeeb ic->ic_softc = lhw; 36396b4cac81SBjoern A. Zeeb ic->ic_name = name; 36406b4cac81SBjoern A. Zeeb 36416b4cac81SBjoern A. Zeeb /* XXX-BZ do we also need to set wiphy name? */ 36426b4cac81SBjoern A. Zeeb } 36436b4cac81SBjoern A. Zeeb 36446b4cac81SBjoern A. Zeeb struct ieee80211_hw * 36456b4cac81SBjoern A. Zeeb linuxkpi_wiphy_to_ieee80211_hw(struct wiphy *wiphy) 36466b4cac81SBjoern A. Zeeb { 36476b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 36486b4cac81SBjoern A. Zeeb 36496b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 36506b4cac81SBjoern A. Zeeb return (LHW_TO_HW(lhw)); 36516b4cac81SBjoern A. Zeeb } 36526b4cac81SBjoern A. Zeeb 36536b4cac81SBjoern A. Zeeb static void 36546b4cac81SBjoern A. Zeeb lkpi_radiotap_attach(struct lkpi_hw *lhw) 36556b4cac81SBjoern A. Zeeb { 36566b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36576b4cac81SBjoern A. Zeeb 36586b4cac81SBjoern A. Zeeb ic = lhw->ic; 36596b4cac81SBjoern A. Zeeb ieee80211_radiotap_attach(ic, 36606b4cac81SBjoern A. Zeeb &lhw->rtap_tx.wt_ihdr, sizeof(lhw->rtap_tx), 36616b4cac81SBjoern A. Zeeb LKPI_RTAP_TX_FLAGS_PRESENT, 36626b4cac81SBjoern A. Zeeb &lhw->rtap_rx.wr_ihdr, sizeof(lhw->rtap_rx), 36636b4cac81SBjoern A. Zeeb LKPI_RTAP_RX_FLAGS_PRESENT); 36646b4cac81SBjoern A. Zeeb } 36656b4cac81SBjoern A. Zeeb 36662e183d99SBjoern A. Zeeb int 36676b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ifattach(struct ieee80211_hw *hw) 36686b4cac81SBjoern A. Zeeb { 36696b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 36706b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 3671c5b96b3eSBjoern A. Zeeb int band, i; 36726b4cac81SBjoern A. Zeeb 36736b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 36746b4cac81SBjoern A. Zeeb ic = lhw->ic; 36756b4cac81SBjoern A. Zeeb 3676652e22d3SBjoern A. Zeeb /* We do it this late as wiphy->dev should be set for the name. */ 3677652e22d3SBjoern A. Zeeb lhw->workq = alloc_ordered_workqueue(wiphy_name(hw->wiphy), 0); 3678652e22d3SBjoern A. Zeeb if (lhw->workq == NULL) 3679652e22d3SBjoern A. Zeeb return (-EAGAIN); 3680652e22d3SBjoern A. Zeeb 36816b4cac81SBjoern A. Zeeb /* XXX-BZ figure this out how they count his... */ 36826b4cac81SBjoern A. Zeeb if (!is_zero_ether_addr(hw->wiphy->perm_addr)) { 36836b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(ic->ic_macaddr, 36846b4cac81SBjoern A. Zeeb hw->wiphy->perm_addr); 36856b4cac81SBjoern A. Zeeb } else if (hw->wiphy->n_addresses > 0) { 36866b4cac81SBjoern A. Zeeb /* We take the first one. */ 36876b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(ic->ic_macaddr, 36886b4cac81SBjoern A. Zeeb hw->wiphy->addresses[0].addr); 36896b4cac81SBjoern A. Zeeb } else { 36906b4cac81SBjoern A. Zeeb ic_printf(ic, "%s: warning, no hardware address!\n", __func__); 36916b4cac81SBjoern A. Zeeb } 36926b4cac81SBjoern A. Zeeb 36933d09d310SBjoern A. Zeeb #ifdef __not_yet__ 36943d09d310SBjoern A. Zeeb /* See comment in lkpi_80211_txq_tx_one(). */ 36956b4cac81SBjoern A. Zeeb ic->ic_headroom = hw->extra_tx_headroom; 36963d09d310SBjoern A. Zeeb #endif 36976b4cac81SBjoern A. Zeeb 36986b4cac81SBjoern A. Zeeb ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 36996b4cac81SBjoern A. Zeeb ic->ic_opmode = IEEE80211_M_STA; 37006b4cac81SBjoern A. Zeeb 37016b4cac81SBjoern A. Zeeb /* Set device capabilities. */ 37026b4cac81SBjoern A. Zeeb /* XXX-BZ we need to get these from linux80211/drivers and convert. */ 37036b4cac81SBjoern A. Zeeb ic->ic_caps = 37046b4cac81SBjoern A. Zeeb IEEE80211_C_STA | 37056b4cac81SBjoern A. Zeeb IEEE80211_C_MONITOR | 37066b4cac81SBjoern A. Zeeb IEEE80211_C_WPA | /* WPA/RSN */ 37074a67f1dfSBjoern A. Zeeb #ifdef LKPI_80211_WME 37086b4cac81SBjoern A. Zeeb IEEE80211_C_WME | 37094a67f1dfSBjoern A. Zeeb #endif 37106b4cac81SBjoern A. Zeeb #if 0 37116b4cac81SBjoern A. Zeeb IEEE80211_C_PMGT | 37126b4cac81SBjoern A. Zeeb #endif 37136b4cac81SBjoern A. Zeeb IEEE80211_C_SHSLOT | /* short slot time supported */ 37146b4cac81SBjoern A. Zeeb IEEE80211_C_SHPREAMBLE /* short preamble supported */ 37156b4cac81SBjoern A. Zeeb ; 37166b4cac81SBjoern A. Zeeb #if 0 37176b4cac81SBjoern A. Zeeb /* Scanning is a different kind of beast to re-work. */ 37186b4cac81SBjoern A. Zeeb ic->ic_caps |= IEEE80211_C_BGSCAN; 37196b4cac81SBjoern A. Zeeb #endif 3720cc4e78d5SBjoern A. Zeeb if (lhw->ops->hw_scan) { 3721cc4e78d5SBjoern A. Zeeb /* 3722cc4e78d5SBjoern A. Zeeb * Advertise full-offload scanning. 3723cc4e78d5SBjoern A. Zeeb * 3724cc4e78d5SBjoern A. Zeeb * Not limiting to SINGLE_SCAN_ON_ALL_BANDS here as otherwise 3725cc4e78d5SBjoern A. Zeeb * we essentially disable hw_scan for all drivers not setting 3726cc4e78d5SBjoern A. Zeeb * the flag. 3727cc4e78d5SBjoern A. Zeeb */ 37286b4cac81SBjoern A. Zeeb ic->ic_flags_ext |= IEEE80211_FEXT_SCAN_OFFLOAD; 3729a486fbbdSBjoern A. Zeeb lhw->scan_flags |= LKPI_LHW_SCAN_HW; 37306b4cac81SBjoern A. Zeeb } 37316b4cac81SBjoern A. Zeeb 37326b4cac81SBjoern A. Zeeb #ifdef __notyet__ 37336b4cac81SBjoern A. Zeeb ic->ic_htcaps = IEEE80211_HTC_HT /* HT operation */ 37346b4cac81SBjoern A. Zeeb | IEEE80211_HTC_AMPDU /* A-MPDU tx/rx */ 37356b4cac81SBjoern A. Zeeb | IEEE80211_HTC_AMSDU /* A-MSDU tx/rx */ 37366b4cac81SBjoern A. Zeeb | IEEE80211_HTCAP_MAXAMSDU_3839 37376b4cac81SBjoern A. Zeeb /* max A-MSDU length */ 37386b4cac81SBjoern A. Zeeb | IEEE80211_HTCAP_SMPS_OFF; /* SM power save off */ 37396b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_SHORTGI20; 37406b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_CHWIDTH40 | IEEE80211_HTCAP_SHORTGI40; 37416b4cac81SBjoern A. Zeeb ic->ic_htcaps |= IEEE80211_HTCAP_TXSTBC; 37426b4cac81SBjoern A. Zeeb #endif 37436b4cac81SBjoern A. Zeeb 3744527687a9SBjoern A. Zeeb /* 3745527687a9SBjoern A. Zeeb * The wiphy variables report bitmasks of avail antennas. 3746527687a9SBjoern A. Zeeb * (*get_antenna) get the current bitmask sets which can be 3747527687a9SBjoern A. Zeeb * altered by (*set_antenna) for some drivers. 3748527687a9SBjoern A. Zeeb * XXX-BZ will the count alone do us much good long-term in net80211? 3749527687a9SBjoern A. Zeeb */ 3750527687a9SBjoern A. Zeeb if (hw->wiphy->available_antennas_rx || 3751527687a9SBjoern A. Zeeb hw->wiphy->available_antennas_tx) { 3752527687a9SBjoern A. Zeeb uint32_t rxs, txs; 3753527687a9SBjoern A. Zeeb 3754527687a9SBjoern A. Zeeb if (lkpi_80211_mo_get_antenna(hw, &txs, &rxs) == 0) { 3755527687a9SBjoern A. Zeeb ic->ic_rxstream = bitcount32(rxs); 3756527687a9SBjoern A. Zeeb ic->ic_txstream = bitcount32(txs); 3757527687a9SBjoern A. Zeeb } 3758527687a9SBjoern A. Zeeb } 3759527687a9SBjoern A. Zeeb 37606b4cac81SBjoern A. Zeeb ic->ic_cryptocaps = 0; 3761b35f6cd0SBjoern A. Zeeb #ifdef LKPI_80211_HW_CRYPTO 37626b4cac81SBjoern A. Zeeb if (hw->wiphy->n_cipher_suites > 0) { 37636b4cac81SBjoern A. Zeeb for (i = 0; i < hw->wiphy->n_cipher_suites; i++) 37646b4cac81SBjoern A. Zeeb ic->ic_cryptocaps |= lkpi_l80211_to_net80211_cyphers( 37656b4cac81SBjoern A. Zeeb hw->wiphy->cipher_suites[i]); 37666b4cac81SBjoern A. Zeeb } 37676b4cac81SBjoern A. Zeeb #endif 37686b4cac81SBjoern A. Zeeb 37696b4cac81SBjoern A. Zeeb lkpi_ic_getradiocaps(ic, IEEE80211_CHAN_MAX, &ic->ic_nchans, 37706b4cac81SBjoern A. Zeeb ic->ic_channels); 37716b4cac81SBjoern A. Zeeb 37726b4cac81SBjoern A. Zeeb ieee80211_ifattach(ic); 37736b4cac81SBjoern A. Zeeb 37746b4cac81SBjoern A. Zeeb ic->ic_update_mcast = lkpi_ic_update_mcast; 37756b4cac81SBjoern A. Zeeb ic->ic_update_promisc = lkpi_ic_update_promisc; 37766b4cac81SBjoern A. Zeeb ic->ic_update_chw = lkpi_ic_update_chw; 37776b4cac81SBjoern A. Zeeb ic->ic_parent = lkpi_ic_parent; 37786b4cac81SBjoern A. Zeeb ic->ic_scan_start = lkpi_ic_scan_start; 37796b4cac81SBjoern A. Zeeb ic->ic_scan_end = lkpi_ic_scan_end; 37806b4cac81SBjoern A. Zeeb ic->ic_set_channel = lkpi_ic_set_channel; 37816b4cac81SBjoern A. Zeeb ic->ic_transmit = lkpi_ic_transmit; 37826b4cac81SBjoern A. Zeeb ic->ic_raw_xmit = lkpi_ic_raw_xmit; 37836b4cac81SBjoern A. Zeeb ic->ic_vap_create = lkpi_ic_vap_create; 37846b4cac81SBjoern A. Zeeb ic->ic_vap_delete = lkpi_ic_vap_delete; 37856b4cac81SBjoern A. Zeeb ic->ic_getradiocaps = lkpi_ic_getradiocaps; 37866b4cac81SBjoern A. Zeeb ic->ic_wme.wme_update = lkpi_ic_wme_update; 37876b4cac81SBjoern A. Zeeb 3788a486fbbdSBjoern A. Zeeb lhw->ic_scan_curchan = ic->ic_scan_curchan; 3789a486fbbdSBjoern A. Zeeb ic->ic_scan_curchan = lkpi_ic_scan_curchan; 3790a486fbbdSBjoern A. Zeeb lhw->ic_scan_mindwell = ic->ic_scan_mindwell; 3791a486fbbdSBjoern A. Zeeb ic->ic_scan_mindwell = lkpi_ic_scan_mindwell; 3792a486fbbdSBjoern A. Zeeb 37936b4cac81SBjoern A. Zeeb lhw->ic_node_alloc = ic->ic_node_alloc; 37946b4cac81SBjoern A. Zeeb ic->ic_node_alloc = lkpi_ic_node_alloc; 37956b4cac81SBjoern A. Zeeb lhw->ic_node_init = ic->ic_node_init; 37966b4cac81SBjoern A. Zeeb ic->ic_node_init = lkpi_ic_node_init; 37976b4cac81SBjoern A. Zeeb lhw->ic_node_cleanup = ic->ic_node_cleanup; 37986b4cac81SBjoern A. Zeeb ic->ic_node_cleanup = lkpi_ic_node_cleanup; 37996b4cac81SBjoern A. Zeeb lhw->ic_node_free = ic->ic_node_free; 38006b4cac81SBjoern A. Zeeb ic->ic_node_free = lkpi_ic_node_free; 38016b4cac81SBjoern A. Zeeb 38026b4cac81SBjoern A. Zeeb lkpi_radiotap_attach(lhw); 38036b4cac81SBjoern A. Zeeb 3804c5b96b3eSBjoern A. Zeeb /* 3805c5b96b3eSBjoern A. Zeeb * Assign the first possible channel for now; seems Realtek drivers 3806c5b96b3eSBjoern A. Zeeb * expect one. 3807d9945d78SBjoern A. Zeeb * Also remember the amount of bands we support and the most rates 3808d9945d78SBjoern A. Zeeb * in any band so we can scale [(ext) sup rates] IE(s) accordingly. 3809c5b96b3eSBjoern A. Zeeb */ 3810d9945d78SBjoern A. Zeeb lhw->supbands = lhw->max_rates = 0; 3811f454a4a1SBjoern A. Zeeb for (band = 0; band < NUM_NL80211_BANDS; band++) { 3812c5b96b3eSBjoern A. Zeeb struct ieee80211_supported_band *supband; 3813c5b96b3eSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *channels; 3814c5b96b3eSBjoern A. Zeeb 3815c5b96b3eSBjoern A. Zeeb supband = hw->wiphy->bands[band]; 3816c5b96b3eSBjoern A. Zeeb if (supband == NULL || supband->n_channels == 0) 3817c5b96b3eSBjoern A. Zeeb continue; 3818c5b96b3eSBjoern A. Zeeb 3819d9945d78SBjoern A. Zeeb lhw->supbands++; 3820d9945d78SBjoern A. Zeeb lhw->max_rates = max(lhw->max_rates, supband->n_bitrates); 3821d9945d78SBjoern A. Zeeb 3822f454a4a1SBjoern A. Zeeb /* If we have a channel, we need to keep counting supbands. */ 3823f454a4a1SBjoern A. Zeeb if (hw->conf.chandef.chan != NULL) 3824f454a4a1SBjoern A. Zeeb continue; 3825f454a4a1SBjoern A. Zeeb 3826c5b96b3eSBjoern A. Zeeb channels = supband->channels; 3827c5b96b3eSBjoern A. Zeeb for (i = 0; i < supband->n_channels; i++) { 3828c5b96b3eSBjoern A. Zeeb 3829c5b96b3eSBjoern A. Zeeb if (channels[i].flags & IEEE80211_CHAN_DISABLED) 3830c5b96b3eSBjoern A. Zeeb continue; 3831c5b96b3eSBjoern A. Zeeb 38324a07abdeSBjoern A. Zeeb cfg80211_chandef_create(&hw->conf.chandef, &channels[i], 3833c5b96b3eSBjoern A. Zeeb NL80211_CHAN_NO_HT); 3834c5b96b3eSBjoern A. Zeeb break; 3835c5b96b3eSBjoern A. Zeeb } 3836c5b96b3eSBjoern A. Zeeb } 3837c5b96b3eSBjoern A. Zeeb 3838d9945d78SBjoern A. Zeeb IMPROVE("see net80211::ieee80211_chan_init vs. wiphy->bands[].bitrates possibly in lkpi_ic_getradiocaps?"); 3839d9945d78SBjoern A. Zeeb 3840d9945d78SBjoern A. Zeeb /* Make sure we do not support more than net80211 is willing to take. */ 3841d9945d78SBjoern A. Zeeb if (lhw->max_rates > IEEE80211_RATE_MAXSIZE) { 3842d9945d78SBjoern A. Zeeb ic_printf(ic, "%s: limiting max_rates %d to %d!\n", __func__, 3843d9945d78SBjoern A. Zeeb lhw->max_rates, IEEE80211_RATE_MAXSIZE); 3844d9945d78SBjoern A. Zeeb lhw->max_rates = IEEE80211_RATE_MAXSIZE; 3845d9945d78SBjoern A. Zeeb } 3846d9945d78SBjoern A. Zeeb 3847d9945d78SBjoern A. Zeeb /* 3848d9945d78SBjoern A. Zeeb * The maximum supported bitrates on any band + size for 3849d9945d78SBjoern A. Zeeb * DSSS Parameter Set give our per-band IE size. 3850d9945d78SBjoern A. Zeeb * XXX-BZ FIXME add HT VHT ... later 3851d9945d78SBjoern A. Zeeb * SSID is the responsibility of the driver and goes on the side. 3852d9945d78SBjoern A. Zeeb * The user specified bits coming from the vap go into the 3853d9945d78SBjoern A. Zeeb * "common ies" fields. 3854d9945d78SBjoern A. Zeeb */ 3855d9945d78SBjoern A. Zeeb lhw->scan_ie_len = 2 + IEEE80211_RATE_SIZE; 3856d9945d78SBjoern A. Zeeb if (lhw->max_rates > IEEE80211_RATE_SIZE) 3857d9945d78SBjoern A. Zeeb lhw->scan_ie_len += 2 + (lhw->max_rates - IEEE80211_RATE_SIZE); 3858d9945d78SBjoern A. Zeeb /* 3859d9945d78SBjoern A. Zeeb * net80211 does not seem to support the DSSS Parameter Set but some of 3860d9945d78SBjoern A. Zeeb * the drivers insert it so calculate the extra fixed space in. 3861d9945d78SBjoern A. Zeeb */ 3862d9945d78SBjoern A. Zeeb lhw->scan_ie_len += 2 + 1; 3863d9945d78SBjoern A. Zeeb 3864d9945d78SBjoern A. Zeeb /* Reduce the max_scan_ie_len "left" by the amount we consume already. */ 3865d9945d78SBjoern A. Zeeb if (hw->wiphy->max_scan_ie_len > 0) 3866d9945d78SBjoern A. Zeeb hw->wiphy->max_scan_ie_len -= lhw->scan_ie_len; 3867d9945d78SBjoern A. Zeeb 38686b4cac81SBjoern A. Zeeb if (bootverbose) 38696b4cac81SBjoern A. Zeeb ieee80211_announce(ic); 38702e183d99SBjoern A. Zeeb 38712e183d99SBjoern A. Zeeb return (0); 38726b4cac81SBjoern A. Zeeb } 38736b4cac81SBjoern A. Zeeb 38746b4cac81SBjoern A. Zeeb void 38756b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_ifdetach(struct ieee80211_hw *hw) 38766b4cac81SBjoern A. Zeeb { 38776b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 38786b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 38796b4cac81SBjoern A. Zeeb 38806b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 38816b4cac81SBjoern A. Zeeb ic = lhw->ic; 38826b4cac81SBjoern A. Zeeb ieee80211_ifdetach(ic); 38836b4cac81SBjoern A. Zeeb } 38846b4cac81SBjoern A. Zeeb 38856b4cac81SBjoern A. Zeeb void 38866b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_interfaces(struct ieee80211_hw *hw, 38876b4cac81SBjoern A. Zeeb enum ieee80211_iface_iter flags, 38886b4cac81SBjoern A. Zeeb void(*iterfunc)(void *, uint8_t *, struct ieee80211_vif *), 38896b4cac81SBjoern A. Zeeb void *arg) 38906b4cac81SBjoern A. Zeeb { 38916b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 38926b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 38936b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 389461a68e50SBjoern A. Zeeb bool active, atomic, nin_drv; 38956b4cac81SBjoern A. Zeeb 38966b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 38976b4cac81SBjoern A. Zeeb 38986b4cac81SBjoern A. Zeeb if (flags & ~(IEEE80211_IFACE_ITER_NORMAL| 38996b4cac81SBjoern A. Zeeb IEEE80211_IFACE_ITER_RESUME_ALL| 390061a68e50SBjoern A. Zeeb IEEE80211_IFACE_SKIP_SDATA_NOT_IN_DRIVER| 3901adff403fSBjoern A. Zeeb IEEE80211_IFACE_ITER_ACTIVE|IEEE80211_IFACE_ITER__ATOMIC)) { 39026b4cac81SBjoern A. Zeeb ic_printf(lhw->ic, "XXX TODO %s flags(%#x) not yet supported.\n", 39036b4cac81SBjoern A. Zeeb __func__, flags); 39046b4cac81SBjoern A. Zeeb } 39056b4cac81SBjoern A. Zeeb 3906adff403fSBjoern A. Zeeb active = (flags & IEEE80211_IFACE_ITER_ACTIVE) != 0; 39076b4cac81SBjoern A. Zeeb atomic = (flags & IEEE80211_IFACE_ITER__ATOMIC) != 0; 390861a68e50SBjoern A. Zeeb nin_drv = (flags & IEEE80211_IFACE_SKIP_SDATA_NOT_IN_DRIVER) != 0; 39096b4cac81SBjoern A. Zeeb 39106b4cac81SBjoern A. Zeeb if (atomic) 39118891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 39126b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 39136b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 39146b4cac81SBjoern A. Zeeb 39156b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 39166b4cac81SBjoern A. Zeeb 39176b4cac81SBjoern A. Zeeb /* 39186b4cac81SBjoern A. Zeeb * If we want "active" interfaces, we need to distinguish on 39196b4cac81SBjoern A. Zeeb * whether the driver knows about them or not to be able to 39206b4cac81SBjoern A. Zeeb * handle the "resume" case correctly. Skip the ones the 39216b4cac81SBjoern A. Zeeb * driver does not know about. 39226b4cac81SBjoern A. Zeeb */ 39236b4cac81SBjoern A. Zeeb if (active && !lvif->added_to_drv && 39246b4cac81SBjoern A. Zeeb (flags & IEEE80211_IFACE_ITER_RESUME_ALL) != 0) 39256b4cac81SBjoern A. Zeeb continue; 39266b4cac81SBjoern A. Zeeb 39276b4cac81SBjoern A. Zeeb /* 392861a68e50SBjoern A. Zeeb * If we shall skip interfaces not added to the driver do so 392961a68e50SBjoern A. Zeeb * if we haven't yet. 393061a68e50SBjoern A. Zeeb */ 393161a68e50SBjoern A. Zeeb if (nin_drv && !lvif->added_to_drv) 393261a68e50SBjoern A. Zeeb continue; 393361a68e50SBjoern A. Zeeb 393461a68e50SBjoern A. Zeeb /* 39356b4cac81SBjoern A. Zeeb * Run the iterator function if we are either not asking 39366b4cac81SBjoern A. Zeeb * asking for active only or if the VAP is "running". 39376b4cac81SBjoern A. Zeeb */ 39386b4cac81SBjoern A. Zeeb /* XXX-BZ probably should have state in the lvif as well. */ 39396b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 39406b4cac81SBjoern A. Zeeb if (!active || (vap->iv_state != IEEE80211_S_INIT)) 39416b4cac81SBjoern A. Zeeb iterfunc(arg, vif->addr, vif); 39426b4cac81SBjoern A. Zeeb } 39436b4cac81SBjoern A. Zeeb if (atomic) 39448891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 39456b4cac81SBjoern A. Zeeb } 39466b4cac81SBjoern A. Zeeb 39476b4cac81SBjoern A. Zeeb void 39486b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_keys(struct ieee80211_hw *hw, 39496b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif, 39506b4cac81SBjoern A. Zeeb void(*iterfunc)(struct ieee80211_hw *, struct ieee80211_vif *, 39516b4cac81SBjoern A. Zeeb struct ieee80211_sta *, struct ieee80211_key_conf *, void *), 39526b4cac81SBjoern A. Zeeb void *arg) 39536b4cac81SBjoern A. Zeeb { 39546b4cac81SBjoern A. Zeeb 39556b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 39566b4cac81SBjoern A. Zeeb } 39576b4cac81SBjoern A. Zeeb 39586b4cac81SBjoern A. Zeeb void 39596b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_chan_contexts(struct ieee80211_hw *hw, 39606b4cac81SBjoern A. Zeeb void(*iterfunc)(struct ieee80211_hw *, struct ieee80211_chanctx_conf *, 39616b4cac81SBjoern A. Zeeb void *), 39626b4cac81SBjoern A. Zeeb void *arg) 39636b4cac81SBjoern A. Zeeb { 39646b4cac81SBjoern A. Zeeb 39656b4cac81SBjoern A. Zeeb UNIMPLEMENTED; 39666b4cac81SBjoern A. Zeeb } 39676b4cac81SBjoern A. Zeeb 39686b4cac81SBjoern A. Zeeb void 39696b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_iterate_stations_atomic(struct ieee80211_hw *hw, 39706b4cac81SBjoern A. Zeeb void (*iterfunc)(void *, struct ieee80211_sta *), void *arg) 39716b4cac81SBjoern A. Zeeb { 39726b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 39736b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 39746b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 39756b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 39766b4cac81SBjoern A. Zeeb 39776b4cac81SBjoern A. Zeeb KASSERT(hw != NULL && iterfunc != NULL, 39786b4cac81SBjoern A. Zeeb ("%s: hw %p iterfunc %p arg %p\n", __func__, hw, iterfunc, arg)); 39796b4cac81SBjoern A. Zeeb 39806b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 39816b4cac81SBjoern A. Zeeb 39828891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 39836b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 39846b4cac81SBjoern A. Zeeb 39856b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 39866b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lsta, &lvif->lsta_head, lsta_entry) { 39876b4cac81SBjoern A. Zeeb if (!lsta->added_to_drv) 39886b4cac81SBjoern A. Zeeb continue; 39896b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 39906b4cac81SBjoern A. Zeeb iterfunc(arg, sta); 39916b4cac81SBjoern A. Zeeb } 39926b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 39936b4cac81SBjoern A. Zeeb } 39948891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 39956b4cac81SBjoern A. Zeeb } 39966b4cac81SBjoern A. Zeeb 39976b4cac81SBjoern A. Zeeb int 39986b4cac81SBjoern A. Zeeb linuxkpi_regulatory_set_wiphy_regd_sync(struct wiphy *wiphy, 39996b4cac81SBjoern A. Zeeb struct linuxkpi_ieee80211_regdomain *regd) 40006b4cac81SBjoern A. Zeeb { 40016b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40026b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 40036b4cac81SBjoern A. Zeeb struct ieee80211_regdomain *rd; 40046b4cac81SBjoern A. Zeeb 40056b4cac81SBjoern A. Zeeb lhw = wiphy_priv(wiphy); 40066b4cac81SBjoern A. Zeeb ic = lhw->ic; 40076b4cac81SBjoern A. Zeeb 40086b4cac81SBjoern A. Zeeb rd = &ic->ic_regdomain; 40096b4cac81SBjoern A. Zeeb if (rd->isocc[0] == '\0') { 40106b4cac81SBjoern A. Zeeb rd->isocc[0] = regd->alpha2[0]; 40116b4cac81SBjoern A. Zeeb rd->isocc[1] = regd->alpha2[1]; 40126b4cac81SBjoern A. Zeeb } 40136b4cac81SBjoern A. Zeeb 40146b4cac81SBjoern A. Zeeb TODO(); 40156b4cac81SBjoern A. Zeeb /* XXX-BZ finish the rest. */ 40166b4cac81SBjoern A. Zeeb 40176b4cac81SBjoern A. Zeeb return (0); 40186b4cac81SBjoern A. Zeeb } 40196b4cac81SBjoern A. Zeeb 40206b4cac81SBjoern A. Zeeb void 40216b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_scan_completed(struct ieee80211_hw *hw, 40226b4cac81SBjoern A. Zeeb struct cfg80211_scan_info *info) 40236b4cac81SBjoern A. Zeeb { 40246b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40256b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 40266b4cac81SBjoern A. Zeeb struct ieee80211_scan_state *ss; 40276b4cac81SBjoern A. Zeeb 40286b4cac81SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 40296b4cac81SBjoern A. Zeeb ic = lhw->ic; 40306b4cac81SBjoern A. Zeeb ss = ic->ic_scan; 40316b4cac81SBjoern A. Zeeb 40326b4cac81SBjoern A. Zeeb ieee80211_scan_done(ss->ss_vap); 40336b4cac81SBjoern A. Zeeb 40348ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_LOCK(lhw); 40356b4cac81SBjoern A. Zeeb free(lhw->hw_req, M_LKPI80211); 40366b4cac81SBjoern A. Zeeb lhw->hw_req = NULL; 4037a486fbbdSBjoern A. Zeeb lhw->scan_flags &= ~LKPI_LHW_SCAN_RUNNING; 40386b4cac81SBjoern A. Zeeb wakeup(lhw); 40398ac540d3SBjoern A. Zeeb LKPI_80211_LHW_SCAN_UNLOCK(lhw); 40406b4cac81SBjoern A. Zeeb 40416b4cac81SBjoern A. Zeeb return; 40426b4cac81SBjoern A. Zeeb } 40436b4cac81SBjoern A. Zeeb 4044e30e05d3SBjoern A. Zeeb /* For %list see comment towards the end of the function. */ 40456b4cac81SBjoern A. Zeeb void 40466b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_rx(struct ieee80211_hw *hw, struct sk_buff *skb, 4047e30e05d3SBjoern A. Zeeb struct ieee80211_sta *sta, struct napi_struct *napi __unused, 4048e30e05d3SBjoern A. Zeeb struct list_head *list __unused) 40496b4cac81SBjoern A. Zeeb { 40506b4cac81SBjoern A. Zeeb struct epoch_tracker et; 40516b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 40526b4cac81SBjoern A. Zeeb struct ieee80211com *ic; 40536b4cac81SBjoern A. Zeeb struct mbuf *m; 40546b4cac81SBjoern A. Zeeb struct skb_shared_info *shinfo; 40556b4cac81SBjoern A. Zeeb struct ieee80211_rx_status *rx_status; 40566b4cac81SBjoern A. Zeeb struct ieee80211_rx_stats rx_stats; 40576b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 40586b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 40596b4cac81SBjoern A. Zeeb struct ieee80211_hdr *hdr; 40606b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 40619d9ba2b7SBjoern A. Zeeb int i, offset, ok; 4062170acccfSBjoern A. Zeeb int8_t rssi; 4063c0cadd99SBjoern A. Zeeb bool is_beacon; 40646b4cac81SBjoern A. Zeeb 40656b4cac81SBjoern A. Zeeb if (skb->len < 2) { 40666b4cac81SBjoern A. Zeeb /* Need 80211 stats here. */ 40676b4cac81SBjoern A. Zeeb IMPROVE(); 40686b4cac81SBjoern A. Zeeb goto err; 40696b4cac81SBjoern A. Zeeb } 40706b4cac81SBjoern A. Zeeb 40716b4cac81SBjoern A. Zeeb /* 40726b4cac81SBjoern A. Zeeb * For now do the data copy; we can later improve things. Might even 40736b4cac81SBjoern A. Zeeb * have an mbuf backing the skb data then? 40746b4cac81SBjoern A. Zeeb */ 40756b4cac81SBjoern A. Zeeb m = m_get2(skb->len, M_NOWAIT, MT_DATA, M_PKTHDR); 40766b4cac81SBjoern A. Zeeb if (m == NULL) 40776b4cac81SBjoern A. Zeeb goto err; 40786b4cac81SBjoern A. Zeeb m_copyback(m, 0, skb->tail - skb->data, skb->data); 40796b4cac81SBjoern A. Zeeb 40806b4cac81SBjoern A. Zeeb shinfo = skb_shinfo(skb); 40816b4cac81SBjoern A. Zeeb offset = m->m_len; 40826b4cac81SBjoern A. Zeeb for (i = 0; i < shinfo->nr_frags; i++) { 40836b4cac81SBjoern A. Zeeb m_copyback(m, offset, shinfo->frags[i].size, 40846b4cac81SBjoern A. Zeeb (uint8_t *)linux_page_address(shinfo->frags[i].page) + 40856b4cac81SBjoern A. Zeeb shinfo->frags[i].offset); 40866b4cac81SBjoern A. Zeeb offset += shinfo->frags[i].size; 40876b4cac81SBjoern A. Zeeb } 40886b4cac81SBjoern A. Zeeb 40896b4cac81SBjoern A. Zeeb rx_status = IEEE80211_SKB_RXCB(skb); 40906b4cac81SBjoern A. Zeeb 40916b4cac81SBjoern A. Zeeb hdr = (void *)skb->data; 4092c0cadd99SBjoern A. Zeeb is_beacon = ieee80211_is_beacon(hdr->frame_control); 4093c0cadd99SBjoern A. Zeeb 4094c0cadd99SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 40959d9ba2b7SBjoern A. Zeeb if (is_beacon && (linuxkpi_debug_80211 & D80211_TRACE_RX_BEACONS) == 0) 40966b4cac81SBjoern A. Zeeb goto no_trace_beacons; 40976b4cac81SBjoern A. Zeeb 40989d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 40996b4cac81SBjoern A. Zeeb printf("TRACE-RX: %s: skb %p a/l/d/t-len (%u/%u/%u/%u) " 4100c0cadd99SBjoern A. Zeeb "h %p d %p t %p e %p sh %p (%u) m %p plen %u len %u%s\n", 41016b4cac81SBjoern A. Zeeb __func__, skb, skb->_alloc_len, skb->len, skb->data_len, 41026b4cac81SBjoern A. Zeeb skb->truesize, skb->head, skb->data, skb->tail, skb->end, 41036b4cac81SBjoern A. Zeeb shinfo, shinfo->nr_frags, 4104c0cadd99SBjoern A. Zeeb m, m->m_pkthdr.len, m->m_len, is_beacon ? " beacon" : ""); 41056b4cac81SBjoern A. Zeeb 41069d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX_DUMP) 41076b4cac81SBjoern A. Zeeb hexdump(mtod(m, const void *), m->m_len, "RX (raw) ", 0); 41086b4cac81SBjoern A. Zeeb 41096b4cac81SBjoern A. Zeeb /* Implement a dump_rxcb() !!! */ 41109d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 4111c8dafefaSBjoern A. Zeeb printf("TRACE %s: RXCB: %ju %ju %u, %#0x, %u, %#0x, %#0x, " 411260970a32SBjoern A. Zeeb "%u band %u, %u { %d %d %d %d }, %d, %#x %#x %#x %#x %u %u %u\n", 41136b4cac81SBjoern A. Zeeb __func__, 4114c8dafefaSBjoern A. Zeeb (uintmax_t)rx_status->boottime_ns, 4115c8dafefaSBjoern A. Zeeb (uintmax_t)rx_status->mactime, 41166b4cac81SBjoern A. Zeeb rx_status->device_timestamp, 41176b4cac81SBjoern A. Zeeb rx_status->flag, 41186b4cac81SBjoern A. Zeeb rx_status->freq, 41196b4cac81SBjoern A. Zeeb rx_status->bw, 41206b4cac81SBjoern A. Zeeb rx_status->encoding, 41216b4cac81SBjoern A. Zeeb rx_status->ampdu_reference, 41226b4cac81SBjoern A. Zeeb rx_status->band, 41236b4cac81SBjoern A. Zeeb rx_status->chains, 41246b4cac81SBjoern A. Zeeb rx_status->chain_signal[0], 41256b4cac81SBjoern A. Zeeb rx_status->chain_signal[1], 41266b4cac81SBjoern A. Zeeb rx_status->chain_signal[2], 412760970a32SBjoern A. Zeeb rx_status->chain_signal[3], 41286b4cac81SBjoern A. Zeeb rx_status->signal, 41296b4cac81SBjoern A. Zeeb rx_status->enc_flags, 41306b4cac81SBjoern A. Zeeb rx_status->he_dcm, 41316b4cac81SBjoern A. Zeeb rx_status->he_gi, 41326b4cac81SBjoern A. Zeeb rx_status->he_ru, 41336b4cac81SBjoern A. Zeeb rx_status->zero_length_psdu_type, 41346b4cac81SBjoern A. Zeeb rx_status->nss, 41356b4cac81SBjoern A. Zeeb rx_status->rate_idx); 41366b4cac81SBjoern A. Zeeb no_trace_beacons: 41376b4cac81SBjoern A. Zeeb #endif 41386b4cac81SBjoern A. Zeeb 41396b4cac81SBjoern A. Zeeb memset(&rx_stats, 0, sizeof(rx_stats)); 41406b4cac81SBjoern A. Zeeb rx_stats.r_flags = IEEE80211_R_NF | IEEE80211_R_RSSI; 414160970a32SBjoern A. Zeeb /* XXX-BZ correct hardcoded rssi and noise floor, how? survey? */ 414260970a32SBjoern A. Zeeb rx_stats.c_nf = -96; 41436b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, SIGNAL_DBM) && 41446b4cac81SBjoern A. Zeeb !(rx_status->flag & RX_FLAG_NO_SIGNAL_VAL)) 4145170acccfSBjoern A. Zeeb rssi = rx_status->signal; 41466b4cac81SBjoern A. Zeeb else 4147170acccfSBjoern A. Zeeb rssi = rx_stats.c_nf; 4148170acccfSBjoern A. Zeeb /* 4149170acccfSBjoern A. Zeeb * net80211 signal strength data are in .5 dBm units relative to 4150170acccfSBjoern A. Zeeb * the current noise floor (see comment in ieee80211_node.h). 4151170acccfSBjoern A. Zeeb */ 4152170acccfSBjoern A. Zeeb rssi -= rx_stats.c_nf; 4153170acccfSBjoern A. Zeeb rx_stats.c_rssi = rssi * 2; 41546b4cac81SBjoern A. Zeeb rx_stats.r_flags |= IEEE80211_R_BAND; 41556b4cac81SBjoern A. Zeeb rx_stats.c_band = 41566b4cac81SBjoern A. Zeeb lkpi_nl80211_band_to_net80211_band(rx_status->band); 41576b4cac81SBjoern A. Zeeb rx_stats.r_flags |= IEEE80211_R_FREQ | IEEE80211_R_IEEE; 41586b4cac81SBjoern A. Zeeb rx_stats.c_freq = rx_status->freq; 41596b4cac81SBjoern A. Zeeb rx_stats.c_ieee = ieee80211_mhz2ieee(rx_stats.c_freq, rx_stats.c_band); 41606b4cac81SBjoern A. Zeeb 41616b4cac81SBjoern A. Zeeb /* XXX (*sta_statistics)() to get to some of that? */ 41626b4cac81SBjoern A. Zeeb /* XXX-BZ dump the FreeBSD version of rx_stats as well! */ 41636b4cac81SBjoern A. Zeeb 41646b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 41656b4cac81SBjoern A. Zeeb ic = lhw->ic; 41666b4cac81SBjoern A. Zeeb 41676b4cac81SBjoern A. Zeeb ok = ieee80211_add_rx_params(m, &rx_stats); 41686b4cac81SBjoern A. Zeeb if (ok == 0) { 4169dbc06dd9SBjoern A. Zeeb m_freem(m); 41706b4cac81SBjoern A. Zeeb counter_u64_add(ic->ic_ierrors, 1); 41716b4cac81SBjoern A. Zeeb goto err; 41726b4cac81SBjoern A. Zeeb } 41736b4cac81SBjoern A. Zeeb 41746b4cac81SBjoern A. Zeeb if (sta != NULL) { 41756b4cac81SBjoern A. Zeeb lsta = STA_TO_LSTA(sta); 41766b4cac81SBjoern A. Zeeb ni = ieee80211_ref_node(lsta->ni); 41776b4cac81SBjoern A. Zeeb } else { 4178c8dafefaSBjoern A. Zeeb struct ieee80211_frame_min *wh; 4179c8dafefaSBjoern A. Zeeb 41806b4cac81SBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame_min *); 41816b4cac81SBjoern A. Zeeb ni = ieee80211_find_rxnode(ic, wh); 41826b4cac81SBjoern A. Zeeb if (ni != NULL) 41836b4cac81SBjoern A. Zeeb lsta = ni->ni_drv_data; 41846b4cac81SBjoern A. Zeeb } 41856b4cac81SBjoern A. Zeeb 41866b4cac81SBjoern A. Zeeb if (ni != NULL) 41876b4cac81SBjoern A. Zeeb vap = ni->ni_vap; 41886b4cac81SBjoern A. Zeeb else 41896b4cac81SBjoern A. Zeeb /* 41906b4cac81SBjoern A. Zeeb * XXX-BZ can we improve this by looking at the frame hdr 41916b4cac81SBjoern A. Zeeb * or other meta-data passed up? 41926b4cac81SBjoern A. Zeeb */ 41936b4cac81SBjoern A. Zeeb vap = TAILQ_FIRST(&ic->ic_vaps); 41946b4cac81SBjoern A. Zeeb 41959d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 41969d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 4197c0cadd99SBjoern A. Zeeb printf("TRACE %s: sta %p lsta %p state %d ni %p vap %p%s\n", 4198c0cadd99SBjoern A. Zeeb __func__, sta, lsta, (lsta != NULL) ? lsta->state : -1, 4199c0cadd99SBjoern A. Zeeb ni, vap, is_beacon ? " beacon" : ""); 42009d9ba2b7SBjoern A. Zeeb #endif 42016b4cac81SBjoern A. Zeeb 4202c0cadd99SBjoern A. Zeeb if (ni != NULL && vap != NULL && is_beacon && 4203c8dafefaSBjoern A. Zeeb rx_status->device_timestamp > 0 && 4204c8dafefaSBjoern A. Zeeb m->m_pkthdr.len >= sizeof(struct ieee80211_frame)) { 4205c8dafefaSBjoern A. Zeeb struct lkpi_vif *lvif; 4206c8dafefaSBjoern A. Zeeb struct ieee80211_vif *vif; 4207c8dafefaSBjoern A. Zeeb struct ieee80211_frame *wh; 4208c8dafefaSBjoern A. Zeeb 4209c8dafefaSBjoern A. Zeeb wh = mtod(m, struct ieee80211_frame *); 4210c8dafefaSBjoern A. Zeeb if (!IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid)) 4211c8dafefaSBjoern A. Zeeb goto skip_device_ts; 4212c8dafefaSBjoern A. Zeeb 4213c8dafefaSBjoern A. Zeeb lvif = VAP_TO_LVIF(vap); 4214c8dafefaSBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 4215c8dafefaSBjoern A. Zeeb 4216c8dafefaSBjoern A. Zeeb IMPROVE("TIMING_BEACON_ONLY?"); 4217c8dafefaSBjoern A. Zeeb /* mac80211 specific (not net80211) so keep it here. */ 4218c8dafefaSBjoern A. Zeeb vif->bss_conf.sync_device_ts = rx_status->device_timestamp; 4219c8dafefaSBjoern A. Zeeb /* 4220c8dafefaSBjoern A. Zeeb * net80211 should take care of the other information (sync_tsf, 4221c8dafefaSBjoern A. Zeeb * sync_dtim_count) as otherwise we need to parse the beacon. 4222c8dafefaSBjoern A. Zeeb */ 4223c8dafefaSBjoern A. Zeeb } 4224c8dafefaSBjoern A. Zeeb skip_device_ts: 4225c8dafefaSBjoern A. Zeeb 42266b4cac81SBjoern A. Zeeb if (vap != NULL && vap->iv_state > IEEE80211_S_INIT && 42276b4cac81SBjoern A. Zeeb ieee80211_radiotap_active_vap(vap)) { 42286b4cac81SBjoern A. Zeeb struct lkpi_radiotap_rx_hdr *rtap; 42296b4cac81SBjoern A. Zeeb 42306b4cac81SBjoern A. Zeeb rtap = &lhw->rtap_rx; 42316b4cac81SBjoern A. Zeeb rtap->wr_tsft = rx_status->device_timestamp; 42326b4cac81SBjoern A. Zeeb rtap->wr_flags = 0; 42336b4cac81SBjoern A. Zeeb if (rx_status->enc_flags & RX_ENC_FLAG_SHORTPRE) 42346b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE; 42356b4cac81SBjoern A. Zeeb if (rx_status->enc_flags & RX_ENC_FLAG_SHORT_GI) 42366b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTGI; 42376b4cac81SBjoern A. Zeeb #if 0 /* .. or it does not given we strip it below. */ 42386b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, RX_INCLUDES_FCS)) 42396b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_FCS; 42406b4cac81SBjoern A. Zeeb #endif 42416b4cac81SBjoern A. Zeeb if (rx_status->flag & RX_FLAG_FAILED_FCS_CRC) 42426b4cac81SBjoern A. Zeeb rtap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS; 42436b4cac81SBjoern A. Zeeb rtap->wr_rate = 0; 42446b4cac81SBjoern A. Zeeb IMPROVE(); 42456b4cac81SBjoern A. Zeeb /* XXX TODO status->encoding / rate_index / bw */ 42466b4cac81SBjoern A. Zeeb rtap->wr_chan_freq = htole16(rx_stats.c_freq); 42476b4cac81SBjoern A. Zeeb if (ic->ic_curchan->ic_ieee == rx_stats.c_ieee) 42486b4cac81SBjoern A. Zeeb rtap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 4249170acccfSBjoern A. Zeeb rtap->wr_dbm_antsignal = rssi; 42506b4cac81SBjoern A. Zeeb rtap->wr_dbm_antnoise = rx_stats.c_nf; 42516b4cac81SBjoern A. Zeeb } 42526b4cac81SBjoern A. Zeeb 42536b4cac81SBjoern A. Zeeb if (ieee80211_hw_check(hw, RX_INCLUDES_FCS)) 42546b4cac81SBjoern A. Zeeb m_adj(m, -IEEE80211_CRC_LEN); 42556b4cac81SBjoern A. Zeeb 4256e30e05d3SBjoern A. Zeeb #if 0 4257e30e05d3SBjoern A. Zeeb if (list != NULL) { 4258e30e05d3SBjoern A. Zeeb /* 4259e30e05d3SBjoern A. Zeeb * Normally this would be queued up and delivered by 4260e30e05d3SBjoern A. Zeeb * netif_receive_skb_list(), napi_gro_receive(), or the like. 4261e30e05d3SBjoern A. Zeeb * See mt76::mac80211.c as only current possible consumer. 4262e30e05d3SBjoern A. Zeeb */ 4263e30e05d3SBjoern A. Zeeb IMPROVE("we simply pass the packet to net80211 to deal with."); 4264e30e05d3SBjoern A. Zeeb } 4265e30e05d3SBjoern A. Zeeb #endif 4266e30e05d3SBjoern A. Zeeb 42676b4cac81SBjoern A. Zeeb NET_EPOCH_ENTER(et); 42686b4cac81SBjoern A. Zeeb if (ni != NULL) { 42699d9ba2b7SBjoern A. Zeeb ok = ieee80211_input_mimo(ni, m); 42706b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 4271dbc06dd9SBjoern A. Zeeb if (ok < 0) 4272dbc06dd9SBjoern A. Zeeb m_freem(m); 42736b4cac81SBjoern A. Zeeb } else { 42749d9ba2b7SBjoern A. Zeeb ok = ieee80211_input_mimo_all(ic, m); 4275dbc06dd9SBjoern A. Zeeb /* mbuf got consumed. */ 42766b4cac81SBjoern A. Zeeb } 42776b4cac81SBjoern A. Zeeb NET_EPOCH_EXIT(et); 42786b4cac81SBjoern A. Zeeb 42799d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 42809d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_RX) 42819d9ba2b7SBjoern A. Zeeb printf("TRACE %s: handled frame type %#0x\n", __func__, ok); 42829d9ba2b7SBjoern A. Zeeb #endif 42836b4cac81SBjoern A. Zeeb 42846b4cac81SBjoern A. Zeeb IMPROVE(); 42856b4cac81SBjoern A. Zeeb 42866b4cac81SBjoern A. Zeeb err: 42876b4cac81SBjoern A. Zeeb /* The skb is ours so we can free it :-) */ 42886b4cac81SBjoern A. Zeeb kfree_skb(skb); 42896b4cac81SBjoern A. Zeeb } 42906b4cac81SBjoern A. Zeeb 42916b4cac81SBjoern A. Zeeb uint8_t 4292ec190d91SBjoern A. Zeeb linuxkpi_ieee80211_get_tid(struct ieee80211_hdr *hdr, bool nonqos_ok) 42936b4cac81SBjoern A. Zeeb { 42946b4cac81SBjoern A. Zeeb const struct ieee80211_frame *wh; 4295ec190d91SBjoern A. Zeeb uint8_t tid; 4296ec190d91SBjoern A. Zeeb 4297ec190d91SBjoern A. Zeeb /* Linux seems to assume this is a QOS-Data-Frame */ 4298ec190d91SBjoern A. Zeeb KASSERT(nonqos_ok || ieee80211_is_data_qos(hdr->frame_control), 4299ec190d91SBjoern A. Zeeb ("%s: hdr %p fc %#06x not qos_data\n", __func__, hdr, 4300ec190d91SBjoern A. Zeeb hdr->frame_control)); 43016b4cac81SBjoern A. Zeeb 43026b4cac81SBjoern A. Zeeb wh = (const struct ieee80211_frame *)hdr; 4303ec190d91SBjoern A. Zeeb tid = ieee80211_gettid(wh); 4304ec190d91SBjoern A. Zeeb KASSERT(nonqos_ok || tid == (tid & IEEE80211_QOS_TID), ("%s: tid %u " 4305ec190d91SBjoern A. Zeeb "not expected (%u?)\n", __func__, tid, IEEE80211_NONQOS_TID)); 4306ec190d91SBjoern A. Zeeb 4307ec190d91SBjoern A. Zeeb return (tid); 43086b4cac81SBjoern A. Zeeb } 43096b4cac81SBjoern A. Zeeb 43106b4cac81SBjoern A. Zeeb struct wiphy * 43116b4cac81SBjoern A. Zeeb linuxkpi_wiphy_new(const struct cfg80211_ops *ops, size_t priv_len) 43126b4cac81SBjoern A. Zeeb { 43136b4cac81SBjoern A. Zeeb struct lkpi_wiphy *lwiphy; 43146b4cac81SBjoern A. Zeeb 43156b4cac81SBjoern A. Zeeb lwiphy = kzalloc(sizeof(*lwiphy) + priv_len, GFP_KERNEL); 43166b4cac81SBjoern A. Zeeb if (lwiphy == NULL) 43176b4cac81SBjoern A. Zeeb return (NULL); 43186b4cac81SBjoern A. Zeeb lwiphy->ops = ops; 43196b4cac81SBjoern A. Zeeb 43206b4cac81SBjoern A. Zeeb /* XXX TODO */ 43216b4cac81SBjoern A. Zeeb return (LWIPHY_TO_WIPHY(lwiphy)); 43226b4cac81SBjoern A. Zeeb } 43236b4cac81SBjoern A. Zeeb 43246b4cac81SBjoern A. Zeeb void 43256b4cac81SBjoern A. Zeeb linuxkpi_wiphy_free(struct wiphy *wiphy) 43266b4cac81SBjoern A. Zeeb { 43276b4cac81SBjoern A. Zeeb struct lkpi_wiphy *lwiphy; 43286b4cac81SBjoern A. Zeeb 43296b4cac81SBjoern A. Zeeb if (wiphy == NULL) 43306b4cac81SBjoern A. Zeeb return; 43316b4cac81SBjoern A. Zeeb 43326b4cac81SBjoern A. Zeeb lwiphy = WIPHY_TO_LWIPHY(wiphy); 43336b4cac81SBjoern A. Zeeb kfree(lwiphy); 43346b4cac81SBjoern A. Zeeb } 43356b4cac81SBjoern A. Zeeb 43366b4cac81SBjoern A. Zeeb uint32_t 43376b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_channel_to_frequency(uint32_t channel, 43386b4cac81SBjoern A. Zeeb enum nl80211_band band) 43396b4cac81SBjoern A. Zeeb { 43406b4cac81SBjoern A. Zeeb 43416b4cac81SBjoern A. Zeeb switch (band) { 43426b4cac81SBjoern A. Zeeb case NL80211_BAND_2GHZ: 43436b4cac81SBjoern A. Zeeb return (ieee80211_ieee2mhz(channel, IEEE80211_CHAN_2GHZ)); 43446b4cac81SBjoern A. Zeeb break; 43456b4cac81SBjoern A. Zeeb case NL80211_BAND_5GHZ: 43466b4cac81SBjoern A. Zeeb return (ieee80211_ieee2mhz(channel, IEEE80211_CHAN_5GHZ)); 43476b4cac81SBjoern A. Zeeb break; 43486b4cac81SBjoern A. Zeeb default: 43496b4cac81SBjoern A. Zeeb /* XXX abort, retry, error, panic? */ 43506b4cac81SBjoern A. Zeeb break; 43516b4cac81SBjoern A. Zeeb } 43526b4cac81SBjoern A. Zeeb 43536b4cac81SBjoern A. Zeeb return (0); 43546b4cac81SBjoern A. Zeeb } 43556b4cac81SBjoern A. Zeeb 43566b4cac81SBjoern A. Zeeb uint32_t 43576b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_frequency_to_channel(uint32_t freq, uint32_t flags __unused) 43586b4cac81SBjoern A. Zeeb { 43596b4cac81SBjoern A. Zeeb 43606b4cac81SBjoern A. Zeeb return (ieee80211_mhz2ieee(freq, 0)); 43616b4cac81SBjoern A. Zeeb } 43626b4cac81SBjoern A. Zeeb 43636b4cac81SBjoern A. Zeeb static struct lkpi_sta * 43646b4cac81SBjoern A. Zeeb lkpi_find_lsta_by_ni(struct lkpi_vif *lvif, struct ieee80211_node *ni) 43656b4cac81SBjoern A. Zeeb { 43666b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta, *temp; 43676b4cac81SBjoern A. Zeeb 43686b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 43696b4cac81SBjoern A. Zeeb TAILQ_FOREACH_SAFE(lsta, &lvif->lsta_head, lsta_entry, temp) { 43706b4cac81SBjoern A. Zeeb if (lsta->ni == ni) { 43716b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 43726b4cac81SBjoern A. Zeeb return (lsta); 43736b4cac81SBjoern A. Zeeb } 43746b4cac81SBjoern A. Zeeb } 43756b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 43766b4cac81SBjoern A. Zeeb 43776b4cac81SBjoern A. Zeeb return (NULL); 43786b4cac81SBjoern A. Zeeb } 43796b4cac81SBjoern A. Zeeb 43806b4cac81SBjoern A. Zeeb struct ieee80211_sta * 43816b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_find_sta(struct ieee80211_vif *vif, const u8 *peer) 43826b4cac81SBjoern A. Zeeb { 43836b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 43846b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta, *temp; 43856b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 43866b4cac81SBjoern A. Zeeb 43876b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 43886b4cac81SBjoern A. Zeeb 43896b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 43906b4cac81SBjoern A. Zeeb TAILQ_FOREACH_SAFE(lsta, &lvif->lsta_head, lsta_entry, temp) { 43916b4cac81SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 43926b4cac81SBjoern A. Zeeb if (IEEE80211_ADDR_EQ(sta->addr, peer)) { 43936b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 43946b4cac81SBjoern A. Zeeb return (sta); 43956b4cac81SBjoern A. Zeeb } 43966b4cac81SBjoern A. Zeeb } 43976b4cac81SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 43986b4cac81SBjoern A. Zeeb return (NULL); 43996b4cac81SBjoern A. Zeeb } 44006b4cac81SBjoern A. Zeeb 44016b4cac81SBjoern A. Zeeb struct ieee80211_sta * 44022e183d99SBjoern A. Zeeb linuxkpi_ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw, 44032e183d99SBjoern A. Zeeb const uint8_t *addr, const uint8_t *ourvifaddr) 44046b4cac81SBjoern A. Zeeb { 44056b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 44066b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 44076b4cac81SBjoern A. Zeeb struct lkpi_sta *lsta; 44086b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif; 44096b4cac81SBjoern A. Zeeb struct ieee80211_sta *sta; 44106b4cac81SBjoern A. Zeeb 44116b4cac81SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 44126b4cac81SBjoern A. Zeeb sta = NULL; 44136b4cac81SBjoern A. Zeeb 44148891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 44156b4cac81SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 44166b4cac81SBjoern A. Zeeb 44176b4cac81SBjoern A. Zeeb /* XXX-BZ check our address from the vif. */ 44186b4cac81SBjoern A. Zeeb 44196b4cac81SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 44206b4cac81SBjoern A. Zeeb if (ourvifaddr != NULL && 44216b4cac81SBjoern A. Zeeb !IEEE80211_ADDR_EQ(vif->addr, ourvifaddr)) 44226b4cac81SBjoern A. Zeeb continue; 44236b4cac81SBjoern A. Zeeb sta = linuxkpi_ieee80211_find_sta(vif, addr); 44246b4cac81SBjoern A. Zeeb if (sta != NULL) 44256b4cac81SBjoern A. Zeeb break; 44266b4cac81SBjoern A. Zeeb } 44278891c455SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 44286b4cac81SBjoern A. Zeeb 44296b4cac81SBjoern A. Zeeb if (sta != NULL) { 44306b4cac81SBjoern A. Zeeb lsta = STA_TO_LSTA(sta); 44316b4cac81SBjoern A. Zeeb if (!lsta->added_to_drv) 44326b4cac81SBjoern A. Zeeb return (NULL); 44336b4cac81SBjoern A. Zeeb } 44346b4cac81SBjoern A. Zeeb 44356b4cac81SBjoern A. Zeeb return (sta); 44366b4cac81SBjoern A. Zeeb } 44376b4cac81SBjoern A. Zeeb 44386b4cac81SBjoern A. Zeeb struct sk_buff * 44396b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_tx_dequeue(struct ieee80211_hw *hw, 44406b4cac81SBjoern A. Zeeb struct ieee80211_txq *txq) 44416b4cac81SBjoern A. Zeeb { 44426b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 44430cbcfa19SBjoern A. Zeeb struct lkpi_vif *lvif; 44446b4cac81SBjoern A. Zeeb struct sk_buff *skb; 44456b4cac81SBjoern A. Zeeb 44460cbcfa19SBjoern A. Zeeb skb = NULL; 44476b4cac81SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 44486b4cac81SBjoern A. Zeeb ltxq->seen_dequeue = true; 44496b4cac81SBjoern A. Zeeb 44500cbcfa19SBjoern A. Zeeb if (ltxq->stopped) 44510cbcfa19SBjoern A. Zeeb goto stopped; 44520cbcfa19SBjoern A. Zeeb 44530cbcfa19SBjoern A. Zeeb lvif = VIF_TO_LVIF(ltxq->txq.vif); 44540cbcfa19SBjoern A. Zeeb if (lvif->hw_queue_stopped[ltxq->txq.ac]) { 44550cbcfa19SBjoern A. Zeeb ltxq->stopped = true; 44560cbcfa19SBjoern A. Zeeb goto stopped; 44570cbcfa19SBjoern A. Zeeb } 44580cbcfa19SBjoern A. Zeeb 44596b4cac81SBjoern A. Zeeb skb = skb_dequeue(<xq->skbq); 44606b4cac81SBjoern A. Zeeb 44610cbcfa19SBjoern A. Zeeb stopped: 44626b4cac81SBjoern A. Zeeb return (skb); 44636b4cac81SBjoern A. Zeeb } 44646b4cac81SBjoern A. Zeeb 44656b4cac81SBjoern A. Zeeb void 44666b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_txq_get_depth(struct ieee80211_txq *txq, 446786220d3cSBjoern A. Zeeb unsigned long *frame_cnt, unsigned long *byte_cnt) 44686b4cac81SBjoern A. Zeeb { 44696b4cac81SBjoern A. Zeeb struct lkpi_txq *ltxq; 44706b4cac81SBjoern A. Zeeb struct sk_buff *skb; 447186220d3cSBjoern A. Zeeb unsigned long fc, bc; 44726b4cac81SBjoern A. Zeeb 44736b4cac81SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 44746b4cac81SBjoern A. Zeeb 44756b4cac81SBjoern A. Zeeb fc = bc = 0; 44766b4cac81SBjoern A. Zeeb skb_queue_walk(<xq->skbq, skb) { 44776b4cac81SBjoern A. Zeeb fc++; 44786b4cac81SBjoern A. Zeeb bc += skb->len; 44796b4cac81SBjoern A. Zeeb } 44806b4cac81SBjoern A. Zeeb if (frame_cnt) 44816b4cac81SBjoern A. Zeeb *frame_cnt = fc; 44826b4cac81SBjoern A. Zeeb if (byte_cnt) 44836b4cac81SBjoern A. Zeeb *byte_cnt = bc; 44846b4cac81SBjoern A. Zeeb 44856b4cac81SBjoern A. Zeeb /* Validate that this is doing the correct thing. */ 44866b4cac81SBjoern A. Zeeb /* Should we keep track on en/dequeue? */ 44876b4cac81SBjoern A. Zeeb IMPROVE(); 44886b4cac81SBjoern A. Zeeb } 44896b4cac81SBjoern A. Zeeb 44906b4cac81SBjoern A. Zeeb /* 44916b4cac81SBjoern A. Zeeb * We are called from ieee80211_free_txskb() or ieee80211_tx_status(). 44926b4cac81SBjoern A. Zeeb * The latter tries to derive the success status from the info flags 44936b4cac81SBjoern A. Zeeb * passed back from the driver. rawx_mit() saves the ni on the m and the 44946b4cac81SBjoern A. Zeeb * m on the skb for us to be able to give feedback to net80211. 44956b4cac81SBjoern A. Zeeb */ 4496a8397571SBjoern A. Zeeb static void 4497a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb, 44986b4cac81SBjoern A. Zeeb int status) 44996b4cac81SBjoern A. Zeeb { 45006b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 45016b4cac81SBjoern A. Zeeb struct mbuf *m; 45026b4cac81SBjoern A. Zeeb 45036b4cac81SBjoern A. Zeeb m = skb->m; 45046b4cac81SBjoern A. Zeeb skb->m = NULL; 45056b4cac81SBjoern A. Zeeb 45066b4cac81SBjoern A. Zeeb if (m != NULL) { 45076b4cac81SBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 45086b4cac81SBjoern A. Zeeb /* Status: 0 is ok, != 0 is error. */ 45096b4cac81SBjoern A. Zeeb ieee80211_tx_complete(ni, m, status); 45106b4cac81SBjoern A. Zeeb /* ni & mbuf were consumed. */ 45116b4cac81SBjoern A. Zeeb } 4512a8397571SBjoern A. Zeeb } 45136b4cac81SBjoern A. Zeeb 4514a8397571SBjoern A. Zeeb void 4515a8397571SBjoern A. Zeeb linuxkpi_ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb, 4516a8397571SBjoern A. Zeeb int status) 4517a8397571SBjoern A. Zeeb { 4518a8397571SBjoern A. Zeeb 4519a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(hw, skb, status); 45206b4cac81SBjoern A. Zeeb kfree_skb(skb); 45216b4cac81SBjoern A. Zeeb } 45226b4cac81SBjoern A. Zeeb 4523383b3e8fSBjoern A. Zeeb void 4524a8397571SBjoern A. Zeeb linuxkpi_ieee80211_tx_status_ext(struct ieee80211_hw *hw, 4525a8397571SBjoern A. Zeeb struct ieee80211_tx_status *txstat) 4526383b3e8fSBjoern A. Zeeb { 4527a8397571SBjoern A. Zeeb struct sk_buff *skb; 4528383b3e8fSBjoern A. Zeeb struct ieee80211_tx_info *info; 4529383b3e8fSBjoern A. Zeeb struct ieee80211_ratectl_tx_status txs; 4530383b3e8fSBjoern A. Zeeb struct ieee80211_node *ni; 4531383b3e8fSBjoern A. Zeeb int status; 4532383b3e8fSBjoern A. Zeeb 4533a8397571SBjoern A. Zeeb skb = txstat->skb; 4534383b3e8fSBjoern A. Zeeb if (skb->m != NULL) { 4535383b3e8fSBjoern A. Zeeb struct mbuf *m; 4536383b3e8fSBjoern A. Zeeb 4537383b3e8fSBjoern A. Zeeb m = skb->m; 4538383b3e8fSBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 4539383b3e8fSBjoern A. Zeeb memset(&txs, 0, sizeof(txs)); 4540383b3e8fSBjoern A. Zeeb } else { 4541383b3e8fSBjoern A. Zeeb ni = NULL; 4542383b3e8fSBjoern A. Zeeb } 4543383b3e8fSBjoern A. Zeeb 4544a8397571SBjoern A. Zeeb info = txstat->info; 4545383b3e8fSBjoern A. Zeeb if (info->flags & IEEE80211_TX_STAT_ACK) { 4546383b3e8fSBjoern A. Zeeb status = 0; /* No error. */ 4547383b3e8fSBjoern A. Zeeb txs.status = IEEE80211_RATECTL_TX_SUCCESS; 4548383b3e8fSBjoern A. Zeeb } else { 4549383b3e8fSBjoern A. Zeeb status = 1; 4550383b3e8fSBjoern A. Zeeb txs.status = IEEE80211_RATECTL_TX_FAIL_UNSPECIFIED; 4551383b3e8fSBjoern A. Zeeb } 4552383b3e8fSBjoern A. Zeeb 4553383b3e8fSBjoern A. Zeeb if (ni != NULL) { 4554e2c5ab09SJohn Baldwin int ridx __unused; 4555383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4556383b3e8fSBjoern A. Zeeb int old_rate; 4557383b3e8fSBjoern A. Zeeb 4558383b3e8fSBjoern A. Zeeb old_rate = ni->ni_vap->iv_bss->ni_txrate; 4559383b3e8fSBjoern A. Zeeb #endif 4560383b3e8fSBjoern A. Zeeb txs.pktlen = skb->len; 4561383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_PKTLEN; 4562383b3e8fSBjoern A. Zeeb if (info->status.rates[0].count > 1) { 4563383b3e8fSBjoern A. Zeeb txs.long_retries = info->status.rates[0].count - 1; /* 1 + retries in drivers. */ 4564383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_LONG_RETRY; 4565383b3e8fSBjoern A. Zeeb } 4566383b3e8fSBjoern A. Zeeb #if 0 /* Unused in net80211 currently. */ 4567a8397571SBjoern A. Zeeb /* XXX-BZ convert check .flags for MCS/VHT/.. */ 4568383b3e8fSBjoern A. Zeeb txs.final_rate = info->status.rates[0].idx; 4569383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_FINAL_RATE; 4570383b3e8fSBjoern A. Zeeb #endif 4571adff403fSBjoern A. Zeeb if (info->status.flags & IEEE80211_TX_STATUS_ACK_SIGNAL_VALID) { 4572383b3e8fSBjoern A. Zeeb txs.rssi = info->status.ack_signal; /* XXX-BZ CONVERT? */ 4573383b3e8fSBjoern A. Zeeb txs.flags |= IEEE80211_RATECTL_STATUS_RSSI; 4574383b3e8fSBjoern A. Zeeb } 4575383b3e8fSBjoern A. Zeeb 4576383b3e8fSBjoern A. Zeeb IMPROVE("only update of rate matches but that requires us to get a proper rate"); 4577383b3e8fSBjoern A. Zeeb ieee80211_ratectl_tx_complete(ni, &txs); 4578383b3e8fSBjoern A. Zeeb ridx = ieee80211_ratectl_rate(ni->ni_vap->iv_bss, NULL, 0); 4579383b3e8fSBjoern A. Zeeb 4580383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4581383b3e8fSBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) { 4582383b3e8fSBjoern A. Zeeb printf("TX-RATE: %s: old %d new %d ridx %d, " 4583383b3e8fSBjoern A. Zeeb "long_retries %d\n", __func__, 4584383b3e8fSBjoern A. Zeeb old_rate, ni->ni_vap->iv_bss->ni_txrate, 4585383b3e8fSBjoern A. Zeeb ridx, txs.long_retries); 4586383b3e8fSBjoern A. Zeeb } 4587383b3e8fSBjoern A. Zeeb #endif 4588383b3e8fSBjoern A. Zeeb } 4589383b3e8fSBjoern A. Zeeb 4590383b3e8fSBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 4591383b3e8fSBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE_TX) 4592383b3e8fSBjoern A. Zeeb printf("TX-STATUS: %s: hw %p skb %p status %d : flags %#x " 4593383b3e8fSBjoern A. Zeeb "band %u hw_queue %u tx_time_est %d : " 4594383b3e8fSBjoern A. Zeeb "rates [ %u %u %#x, %u %u %#x, %u %u %#x, %u %u %#x ] " 4595383b3e8fSBjoern A. Zeeb "ack_signal %u ampdu_ack_len %u ampdu_len %u antenna %u " 4596adff403fSBjoern A. Zeeb "tx_time %u flags %#x " 4597383b3e8fSBjoern A. Zeeb "status_driver_data [ %p %p ]\n", 4598383b3e8fSBjoern A. Zeeb __func__, hw, skb, status, info->flags, 4599383b3e8fSBjoern A. Zeeb info->band, info->hw_queue, info->tx_time_est, 4600383b3e8fSBjoern A. Zeeb info->status.rates[0].idx, info->status.rates[0].count, 4601383b3e8fSBjoern A. Zeeb info->status.rates[0].flags, 4602383b3e8fSBjoern A. Zeeb info->status.rates[1].idx, info->status.rates[1].count, 4603383b3e8fSBjoern A. Zeeb info->status.rates[1].flags, 4604383b3e8fSBjoern A. Zeeb info->status.rates[2].idx, info->status.rates[2].count, 4605383b3e8fSBjoern A. Zeeb info->status.rates[2].flags, 4606383b3e8fSBjoern A. Zeeb info->status.rates[3].idx, info->status.rates[3].count, 4607383b3e8fSBjoern A. Zeeb info->status.rates[3].flags, 4608383b3e8fSBjoern A. Zeeb info->status.ack_signal, info->status.ampdu_ack_len, 4609383b3e8fSBjoern A. Zeeb info->status.ampdu_len, info->status.antenna, 4610adff403fSBjoern A. Zeeb info->status.tx_time, info->status.flags, 4611383b3e8fSBjoern A. Zeeb info->status.status_driver_data[0], 4612383b3e8fSBjoern A. Zeeb info->status.status_driver_data[1]); 4613383b3e8fSBjoern A. Zeeb #endif 4614383b3e8fSBjoern A. Zeeb 4615a8397571SBjoern A. Zeeb if (txstat->free_list) { 4616a8397571SBjoern A. Zeeb _lkpi_ieee80211_free_txskb(hw, skb, status); 4617a8397571SBjoern A. Zeeb list_add_tail(&skb->list, txstat->free_list); 4618a8397571SBjoern A. Zeeb } else { 4619383b3e8fSBjoern A. Zeeb linuxkpi_ieee80211_free_txskb(hw, skb, status); 4620383b3e8fSBjoern A. Zeeb } 4621a8397571SBjoern A. Zeeb } 4622a8397571SBjoern A. Zeeb 4623a8397571SBjoern A. Zeeb void 4624a8397571SBjoern A. Zeeb linuxkpi_ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb) 4625a8397571SBjoern A. Zeeb { 4626a8397571SBjoern A. Zeeb struct ieee80211_tx_status status; 4627a8397571SBjoern A. Zeeb 4628a8397571SBjoern A. Zeeb memset(&status, 0, sizeof(status)); 4629a8397571SBjoern A. Zeeb status.info = IEEE80211_SKB_CB(skb); 4630a8397571SBjoern A. Zeeb status.skb = skb; 4631a8397571SBjoern A. Zeeb /* sta, n_rates, rates, free_list? */ 4632a8397571SBjoern A. Zeeb 4633a8397571SBjoern A. Zeeb ieee80211_tx_status_ext(hw, &status); 4634a8397571SBjoern A. Zeeb } 4635383b3e8fSBjoern A. Zeeb 46366b4cac81SBjoern A. Zeeb /* 46376b4cac81SBjoern A. Zeeb * This is an internal bandaid for the moment for the way we glue 46386b4cac81SBjoern A. Zeeb * skbs and mbufs together for TX. Once we have skbs backed by 46396b4cac81SBjoern A. Zeeb * mbufs this should go away. 46406b4cac81SBjoern A. Zeeb * This is a public function but kept on the private KPI (lkpi_) 46416b4cac81SBjoern A. Zeeb * and is not exposed by a header file. 46426b4cac81SBjoern A. Zeeb */ 46436b4cac81SBjoern A. Zeeb static void 46446b4cac81SBjoern A. Zeeb lkpi_ieee80211_free_skb_mbuf(void *p) 46456b4cac81SBjoern A. Zeeb { 46466b4cac81SBjoern A. Zeeb struct ieee80211_node *ni; 46476b4cac81SBjoern A. Zeeb struct mbuf *m; 46486b4cac81SBjoern A. Zeeb 46496b4cac81SBjoern A. Zeeb if (p == NULL) 46506b4cac81SBjoern A. Zeeb return; 46516b4cac81SBjoern A. Zeeb 46526b4cac81SBjoern A. Zeeb m = (struct mbuf *)p; 46536b4cac81SBjoern A. Zeeb M_ASSERTPKTHDR(m); 46546b4cac81SBjoern A. Zeeb 46556b4cac81SBjoern A. Zeeb ni = m->m_pkthdr.PH_loc.ptr; 46566b4cac81SBjoern A. Zeeb m->m_pkthdr.PH_loc.ptr = NULL; 46576b4cac81SBjoern A. Zeeb if (ni != NULL) 46586b4cac81SBjoern A. Zeeb ieee80211_free_node(ni); 46596b4cac81SBjoern A. Zeeb m_freem(m); 46606b4cac81SBjoern A. Zeeb } 46616b4cac81SBjoern A. Zeeb 46626b4cac81SBjoern A. Zeeb void 46636b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_queue_delayed_work(struct ieee80211_hw *hw, 46646b4cac81SBjoern A. Zeeb struct delayed_work *w, int delay) 46656b4cac81SBjoern A. Zeeb { 46666b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 46676b4cac81SBjoern A. Zeeb 46686b4cac81SBjoern A. Zeeb /* Need to make sure hw is in a stable (non-suspended) state. */ 46696b4cac81SBjoern A. Zeeb IMPROVE(); 46706b4cac81SBjoern A. Zeeb 46716b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 46726b4cac81SBjoern A. Zeeb queue_delayed_work(lhw->workq, w, delay); 46736b4cac81SBjoern A. Zeeb } 46746b4cac81SBjoern A. Zeeb 46756b4cac81SBjoern A. Zeeb void 46766b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_queue_work(struct ieee80211_hw *hw, 46776b4cac81SBjoern A. Zeeb struct work_struct *w) 46786b4cac81SBjoern A. Zeeb { 46796b4cac81SBjoern A. Zeeb struct lkpi_hw *lhw; 46806b4cac81SBjoern A. Zeeb 46816b4cac81SBjoern A. Zeeb /* Need to make sure hw is in a stable (non-suspended) state. */ 46826b4cac81SBjoern A. Zeeb IMPROVE(); 46836b4cac81SBjoern A. Zeeb 46846b4cac81SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 46856b4cac81SBjoern A. Zeeb queue_work(lhw->workq, w); 46866b4cac81SBjoern A. Zeeb } 46876b4cac81SBjoern A. Zeeb 46886b4cac81SBjoern A. Zeeb struct sk_buff * 4689ade774b1SBjoern A. Zeeb linuxkpi_ieee80211_probereq_get(struct ieee80211_hw *hw, uint8_t *addr, 4690ade774b1SBjoern A. Zeeb uint8_t *ssid, size_t ssid_len, size_t tailroom) 4691ade774b1SBjoern A. Zeeb { 4692ade774b1SBjoern A. Zeeb struct sk_buff *skb; 4693ade774b1SBjoern A. Zeeb struct ieee80211_frame *wh; 4694ade774b1SBjoern A. Zeeb uint8_t *p; 4695ade774b1SBjoern A. Zeeb size_t len; 4696ade774b1SBjoern A. Zeeb 4697ade774b1SBjoern A. Zeeb len = sizeof(*wh); 4698ade774b1SBjoern A. Zeeb len += 2 + ssid_len; 4699ade774b1SBjoern A. Zeeb 4700ade774b1SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + len + tailroom); 4701ade774b1SBjoern A. Zeeb if (skb == NULL) 4702ade774b1SBjoern A. Zeeb return (NULL); 4703ade774b1SBjoern A. Zeeb 4704ade774b1SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 4705ade774b1SBjoern A. Zeeb 4706ade774b1SBjoern A. Zeeb wh = skb_put_zero(skb, sizeof(*wh)); 4707ade774b1SBjoern A. Zeeb wh->i_fc[0] = IEEE80211_FC0_VERSION_0; 4708ade774b1SBjoern A. Zeeb wh->i_fc[0] |= IEEE80211_FC0_SUBTYPE_PROBE_REQ | IEEE80211_FC0_TYPE_MGT; 4709ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr1, ieee80211broadcastaddr); 4710ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr2, addr); 4711ade774b1SBjoern A. Zeeb IEEE80211_ADDR_COPY(wh->i_addr3, ieee80211broadcastaddr); 4712ade774b1SBjoern A. Zeeb 4713ade774b1SBjoern A. Zeeb p = skb_put(skb, 2 + ssid_len); 4714ade774b1SBjoern A. Zeeb *p++ = IEEE80211_ELEMID_SSID; 4715ade774b1SBjoern A. Zeeb *p++ = ssid_len; 4716ade774b1SBjoern A. Zeeb if (ssid_len > 0) 4717ade774b1SBjoern A. Zeeb memcpy(p, ssid, ssid_len); 4718ade774b1SBjoern A. Zeeb 4719ade774b1SBjoern A. Zeeb return (skb); 4720ade774b1SBjoern A. Zeeb } 4721ade774b1SBjoern A. Zeeb 4722ade774b1SBjoern A. Zeeb struct sk_buff * 47236b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_pspoll_get(struct ieee80211_hw *hw, 47246b4cac81SBjoern A. Zeeb struct ieee80211_vif *vif) 47256b4cac81SBjoern A. Zeeb { 47266b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 47276b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 47286b4cac81SBjoern A. Zeeb struct sk_buff *skb; 47296b4cac81SBjoern A. Zeeb struct ieee80211_frame_pspoll *psp; 47306b4cac81SBjoern A. Zeeb uint16_t v; 47316b4cac81SBjoern A. Zeeb 47326b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + sizeof(*psp)); 47336b4cac81SBjoern A. Zeeb if (skb == NULL) 47346b4cac81SBjoern A. Zeeb return (NULL); 47356b4cac81SBjoern A. Zeeb 47366b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 47376b4cac81SBjoern A. Zeeb 47386b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 47396b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 47406b4cac81SBjoern A. Zeeb 47416b4cac81SBjoern A. Zeeb psp = skb_put_zero(skb, sizeof(*psp)); 47426b4cac81SBjoern A. Zeeb psp->i_fc[0] = IEEE80211_FC0_VERSION_0; 47436b4cac81SBjoern A. Zeeb psp->i_fc[0] |= IEEE80211_FC0_SUBTYPE_PS_POLL | IEEE80211_FC0_TYPE_CTL; 4744616e1330SBjoern A. Zeeb v = htole16(vif->cfg.aid | 1<<15 | 1<<16); 47456b4cac81SBjoern A. Zeeb memcpy(&psp->i_aid, &v, sizeof(v)); 47466b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(psp->i_bssid, vap->iv_bss->ni_macaddr); 47476b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(psp->i_ta, vif->addr); 47486b4cac81SBjoern A. Zeeb 47496b4cac81SBjoern A. Zeeb return (skb); 47506b4cac81SBjoern A. Zeeb } 47516b4cac81SBjoern A. Zeeb 47526b4cac81SBjoern A. Zeeb struct sk_buff * 47536b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_nullfunc_get(struct ieee80211_hw *hw, 4754adff403fSBjoern A. Zeeb struct ieee80211_vif *vif, int linkid, bool qos) 47556b4cac81SBjoern A. Zeeb { 47566b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 47576b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 47586b4cac81SBjoern A. Zeeb struct sk_buff *skb; 47596b4cac81SBjoern A. Zeeb struct ieee80211_frame *nullf; 47606b4cac81SBjoern A. Zeeb 4761adff403fSBjoern A. Zeeb IMPROVE("linkid"); 4762adff403fSBjoern A. Zeeb 47636b4cac81SBjoern A. Zeeb skb = dev_alloc_skb(hw->extra_tx_headroom + sizeof(*nullf)); 47646b4cac81SBjoern A. Zeeb if (skb == NULL) 47656b4cac81SBjoern A. Zeeb return (NULL); 47666b4cac81SBjoern A. Zeeb 47676b4cac81SBjoern A. Zeeb skb_reserve(skb, hw->extra_tx_headroom); 47686b4cac81SBjoern A. Zeeb 47696b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 47706b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 47716b4cac81SBjoern A. Zeeb 47726b4cac81SBjoern A. Zeeb nullf = skb_put_zero(skb, sizeof(*nullf)); 47736b4cac81SBjoern A. Zeeb nullf->i_fc[0] = IEEE80211_FC0_VERSION_0; 47746b4cac81SBjoern A. Zeeb nullf->i_fc[0] |= IEEE80211_FC0_SUBTYPE_NODATA | IEEE80211_FC0_TYPE_DATA; 47756b4cac81SBjoern A. Zeeb nullf->i_fc[1] = IEEE80211_FC1_DIR_TODS; 47766b4cac81SBjoern A. Zeeb 47776b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr1, vap->iv_bss->ni_bssid); 47786b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr2, vif->addr); 47796b4cac81SBjoern A. Zeeb IEEE80211_ADDR_COPY(nullf->i_addr3, vap->iv_bss->ni_macaddr); 47806b4cac81SBjoern A. Zeeb 47816b4cac81SBjoern A. Zeeb return (skb); 47826b4cac81SBjoern A. Zeeb } 47836b4cac81SBjoern A. Zeeb 47846b4cac81SBjoern A. Zeeb struct wireless_dev * 47856b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_vif_to_wdev(struct ieee80211_vif *vif) 47866b4cac81SBjoern A. Zeeb { 47876b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 47886b4cac81SBjoern A. Zeeb 47896b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 47906b4cac81SBjoern A. Zeeb return (&lvif->wdev); 47916b4cac81SBjoern A. Zeeb } 47926b4cac81SBjoern A. Zeeb 47936b4cac81SBjoern A. Zeeb void 47946b4cac81SBjoern A. Zeeb linuxkpi_ieee80211_connection_loss(struct ieee80211_vif *vif) 47956b4cac81SBjoern A. Zeeb { 47966b4cac81SBjoern A. Zeeb struct lkpi_vif *lvif; 47976b4cac81SBjoern A. Zeeb struct ieee80211vap *vap; 47986b4cac81SBjoern A. Zeeb enum ieee80211_state nstate; 47996b4cac81SBjoern A. Zeeb int arg; 48006b4cac81SBjoern A. Zeeb 48016b4cac81SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 48026b4cac81SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 48036b4cac81SBjoern A. Zeeb 48046b4cac81SBjoern A. Zeeb /* 4805f3229b62SBjoern A. Zeeb * Go to init; otherwise we need to elaborately check state and 48066b4cac81SBjoern A. Zeeb * handle accordingly, e.g., if in RUN we could call iv_bmiss. 48076b4cac81SBjoern A. Zeeb * Let the statemachine handle all neccessary changes. 48086b4cac81SBjoern A. Zeeb */ 4809f3229b62SBjoern A. Zeeb nstate = IEEE80211_S_INIT; 4810bb81db90SBjoern A. Zeeb arg = 0; /* Not a valid reason. */ 48116b4cac81SBjoern A. Zeeb 48129d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 48139d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE) 48146b4cac81SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: vif %p\n", __func__, vif); 48159d9ba2b7SBjoern A. Zeeb #endif 48166b4cac81SBjoern A. Zeeb ieee80211_new_state(vap, nstate, arg); 48176b4cac81SBjoern A. Zeeb } 48186b4cac81SBjoern A. Zeeb 4819bb81db90SBjoern A. Zeeb void 4820bb81db90SBjoern A. Zeeb linuxkpi_ieee80211_beacon_loss(struct ieee80211_vif *vif) 4821bb81db90SBjoern A. Zeeb { 4822bb81db90SBjoern A. Zeeb struct lkpi_vif *lvif; 4823bb81db90SBjoern A. Zeeb struct ieee80211vap *vap; 4824bb81db90SBjoern A. Zeeb 4825bb81db90SBjoern A. Zeeb lvif = VIF_TO_LVIF(vif); 4826bb81db90SBjoern A. Zeeb vap = LVIF_TO_VAP(lvif); 4827bb81db90SBjoern A. Zeeb 48289d9ba2b7SBjoern A. Zeeb #ifdef LINUXKPI_DEBUG_80211 48299d9ba2b7SBjoern A. Zeeb if (linuxkpi_debug_80211 & D80211_TRACE || vap->iv_state != IEEE80211_S_RUN) 4830bb81db90SBjoern A. Zeeb ic_printf(vap->iv_ic, "%s: vif %p vap %p state %s\n", __func__, 4831bb81db90SBjoern A. Zeeb vif, vap, ieee80211_state_name[vap->iv_state]); 48329d9ba2b7SBjoern A. Zeeb #endif 48333540911bSBjoern A. Zeeb ieee80211_beacon_miss(vap->iv_ic); 4834bb81db90SBjoern A. Zeeb } 4835bb81db90SBjoern A. Zeeb 48365edde07cSBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 48375edde07cSBjoern A. Zeeb 48385a9a0d78SBjoern A. Zeeb void 48395a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queue(struct ieee80211_hw *hw, int qnum) 48405a9a0d78SBjoern A. Zeeb { 48415a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 48425a9a0d78SBjoern A. Zeeb struct lkpi_vif *lvif; 48435a9a0d78SBjoern A. Zeeb struct ieee80211_vif *vif; 48445a9a0d78SBjoern A. Zeeb int ac_count, ac; 48455a9a0d78SBjoern A. Zeeb 48465a9a0d78SBjoern A. Zeeb KASSERT(qnum < hw->queues, ("%s: qnum %d >= hw->queues %d, hw %p\n", 48475a9a0d78SBjoern A. Zeeb __func__, qnum, hw->queues, hw)); 48485a9a0d78SBjoern A. Zeeb 48495a9a0d78SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 48505a9a0d78SBjoern A. Zeeb 48515a9a0d78SBjoern A. Zeeb /* See lkpi_ic_vap_create(). */ 48525a9a0d78SBjoern A. Zeeb if (hw->queues >= IEEE80211_NUM_ACS) 48535a9a0d78SBjoern A. Zeeb ac_count = IEEE80211_NUM_ACS; 48545a9a0d78SBjoern A. Zeeb else 48555a9a0d78SBjoern A. Zeeb ac_count = 1; 48565a9a0d78SBjoern A. Zeeb 48575a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 48585a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 48595a9a0d78SBjoern A. Zeeb 48605a9a0d78SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 48615a9a0d78SBjoern A. Zeeb for (ac = 0; ac < ac_count; ac++) { 48625a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 48635a9a0d78SBjoern A. Zeeb if (qnum == vif->hw_queue[ac]) { 48645a9a0d78SBjoern A. Zeeb /* 48655a9a0d78SBjoern A. Zeeb * For now log this to better understand 48665a9a0d78SBjoern A. Zeeb * how this is supposed to work. 48675a9a0d78SBjoern A. Zeeb */ 48685a9a0d78SBjoern A. Zeeb if (lvif->hw_queue_stopped[ac]) 48695a9a0d78SBjoern A. Zeeb ic_printf(lhw->ic, "%s:%d: lhw %p hw %p " 48705a9a0d78SBjoern A. Zeeb "lvif %p vif %p ac %d qnum %d already " 48715a9a0d78SBjoern A. Zeeb "stopped\n", __func__, __LINE__, 48725a9a0d78SBjoern A. Zeeb lhw, hw, lvif, vif, ac, qnum); 48735a9a0d78SBjoern A. Zeeb lvif->hw_queue_stopped[ac] = true; 48745a9a0d78SBjoern A. Zeeb } 48755a9a0d78SBjoern A. Zeeb } 48765a9a0d78SBjoern A. Zeeb } 48775a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 48785a9a0d78SBjoern A. Zeeb } 48795a9a0d78SBjoern A. Zeeb 48805a9a0d78SBjoern A. Zeeb void 48815a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queues(struct ieee80211_hw *hw) 48825a9a0d78SBjoern A. Zeeb { 48835a9a0d78SBjoern A. Zeeb int i; 48845a9a0d78SBjoern A. Zeeb 48855a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Locking; do we need further info?"); 48865a9a0d78SBjoern A. Zeeb for (i = 0; i < hw->queues; i++) 48875a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_stop_queue(hw, i); 48885a9a0d78SBjoern A. Zeeb } 48895a9a0d78SBjoern A. Zeeb 48905a9a0d78SBjoern A. Zeeb 48915a9a0d78SBjoern A. Zeeb static void 48925a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(struct ieee80211_hw *hw, int hwq) 48935a9a0d78SBjoern A. Zeeb { 48945a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 48955a9a0d78SBjoern A. Zeeb struct lkpi_vif *lvif; 48965a9a0d78SBjoern A. Zeeb struct lkpi_sta *lsta; 48975a9a0d78SBjoern A. Zeeb int ac_count, ac, tid; 48985a9a0d78SBjoern A. Zeeb 48995a9a0d78SBjoern A. Zeeb /* See lkpi_ic_vap_create(). */ 49005a9a0d78SBjoern A. Zeeb if (hw->queues >= IEEE80211_NUM_ACS) 49015a9a0d78SBjoern A. Zeeb ac_count = IEEE80211_NUM_ACS; 49025a9a0d78SBjoern A. Zeeb else 49035a9a0d78SBjoern A. Zeeb ac_count = 1; 49045a9a0d78SBjoern A. Zeeb 49055a9a0d78SBjoern A. Zeeb lhw = wiphy_priv(hw->wiphy); 49065a9a0d78SBjoern A. Zeeb 49075a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Locking"); 49085a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_LOCK(lhw); 49095a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lvif, &lhw->lvif_head, lvif_entry) { 49105a9a0d78SBjoern A. Zeeb struct ieee80211_vif *vif; 49115a9a0d78SBjoern A. Zeeb 49125a9a0d78SBjoern A. Zeeb vif = LVIF_TO_VIF(lvif); 49135a9a0d78SBjoern A. Zeeb for (ac = 0; ac < ac_count; ac++) { 49145a9a0d78SBjoern A. Zeeb 49155a9a0d78SBjoern A. Zeeb if (hwq == vif->hw_queue[ac]) { 49165a9a0d78SBjoern A. Zeeb 49175a9a0d78SBjoern A. Zeeb /* XXX-BZ what about software scan? */ 49185a9a0d78SBjoern A. Zeeb 49195a9a0d78SBjoern A. Zeeb /* 49205a9a0d78SBjoern A. Zeeb * For now log this to better understand 49215a9a0d78SBjoern A. Zeeb * how this is supposed to work. 49225a9a0d78SBjoern A. Zeeb */ 49235a9a0d78SBjoern A. Zeeb if (!lvif->hw_queue_stopped[ac]) 49245a9a0d78SBjoern A. Zeeb ic_printf(lhw->ic, "%s:%d: lhw %p hw %p " 49255a9a0d78SBjoern A. Zeeb "lvif %p vif %p ac %d hw_q not stopped\n", 49265a9a0d78SBjoern A. Zeeb __func__, __LINE__, 49275a9a0d78SBjoern A. Zeeb lhw, hw, lvif, vif, ac); 49285a9a0d78SBjoern A. Zeeb lvif->hw_queue_stopped[ac] = false; 49295a9a0d78SBjoern A. Zeeb 49305a9a0d78SBjoern A. Zeeb LKPI_80211_LVIF_LOCK(lvif); 49315a9a0d78SBjoern A. Zeeb TAILQ_FOREACH(lsta, &lvif->lsta_head, lsta_entry) { 49325a9a0d78SBjoern A. Zeeb struct ieee80211_sta *sta; 49335a9a0d78SBjoern A. Zeeb 49345a9a0d78SBjoern A. Zeeb sta = LSTA_TO_STA(lsta); 49355a9a0d78SBjoern A. Zeeb for (tid = 0; tid < nitems(sta->txq); tid++) { 49365a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 49375a9a0d78SBjoern A. Zeeb 49385a9a0d78SBjoern A. Zeeb if (sta->txq[tid] == NULL) 49395a9a0d78SBjoern A. Zeeb continue; 49405a9a0d78SBjoern A. Zeeb 49415a9a0d78SBjoern A. Zeeb if (sta->txq[tid]->ac != ac) 49425a9a0d78SBjoern A. Zeeb continue; 49435a9a0d78SBjoern A. Zeeb 49445a9a0d78SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(sta->txq[tid]); 49455a9a0d78SBjoern A. Zeeb if (!ltxq->stopped) 49465a9a0d78SBjoern A. Zeeb continue; 49475a9a0d78SBjoern A. Zeeb 49485a9a0d78SBjoern A. Zeeb ltxq->stopped = false; 49495a9a0d78SBjoern A. Zeeb 49505a9a0d78SBjoern A. Zeeb /* XXX-BZ see when this explodes with all the locking. taskq? */ 49515a9a0d78SBjoern A. Zeeb lkpi_80211_mo_wake_tx_queue(hw, sta->txq[tid]); 49525a9a0d78SBjoern A. Zeeb } 49535a9a0d78SBjoern A. Zeeb } 49545a9a0d78SBjoern A. Zeeb LKPI_80211_LVIF_UNLOCK(lvif); 49555a9a0d78SBjoern A. Zeeb } 49565a9a0d78SBjoern A. Zeeb } 49575a9a0d78SBjoern A. Zeeb } 49585a9a0d78SBjoern A. Zeeb LKPI_80211_LHW_LVIF_UNLOCK(lhw); 49595a9a0d78SBjoern A. Zeeb } 49605a9a0d78SBjoern A. Zeeb 49615a9a0d78SBjoern A. Zeeb void 49625a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_wake_queues(struct ieee80211_hw *hw) 49635a9a0d78SBjoern A. Zeeb { 49645a9a0d78SBjoern A. Zeeb int i; 49655a9a0d78SBjoern A. Zeeb 49665a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Is this all/enough here?"); 49675a9a0d78SBjoern A. Zeeb for (i = 0; i < hw->queues; i++) 49685a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(hw, i); 49695a9a0d78SBjoern A. Zeeb } 49705a9a0d78SBjoern A. Zeeb 49715a9a0d78SBjoern A. Zeeb void 49725a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_wake_queue(struct ieee80211_hw *hw, int qnum) 49735a9a0d78SBjoern A. Zeeb { 49745a9a0d78SBjoern A. Zeeb 49755a9a0d78SBjoern A. Zeeb KASSERT(qnum < hw->queues, ("%s: qnum %d >= hw->queues %d, hw %p\n", 49765a9a0d78SBjoern A. Zeeb __func__, qnum, hw->queues, hw)); 49775a9a0d78SBjoern A. Zeeb 49785a9a0d78SBjoern A. Zeeb lkpi_ieee80211_wake_queues(hw, qnum); 49795a9a0d78SBjoern A. Zeeb } 49805a9a0d78SBjoern A. Zeeb 49815a9a0d78SBjoern A. Zeeb /* This is just hardware queues. */ 49825a9a0d78SBjoern A. Zeeb void 49835a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_txq_schedule_start(struct ieee80211_hw *hw, uint8_t ac) 49845a9a0d78SBjoern A. Zeeb { 49855a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 49865a9a0d78SBjoern A. Zeeb 49875a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 49885a9a0d78SBjoern A. Zeeb 49895a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("Are there reasons why we wouldn't schedule?"); 49905a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 49915a9a0d78SBjoern A. Zeeb if (++lhw->txq_generation[ac] == 0) 49925a9a0d78SBjoern A. Zeeb lhw->txq_generation[ac]++; 49935a9a0d78SBjoern A. Zeeb } 49945a9a0d78SBjoern A. Zeeb 49955a9a0d78SBjoern A. Zeeb struct ieee80211_txq * 49965a9a0d78SBjoern A. Zeeb linuxkpi_ieee80211_next_txq(struct ieee80211_hw *hw, uint8_t ac) 49975a9a0d78SBjoern A. Zeeb { 49985a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 49995a9a0d78SBjoern A. Zeeb struct ieee80211_txq *txq; 50005a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 50015a9a0d78SBjoern A. Zeeb 50025a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 50035a9a0d78SBjoern A. Zeeb txq = NULL; 50045a9a0d78SBjoern A. Zeeb 50055a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 50065a9a0d78SBjoern A. Zeeb 50075a9a0d78SBjoern A. Zeeb /* Check that we are scheduled. */ 50085a9a0d78SBjoern A. Zeeb if (lhw->txq_generation[ac] == 0) 50095a9a0d78SBjoern A. Zeeb goto out; 50105a9a0d78SBjoern A. Zeeb 50115a9a0d78SBjoern A. Zeeb ltxq = TAILQ_FIRST(&lhw->scheduled_txqs[ac]); 50125a9a0d78SBjoern A. Zeeb if (ltxq == NULL) 50135a9a0d78SBjoern A. Zeeb goto out; 50145a9a0d78SBjoern A. Zeeb if (ltxq->txq_generation == lhw->txq_generation[ac]) 50155a9a0d78SBjoern A. Zeeb goto out; 50165a9a0d78SBjoern A. Zeeb 50175a9a0d78SBjoern A. Zeeb ltxq->txq_generation = lhw->txq_generation[ac]; 50185a9a0d78SBjoern A. Zeeb TAILQ_REMOVE(&lhw->scheduled_txqs[ac], ltxq, txq_entry); 50195a9a0d78SBjoern A. Zeeb txq = <xq->txq; 50205a9a0d78SBjoern A. Zeeb TAILQ_ELEM_INIT(ltxq, txq_entry); 50215a9a0d78SBjoern A. Zeeb 50225a9a0d78SBjoern A. Zeeb out: 50235a9a0d78SBjoern A. Zeeb return (txq); 50245a9a0d78SBjoern A. Zeeb } 50255a9a0d78SBjoern A. Zeeb 50265a9a0d78SBjoern A. Zeeb void linuxkpi_ieee80211_schedule_txq(struct ieee80211_hw *hw, 50275a9a0d78SBjoern A. Zeeb struct ieee80211_txq *txq, bool withoutpkts) 50285a9a0d78SBjoern A. Zeeb { 50295a9a0d78SBjoern A. Zeeb struct lkpi_hw *lhw; 50305a9a0d78SBjoern A. Zeeb struct lkpi_txq *ltxq; 50315a9a0d78SBjoern A. Zeeb 50325a9a0d78SBjoern A. Zeeb ltxq = TXQ_TO_LTXQ(txq); 50335a9a0d78SBjoern A. Zeeb 50345a9a0d78SBjoern A. Zeeb IMPROVE_TXQ("LOCKING"); 50355a9a0d78SBjoern A. Zeeb 50365a9a0d78SBjoern A. Zeeb /* Only schedule if work to do or asked to anyway. */ 50375a9a0d78SBjoern A. Zeeb if (!withoutpkts && skb_queue_empty(<xq->skbq)) 50385a9a0d78SBjoern A. Zeeb goto out; 50395a9a0d78SBjoern A. Zeeb 50405a9a0d78SBjoern A. Zeeb /* Make sure we do not double-schedule. */ 50415a9a0d78SBjoern A. Zeeb if (ltxq->txq_entry.tqe_next != NULL) 50425a9a0d78SBjoern A. Zeeb goto out; 50435a9a0d78SBjoern A. Zeeb 50445a9a0d78SBjoern A. Zeeb lhw = HW_TO_LHW(hw); 50455a9a0d78SBjoern A. Zeeb TAILQ_INSERT_TAIL(&lhw->scheduled_txqs[txq->ac], ltxq, txq_entry); 50465a9a0d78SBjoern A. Zeeb out: 50475a9a0d78SBjoern A. Zeeb return; 50485a9a0d78SBjoern A. Zeeb } 50495a9a0d78SBjoern A. Zeeb 50505a9a0d78SBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 50515a9a0d78SBjoern A. Zeeb 50525edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss { 50535edde07cSBjoern A. Zeeb u_int refcnt; 50545edde07cSBjoern A. Zeeb struct cfg80211_bss bss; 50555edde07cSBjoern A. Zeeb }; 50565edde07cSBjoern A. Zeeb 50575edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup { 50585edde07cSBjoern A. Zeeb struct wiphy *wiphy; 50595edde07cSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 50605edde07cSBjoern A. Zeeb const uint8_t *bssid; 50615edde07cSBjoern A. Zeeb const uint8_t *ssid; 50625edde07cSBjoern A. Zeeb size_t ssid_len; 50635edde07cSBjoern A. Zeeb enum ieee80211_bss_type bss_type; 50645edde07cSBjoern A. Zeeb enum ieee80211_privacy privacy; 50655edde07cSBjoern A. Zeeb 50665edde07cSBjoern A. Zeeb /* 50675edde07cSBjoern A. Zeeb * Something to store a copy of the result as the net80211 scan cache 50685edde07cSBjoern A. Zeeb * is not refoucnted so a scan entry might go away any time. 50695edde07cSBjoern A. Zeeb */ 50705edde07cSBjoern A. Zeeb bool match; 50715edde07cSBjoern A. Zeeb struct cfg80211_bss *bss; 50725edde07cSBjoern A. Zeeb }; 50735edde07cSBjoern A. Zeeb 50745edde07cSBjoern A. Zeeb static void 50755edde07cSBjoern A. Zeeb lkpi_cfg80211_get_bss_iterf(void *arg, const struct ieee80211_scan_entry *se) 50765edde07cSBjoern A. Zeeb { 50775edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup *lookup; 50785edde07cSBjoern A. Zeeb size_t ielen; 50795edde07cSBjoern A. Zeeb 50805edde07cSBjoern A. Zeeb lookup = arg; 50815edde07cSBjoern A. Zeeb 50825edde07cSBjoern A. Zeeb /* Do not try to find another match. */ 50835edde07cSBjoern A. Zeeb if (lookup->match) 50845edde07cSBjoern A. Zeeb return; 50855edde07cSBjoern A. Zeeb 50865edde07cSBjoern A. Zeeb /* Nothing to store result. */ 50875edde07cSBjoern A. Zeeb if (lookup->bss == NULL) 50885edde07cSBjoern A. Zeeb return; 50895edde07cSBjoern A. Zeeb 50905edde07cSBjoern A. Zeeb if (lookup->privacy != IEEE80211_PRIVACY_ANY) { 50915edde07cSBjoern A. Zeeb /* if (se->se_capinfo & IEEE80211_CAPINFO_PRIVACY) */ 50925edde07cSBjoern A. Zeeb /* We have no idea what to compare to as the drivers only request ANY */ 50935edde07cSBjoern A. Zeeb return; 50945edde07cSBjoern A. Zeeb } 50955edde07cSBjoern A. Zeeb 50965edde07cSBjoern A. Zeeb if (lookup->bss_type != IEEE80211_BSS_TYPE_ANY) { 50975edde07cSBjoern A. Zeeb /* if (se->se_capinfo & (IEEE80211_CAPINFO_IBSS|IEEE80211_CAPINFO_ESS)) */ 50985edde07cSBjoern A. Zeeb /* We have no idea what to compare to as the drivers only request ANY */ 50995edde07cSBjoern A. Zeeb return; 51005edde07cSBjoern A. Zeeb } 51015edde07cSBjoern A. Zeeb 51025edde07cSBjoern A. Zeeb if (lookup->chan != NULL) { 51035edde07cSBjoern A. Zeeb struct linuxkpi_ieee80211_channel *chan; 51045edde07cSBjoern A. Zeeb 51055edde07cSBjoern A. Zeeb chan = linuxkpi_ieee80211_get_channel(lookup->wiphy, 51065edde07cSBjoern A. Zeeb se->se_chan->ic_freq); 51075edde07cSBjoern A. Zeeb if (chan == NULL || chan != lookup->chan) 51085edde07cSBjoern A. Zeeb return; 51095edde07cSBjoern A. Zeeb } 51105edde07cSBjoern A. Zeeb 51115edde07cSBjoern A. Zeeb if (lookup->bssid && !IEEE80211_ADDR_EQ(lookup->bssid, se->se_bssid)) 51125edde07cSBjoern A. Zeeb return; 51135edde07cSBjoern A. Zeeb 51145edde07cSBjoern A. Zeeb if (lookup->ssid) { 51155edde07cSBjoern A. Zeeb if (lookup->ssid_len != se->se_ssid[1] || 51165edde07cSBjoern A. Zeeb se->se_ssid[1] == 0) 51175edde07cSBjoern A. Zeeb return; 51185edde07cSBjoern A. Zeeb if (memcmp(lookup->ssid, se->se_ssid+2, lookup->ssid_len) != 0) 51195edde07cSBjoern A. Zeeb return; 51205edde07cSBjoern A. Zeeb } 51215edde07cSBjoern A. Zeeb 51225edde07cSBjoern A. Zeeb ielen = se->se_ies.len; 51235edde07cSBjoern A. Zeeb 51245edde07cSBjoern A. Zeeb lookup->bss->ies = malloc(sizeof(*lookup->bss->ies) + ielen, 51255edde07cSBjoern A. Zeeb M_LKPI80211, M_NOWAIT | M_ZERO); 51265edde07cSBjoern A. Zeeb if (lookup->bss->ies == NULL) 51275edde07cSBjoern A. Zeeb return; 51285edde07cSBjoern A. Zeeb 51295edde07cSBjoern A. Zeeb lookup->bss->ies->data = (uint8_t *)lookup->bss->ies + sizeof(*lookup->bss->ies); 51305edde07cSBjoern A. Zeeb lookup->bss->ies->len = ielen; 51315edde07cSBjoern A. Zeeb if (ielen) 51325edde07cSBjoern A. Zeeb memcpy(lookup->bss->ies->data, se->se_ies.data, ielen); 51335edde07cSBjoern A. Zeeb 51345edde07cSBjoern A. Zeeb lookup->match = true; 51355edde07cSBjoern A. Zeeb } 51365edde07cSBjoern A. Zeeb 51375edde07cSBjoern A. Zeeb struct cfg80211_bss * 51385edde07cSBjoern A. Zeeb linuxkpi_cfg80211_get_bss(struct wiphy *wiphy, struct linuxkpi_ieee80211_channel *chan, 51395edde07cSBjoern A. Zeeb const uint8_t *bssid, const uint8_t *ssid, size_t ssid_len, 51405edde07cSBjoern A. Zeeb enum ieee80211_bss_type bss_type, enum ieee80211_privacy privacy) 51415edde07cSBjoern A. Zeeb { 51425edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss *lbss; 51435edde07cSBjoern A. Zeeb struct lkpi_cfg80211_get_bss_iter_lookup lookup; 51445edde07cSBjoern A. Zeeb struct lkpi_hw *lhw; 51455edde07cSBjoern A. Zeeb struct ieee80211vap *vap; 51465edde07cSBjoern A. Zeeb 51475edde07cSBjoern A. Zeeb lhw = wiphy_priv(wiphy); 51485edde07cSBjoern A. Zeeb 51495edde07cSBjoern A. Zeeb /* Let's hope we can alloc. */ 51505edde07cSBjoern A. Zeeb lbss = malloc(sizeof(*lbss), M_LKPI80211, M_NOWAIT | M_ZERO); 51515edde07cSBjoern A. Zeeb if (lbss == NULL) { 51525edde07cSBjoern A. Zeeb ic_printf(lhw->ic, "%s: alloc failed.\n", __func__); 51535edde07cSBjoern A. Zeeb return (NULL); 51545edde07cSBjoern A. Zeeb } 51555edde07cSBjoern A. Zeeb 51565edde07cSBjoern A. Zeeb lookup.wiphy = wiphy; 51575edde07cSBjoern A. Zeeb lookup.chan = chan; 51585edde07cSBjoern A. Zeeb lookup.bssid = bssid; 51595edde07cSBjoern A. Zeeb lookup.ssid = ssid; 51605edde07cSBjoern A. Zeeb lookup.ssid_len = ssid_len; 51615edde07cSBjoern A. Zeeb lookup.bss_type = bss_type; 51625edde07cSBjoern A. Zeeb lookup.privacy = privacy; 51635edde07cSBjoern A. Zeeb lookup.match = false; 51645edde07cSBjoern A. Zeeb lookup.bss = &lbss->bss; 51655edde07cSBjoern A. Zeeb 51665edde07cSBjoern A. Zeeb IMPROVE("Iterate over all VAPs comparing perm_addr and addresses?"); 51675edde07cSBjoern A. Zeeb vap = TAILQ_FIRST(&lhw->ic->ic_vaps); 51685edde07cSBjoern A. Zeeb ieee80211_scan_iterate(vap, lkpi_cfg80211_get_bss_iterf, &lookup); 51695edde07cSBjoern A. Zeeb if (!lookup.match) { 51705edde07cSBjoern A. Zeeb free(lbss, M_LKPI80211); 51715edde07cSBjoern A. Zeeb return (NULL); 51725edde07cSBjoern A. Zeeb } 51735edde07cSBjoern A. Zeeb 51745edde07cSBjoern A. Zeeb refcount_init(&lbss->refcnt, 1); 51755edde07cSBjoern A. Zeeb return (&lbss->bss); 51765edde07cSBjoern A. Zeeb } 51775edde07cSBjoern A. Zeeb 51785edde07cSBjoern A. Zeeb void 51795edde07cSBjoern A. Zeeb linuxkpi_cfg80211_put_bss(struct wiphy *wiphy, struct cfg80211_bss *bss) 51805edde07cSBjoern A. Zeeb { 51815edde07cSBjoern A. Zeeb struct lkpi_cfg80211_bss *lbss; 51825edde07cSBjoern A. Zeeb 51835edde07cSBjoern A. Zeeb lbss = container_of(bss, struct lkpi_cfg80211_bss, bss); 51845edde07cSBjoern A. Zeeb 51855edde07cSBjoern A. Zeeb /* Free everything again on refcount ... */ 51865edde07cSBjoern A. Zeeb if (refcount_release(&lbss->refcnt)) { 51875edde07cSBjoern A. Zeeb free(lbss->bss.ies, M_LKPI80211); 51885edde07cSBjoern A. Zeeb free(lbss, M_LKPI80211); 51895edde07cSBjoern A. Zeeb } 51905edde07cSBjoern A. Zeeb } 51915edde07cSBjoern A. Zeeb 51925edde07cSBjoern A. Zeeb void 51935edde07cSBjoern A. Zeeb linuxkpi_cfg80211_bss_flush(struct wiphy *wiphy) 51945edde07cSBjoern A. Zeeb { 51955edde07cSBjoern A. Zeeb struct lkpi_hw *lhw; 51965edde07cSBjoern A. Zeeb struct ieee80211com *ic; 51975edde07cSBjoern A. Zeeb struct ieee80211vap *vap; 51985edde07cSBjoern A. Zeeb 51995edde07cSBjoern A. Zeeb lhw = wiphy_priv(wiphy); 52005edde07cSBjoern A. Zeeb ic = lhw->ic; 52015edde07cSBjoern A. Zeeb 52025edde07cSBjoern A. Zeeb /* 52035edde07cSBjoern A. Zeeb * If we haven't called ieee80211_ifattach() yet 52045edde07cSBjoern A. Zeeb * or there is no VAP, there are no scans to flush. 52055edde07cSBjoern A. Zeeb */ 52065edde07cSBjoern A. Zeeb if (ic == NULL || 52075edde07cSBjoern A. Zeeb (lhw->sc_flags & LKPI_MAC80211_DRV_STARTED) == 0) 52085edde07cSBjoern A. Zeeb return; 52095edde07cSBjoern A. Zeeb 52105edde07cSBjoern A. Zeeb /* Should only happen on the current one? Not seen it late enough. */ 52115edde07cSBjoern A. Zeeb IEEE80211_LOCK(ic); 52125edde07cSBjoern A. Zeeb TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) 52135edde07cSBjoern A. Zeeb ieee80211_scan_flush(vap); 52145edde07cSBjoern A. Zeeb IEEE80211_UNLOCK(ic); 52155edde07cSBjoern A. Zeeb } 52165edde07cSBjoern A. Zeeb 52175edde07cSBjoern A. Zeeb /* -------------------------------------------------------------------------- */ 52185edde07cSBjoern A. Zeeb 52196b4cac81SBjoern A. Zeeb MODULE_VERSION(linuxkpi_wlan, 1); 52206b4cac81SBjoern A. Zeeb MODULE_DEPEND(linuxkpi_wlan, linuxkpi, 1, 1, 1); 52216b4cac81SBjoern A. Zeeb MODULE_DEPEND(linuxkpi_wlan, wlan, 1, 1, 1); 5222