18c2ecf20Sopenharmony_ci/* 28c2ecf20Sopenharmony_ci * Copyright (c) 2008-2011 Atheros Communications Inc. 38c2ecf20Sopenharmony_ci * 48c2ecf20Sopenharmony_ci * Permission to use, copy, modify, and/or distribute this software for any 58c2ecf20Sopenharmony_ci * purpose with or without fee is hereby granted, provided that the above 68c2ecf20Sopenharmony_ci * copyright notice and this permission notice appear in all copies. 78c2ecf20Sopenharmony_ci * 88c2ecf20Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 98c2ecf20Sopenharmony_ci * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 108c2ecf20Sopenharmony_ci * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 118c2ecf20Sopenharmony_ci * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 128c2ecf20Sopenharmony_ci * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 138c2ecf20Sopenharmony_ci * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 148c2ecf20Sopenharmony_ci * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 158c2ecf20Sopenharmony_ci */ 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci#include <linux/dma-mapping.h> 188c2ecf20Sopenharmony_ci#include "ath9k.h" 198c2ecf20Sopenharmony_ci#include "ar9003_mac.h" 208c2ecf20Sopenharmony_ci 218c2ecf20Sopenharmony_ci#define SKB_CB_ATHBUF(__skb) (*((struct ath_rxbuf **)__skb->cb)) 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_cistatic inline bool ath9k_check_auto_sleep(struct ath_softc *sc) 248c2ecf20Sopenharmony_ci{ 258c2ecf20Sopenharmony_ci return sc->ps_enabled && 268c2ecf20Sopenharmony_ci (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP); 278c2ecf20Sopenharmony_ci} 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_ci/* 308c2ecf20Sopenharmony_ci * Setup and link descriptors. 318c2ecf20Sopenharmony_ci * 328c2ecf20Sopenharmony_ci * 11N: we can no longer afford to self link the last descriptor. 338c2ecf20Sopenharmony_ci * MAC acknowledges BA status as long as it copies frames to host 348c2ecf20Sopenharmony_ci * buffer (or rx fifo). This can incorrectly acknowledge packets 358c2ecf20Sopenharmony_ci * to a sender if last desc is self-linked. 368c2ecf20Sopenharmony_ci */ 378c2ecf20Sopenharmony_cistatic void ath_rx_buf_link(struct ath_softc *sc, struct ath_rxbuf *bf, 388c2ecf20Sopenharmony_ci bool flush) 398c2ecf20Sopenharmony_ci{ 408c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 418c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 428c2ecf20Sopenharmony_ci struct ath_desc *ds; 438c2ecf20Sopenharmony_ci struct sk_buff *skb; 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci ds = bf->bf_desc; 468c2ecf20Sopenharmony_ci ds->ds_link = 0; /* link to null */ 478c2ecf20Sopenharmony_ci ds->ds_data = bf->bf_buf_addr; 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci /* virtual addr of the beginning of the buffer. */ 508c2ecf20Sopenharmony_ci skb = bf->bf_mpdu; 518c2ecf20Sopenharmony_ci BUG_ON(skb == NULL); 528c2ecf20Sopenharmony_ci ds->ds_vdata = skb->data; 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci /* 558c2ecf20Sopenharmony_ci * setup rx descriptors. The rx_bufsize here tells the hardware 568c2ecf20Sopenharmony_ci * how much data it can DMA to us and that we are prepared 578c2ecf20Sopenharmony_ci * to process 588c2ecf20Sopenharmony_ci */ 598c2ecf20Sopenharmony_ci ath9k_hw_setuprxdesc(ah, ds, 608c2ecf20Sopenharmony_ci common->rx_bufsize, 618c2ecf20Sopenharmony_ci 0); 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_ci if (sc->rx.rxlink) 648c2ecf20Sopenharmony_ci *sc->rx.rxlink = bf->bf_daddr; 658c2ecf20Sopenharmony_ci else if (!flush) 668c2ecf20Sopenharmony_ci ath9k_hw_putrxbuf(ah, bf->bf_daddr); 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci sc->rx.rxlink = &ds->ds_link; 698c2ecf20Sopenharmony_ci} 708c2ecf20Sopenharmony_ci 718c2ecf20Sopenharmony_cistatic void ath_rx_buf_relink(struct ath_softc *sc, struct ath_rxbuf *bf, 728c2ecf20Sopenharmony_ci bool flush) 738c2ecf20Sopenharmony_ci{ 748c2ecf20Sopenharmony_ci if (sc->rx.buf_hold) 758c2ecf20Sopenharmony_ci ath_rx_buf_link(sc, sc->rx.buf_hold, flush); 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci sc->rx.buf_hold = bf; 788c2ecf20Sopenharmony_ci} 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_cistatic void ath_setdefantenna(struct ath_softc *sc, u32 antenna) 818c2ecf20Sopenharmony_ci{ 828c2ecf20Sopenharmony_ci /* XXX block beacon interrupts */ 838c2ecf20Sopenharmony_ci ath9k_hw_setantenna(sc->sc_ah, antenna); 848c2ecf20Sopenharmony_ci sc->rx.defant = antenna; 858c2ecf20Sopenharmony_ci sc->rx.rxotherant = 0; 868c2ecf20Sopenharmony_ci} 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_cistatic void ath_opmode_init(struct ath_softc *sc) 898c2ecf20Sopenharmony_ci{ 908c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 918c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci u32 rfilt, mfilt[2]; 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci /* configure rx filter */ 968c2ecf20Sopenharmony_ci rfilt = ath_calcrxfilter(sc); 978c2ecf20Sopenharmony_ci ath9k_hw_setrxfilter(ah, rfilt); 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci /* configure bssid mask */ 1008c2ecf20Sopenharmony_ci ath_hw_setbssidmask(common); 1018c2ecf20Sopenharmony_ci 1028c2ecf20Sopenharmony_ci /* configure operational mode */ 1038c2ecf20Sopenharmony_ci ath9k_hw_setopmode(ah); 1048c2ecf20Sopenharmony_ci 1058c2ecf20Sopenharmony_ci /* calculate and install multicast filter */ 1068c2ecf20Sopenharmony_ci mfilt[0] = mfilt[1] = ~0; 1078c2ecf20Sopenharmony_ci ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]); 1088c2ecf20Sopenharmony_ci} 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_cistatic bool ath_rx_edma_buf_link(struct ath_softc *sc, 1118c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype) 1128c2ecf20Sopenharmony_ci{ 1138c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 1148c2ecf20Sopenharmony_ci struct ath_rx_edma *rx_edma; 1158c2ecf20Sopenharmony_ci struct sk_buff *skb; 1168c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 1178c2ecf20Sopenharmony_ci 1188c2ecf20Sopenharmony_ci rx_edma = &sc->rx.rx_edma[qtype]; 1198c2ecf20Sopenharmony_ci if (skb_queue_len(&rx_edma->rx_fifo) >= rx_edma->rx_fifo_hwsize) 1208c2ecf20Sopenharmony_ci return false; 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci bf = list_first_entry(&sc->rx.rxbuf, struct ath_rxbuf, list); 1238c2ecf20Sopenharmony_ci list_del_init(&bf->list); 1248c2ecf20Sopenharmony_ci 1258c2ecf20Sopenharmony_ci skb = bf->bf_mpdu; 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_ci memset(skb->data, 0, ah->caps.rx_status_len); 1288c2ecf20Sopenharmony_ci dma_sync_single_for_device(sc->dev, bf->bf_buf_addr, 1298c2ecf20Sopenharmony_ci ah->caps.rx_status_len, DMA_TO_DEVICE); 1308c2ecf20Sopenharmony_ci 1318c2ecf20Sopenharmony_ci SKB_CB_ATHBUF(skb) = bf; 1328c2ecf20Sopenharmony_ci ath9k_hw_addrxbuf_edma(ah, bf->bf_buf_addr, qtype); 1338c2ecf20Sopenharmony_ci __skb_queue_tail(&rx_edma->rx_fifo, skb); 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci return true; 1368c2ecf20Sopenharmony_ci} 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_cistatic void ath_rx_addbuffer_edma(struct ath_softc *sc, 1398c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype) 1408c2ecf20Sopenharmony_ci{ 1418c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 1428c2ecf20Sopenharmony_ci struct ath_rxbuf *bf, *tbf; 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_ci if (list_empty(&sc->rx.rxbuf)) { 1458c2ecf20Sopenharmony_ci ath_dbg(common, QUEUE, "No free rx buf available\n"); 1468c2ecf20Sopenharmony_ci return; 1478c2ecf20Sopenharmony_ci } 1488c2ecf20Sopenharmony_ci 1498c2ecf20Sopenharmony_ci list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) 1508c2ecf20Sopenharmony_ci if (!ath_rx_edma_buf_link(sc, qtype)) 1518c2ecf20Sopenharmony_ci break; 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci} 1548c2ecf20Sopenharmony_ci 1558c2ecf20Sopenharmony_cistatic void ath_rx_remove_buffer(struct ath_softc *sc, 1568c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype) 1578c2ecf20Sopenharmony_ci{ 1588c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 1598c2ecf20Sopenharmony_ci struct ath_rx_edma *rx_edma; 1608c2ecf20Sopenharmony_ci struct sk_buff *skb; 1618c2ecf20Sopenharmony_ci 1628c2ecf20Sopenharmony_ci rx_edma = &sc->rx.rx_edma[qtype]; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci while ((skb = __skb_dequeue(&rx_edma->rx_fifo)) != NULL) { 1658c2ecf20Sopenharmony_ci bf = SKB_CB_ATHBUF(skb); 1668c2ecf20Sopenharmony_ci BUG_ON(!bf); 1678c2ecf20Sopenharmony_ci list_add_tail(&bf->list, &sc->rx.rxbuf); 1688c2ecf20Sopenharmony_ci } 1698c2ecf20Sopenharmony_ci} 1708c2ecf20Sopenharmony_ci 1718c2ecf20Sopenharmony_cistatic void ath_rx_edma_cleanup(struct ath_softc *sc) 1728c2ecf20Sopenharmony_ci{ 1738c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 1748c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 1758c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_ci ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_LP); 1788c2ecf20Sopenharmony_ci ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_HP); 1798c2ecf20Sopenharmony_ci 1808c2ecf20Sopenharmony_ci list_for_each_entry(bf, &sc->rx.rxbuf, list) { 1818c2ecf20Sopenharmony_ci if (bf->bf_mpdu) { 1828c2ecf20Sopenharmony_ci dma_unmap_single(sc->dev, bf->bf_buf_addr, 1838c2ecf20Sopenharmony_ci common->rx_bufsize, 1848c2ecf20Sopenharmony_ci DMA_BIDIRECTIONAL); 1858c2ecf20Sopenharmony_ci dev_kfree_skb_any(bf->bf_mpdu); 1868c2ecf20Sopenharmony_ci bf->bf_buf_addr = 0; 1878c2ecf20Sopenharmony_ci bf->bf_mpdu = NULL; 1888c2ecf20Sopenharmony_ci } 1898c2ecf20Sopenharmony_ci } 1908c2ecf20Sopenharmony_ci} 1918c2ecf20Sopenharmony_ci 1928c2ecf20Sopenharmony_cistatic void ath_rx_edma_init_queue(struct ath_rx_edma *rx_edma, int size) 1938c2ecf20Sopenharmony_ci{ 1948c2ecf20Sopenharmony_ci __skb_queue_head_init(&rx_edma->rx_fifo); 1958c2ecf20Sopenharmony_ci rx_edma->rx_fifo_hwsize = size; 1968c2ecf20Sopenharmony_ci} 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_cistatic int ath_rx_edma_init(struct ath_softc *sc, int nbufs) 1998c2ecf20Sopenharmony_ci{ 2008c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 2018c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 2028c2ecf20Sopenharmony_ci struct sk_buff *skb; 2038c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 2048c2ecf20Sopenharmony_ci int error = 0, i; 2058c2ecf20Sopenharmony_ci u32 size; 2068c2ecf20Sopenharmony_ci 2078c2ecf20Sopenharmony_ci ath9k_hw_set_rx_bufsize(ah, common->rx_bufsize - 2088c2ecf20Sopenharmony_ci ah->caps.rx_status_len); 2098c2ecf20Sopenharmony_ci 2108c2ecf20Sopenharmony_ci ath_rx_edma_init_queue(&sc->rx.rx_edma[ATH9K_RX_QUEUE_LP], 2118c2ecf20Sopenharmony_ci ah->caps.rx_lp_qdepth); 2128c2ecf20Sopenharmony_ci ath_rx_edma_init_queue(&sc->rx.rx_edma[ATH9K_RX_QUEUE_HP], 2138c2ecf20Sopenharmony_ci ah->caps.rx_hp_qdepth); 2148c2ecf20Sopenharmony_ci 2158c2ecf20Sopenharmony_ci size = sizeof(struct ath_rxbuf) * nbufs; 2168c2ecf20Sopenharmony_ci bf = devm_kzalloc(sc->dev, size, GFP_KERNEL); 2178c2ecf20Sopenharmony_ci if (!bf) 2188c2ecf20Sopenharmony_ci return -ENOMEM; 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&sc->rx.rxbuf); 2218c2ecf20Sopenharmony_ci 2228c2ecf20Sopenharmony_ci for (i = 0; i < nbufs; i++, bf++) { 2238c2ecf20Sopenharmony_ci skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_KERNEL); 2248c2ecf20Sopenharmony_ci if (!skb) { 2258c2ecf20Sopenharmony_ci error = -ENOMEM; 2268c2ecf20Sopenharmony_ci goto rx_init_fail; 2278c2ecf20Sopenharmony_ci } 2288c2ecf20Sopenharmony_ci 2298c2ecf20Sopenharmony_ci memset(skb->data, 0, common->rx_bufsize); 2308c2ecf20Sopenharmony_ci bf->bf_mpdu = skb; 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_ci bf->bf_buf_addr = dma_map_single(sc->dev, skb->data, 2338c2ecf20Sopenharmony_ci common->rx_bufsize, 2348c2ecf20Sopenharmony_ci DMA_BIDIRECTIONAL); 2358c2ecf20Sopenharmony_ci if (unlikely(dma_mapping_error(sc->dev, 2368c2ecf20Sopenharmony_ci bf->bf_buf_addr))) { 2378c2ecf20Sopenharmony_ci dev_kfree_skb_any(skb); 2388c2ecf20Sopenharmony_ci bf->bf_mpdu = NULL; 2398c2ecf20Sopenharmony_ci bf->bf_buf_addr = 0; 2408c2ecf20Sopenharmony_ci ath_err(common, 2418c2ecf20Sopenharmony_ci "dma_mapping_error() on RX init\n"); 2428c2ecf20Sopenharmony_ci error = -ENOMEM; 2438c2ecf20Sopenharmony_ci goto rx_init_fail; 2448c2ecf20Sopenharmony_ci } 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_ci list_add_tail(&bf->list, &sc->rx.rxbuf); 2478c2ecf20Sopenharmony_ci } 2488c2ecf20Sopenharmony_ci 2498c2ecf20Sopenharmony_ci return 0; 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_cirx_init_fail: 2528c2ecf20Sopenharmony_ci ath_rx_edma_cleanup(sc); 2538c2ecf20Sopenharmony_ci return error; 2548c2ecf20Sopenharmony_ci} 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_cistatic void ath_edma_start_recv(struct ath_softc *sc) 2578c2ecf20Sopenharmony_ci{ 2588c2ecf20Sopenharmony_ci ath9k_hw_rxena(sc->sc_ah); 2598c2ecf20Sopenharmony_ci ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_HP); 2608c2ecf20Sopenharmony_ci ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_LP); 2618c2ecf20Sopenharmony_ci ath_opmode_init(sc); 2628c2ecf20Sopenharmony_ci ath9k_hw_startpcureceive(sc->sc_ah, sc->cur_chan->offchannel); 2638c2ecf20Sopenharmony_ci} 2648c2ecf20Sopenharmony_ci 2658c2ecf20Sopenharmony_cistatic void ath_edma_stop_recv(struct ath_softc *sc) 2668c2ecf20Sopenharmony_ci{ 2678c2ecf20Sopenharmony_ci ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_HP); 2688c2ecf20Sopenharmony_ci ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_LP); 2698c2ecf20Sopenharmony_ci} 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ciint ath_rx_init(struct ath_softc *sc, int nbufs) 2728c2ecf20Sopenharmony_ci{ 2738c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 2748c2ecf20Sopenharmony_ci struct sk_buff *skb; 2758c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 2768c2ecf20Sopenharmony_ci int error = 0; 2778c2ecf20Sopenharmony_ci 2788c2ecf20Sopenharmony_ci spin_lock_init(&sc->sc_pcu_lock); 2798c2ecf20Sopenharmony_ci 2808c2ecf20Sopenharmony_ci common->rx_bufsize = IEEE80211_MAX_MPDU_LEN / 2 + 2818c2ecf20Sopenharmony_ci sc->sc_ah->caps.rx_status_len; 2828c2ecf20Sopenharmony_ci 2838c2ecf20Sopenharmony_ci if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) 2848c2ecf20Sopenharmony_ci return ath_rx_edma_init(sc, nbufs); 2858c2ecf20Sopenharmony_ci 2868c2ecf20Sopenharmony_ci ath_dbg(common, CONFIG, "cachelsz %u rxbufsize %u\n", 2878c2ecf20Sopenharmony_ci common->cachelsz, common->rx_bufsize); 2888c2ecf20Sopenharmony_ci 2898c2ecf20Sopenharmony_ci /* Initialize rx descriptors */ 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_ci error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf, 2928c2ecf20Sopenharmony_ci "rx", nbufs, 1, 0); 2938c2ecf20Sopenharmony_ci if (error != 0) { 2948c2ecf20Sopenharmony_ci ath_err(common, 2958c2ecf20Sopenharmony_ci "failed to allocate rx descriptors: %d\n", 2968c2ecf20Sopenharmony_ci error); 2978c2ecf20Sopenharmony_ci goto err; 2988c2ecf20Sopenharmony_ci } 2998c2ecf20Sopenharmony_ci 3008c2ecf20Sopenharmony_ci list_for_each_entry(bf, &sc->rx.rxbuf, list) { 3018c2ecf20Sopenharmony_ci skb = ath_rxbuf_alloc(common, common->rx_bufsize, 3028c2ecf20Sopenharmony_ci GFP_KERNEL); 3038c2ecf20Sopenharmony_ci if (skb == NULL) { 3048c2ecf20Sopenharmony_ci error = -ENOMEM; 3058c2ecf20Sopenharmony_ci goto err; 3068c2ecf20Sopenharmony_ci } 3078c2ecf20Sopenharmony_ci 3088c2ecf20Sopenharmony_ci bf->bf_mpdu = skb; 3098c2ecf20Sopenharmony_ci bf->bf_buf_addr = dma_map_single(sc->dev, skb->data, 3108c2ecf20Sopenharmony_ci common->rx_bufsize, 3118c2ecf20Sopenharmony_ci DMA_FROM_DEVICE); 3128c2ecf20Sopenharmony_ci if (unlikely(dma_mapping_error(sc->dev, 3138c2ecf20Sopenharmony_ci bf->bf_buf_addr))) { 3148c2ecf20Sopenharmony_ci dev_kfree_skb_any(skb); 3158c2ecf20Sopenharmony_ci bf->bf_mpdu = NULL; 3168c2ecf20Sopenharmony_ci bf->bf_buf_addr = 0; 3178c2ecf20Sopenharmony_ci ath_err(common, 3188c2ecf20Sopenharmony_ci "dma_mapping_error() on RX init\n"); 3198c2ecf20Sopenharmony_ci error = -ENOMEM; 3208c2ecf20Sopenharmony_ci goto err; 3218c2ecf20Sopenharmony_ci } 3228c2ecf20Sopenharmony_ci } 3238c2ecf20Sopenharmony_ci sc->rx.rxlink = NULL; 3248c2ecf20Sopenharmony_cierr: 3258c2ecf20Sopenharmony_ci if (error) 3268c2ecf20Sopenharmony_ci ath_rx_cleanup(sc); 3278c2ecf20Sopenharmony_ci 3288c2ecf20Sopenharmony_ci return error; 3298c2ecf20Sopenharmony_ci} 3308c2ecf20Sopenharmony_ci 3318c2ecf20Sopenharmony_civoid ath_rx_cleanup(struct ath_softc *sc) 3328c2ecf20Sopenharmony_ci{ 3338c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 3348c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 3358c2ecf20Sopenharmony_ci struct sk_buff *skb; 3368c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) { 3398c2ecf20Sopenharmony_ci ath_rx_edma_cleanup(sc); 3408c2ecf20Sopenharmony_ci return; 3418c2ecf20Sopenharmony_ci } 3428c2ecf20Sopenharmony_ci 3438c2ecf20Sopenharmony_ci list_for_each_entry(bf, &sc->rx.rxbuf, list) { 3448c2ecf20Sopenharmony_ci skb = bf->bf_mpdu; 3458c2ecf20Sopenharmony_ci if (skb) { 3468c2ecf20Sopenharmony_ci dma_unmap_single(sc->dev, bf->bf_buf_addr, 3478c2ecf20Sopenharmony_ci common->rx_bufsize, 3488c2ecf20Sopenharmony_ci DMA_FROM_DEVICE); 3498c2ecf20Sopenharmony_ci dev_kfree_skb(skb); 3508c2ecf20Sopenharmony_ci bf->bf_buf_addr = 0; 3518c2ecf20Sopenharmony_ci bf->bf_mpdu = NULL; 3528c2ecf20Sopenharmony_ci } 3538c2ecf20Sopenharmony_ci } 3548c2ecf20Sopenharmony_ci} 3558c2ecf20Sopenharmony_ci 3568c2ecf20Sopenharmony_ci/* 3578c2ecf20Sopenharmony_ci * Calculate the receive filter according to the 3588c2ecf20Sopenharmony_ci * operating mode and state: 3598c2ecf20Sopenharmony_ci * 3608c2ecf20Sopenharmony_ci * o always accept unicast, broadcast, and multicast traffic 3618c2ecf20Sopenharmony_ci * o maintain current state of phy error reception (the hal 3628c2ecf20Sopenharmony_ci * may enable phy error frames for noise immunity work) 3638c2ecf20Sopenharmony_ci * o probe request frames are accepted only when operating in 3648c2ecf20Sopenharmony_ci * hostap, adhoc, or monitor modes 3658c2ecf20Sopenharmony_ci * o enable promiscuous mode according to the interface state 3668c2ecf20Sopenharmony_ci * o accept beacons: 3678c2ecf20Sopenharmony_ci * - when operating in adhoc mode so the 802.11 layer creates 3688c2ecf20Sopenharmony_ci * node table entries for peers, 3698c2ecf20Sopenharmony_ci * - when operating in station mode for collecting rssi data when 3708c2ecf20Sopenharmony_ci * the station is otherwise quiet, or 3718c2ecf20Sopenharmony_ci * - when operating as a repeater so we see repeater-sta beacons 3728c2ecf20Sopenharmony_ci * - when scanning 3738c2ecf20Sopenharmony_ci */ 3748c2ecf20Sopenharmony_ci 3758c2ecf20Sopenharmony_ciu32 ath_calcrxfilter(struct ath_softc *sc) 3768c2ecf20Sopenharmony_ci{ 3778c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 3788c2ecf20Sopenharmony_ci u32 rfilt; 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_ci if (IS_ENABLED(CONFIG_ATH9K_TX99)) 3818c2ecf20Sopenharmony_ci return 0; 3828c2ecf20Sopenharmony_ci 3838c2ecf20Sopenharmony_ci rfilt = ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST 3848c2ecf20Sopenharmony_ci | ATH9K_RX_FILTER_MCAST; 3858c2ecf20Sopenharmony_ci 3868c2ecf20Sopenharmony_ci /* if operating on a DFS channel, enable radar pulse detection */ 3878c2ecf20Sopenharmony_ci if (sc->hw->conf.radar_enabled) 3888c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_PHYRADAR | ATH9K_RX_FILTER_PHYERR; 3898c2ecf20Sopenharmony_ci 3908c2ecf20Sopenharmony_ci spin_lock_bh(&sc->chan_lock); 3918c2ecf20Sopenharmony_ci 3928c2ecf20Sopenharmony_ci if (sc->cur_chan->rxfilter & FIF_PROBE_REQ) 3938c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_PROBEREQ; 3948c2ecf20Sopenharmony_ci 3958c2ecf20Sopenharmony_ci if (sc->sc_ah->is_monitoring) 3968c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_PROM; 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci if ((sc->cur_chan->rxfilter & FIF_CONTROL) || 3998c2ecf20Sopenharmony_ci sc->sc_ah->dynack.enabled) 4008c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_CONTROL; 4018c2ecf20Sopenharmony_ci 4028c2ecf20Sopenharmony_ci if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) && 4038c2ecf20Sopenharmony_ci (sc->cur_chan->nvifs <= 1) && 4048c2ecf20Sopenharmony_ci !(sc->cur_chan->rxfilter & FIF_BCN_PRBRESP_PROMISC)) 4058c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_MYBEACON; 4068c2ecf20Sopenharmony_ci else if (sc->sc_ah->opmode != NL80211_IFTYPE_OCB) 4078c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_BEACON; 4088c2ecf20Sopenharmony_ci 4098c2ecf20Sopenharmony_ci if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) || 4108c2ecf20Sopenharmony_ci (sc->cur_chan->rxfilter & FIF_PSPOLL)) 4118c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_PSPOLL; 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_ci if (sc->cur_chandef.width != NL80211_CHAN_WIDTH_20_NOHT) 4148c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_COMP_BAR; 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_ci if (sc->cur_chan->nvifs > 1 || 4178c2ecf20Sopenharmony_ci (sc->cur_chan->rxfilter & (FIF_OTHER_BSS | FIF_MCAST_ACTION))) { 4188c2ecf20Sopenharmony_ci /* This is needed for older chips */ 4198c2ecf20Sopenharmony_ci if (sc->sc_ah->hw_version.macVersion <= AR_SREV_VERSION_9160) 4208c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_PROM; 4218c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL; 4228c2ecf20Sopenharmony_ci } 4238c2ecf20Sopenharmony_ci 4248c2ecf20Sopenharmony_ci if (AR_SREV_9550(sc->sc_ah) || AR_SREV_9531(sc->sc_ah) || 4258c2ecf20Sopenharmony_ci AR_SREV_9561(sc->sc_ah)) 4268c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_4ADDRESS; 4278c2ecf20Sopenharmony_ci 4288c2ecf20Sopenharmony_ci if (AR_SREV_9462(sc->sc_ah) || AR_SREV_9565(sc->sc_ah)) 4298c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_CONTROL_WRAPPER; 4308c2ecf20Sopenharmony_ci 4318c2ecf20Sopenharmony_ci if (ath9k_is_chanctx_enabled() && 4328c2ecf20Sopenharmony_ci test_bit(ATH_OP_SCANNING, &common->op_flags)) 4338c2ecf20Sopenharmony_ci rfilt |= ATH9K_RX_FILTER_BEACON; 4348c2ecf20Sopenharmony_ci 4358c2ecf20Sopenharmony_ci spin_unlock_bh(&sc->chan_lock); 4368c2ecf20Sopenharmony_ci 4378c2ecf20Sopenharmony_ci return rfilt; 4388c2ecf20Sopenharmony_ci 4398c2ecf20Sopenharmony_ci} 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_civoid ath_startrecv(struct ath_softc *sc) 4428c2ecf20Sopenharmony_ci{ 4438c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 4448c2ecf20Sopenharmony_ci struct ath_rxbuf *bf, *tbf; 4458c2ecf20Sopenharmony_ci 4468c2ecf20Sopenharmony_ci if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) { 4478c2ecf20Sopenharmony_ci ath_edma_start_recv(sc); 4488c2ecf20Sopenharmony_ci return; 4498c2ecf20Sopenharmony_ci } 4508c2ecf20Sopenharmony_ci 4518c2ecf20Sopenharmony_ci if (list_empty(&sc->rx.rxbuf)) 4528c2ecf20Sopenharmony_ci goto start_recv; 4538c2ecf20Sopenharmony_ci 4548c2ecf20Sopenharmony_ci sc->rx.buf_hold = NULL; 4558c2ecf20Sopenharmony_ci sc->rx.rxlink = NULL; 4568c2ecf20Sopenharmony_ci list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) { 4578c2ecf20Sopenharmony_ci ath_rx_buf_link(sc, bf, false); 4588c2ecf20Sopenharmony_ci } 4598c2ecf20Sopenharmony_ci 4608c2ecf20Sopenharmony_ci /* We could have deleted elements so the list may be empty now */ 4618c2ecf20Sopenharmony_ci if (list_empty(&sc->rx.rxbuf)) 4628c2ecf20Sopenharmony_ci goto start_recv; 4638c2ecf20Sopenharmony_ci 4648c2ecf20Sopenharmony_ci bf = list_first_entry(&sc->rx.rxbuf, struct ath_rxbuf, list); 4658c2ecf20Sopenharmony_ci ath9k_hw_putrxbuf(ah, bf->bf_daddr); 4668c2ecf20Sopenharmony_ci ath9k_hw_rxena(ah); 4678c2ecf20Sopenharmony_ci 4688c2ecf20Sopenharmony_cistart_recv: 4698c2ecf20Sopenharmony_ci ath_opmode_init(sc); 4708c2ecf20Sopenharmony_ci ath9k_hw_startpcureceive(ah, sc->cur_chan->offchannel); 4718c2ecf20Sopenharmony_ci} 4728c2ecf20Sopenharmony_ci 4738c2ecf20Sopenharmony_cistatic void ath_flushrecv(struct ath_softc *sc) 4748c2ecf20Sopenharmony_ci{ 4758c2ecf20Sopenharmony_ci if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) 4768c2ecf20Sopenharmony_ci ath_rx_tasklet(sc, 1, true); 4778c2ecf20Sopenharmony_ci ath_rx_tasklet(sc, 1, false); 4788c2ecf20Sopenharmony_ci} 4798c2ecf20Sopenharmony_ci 4808c2ecf20Sopenharmony_cibool ath_stoprecv(struct ath_softc *sc) 4818c2ecf20Sopenharmony_ci{ 4828c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 4838c2ecf20Sopenharmony_ci bool stopped, reset = false; 4848c2ecf20Sopenharmony_ci 4858c2ecf20Sopenharmony_ci ath9k_hw_abortpcurecv(ah); 4868c2ecf20Sopenharmony_ci ath9k_hw_setrxfilter(ah, 0); 4878c2ecf20Sopenharmony_ci stopped = ath9k_hw_stopdmarecv(ah, &reset); 4888c2ecf20Sopenharmony_ci 4898c2ecf20Sopenharmony_ci ath_flushrecv(sc); 4908c2ecf20Sopenharmony_ci 4918c2ecf20Sopenharmony_ci if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) 4928c2ecf20Sopenharmony_ci ath_edma_stop_recv(sc); 4938c2ecf20Sopenharmony_ci else 4948c2ecf20Sopenharmony_ci sc->rx.rxlink = NULL; 4958c2ecf20Sopenharmony_ci 4968c2ecf20Sopenharmony_ci if (!(ah->ah_flags & AH_UNPLUGGED) && 4978c2ecf20Sopenharmony_ci unlikely(!stopped)) { 4988c2ecf20Sopenharmony_ci ath_dbg(ath9k_hw_common(sc->sc_ah), RESET, 4998c2ecf20Sopenharmony_ci "Failed to stop Rx DMA\n"); 5008c2ecf20Sopenharmony_ci RESET_STAT_INC(sc, RESET_RX_DMA_ERROR); 5018c2ecf20Sopenharmony_ci } 5028c2ecf20Sopenharmony_ci return stopped && !reset; 5038c2ecf20Sopenharmony_ci} 5048c2ecf20Sopenharmony_ci 5058c2ecf20Sopenharmony_cistatic bool ath_beacon_dtim_pending_cab(struct sk_buff *skb) 5068c2ecf20Sopenharmony_ci{ 5078c2ecf20Sopenharmony_ci /* Check whether the Beacon frame has DTIM indicating buffered bc/mc */ 5088c2ecf20Sopenharmony_ci struct ieee80211_mgmt *mgmt; 5098c2ecf20Sopenharmony_ci u8 *pos, *end, id, elen; 5108c2ecf20Sopenharmony_ci struct ieee80211_tim_ie *tim; 5118c2ecf20Sopenharmony_ci 5128c2ecf20Sopenharmony_ci mgmt = (struct ieee80211_mgmt *)skb->data; 5138c2ecf20Sopenharmony_ci pos = mgmt->u.beacon.variable; 5148c2ecf20Sopenharmony_ci end = skb->data + skb->len; 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_ci while (pos + 2 < end) { 5178c2ecf20Sopenharmony_ci id = *pos++; 5188c2ecf20Sopenharmony_ci elen = *pos++; 5198c2ecf20Sopenharmony_ci if (pos + elen > end) 5208c2ecf20Sopenharmony_ci break; 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_ci if (id == WLAN_EID_TIM) { 5238c2ecf20Sopenharmony_ci if (elen < sizeof(*tim)) 5248c2ecf20Sopenharmony_ci break; 5258c2ecf20Sopenharmony_ci tim = (struct ieee80211_tim_ie *) pos; 5268c2ecf20Sopenharmony_ci if (tim->dtim_count != 0) 5278c2ecf20Sopenharmony_ci break; 5288c2ecf20Sopenharmony_ci return tim->bitmap_ctrl & 0x01; 5298c2ecf20Sopenharmony_ci } 5308c2ecf20Sopenharmony_ci 5318c2ecf20Sopenharmony_ci pos += elen; 5328c2ecf20Sopenharmony_ci } 5338c2ecf20Sopenharmony_ci 5348c2ecf20Sopenharmony_ci return false; 5358c2ecf20Sopenharmony_ci} 5368c2ecf20Sopenharmony_ci 5378c2ecf20Sopenharmony_cistatic void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb) 5388c2ecf20Sopenharmony_ci{ 5398c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 5408c2ecf20Sopenharmony_ci bool skip_beacon = false; 5418c2ecf20Sopenharmony_ci 5428c2ecf20Sopenharmony_ci if (skb->len < 24 + 8 + 2 + 2) 5438c2ecf20Sopenharmony_ci return; 5448c2ecf20Sopenharmony_ci 5458c2ecf20Sopenharmony_ci sc->ps_flags &= ~PS_WAIT_FOR_BEACON; 5468c2ecf20Sopenharmony_ci 5478c2ecf20Sopenharmony_ci if (sc->ps_flags & PS_BEACON_SYNC) { 5488c2ecf20Sopenharmony_ci sc->ps_flags &= ~PS_BEACON_SYNC; 5498c2ecf20Sopenharmony_ci ath_dbg(common, PS, 5508c2ecf20Sopenharmony_ci "Reconfigure beacon timers based on synchronized timestamp\n"); 5518c2ecf20Sopenharmony_ci 5528c2ecf20Sopenharmony_ci#ifdef CONFIG_ATH9K_CHANNEL_CONTEXT 5538c2ecf20Sopenharmony_ci if (ath9k_is_chanctx_enabled()) { 5548c2ecf20Sopenharmony_ci if (sc->cur_chan == &sc->offchannel.chan) 5558c2ecf20Sopenharmony_ci skip_beacon = true; 5568c2ecf20Sopenharmony_ci } 5578c2ecf20Sopenharmony_ci#endif 5588c2ecf20Sopenharmony_ci 5598c2ecf20Sopenharmony_ci if (!skip_beacon && 5608c2ecf20Sopenharmony_ci !(WARN_ON_ONCE(sc->cur_chan->beacon.beacon_interval == 0))) 5618c2ecf20Sopenharmony_ci ath9k_set_beacon(sc); 5628c2ecf20Sopenharmony_ci 5638c2ecf20Sopenharmony_ci ath9k_p2p_beacon_sync(sc); 5648c2ecf20Sopenharmony_ci } 5658c2ecf20Sopenharmony_ci 5668c2ecf20Sopenharmony_ci if (ath_beacon_dtim_pending_cab(skb)) { 5678c2ecf20Sopenharmony_ci /* 5688c2ecf20Sopenharmony_ci * Remain awake waiting for buffered broadcast/multicast 5698c2ecf20Sopenharmony_ci * frames. If the last broadcast/multicast frame is not 5708c2ecf20Sopenharmony_ci * received properly, the next beacon frame will work as 5718c2ecf20Sopenharmony_ci * a backup trigger for returning into NETWORK SLEEP state, 5728c2ecf20Sopenharmony_ci * so we are waiting for it as well. 5738c2ecf20Sopenharmony_ci */ 5748c2ecf20Sopenharmony_ci ath_dbg(common, PS, 5758c2ecf20Sopenharmony_ci "Received DTIM beacon indicating buffered broadcast/multicast frame(s)\n"); 5768c2ecf20Sopenharmony_ci sc->ps_flags |= PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON; 5778c2ecf20Sopenharmony_ci return; 5788c2ecf20Sopenharmony_ci } 5798c2ecf20Sopenharmony_ci 5808c2ecf20Sopenharmony_ci if (sc->ps_flags & PS_WAIT_FOR_CAB) { 5818c2ecf20Sopenharmony_ci /* 5828c2ecf20Sopenharmony_ci * This can happen if a broadcast frame is dropped or the AP 5838c2ecf20Sopenharmony_ci * fails to send a frame indicating that all CAB frames have 5848c2ecf20Sopenharmony_ci * been delivered. 5858c2ecf20Sopenharmony_ci */ 5868c2ecf20Sopenharmony_ci sc->ps_flags &= ~PS_WAIT_FOR_CAB; 5878c2ecf20Sopenharmony_ci ath_dbg(common, PS, "PS wait for CAB frames timed out\n"); 5888c2ecf20Sopenharmony_ci } 5898c2ecf20Sopenharmony_ci} 5908c2ecf20Sopenharmony_ci 5918c2ecf20Sopenharmony_cistatic void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb, bool mybeacon) 5928c2ecf20Sopenharmony_ci{ 5938c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr; 5948c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(sc->sc_ah); 5958c2ecf20Sopenharmony_ci 5968c2ecf20Sopenharmony_ci hdr = (struct ieee80211_hdr *)skb->data; 5978c2ecf20Sopenharmony_ci 5988c2ecf20Sopenharmony_ci /* Process Beacon and CAB receive in PS state */ 5998c2ecf20Sopenharmony_ci if (((sc->ps_flags & PS_WAIT_FOR_BEACON) || ath9k_check_auto_sleep(sc)) 6008c2ecf20Sopenharmony_ci && mybeacon) { 6018c2ecf20Sopenharmony_ci ath_rx_ps_beacon(sc, skb); 6028c2ecf20Sopenharmony_ci } else if ((sc->ps_flags & PS_WAIT_FOR_CAB) && 6038c2ecf20Sopenharmony_ci (ieee80211_is_data(hdr->frame_control) || 6048c2ecf20Sopenharmony_ci ieee80211_is_action(hdr->frame_control)) && 6058c2ecf20Sopenharmony_ci is_multicast_ether_addr(hdr->addr1) && 6068c2ecf20Sopenharmony_ci !ieee80211_has_moredata(hdr->frame_control)) { 6078c2ecf20Sopenharmony_ci /* 6088c2ecf20Sopenharmony_ci * No more broadcast/multicast frames to be received at this 6098c2ecf20Sopenharmony_ci * point. 6108c2ecf20Sopenharmony_ci */ 6118c2ecf20Sopenharmony_ci sc->ps_flags &= ~(PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON); 6128c2ecf20Sopenharmony_ci ath_dbg(common, PS, 6138c2ecf20Sopenharmony_ci "All PS CAB frames received, back to sleep\n"); 6148c2ecf20Sopenharmony_ci } else if ((sc->ps_flags & PS_WAIT_FOR_PSPOLL_DATA) && 6158c2ecf20Sopenharmony_ci !is_multicast_ether_addr(hdr->addr1) && 6168c2ecf20Sopenharmony_ci !ieee80211_has_morefrags(hdr->frame_control)) { 6178c2ecf20Sopenharmony_ci sc->ps_flags &= ~PS_WAIT_FOR_PSPOLL_DATA; 6188c2ecf20Sopenharmony_ci ath_dbg(common, PS, 6198c2ecf20Sopenharmony_ci "Going back to sleep after having received PS-Poll data (0x%lx)\n", 6208c2ecf20Sopenharmony_ci sc->ps_flags & (PS_WAIT_FOR_BEACON | 6218c2ecf20Sopenharmony_ci PS_WAIT_FOR_CAB | 6228c2ecf20Sopenharmony_ci PS_WAIT_FOR_PSPOLL_DATA | 6238c2ecf20Sopenharmony_ci PS_WAIT_FOR_TX_ACK)); 6248c2ecf20Sopenharmony_ci } 6258c2ecf20Sopenharmony_ci} 6268c2ecf20Sopenharmony_ci 6278c2ecf20Sopenharmony_cistatic bool ath_edma_get_buffers(struct ath_softc *sc, 6288c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype, 6298c2ecf20Sopenharmony_ci struct ath_rx_status *rs, 6308c2ecf20Sopenharmony_ci struct ath_rxbuf **dest) 6318c2ecf20Sopenharmony_ci{ 6328c2ecf20Sopenharmony_ci struct ath_rx_edma *rx_edma = &sc->rx.rx_edma[qtype]; 6338c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 6348c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 6358c2ecf20Sopenharmony_ci struct sk_buff *skb; 6368c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 6378c2ecf20Sopenharmony_ci int ret; 6388c2ecf20Sopenharmony_ci 6398c2ecf20Sopenharmony_ci skb = skb_peek(&rx_edma->rx_fifo); 6408c2ecf20Sopenharmony_ci if (!skb) 6418c2ecf20Sopenharmony_ci return false; 6428c2ecf20Sopenharmony_ci 6438c2ecf20Sopenharmony_ci bf = SKB_CB_ATHBUF(skb); 6448c2ecf20Sopenharmony_ci BUG_ON(!bf); 6458c2ecf20Sopenharmony_ci 6468c2ecf20Sopenharmony_ci dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr, 6478c2ecf20Sopenharmony_ci common->rx_bufsize, DMA_FROM_DEVICE); 6488c2ecf20Sopenharmony_ci 6498c2ecf20Sopenharmony_ci ret = ath9k_hw_process_rxdesc_edma(ah, rs, skb->data); 6508c2ecf20Sopenharmony_ci if (ret == -EINPROGRESS) { 6518c2ecf20Sopenharmony_ci /*let device gain the buffer again*/ 6528c2ecf20Sopenharmony_ci dma_sync_single_for_device(sc->dev, bf->bf_buf_addr, 6538c2ecf20Sopenharmony_ci common->rx_bufsize, DMA_FROM_DEVICE); 6548c2ecf20Sopenharmony_ci return false; 6558c2ecf20Sopenharmony_ci } 6568c2ecf20Sopenharmony_ci 6578c2ecf20Sopenharmony_ci __skb_unlink(skb, &rx_edma->rx_fifo); 6588c2ecf20Sopenharmony_ci if (ret == -EINVAL) { 6598c2ecf20Sopenharmony_ci /* corrupt descriptor, skip this one and the following one */ 6608c2ecf20Sopenharmony_ci list_add_tail(&bf->list, &sc->rx.rxbuf); 6618c2ecf20Sopenharmony_ci ath_rx_edma_buf_link(sc, qtype); 6628c2ecf20Sopenharmony_ci 6638c2ecf20Sopenharmony_ci skb = skb_peek(&rx_edma->rx_fifo); 6648c2ecf20Sopenharmony_ci if (skb) { 6658c2ecf20Sopenharmony_ci bf = SKB_CB_ATHBUF(skb); 6668c2ecf20Sopenharmony_ci BUG_ON(!bf); 6678c2ecf20Sopenharmony_ci 6688c2ecf20Sopenharmony_ci __skb_unlink(skb, &rx_edma->rx_fifo); 6698c2ecf20Sopenharmony_ci list_add_tail(&bf->list, &sc->rx.rxbuf); 6708c2ecf20Sopenharmony_ci ath_rx_edma_buf_link(sc, qtype); 6718c2ecf20Sopenharmony_ci } 6728c2ecf20Sopenharmony_ci 6738c2ecf20Sopenharmony_ci bf = NULL; 6748c2ecf20Sopenharmony_ci } 6758c2ecf20Sopenharmony_ci 6768c2ecf20Sopenharmony_ci *dest = bf; 6778c2ecf20Sopenharmony_ci return true; 6788c2ecf20Sopenharmony_ci} 6798c2ecf20Sopenharmony_ci 6808c2ecf20Sopenharmony_cistatic struct ath_rxbuf *ath_edma_get_next_rx_buf(struct ath_softc *sc, 6818c2ecf20Sopenharmony_ci struct ath_rx_status *rs, 6828c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype) 6838c2ecf20Sopenharmony_ci{ 6848c2ecf20Sopenharmony_ci struct ath_rxbuf *bf = NULL; 6858c2ecf20Sopenharmony_ci 6868c2ecf20Sopenharmony_ci while (ath_edma_get_buffers(sc, qtype, rs, &bf)) { 6878c2ecf20Sopenharmony_ci if (!bf) 6888c2ecf20Sopenharmony_ci continue; 6898c2ecf20Sopenharmony_ci 6908c2ecf20Sopenharmony_ci return bf; 6918c2ecf20Sopenharmony_ci } 6928c2ecf20Sopenharmony_ci return NULL; 6938c2ecf20Sopenharmony_ci} 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_cistatic struct ath_rxbuf *ath_get_next_rx_buf(struct ath_softc *sc, 6968c2ecf20Sopenharmony_ci struct ath_rx_status *rs) 6978c2ecf20Sopenharmony_ci{ 6988c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 6998c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 7008c2ecf20Sopenharmony_ci struct ath_desc *ds; 7018c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 7028c2ecf20Sopenharmony_ci int ret; 7038c2ecf20Sopenharmony_ci 7048c2ecf20Sopenharmony_ci if (list_empty(&sc->rx.rxbuf)) { 7058c2ecf20Sopenharmony_ci sc->rx.rxlink = NULL; 7068c2ecf20Sopenharmony_ci return NULL; 7078c2ecf20Sopenharmony_ci } 7088c2ecf20Sopenharmony_ci 7098c2ecf20Sopenharmony_ci bf = list_first_entry(&sc->rx.rxbuf, struct ath_rxbuf, list); 7108c2ecf20Sopenharmony_ci if (bf == sc->rx.buf_hold) 7118c2ecf20Sopenharmony_ci return NULL; 7128c2ecf20Sopenharmony_ci 7138c2ecf20Sopenharmony_ci ds = bf->bf_desc; 7148c2ecf20Sopenharmony_ci 7158c2ecf20Sopenharmony_ci /* 7168c2ecf20Sopenharmony_ci * Must provide the virtual address of the current 7178c2ecf20Sopenharmony_ci * descriptor, the physical address, and the virtual 7188c2ecf20Sopenharmony_ci * address of the next descriptor in the h/w chain. 7198c2ecf20Sopenharmony_ci * This allows the HAL to look ahead to see if the 7208c2ecf20Sopenharmony_ci * hardware is done with a descriptor by checking the 7218c2ecf20Sopenharmony_ci * done bit in the following descriptor and the address 7228c2ecf20Sopenharmony_ci * of the current descriptor the DMA engine is working 7238c2ecf20Sopenharmony_ci * on. All this is necessary because of our use of 7248c2ecf20Sopenharmony_ci * a self-linked list to avoid rx overruns. 7258c2ecf20Sopenharmony_ci */ 7268c2ecf20Sopenharmony_ci ret = ath9k_hw_rxprocdesc(ah, ds, rs); 7278c2ecf20Sopenharmony_ci if (ret == -EINPROGRESS) { 7288c2ecf20Sopenharmony_ci struct ath_rx_status trs; 7298c2ecf20Sopenharmony_ci struct ath_rxbuf *tbf; 7308c2ecf20Sopenharmony_ci struct ath_desc *tds; 7318c2ecf20Sopenharmony_ci 7328c2ecf20Sopenharmony_ci memset(&trs, 0, sizeof(trs)); 7338c2ecf20Sopenharmony_ci if (list_is_last(&bf->list, &sc->rx.rxbuf)) { 7348c2ecf20Sopenharmony_ci sc->rx.rxlink = NULL; 7358c2ecf20Sopenharmony_ci return NULL; 7368c2ecf20Sopenharmony_ci } 7378c2ecf20Sopenharmony_ci 7388c2ecf20Sopenharmony_ci tbf = list_entry(bf->list.next, struct ath_rxbuf, list); 7398c2ecf20Sopenharmony_ci 7408c2ecf20Sopenharmony_ci /* 7418c2ecf20Sopenharmony_ci * On some hardware the descriptor status words could 7428c2ecf20Sopenharmony_ci * get corrupted, including the done bit. Because of 7438c2ecf20Sopenharmony_ci * this, check if the next descriptor's done bit is 7448c2ecf20Sopenharmony_ci * set or not. 7458c2ecf20Sopenharmony_ci * 7468c2ecf20Sopenharmony_ci * If the next descriptor's done bit is set, the current 7478c2ecf20Sopenharmony_ci * descriptor has been corrupted. Force s/w to discard 7488c2ecf20Sopenharmony_ci * this descriptor and continue... 7498c2ecf20Sopenharmony_ci */ 7508c2ecf20Sopenharmony_ci 7518c2ecf20Sopenharmony_ci tds = tbf->bf_desc; 7528c2ecf20Sopenharmony_ci ret = ath9k_hw_rxprocdesc(ah, tds, &trs); 7538c2ecf20Sopenharmony_ci if (ret == -EINPROGRESS) 7548c2ecf20Sopenharmony_ci return NULL; 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_ci /* 7578c2ecf20Sopenharmony_ci * Re-check previous descriptor, in case it has been filled 7588c2ecf20Sopenharmony_ci * in the mean time. 7598c2ecf20Sopenharmony_ci */ 7608c2ecf20Sopenharmony_ci ret = ath9k_hw_rxprocdesc(ah, ds, rs); 7618c2ecf20Sopenharmony_ci if (ret == -EINPROGRESS) { 7628c2ecf20Sopenharmony_ci /* 7638c2ecf20Sopenharmony_ci * mark descriptor as zero-length and set the 'more' 7648c2ecf20Sopenharmony_ci * flag to ensure that both buffers get discarded 7658c2ecf20Sopenharmony_ci */ 7668c2ecf20Sopenharmony_ci rs->rs_datalen = 0; 7678c2ecf20Sopenharmony_ci rs->rs_more = true; 7688c2ecf20Sopenharmony_ci } 7698c2ecf20Sopenharmony_ci } 7708c2ecf20Sopenharmony_ci 7718c2ecf20Sopenharmony_ci list_del(&bf->list); 7728c2ecf20Sopenharmony_ci if (!bf->bf_mpdu) 7738c2ecf20Sopenharmony_ci return bf; 7748c2ecf20Sopenharmony_ci 7758c2ecf20Sopenharmony_ci /* 7768c2ecf20Sopenharmony_ci * Synchronize the DMA transfer with CPU before 7778c2ecf20Sopenharmony_ci * 1. accessing the frame 7788c2ecf20Sopenharmony_ci * 2. requeueing the same buffer to h/w 7798c2ecf20Sopenharmony_ci */ 7808c2ecf20Sopenharmony_ci dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr, 7818c2ecf20Sopenharmony_ci common->rx_bufsize, 7828c2ecf20Sopenharmony_ci DMA_FROM_DEVICE); 7838c2ecf20Sopenharmony_ci 7848c2ecf20Sopenharmony_ci return bf; 7858c2ecf20Sopenharmony_ci} 7868c2ecf20Sopenharmony_ci 7878c2ecf20Sopenharmony_cistatic void ath9k_process_tsf(struct ath_rx_status *rs, 7888c2ecf20Sopenharmony_ci struct ieee80211_rx_status *rxs, 7898c2ecf20Sopenharmony_ci u64 tsf) 7908c2ecf20Sopenharmony_ci{ 7918c2ecf20Sopenharmony_ci u32 tsf_lower = tsf & 0xffffffff; 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci rxs->mactime = (tsf & ~0xffffffffULL) | rs->rs_tstamp; 7948c2ecf20Sopenharmony_ci if (rs->rs_tstamp > tsf_lower && 7958c2ecf20Sopenharmony_ci unlikely(rs->rs_tstamp - tsf_lower > 0x10000000)) 7968c2ecf20Sopenharmony_ci rxs->mactime -= 0x100000000ULL; 7978c2ecf20Sopenharmony_ci 7988c2ecf20Sopenharmony_ci if (rs->rs_tstamp < tsf_lower && 7998c2ecf20Sopenharmony_ci unlikely(tsf_lower - rs->rs_tstamp > 0x10000000)) 8008c2ecf20Sopenharmony_ci rxs->mactime += 0x100000000ULL; 8018c2ecf20Sopenharmony_ci} 8028c2ecf20Sopenharmony_ci 8038c2ecf20Sopenharmony_ci/* 8048c2ecf20Sopenharmony_ci * For Decrypt or Demic errors, we only mark packet status here and always push 8058c2ecf20Sopenharmony_ci * up the frame up to let mac80211 handle the actual error case, be it no 8068c2ecf20Sopenharmony_ci * decryption key or real decryption error. This let us keep statistics there. 8078c2ecf20Sopenharmony_ci */ 8088c2ecf20Sopenharmony_cistatic int ath9k_rx_skb_preprocess(struct ath_softc *sc, 8098c2ecf20Sopenharmony_ci struct sk_buff *skb, 8108c2ecf20Sopenharmony_ci struct ath_rx_status *rx_stats, 8118c2ecf20Sopenharmony_ci struct ieee80211_rx_status *rx_status, 8128c2ecf20Sopenharmony_ci bool *decrypt_error, u64 tsf) 8138c2ecf20Sopenharmony_ci{ 8148c2ecf20Sopenharmony_ci struct ieee80211_hw *hw = sc->hw; 8158c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 8168c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 8178c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr; 8188c2ecf20Sopenharmony_ci bool discard_current = sc->rx.discard_next; 8198c2ecf20Sopenharmony_ci bool is_phyerr; 8208c2ecf20Sopenharmony_ci 8218c2ecf20Sopenharmony_ci /* 8228c2ecf20Sopenharmony_ci * Discard corrupt descriptors which are marked in 8238c2ecf20Sopenharmony_ci * ath_get_next_rx_buf(). 8248c2ecf20Sopenharmony_ci */ 8258c2ecf20Sopenharmony_ci if (discard_current) 8268c2ecf20Sopenharmony_ci goto corrupt; 8278c2ecf20Sopenharmony_ci 8288c2ecf20Sopenharmony_ci sc->rx.discard_next = false; 8298c2ecf20Sopenharmony_ci 8308c2ecf20Sopenharmony_ci /* 8318c2ecf20Sopenharmony_ci * Discard zero-length packets and packets smaller than an ACK 8328c2ecf20Sopenharmony_ci * which are not PHY_ERROR (short radar pulses have a length of 3) 8338c2ecf20Sopenharmony_ci */ 8348c2ecf20Sopenharmony_ci is_phyerr = rx_stats->rs_status & ATH9K_RXERR_PHY; 8358c2ecf20Sopenharmony_ci if (!rx_stats->rs_datalen || 8368c2ecf20Sopenharmony_ci (rx_stats->rs_datalen < 10 && !is_phyerr)) { 8378c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_len_err); 8388c2ecf20Sopenharmony_ci goto corrupt; 8398c2ecf20Sopenharmony_ci } 8408c2ecf20Sopenharmony_ci 8418c2ecf20Sopenharmony_ci /* 8428c2ecf20Sopenharmony_ci * rs_status follows rs_datalen so if rs_datalen is too large 8438c2ecf20Sopenharmony_ci * we can take a hint that hardware corrupted it, so ignore 8448c2ecf20Sopenharmony_ci * those frames. 8458c2ecf20Sopenharmony_ci */ 8468c2ecf20Sopenharmony_ci if (rx_stats->rs_datalen > (common->rx_bufsize - ah->caps.rx_status_len)) { 8478c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_len_err); 8488c2ecf20Sopenharmony_ci goto corrupt; 8498c2ecf20Sopenharmony_ci } 8508c2ecf20Sopenharmony_ci 8518c2ecf20Sopenharmony_ci /* Only use status info from the last fragment */ 8528c2ecf20Sopenharmony_ci if (rx_stats->rs_more) 8538c2ecf20Sopenharmony_ci return 0; 8548c2ecf20Sopenharmony_ci 8558c2ecf20Sopenharmony_ci /* 8568c2ecf20Sopenharmony_ci * Return immediately if the RX descriptor has been marked 8578c2ecf20Sopenharmony_ci * as corrupt based on the various error bits. 8588c2ecf20Sopenharmony_ci * 8598c2ecf20Sopenharmony_ci * This is different from the other corrupt descriptor 8608c2ecf20Sopenharmony_ci * condition handled above. 8618c2ecf20Sopenharmony_ci */ 8628c2ecf20Sopenharmony_ci if (rx_stats->rs_status & ATH9K_RXERR_CORRUPT_DESC) 8638c2ecf20Sopenharmony_ci goto corrupt; 8648c2ecf20Sopenharmony_ci 8658c2ecf20Sopenharmony_ci hdr = (struct ieee80211_hdr *) (skb->data + ah->caps.rx_status_len); 8668c2ecf20Sopenharmony_ci 8678c2ecf20Sopenharmony_ci ath9k_process_tsf(rx_stats, rx_status, tsf); 8688c2ecf20Sopenharmony_ci ath_debug_stat_rx(sc, rx_stats); 8698c2ecf20Sopenharmony_ci 8708c2ecf20Sopenharmony_ci /* 8718c2ecf20Sopenharmony_ci * Process PHY errors and return so that the packet 8728c2ecf20Sopenharmony_ci * can be dropped. 8738c2ecf20Sopenharmony_ci */ 8748c2ecf20Sopenharmony_ci if (rx_stats->rs_status & ATH9K_RXERR_PHY) { 8758c2ecf20Sopenharmony_ci /* 8768c2ecf20Sopenharmony_ci * DFS and spectral are mutually exclusive 8778c2ecf20Sopenharmony_ci * 8788c2ecf20Sopenharmony_ci * Since some chips use PHYERR_RADAR as indication for both, we 8798c2ecf20Sopenharmony_ci * need to double check which feature is enabled to prevent 8808c2ecf20Sopenharmony_ci * feeding spectral or dfs-detector with wrong frames. 8818c2ecf20Sopenharmony_ci */ 8828c2ecf20Sopenharmony_ci if (hw->conf.radar_enabled) { 8838c2ecf20Sopenharmony_ci ath9k_dfs_process_phyerr(sc, hdr, rx_stats, 8848c2ecf20Sopenharmony_ci rx_status->mactime); 8858c2ecf20Sopenharmony_ci } else if (sc->spec_priv.spectral_mode != SPECTRAL_DISABLED && 8868c2ecf20Sopenharmony_ci ath_cmn_process_fft(&sc->spec_priv, hdr, rx_stats, 8878c2ecf20Sopenharmony_ci rx_status->mactime)) { 8888c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_spectral); 8898c2ecf20Sopenharmony_ci } 8908c2ecf20Sopenharmony_ci return -EINVAL; 8918c2ecf20Sopenharmony_ci } 8928c2ecf20Sopenharmony_ci 8938c2ecf20Sopenharmony_ci /* 8948c2ecf20Sopenharmony_ci * everything but the rate is checked here, the rate check is done 8958c2ecf20Sopenharmony_ci * separately to avoid doing two lookups for a rate for each frame. 8968c2ecf20Sopenharmony_ci */ 8978c2ecf20Sopenharmony_ci spin_lock_bh(&sc->chan_lock); 8988c2ecf20Sopenharmony_ci if (!ath9k_cmn_rx_accept(common, hdr, rx_status, rx_stats, decrypt_error, 8998c2ecf20Sopenharmony_ci sc->cur_chan->rxfilter)) { 9008c2ecf20Sopenharmony_ci spin_unlock_bh(&sc->chan_lock); 9018c2ecf20Sopenharmony_ci return -EINVAL; 9028c2ecf20Sopenharmony_ci } 9038c2ecf20Sopenharmony_ci spin_unlock_bh(&sc->chan_lock); 9048c2ecf20Sopenharmony_ci 9058c2ecf20Sopenharmony_ci if (ath_is_mybeacon(common, hdr)) { 9068c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_beacons); 9078c2ecf20Sopenharmony_ci rx_stats->is_mybeacon = true; 9088c2ecf20Sopenharmony_ci } 9098c2ecf20Sopenharmony_ci 9108c2ecf20Sopenharmony_ci /* 9118c2ecf20Sopenharmony_ci * This shouldn't happen, but have a safety check anyway. 9128c2ecf20Sopenharmony_ci */ 9138c2ecf20Sopenharmony_ci if (WARN_ON(!ah->curchan)) 9148c2ecf20Sopenharmony_ci return -EINVAL; 9158c2ecf20Sopenharmony_ci 9168c2ecf20Sopenharmony_ci if (ath9k_cmn_process_rate(common, hw, rx_stats, rx_status)) { 9178c2ecf20Sopenharmony_ci /* 9188c2ecf20Sopenharmony_ci * No valid hardware bitrate found -- we should not get here 9198c2ecf20Sopenharmony_ci * because hardware has already validated this frame as OK. 9208c2ecf20Sopenharmony_ci */ 9218c2ecf20Sopenharmony_ci ath_dbg(common, ANY, "unsupported hw bitrate detected 0x%02x using 1 Mbit\n", 9228c2ecf20Sopenharmony_ci rx_stats->rs_rate); 9238c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_rate_err); 9248c2ecf20Sopenharmony_ci return -EINVAL; 9258c2ecf20Sopenharmony_ci } 9268c2ecf20Sopenharmony_ci 9278c2ecf20Sopenharmony_ci if (ath9k_is_chanctx_enabled()) { 9288c2ecf20Sopenharmony_ci if (rx_stats->is_mybeacon) 9298c2ecf20Sopenharmony_ci ath_chanctx_beacon_recv_ev(sc, 9308c2ecf20Sopenharmony_ci ATH_CHANCTX_EVENT_BEACON_RECEIVED); 9318c2ecf20Sopenharmony_ci } 9328c2ecf20Sopenharmony_ci 9338c2ecf20Sopenharmony_ci ath9k_cmn_process_rssi(common, hw, rx_stats, rx_status); 9348c2ecf20Sopenharmony_ci 9358c2ecf20Sopenharmony_ci rx_status->band = ah->curchan->chan->band; 9368c2ecf20Sopenharmony_ci rx_status->freq = ah->curchan->chan->center_freq; 9378c2ecf20Sopenharmony_ci rx_status->antenna = rx_stats->rs_antenna; 9388c2ecf20Sopenharmony_ci rx_status->flag |= RX_FLAG_MACTIME_END; 9398c2ecf20Sopenharmony_ci 9408c2ecf20Sopenharmony_ci#ifdef CONFIG_ATH9K_BTCOEX_SUPPORT 9418c2ecf20Sopenharmony_ci if (ieee80211_is_data_present(hdr->frame_control) && 9428c2ecf20Sopenharmony_ci !ieee80211_is_qos_nullfunc(hdr->frame_control)) 9438c2ecf20Sopenharmony_ci sc->rx.num_pkts++; 9448c2ecf20Sopenharmony_ci#endif 9458c2ecf20Sopenharmony_ci 9468c2ecf20Sopenharmony_ci return 0; 9478c2ecf20Sopenharmony_ci 9488c2ecf20Sopenharmony_cicorrupt: 9498c2ecf20Sopenharmony_ci sc->rx.discard_next = rx_stats->rs_more; 9508c2ecf20Sopenharmony_ci return -EINVAL; 9518c2ecf20Sopenharmony_ci} 9528c2ecf20Sopenharmony_ci 9538c2ecf20Sopenharmony_ci/* 9548c2ecf20Sopenharmony_ci * Run the LNA combining algorithm only in these cases: 9558c2ecf20Sopenharmony_ci * 9568c2ecf20Sopenharmony_ci * Standalone WLAN cards with both LNA/Antenna diversity 9578c2ecf20Sopenharmony_ci * enabled in the EEPROM. 9588c2ecf20Sopenharmony_ci * 9598c2ecf20Sopenharmony_ci * WLAN+BT cards which are in the supported card list 9608c2ecf20Sopenharmony_ci * in ath_pci_id_table and the user has loaded the 9618c2ecf20Sopenharmony_ci * driver with "bt_ant_diversity" set to true. 9628c2ecf20Sopenharmony_ci */ 9638c2ecf20Sopenharmony_cistatic void ath9k_antenna_check(struct ath_softc *sc, 9648c2ecf20Sopenharmony_ci struct ath_rx_status *rs) 9658c2ecf20Sopenharmony_ci{ 9668c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 9678c2ecf20Sopenharmony_ci struct ath9k_hw_capabilities *pCap = &ah->caps; 9688c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 9698c2ecf20Sopenharmony_ci 9708c2ecf20Sopenharmony_ci if (!(ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB)) 9718c2ecf20Sopenharmony_ci return; 9728c2ecf20Sopenharmony_ci 9738c2ecf20Sopenharmony_ci /* 9748c2ecf20Sopenharmony_ci * Change the default rx antenna if rx diversity 9758c2ecf20Sopenharmony_ci * chooses the other antenna 3 times in a row. 9768c2ecf20Sopenharmony_ci */ 9778c2ecf20Sopenharmony_ci if (sc->rx.defant != rs->rs_antenna) { 9788c2ecf20Sopenharmony_ci if (++sc->rx.rxotherant >= 3) 9798c2ecf20Sopenharmony_ci ath_setdefantenna(sc, rs->rs_antenna); 9808c2ecf20Sopenharmony_ci } else { 9818c2ecf20Sopenharmony_ci sc->rx.rxotherant = 0; 9828c2ecf20Sopenharmony_ci } 9838c2ecf20Sopenharmony_ci 9848c2ecf20Sopenharmony_ci if (pCap->hw_caps & ATH9K_HW_CAP_BT_ANT_DIV) { 9858c2ecf20Sopenharmony_ci if (common->bt_ant_diversity) 9868c2ecf20Sopenharmony_ci ath_ant_comb_scan(sc, rs); 9878c2ecf20Sopenharmony_ci } else { 9888c2ecf20Sopenharmony_ci ath_ant_comb_scan(sc, rs); 9898c2ecf20Sopenharmony_ci } 9908c2ecf20Sopenharmony_ci} 9918c2ecf20Sopenharmony_ci 9928c2ecf20Sopenharmony_cistatic void ath9k_apply_ampdu_details(struct ath_softc *sc, 9938c2ecf20Sopenharmony_ci struct ath_rx_status *rs, struct ieee80211_rx_status *rxs) 9948c2ecf20Sopenharmony_ci{ 9958c2ecf20Sopenharmony_ci if (rs->rs_isaggr) { 9968c2ecf20Sopenharmony_ci rxs->flag |= RX_FLAG_AMPDU_DETAILS | RX_FLAG_AMPDU_LAST_KNOWN; 9978c2ecf20Sopenharmony_ci 9988c2ecf20Sopenharmony_ci rxs->ampdu_reference = sc->rx.ampdu_ref; 9998c2ecf20Sopenharmony_ci 10008c2ecf20Sopenharmony_ci if (!rs->rs_moreaggr) { 10018c2ecf20Sopenharmony_ci rxs->flag |= RX_FLAG_AMPDU_IS_LAST; 10028c2ecf20Sopenharmony_ci sc->rx.ampdu_ref++; 10038c2ecf20Sopenharmony_ci } 10048c2ecf20Sopenharmony_ci 10058c2ecf20Sopenharmony_ci if (rs->rs_flags & ATH9K_RX_DELIM_CRC_PRE) 10068c2ecf20Sopenharmony_ci rxs->flag |= RX_FLAG_AMPDU_DELIM_CRC_ERROR; 10078c2ecf20Sopenharmony_ci } 10088c2ecf20Sopenharmony_ci} 10098c2ecf20Sopenharmony_ci 10108c2ecf20Sopenharmony_cistatic void ath_rx_count_airtime(struct ath_softc *sc, 10118c2ecf20Sopenharmony_ci struct ath_rx_status *rs, 10128c2ecf20Sopenharmony_ci struct sk_buff *skb) 10138c2ecf20Sopenharmony_ci{ 10148c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; 10158c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 10168c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 10178c2ecf20Sopenharmony_ci struct ieee80211_sta *sta; 10188c2ecf20Sopenharmony_ci struct ieee80211_rx_status *rxs; 10198c2ecf20Sopenharmony_ci const struct ieee80211_rate *rate; 10208c2ecf20Sopenharmony_ci bool is_sgi, is_40, is_sp; 10218c2ecf20Sopenharmony_ci int phy; 10228c2ecf20Sopenharmony_ci u16 len = rs->rs_datalen; 10238c2ecf20Sopenharmony_ci u32 airtime = 0; 10248c2ecf20Sopenharmony_ci u8 tidno; 10258c2ecf20Sopenharmony_ci 10268c2ecf20Sopenharmony_ci if (!ieee80211_is_data(hdr->frame_control)) 10278c2ecf20Sopenharmony_ci return; 10288c2ecf20Sopenharmony_ci 10298c2ecf20Sopenharmony_ci rcu_read_lock(); 10308c2ecf20Sopenharmony_ci 10318c2ecf20Sopenharmony_ci sta = ieee80211_find_sta_by_ifaddr(sc->hw, hdr->addr2, NULL); 10328c2ecf20Sopenharmony_ci if (!sta) 10338c2ecf20Sopenharmony_ci goto exit; 10348c2ecf20Sopenharmony_ci tidno = skb->priority & IEEE80211_QOS_CTL_TID_MASK; 10358c2ecf20Sopenharmony_ci 10368c2ecf20Sopenharmony_ci rxs = IEEE80211_SKB_RXCB(skb); 10378c2ecf20Sopenharmony_ci 10388c2ecf20Sopenharmony_ci is_sgi = !!(rxs->enc_flags & RX_ENC_FLAG_SHORT_GI); 10398c2ecf20Sopenharmony_ci is_40 = !!(rxs->bw == RATE_INFO_BW_40); 10408c2ecf20Sopenharmony_ci is_sp = !!(rxs->enc_flags & RX_ENC_FLAG_SHORTPRE); 10418c2ecf20Sopenharmony_ci 10428c2ecf20Sopenharmony_ci if (!!(rxs->encoding == RX_ENC_HT)) { 10438c2ecf20Sopenharmony_ci /* MCS rates */ 10448c2ecf20Sopenharmony_ci 10458c2ecf20Sopenharmony_ci airtime += ath_pkt_duration(sc, rxs->rate_idx, len, 10468c2ecf20Sopenharmony_ci is_40, is_sgi, is_sp); 10478c2ecf20Sopenharmony_ci } else { 10488c2ecf20Sopenharmony_ci 10498c2ecf20Sopenharmony_ci phy = IS_CCK_RATE(rs->rs_rate) ? WLAN_RC_PHY_CCK : WLAN_RC_PHY_OFDM; 10508c2ecf20Sopenharmony_ci rate = &common->sbands[rxs->band].bitrates[rxs->rate_idx]; 10518c2ecf20Sopenharmony_ci airtime += ath9k_hw_computetxtime(ah, phy, rate->bitrate * 100, 10528c2ecf20Sopenharmony_ci len, rxs->rate_idx, is_sp); 10538c2ecf20Sopenharmony_ci } 10548c2ecf20Sopenharmony_ci 10558c2ecf20Sopenharmony_ci ieee80211_sta_register_airtime(sta, tidno, 0, airtime); 10568c2ecf20Sopenharmony_ciexit: 10578c2ecf20Sopenharmony_ci rcu_read_unlock(); 10588c2ecf20Sopenharmony_ci} 10598c2ecf20Sopenharmony_ci 10608c2ecf20Sopenharmony_ciint ath_rx_tasklet(struct ath_softc *sc, int flush, bool hp) 10618c2ecf20Sopenharmony_ci{ 10628c2ecf20Sopenharmony_ci struct ath_rxbuf *bf; 10638c2ecf20Sopenharmony_ci struct sk_buff *skb = NULL, *requeue_skb, *hdr_skb; 10648c2ecf20Sopenharmony_ci struct ieee80211_rx_status *rxs; 10658c2ecf20Sopenharmony_ci struct ath_hw *ah = sc->sc_ah; 10668c2ecf20Sopenharmony_ci struct ath_common *common = ath9k_hw_common(ah); 10678c2ecf20Sopenharmony_ci struct ieee80211_hw *hw = sc->hw; 10688c2ecf20Sopenharmony_ci int retval; 10698c2ecf20Sopenharmony_ci struct ath_rx_status rs; 10708c2ecf20Sopenharmony_ci enum ath9k_rx_qtype qtype; 10718c2ecf20Sopenharmony_ci bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA); 10728c2ecf20Sopenharmony_ci int dma_type; 10738c2ecf20Sopenharmony_ci u64 tsf = 0; 10748c2ecf20Sopenharmony_ci unsigned long flags; 10758c2ecf20Sopenharmony_ci dma_addr_t new_buf_addr; 10768c2ecf20Sopenharmony_ci unsigned int budget = 512; 10778c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr; 10788c2ecf20Sopenharmony_ci 10798c2ecf20Sopenharmony_ci if (edma) 10808c2ecf20Sopenharmony_ci dma_type = DMA_BIDIRECTIONAL; 10818c2ecf20Sopenharmony_ci else 10828c2ecf20Sopenharmony_ci dma_type = DMA_FROM_DEVICE; 10838c2ecf20Sopenharmony_ci 10848c2ecf20Sopenharmony_ci qtype = hp ? ATH9K_RX_QUEUE_HP : ATH9K_RX_QUEUE_LP; 10858c2ecf20Sopenharmony_ci 10868c2ecf20Sopenharmony_ci tsf = ath9k_hw_gettsf64(ah); 10878c2ecf20Sopenharmony_ci 10888c2ecf20Sopenharmony_ci do { 10898c2ecf20Sopenharmony_ci bool decrypt_error = false; 10908c2ecf20Sopenharmony_ci 10918c2ecf20Sopenharmony_ci memset(&rs, 0, sizeof(rs)); 10928c2ecf20Sopenharmony_ci if (edma) 10938c2ecf20Sopenharmony_ci bf = ath_edma_get_next_rx_buf(sc, &rs, qtype); 10948c2ecf20Sopenharmony_ci else 10958c2ecf20Sopenharmony_ci bf = ath_get_next_rx_buf(sc, &rs); 10968c2ecf20Sopenharmony_ci 10978c2ecf20Sopenharmony_ci if (!bf) 10988c2ecf20Sopenharmony_ci break; 10998c2ecf20Sopenharmony_ci 11008c2ecf20Sopenharmony_ci skb = bf->bf_mpdu; 11018c2ecf20Sopenharmony_ci if (!skb) 11028c2ecf20Sopenharmony_ci continue; 11038c2ecf20Sopenharmony_ci 11048c2ecf20Sopenharmony_ci /* 11058c2ecf20Sopenharmony_ci * Take frame header from the first fragment and RX status from 11068c2ecf20Sopenharmony_ci * the last one. 11078c2ecf20Sopenharmony_ci */ 11088c2ecf20Sopenharmony_ci if (sc->rx.frag) 11098c2ecf20Sopenharmony_ci hdr_skb = sc->rx.frag; 11108c2ecf20Sopenharmony_ci else 11118c2ecf20Sopenharmony_ci hdr_skb = skb; 11128c2ecf20Sopenharmony_ci 11138c2ecf20Sopenharmony_ci rxs = IEEE80211_SKB_RXCB(hdr_skb); 11148c2ecf20Sopenharmony_ci memset(rxs, 0, sizeof(struct ieee80211_rx_status)); 11158c2ecf20Sopenharmony_ci 11168c2ecf20Sopenharmony_ci retval = ath9k_rx_skb_preprocess(sc, hdr_skb, &rs, rxs, 11178c2ecf20Sopenharmony_ci &decrypt_error, tsf); 11188c2ecf20Sopenharmony_ci if (retval) 11198c2ecf20Sopenharmony_ci goto requeue_drop_frag; 11208c2ecf20Sopenharmony_ci 11218c2ecf20Sopenharmony_ci /* Ensure we always have an skb to requeue once we are done 11228c2ecf20Sopenharmony_ci * processing the current buffer's skb */ 11238c2ecf20Sopenharmony_ci requeue_skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_ATOMIC); 11248c2ecf20Sopenharmony_ci 11258c2ecf20Sopenharmony_ci /* If there is no memory we ignore the current RX'd frame, 11268c2ecf20Sopenharmony_ci * tell hardware it can give us a new frame using the old 11278c2ecf20Sopenharmony_ci * skb and put it at the tail of the sc->rx.rxbuf list for 11288c2ecf20Sopenharmony_ci * processing. */ 11298c2ecf20Sopenharmony_ci if (!requeue_skb) { 11308c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_oom_err); 11318c2ecf20Sopenharmony_ci goto requeue_drop_frag; 11328c2ecf20Sopenharmony_ci } 11338c2ecf20Sopenharmony_ci 11348c2ecf20Sopenharmony_ci /* We will now give hardware our shiny new allocated skb */ 11358c2ecf20Sopenharmony_ci new_buf_addr = dma_map_single(sc->dev, requeue_skb->data, 11368c2ecf20Sopenharmony_ci common->rx_bufsize, dma_type); 11378c2ecf20Sopenharmony_ci if (unlikely(dma_mapping_error(sc->dev, new_buf_addr))) { 11388c2ecf20Sopenharmony_ci dev_kfree_skb_any(requeue_skb); 11398c2ecf20Sopenharmony_ci goto requeue_drop_frag; 11408c2ecf20Sopenharmony_ci } 11418c2ecf20Sopenharmony_ci 11428c2ecf20Sopenharmony_ci /* Unmap the frame */ 11438c2ecf20Sopenharmony_ci dma_unmap_single(sc->dev, bf->bf_buf_addr, 11448c2ecf20Sopenharmony_ci common->rx_bufsize, dma_type); 11458c2ecf20Sopenharmony_ci 11468c2ecf20Sopenharmony_ci bf->bf_mpdu = requeue_skb; 11478c2ecf20Sopenharmony_ci bf->bf_buf_addr = new_buf_addr; 11488c2ecf20Sopenharmony_ci 11498c2ecf20Sopenharmony_ci skb_put(skb, rs.rs_datalen + ah->caps.rx_status_len); 11508c2ecf20Sopenharmony_ci if (ah->caps.rx_status_len) 11518c2ecf20Sopenharmony_ci skb_pull(skb, ah->caps.rx_status_len); 11528c2ecf20Sopenharmony_ci 11538c2ecf20Sopenharmony_ci if (!rs.rs_more) 11548c2ecf20Sopenharmony_ci ath9k_cmn_rx_skb_postprocess(common, hdr_skb, &rs, 11558c2ecf20Sopenharmony_ci rxs, decrypt_error); 11568c2ecf20Sopenharmony_ci 11578c2ecf20Sopenharmony_ci if (rs.rs_more) { 11588c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_frags); 11598c2ecf20Sopenharmony_ci /* 11608c2ecf20Sopenharmony_ci * rs_more indicates chained descriptors which can be 11618c2ecf20Sopenharmony_ci * used to link buffers together for a sort of 11628c2ecf20Sopenharmony_ci * scatter-gather operation. 11638c2ecf20Sopenharmony_ci */ 11648c2ecf20Sopenharmony_ci if (sc->rx.frag) { 11658c2ecf20Sopenharmony_ci /* too many fragments - cannot handle frame */ 11668c2ecf20Sopenharmony_ci dev_kfree_skb_any(sc->rx.frag); 11678c2ecf20Sopenharmony_ci dev_kfree_skb_any(skb); 11688c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_too_many_frags_err); 11698c2ecf20Sopenharmony_ci skb = NULL; 11708c2ecf20Sopenharmony_ci } 11718c2ecf20Sopenharmony_ci sc->rx.frag = skb; 11728c2ecf20Sopenharmony_ci goto requeue; 11738c2ecf20Sopenharmony_ci } 11748c2ecf20Sopenharmony_ci 11758c2ecf20Sopenharmony_ci if (sc->rx.frag) { 11768c2ecf20Sopenharmony_ci int space = skb->len - skb_tailroom(hdr_skb); 11778c2ecf20Sopenharmony_ci 11788c2ecf20Sopenharmony_ci if (pskb_expand_head(hdr_skb, 0, space, GFP_ATOMIC) < 0) { 11798c2ecf20Sopenharmony_ci dev_kfree_skb(skb); 11808c2ecf20Sopenharmony_ci RX_STAT_INC(sc, rx_oom_err); 11818c2ecf20Sopenharmony_ci goto requeue_drop_frag; 11828c2ecf20Sopenharmony_ci } 11838c2ecf20Sopenharmony_ci 11848c2ecf20Sopenharmony_ci sc->rx.frag = NULL; 11858c2ecf20Sopenharmony_ci 11868c2ecf20Sopenharmony_ci skb_copy_from_linear_data(skb, skb_put(hdr_skb, skb->len), 11878c2ecf20Sopenharmony_ci skb->len); 11888c2ecf20Sopenharmony_ci dev_kfree_skb_any(skb); 11898c2ecf20Sopenharmony_ci skb = hdr_skb; 11908c2ecf20Sopenharmony_ci } 11918c2ecf20Sopenharmony_ci 11928c2ecf20Sopenharmony_ci if (rxs->flag & RX_FLAG_MMIC_STRIPPED) 11938c2ecf20Sopenharmony_ci skb_trim(skb, skb->len - 8); 11948c2ecf20Sopenharmony_ci 11958c2ecf20Sopenharmony_ci spin_lock_irqsave(&sc->sc_pm_lock, flags); 11968c2ecf20Sopenharmony_ci if ((sc->ps_flags & (PS_WAIT_FOR_BEACON | 11978c2ecf20Sopenharmony_ci PS_WAIT_FOR_CAB | 11988c2ecf20Sopenharmony_ci PS_WAIT_FOR_PSPOLL_DATA)) || 11998c2ecf20Sopenharmony_ci ath9k_check_auto_sleep(sc)) 12008c2ecf20Sopenharmony_ci ath_rx_ps(sc, skb, rs.is_mybeacon); 12018c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&sc->sc_pm_lock, flags); 12028c2ecf20Sopenharmony_ci 12038c2ecf20Sopenharmony_ci ath9k_antenna_check(sc, &rs); 12048c2ecf20Sopenharmony_ci ath9k_apply_ampdu_details(sc, &rs, rxs); 12058c2ecf20Sopenharmony_ci ath_debug_rate_stats(sc, &rs, skb); 12068c2ecf20Sopenharmony_ci ath_rx_count_airtime(sc, &rs, skb); 12078c2ecf20Sopenharmony_ci 12088c2ecf20Sopenharmony_ci hdr = (struct ieee80211_hdr *)skb->data; 12098c2ecf20Sopenharmony_ci if (ieee80211_is_ack(hdr->frame_control)) 12108c2ecf20Sopenharmony_ci ath_dynack_sample_ack_ts(sc->sc_ah, skb, rs.rs_tstamp); 12118c2ecf20Sopenharmony_ci 12128c2ecf20Sopenharmony_ci ieee80211_rx(hw, skb); 12138c2ecf20Sopenharmony_ci 12148c2ecf20Sopenharmony_cirequeue_drop_frag: 12158c2ecf20Sopenharmony_ci if (sc->rx.frag) { 12168c2ecf20Sopenharmony_ci dev_kfree_skb_any(sc->rx.frag); 12178c2ecf20Sopenharmony_ci sc->rx.frag = NULL; 12188c2ecf20Sopenharmony_ci } 12198c2ecf20Sopenharmony_cirequeue: 12208c2ecf20Sopenharmony_ci list_add_tail(&bf->list, &sc->rx.rxbuf); 12218c2ecf20Sopenharmony_ci 12228c2ecf20Sopenharmony_ci if (!edma) { 12238c2ecf20Sopenharmony_ci ath_rx_buf_relink(sc, bf, flush); 12248c2ecf20Sopenharmony_ci if (!flush) 12258c2ecf20Sopenharmony_ci ath9k_hw_rxena(ah); 12268c2ecf20Sopenharmony_ci } else if (!flush) { 12278c2ecf20Sopenharmony_ci ath_rx_edma_buf_link(sc, qtype); 12288c2ecf20Sopenharmony_ci } 12298c2ecf20Sopenharmony_ci 12308c2ecf20Sopenharmony_ci if (!budget--) 12318c2ecf20Sopenharmony_ci break; 12328c2ecf20Sopenharmony_ci } while (1); 12338c2ecf20Sopenharmony_ci 12348c2ecf20Sopenharmony_ci if (!(ah->imask & ATH9K_INT_RXEOL)) { 12358c2ecf20Sopenharmony_ci ah->imask |= (ATH9K_INT_RXEOL | ATH9K_INT_RXORN); 12368c2ecf20Sopenharmony_ci ath9k_hw_set_interrupts(ah); 12378c2ecf20Sopenharmony_ci } 12388c2ecf20Sopenharmony_ci 12398c2ecf20Sopenharmony_ci return 0; 12408c2ecf20Sopenharmony_ci} 1241