htc_drv_txrx.c revision 33a5315f97e5b3964183f0cf74768ac47eabe631
1fb9987d0f748c983bb795a86f47522313f701a08Sujith/* 2fb9987d0f748c983bb795a86f47522313f701a08Sujith * Copyright (c) 2010 Atheros Communications Inc. 3fb9987d0f748c983bb795a86f47522313f701a08Sujith * 4fb9987d0f748c983bb795a86f47522313f701a08Sujith * Permission to use, copy, modify, and/or distribute this software for any 5fb9987d0f748c983bb795a86f47522313f701a08Sujith * purpose with or without fee is hereby granted, provided that the above 6fb9987d0f748c983bb795a86f47522313f701a08Sujith * copyright notice and this permission notice appear in all copies. 7fb9987d0f748c983bb795a86f47522313f701a08Sujith * 8fb9987d0f748c983bb795a86f47522313f701a08Sujith * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9fb9987d0f748c983bb795a86f47522313f701a08Sujith * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10fb9987d0f748c983bb795a86f47522313f701a08Sujith * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11fb9987d0f748c983bb795a86f47522313f701a08Sujith * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12fb9987d0f748c983bb795a86f47522313f701a08Sujith * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13fb9987d0f748c983bb795a86f47522313f701a08Sujith * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14fb9987d0f748c983bb795a86f47522313f701a08Sujith * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 16fb9987d0f748c983bb795a86f47522313f701a08Sujith 17fb9987d0f748c983bb795a86f47522313f701a08Sujith#include "htc.h" 18fb9987d0f748c983bb795a86f47522313f701a08Sujith 19fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 20fb9987d0f748c983bb795a86f47522313f701a08Sujith/* TX */ 21fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 22fb9987d0f748c983bb795a86f47522313f701a08Sujith 23066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkaustatic const int subtype_txq_to_hwq[] = { 24066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau [WME_AC_BE] = ATH_TXQ_AC_BE, 25066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau [WME_AC_BK] = ATH_TXQ_AC_BK, 26066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau [WME_AC_VI] = ATH_TXQ_AC_VI, 27066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau [WME_AC_VO] = ATH_TXQ_AC_VO, 28066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau}; 29066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau 30ca74b83b66dbd289a395c6243695d746c76676ccSujith#define ATH9K_HTC_INIT_TXQ(subtype) do { \ 31066dae93bdfcc7af5e38a33617773fd5c6457607Felix Fietkau qi.tqi_subtype = subtype_txq_to_hwq[subtype]; \ 32ca74b83b66dbd289a395c6243695d746c76676ccSujith qi.tqi_aifs = ATH9K_TXQ_USEDEFAULT; \ 33ca74b83b66dbd289a395c6243695d746c76676ccSujith qi.tqi_cwmin = ATH9K_TXQ_USEDEFAULT; \ 34ca74b83b66dbd289a395c6243695d746c76676ccSujith qi.tqi_cwmax = ATH9K_TXQ_USEDEFAULT; \ 35ca74b83b66dbd289a395c6243695d746c76676ccSujith qi.tqi_physCompBuf = 0; \ 36ca74b83b66dbd289a395c6243695d746c76676ccSujith qi.tqi_qflags = TXQ_FLAG_TXEOLINT_ENABLE | \ 37ca74b83b66dbd289a395c6243695d746c76676ccSujith TXQ_FLAG_TXDESCINT_ENABLE; \ 38ca74b83b66dbd289a395c6243695d746c76676ccSujith } while (0) 39ca74b83b66dbd289a395c6243695d746c76676ccSujith 40fb9987d0f748c983bb795a86f47522313f701a08Sujithint get_hw_qnum(u16 queue, int *hwq_map) 41fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 42fb9987d0f748c983bb795a86f47522313f701a08Sujith switch (queue) { 43fb9987d0f748c983bb795a86f47522313f701a08Sujith case 0: 44e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkau return hwq_map[WME_AC_VO]; 45fb9987d0f748c983bb795a86f47522313f701a08Sujith case 1: 46e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkau return hwq_map[WME_AC_VI]; 47fb9987d0f748c983bb795a86f47522313f701a08Sujith case 2: 48e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkau return hwq_map[WME_AC_BE]; 49fb9987d0f748c983bb795a86f47522313f701a08Sujith case 3: 50e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkau return hwq_map[WME_AC_BK]; 51fb9987d0f748c983bb795a86f47522313f701a08Sujith default: 52e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkau return hwq_map[WME_AC_BE]; 53fb9987d0f748c983bb795a86f47522313f701a08Sujith } 54fb9987d0f748c983bb795a86f47522313f701a08Sujith} 55fb9987d0f748c983bb795a86f47522313f701a08Sujith 568e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharanvoid ath9k_htc_check_stop_queues(struct ath9k_htc_priv *priv) 578e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan{ 588e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 598e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan priv->tx.queued_cnt++; 608e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan if ((priv->tx.queued_cnt >= ATH9K_HTC_TX_THRESHOLD) && 618e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan !(priv->tx.flags & ATH9K_HTC_OP_TX_QUEUES_STOP)) { 628e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan priv->tx.flags |= ATH9K_HTC_OP_TX_QUEUES_STOP; 638e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan ieee80211_stop_queues(priv->hw); 648e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan } 658e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 668e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan} 678e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan 688e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharanvoid ath9k_htc_check_wake_queues(struct ath9k_htc_priv *priv) 698e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan{ 708e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 718e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan if ((priv->tx.queued_cnt < ATH9K_HTC_TX_THRESHOLD) && 728e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan (priv->tx.flags & ATH9K_HTC_OP_TX_QUEUES_STOP)) { 738e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan priv->tx.flags &= ~ATH9K_HTC_OP_TX_QUEUES_STOP; 748e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan ieee80211_wake_queues(priv->hw); 758e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan } 768e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 778e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan} 788e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan 792c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharanint ath9k_htc_tx_get_slot(struct ath9k_htc_priv *priv) 802c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan{ 812c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan int slot; 822c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan 832c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 842c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan slot = find_first_zero_bit(priv->tx.tx_slot, MAX_TX_BUF_NUM); 852c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan if (slot >= MAX_TX_BUF_NUM) { 862c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 872c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan return -ENOBUFS; 882c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan } 892c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan __set_bit(slot, priv->tx.tx_slot); 902c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 912c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan 922c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan return slot; 932c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan} 942c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan 952c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharanvoid ath9k_htc_tx_clear_slot(struct ath9k_htc_priv *priv, int slot) 962c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan{ 972c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 982c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan __clear_bit(slot, priv->tx.tx_slot); 992c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 1002c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan} 1012c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan 10227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanstatic inline enum htc_endpoint_id get_htc_epid(struct ath9k_htc_priv *priv, 10327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan u16 qnum) 104d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan{ 105d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan enum htc_endpoint_id epid; 106d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 107d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan switch (qnum) { 108d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 0: 109d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_VO); 110d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_vo_ep; 111d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 112d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 1: 113d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_VI); 114d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_vi_ep; 115d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 116d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 2: 117d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_BE); 118d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_be_ep; 119d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 120d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 3: 121d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan default: 122d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_BK); 123d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_bk_ep; 124d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 125d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan } 126d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 127d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan return epid; 128d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan} 129d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 13027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanstatic inline struct sk_buff_head* 13127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanget_htc_epid_queue(struct ath9k_htc_priv *priv, u8 epid) 13227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan{ 13327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 13427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff_head *epid_queue = NULL; 13527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 13627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (epid == priv->mgmt_ep) 13727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.mgmt_ep_queue; 13827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else if (epid == priv->cab_ep) 13927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.cab_ep_queue; 14027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else if (epid == priv->data_be_ep) 14127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.data_be_queue; 14227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else if (epid == priv->data_bk_ep) 14327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.data_bk_queue; 14427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else if (epid == priv->data_vi_ep) 14527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.data_vi_queue; 14627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else if (epid == priv->data_vo_ep) 14727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = &priv->tx.data_vo_queue; 14827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan else 14927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath_err(common, "Invalid EPID: %d\n", epid); 15027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 15127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return epid_queue; 15227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan} 15327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 1542c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan/* 1552c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan * Removes the driver header and returns the TX slot number 1562c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan */ 157729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharanstatic inline int strip_drv_header(struct ath9k_htc_priv *priv, 158729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct sk_buff *skb) 159729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan{ 160729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 161729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 1622c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan int slot; 163729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 164729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 165729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 166729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan if (tx_ctl->epid == priv->mgmt_ep) { 1672c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan struct tx_mgmt_hdr *tx_mhdr = 1682c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan (struct tx_mgmt_hdr *)skb->data; 1692c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan slot = tx_mhdr->cookie; 170729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan skb_pull(skb, sizeof(struct tx_mgmt_hdr)); 171729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } else if ((tx_ctl->epid == priv->data_bk_ep) || 172729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_be_ep) || 173729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_vi_ep) || 174729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_vo_ep) || 175729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->cab_ep)) { 1762c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan struct tx_frame_hdr *tx_fhdr = 1772c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan (struct tx_frame_hdr *)skb->data; 1782c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan slot = tx_fhdr->cookie; 179729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan skb_pull(skb, sizeof(struct tx_frame_hdr)); 180729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } else { 181729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan ath_err(common, "Unsupported EPID: %d\n", tx_ctl->epid); 1822c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan slot = -EINVAL; 183729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } 184729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 1852c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan return slot; 186729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan} 187729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 188e1572c5eeca8ef87a250322364584458b2dadb35Sujithint ath_htc_txq_update(struct ath9k_htc_priv *priv, int qnum, 189e1572c5eeca8ef87a250322364584458b2dadb35Sujith struct ath9k_tx_queue_info *qinfo) 190fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 191fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 192fb9987d0f748c983bb795a86f47522313f701a08Sujith int error = 0; 193fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_tx_queue_info qi; 194fb9987d0f748c983bb795a86f47522313f701a08Sujith 195fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_get_txq_props(ah, qnum, &qi); 196fb9987d0f748c983bb795a86f47522313f701a08Sujith 197fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_aifs = qinfo->tqi_aifs; 198fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_cwmin = qinfo->tqi_cwmin / 2; /* XXX */ 199fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_cwmax = qinfo->tqi_cwmax; 200fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_burstTime = qinfo->tqi_burstTime; 201fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_readyTime = qinfo->tqi_readyTime; 202fb9987d0f748c983bb795a86f47522313f701a08Sujith 203fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!ath9k_hw_set_txq_props(ah, qnum, &qi)) { 2043800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(ath9k_hw_common(ah), 2053800276a40751539a920ef8e0537ef2e19126799Joe Perches "Unable to update hardware queue %u!\n", qnum); 206fb9987d0f748c983bb795a86f47522313f701a08Sujith error = -EIO; 207fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 208fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_resettxqueue(ah, qnum); 209fb9987d0f748c983bb795a86f47522313f701a08Sujith } 210fb9987d0f748c983bb795a86f47522313f701a08Sujith 211fb9987d0f748c983bb795a86f47522313f701a08Sujith return error; 212fb9987d0f748c983bb795a86f47522313f701a08Sujith} 213fb9987d0f748c983bb795a86f47522313f701a08Sujith 214821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharanstatic void ath9k_htc_tx_mgmt(struct ath9k_htc_priv *priv, 215821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ath9k_htc_vif *avp, 216821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct sk_buff *skb, 217821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u8 sta_idx, u8 vif_idx, u8 slot) 218821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan{ 219821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); 220821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_mgmt *mgmt; 221821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_hdr *hdr; 222821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct tx_mgmt_hdr mgmt_hdr; 223821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 224821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u8 *tx_fhdr; 225821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 226821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 227821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan hdr = (struct ieee80211_hdr *) skb->data; 228821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 229821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memset(tx_ctl, 0, sizeof(*tx_ctl)); 230821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memset(&mgmt_hdr, 0, sizeof(struct tx_mgmt_hdr)); 231821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 232821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan /* 233821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * Set the TSF adjust value for probe response 234821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * frame also. 235821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan */ 236821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (avp && unlikely(ieee80211_is_probe_resp(hdr->frame_control))) { 237821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt = (struct ieee80211_mgmt *)skb->data; 238821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt->u.probe_resp.timestamp = avp->tsfadjust; 239821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan } 240821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 241821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->type = ATH9K_HTC_MGMT; 242821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 243821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.node_idx = sta_idx; 244821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.vif_idx = vif_idx; 245821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.tidno = 0; 246821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.flags = 0; 247821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.cookie = slot; 248821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 249821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.key_type = ath9k_cmn_get_hw_crypto_keytype(skb); 250821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (mgmt_hdr.key_type == ATH9K_KEY_TYPE_CLEAR) 251821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.keyix = (u8) ATH9K_TXKEYIX_INVALID; 252821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan else 253821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan mgmt_hdr.keyix = tx_info->control.hw_key->hw_key_idx; 254821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 255821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_fhdr = skb_push(skb, sizeof(mgmt_hdr)); 256821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memcpy(tx_fhdr, (u8 *) &mgmt_hdr, sizeof(mgmt_hdr)); 257821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->epid = priv->mgmt_ep; 258821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan} 259821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 260821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharanstatic void ath9k_htc_tx_data(struct ath9k_htc_priv *priv, 261821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_vif *vif, 262821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct sk_buff *skb, 263821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u8 sta_idx, u8 vif_idx, u8 slot, 264821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan bool is_cab) 265821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan{ 266821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); 267821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ieee80211_hdr *hdr; 268821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 269821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan struct tx_frame_hdr tx_hdr; 270821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u32 flags = 0; 271821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u8 *qc, *tx_fhdr; 272821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan u16 qnum; 273821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 274821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 275821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan hdr = (struct ieee80211_hdr *) skb->data; 276821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 277821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memset(tx_ctl, 0, sizeof(*tx_ctl)); 278821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memset(&tx_hdr, 0, sizeof(struct tx_frame_hdr)); 279821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 280821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.node_idx = sta_idx; 281821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.vif_idx = vif_idx; 282821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.cookie = slot; 283821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 284821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan /* 285821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * This is a bit redundant but it helps to get 286821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * the per-packet index quickly when draining the 287821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * TX queue in the HIF layer. Otherwise we would 288821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan * have to parse the packet contents ... 289821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan */ 290821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->sta_idx = sta_idx; 291821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 292821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (tx_info->flags & IEEE80211_TX_CTL_AMPDU) { 293821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->type = ATH9K_HTC_AMPDU; 294821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.data_type = ATH9K_HTC_AMPDU; 295821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan } else { 296821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->type = ATH9K_HTC_NORMAL; 297821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.data_type = ATH9K_HTC_NORMAL; 298821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan } 299821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 300821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (ieee80211_is_data_qos(hdr->frame_control)) { 301821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan qc = ieee80211_get_qos_ctl(hdr); 302821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.tidno = qc[0] & IEEE80211_QOS_CTL_TID_MASK; 303821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan } 304821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 305821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan /* Check for RTS protection */ 306821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (priv->hw->wiphy->rts_threshold != (u32) -1) 307821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (skb->len > priv->hw->wiphy->rts_threshold) 308821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan flags |= ATH9K_HTC_TX_RTSCTS; 309821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 310821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan /* CTS-to-self */ 311821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (!(flags & ATH9K_HTC_TX_RTSCTS) && 312821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan (vif && vif->bss_conf.use_cts_prot)) 313821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan flags |= ATH9K_HTC_TX_CTSONLY; 314821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 315821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.flags = cpu_to_be32(flags); 316821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.key_type = ath9k_cmn_get_hw_crypto_keytype(skb); 317821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (tx_hdr.key_type == ATH9K_KEY_TYPE_CLEAR) 318821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.keyix = (u8) ATH9K_TXKEYIX_INVALID; 319821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan else 320821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_hdr.keyix = tx_info->control.hw_key->hw_key_idx; 321821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 322821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_fhdr = skb_push(skb, sizeof(tx_hdr)); 323821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan memcpy(tx_fhdr, (u8 *) &tx_hdr, sizeof(tx_hdr)); 324821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 325821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (is_cab) { 326821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan CAB_STAT_INC; 327821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->epid = priv->cab_ep; 328821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan return; 329821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan } 330821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 331821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan qnum = skb_get_queue_mapping(skb); 332821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan tx_ctl->epid = get_htc_epid(priv, qnum); 333821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan} 334821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan 3357d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharanint ath9k_htc_tx_start(struct ath9k_htc_priv *priv, 3362c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan struct sk_buff *skb, 3372c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan u8 slot, bool is_cab) 338fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 339fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 340fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); 341fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_sta *sta = tx_info->control.sta; 342a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan struct ieee80211_vif *vif = tx_info->control.vif; 343fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_sta *ista; 3449b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan struct ath9k_htc_vif *avp = NULL; 345da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan u8 sta_idx, vif_idx; 346fb9987d0f748c983bb795a86f47522313f701a08Sujith 347fb9987d0f748c983bb795a86f47522313f701a08Sujith hdr = (struct ieee80211_hdr *) skb->data; 348fb9987d0f748c983bb795a86f47522313f701a08Sujith 349a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan /* 350a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * Find out on which interface this packet has to be 351a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * sent out. 352a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan */ 353a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan if (vif) { 354a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan avp = (struct ath9k_htc_vif *) vif->drv_priv; 355a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan vif_idx = avp->index; 356a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } else { 357a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan if (!priv->ah->is_monitoring) { 358a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan ath_dbg(ath9k_hw_common(priv->ah), ATH_DBG_XMIT, 359a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan "VIF is null, but no monitor interface !\n"); 360a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan return -EINVAL; 361a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } 362a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan 363a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan vif_idx = priv->mon_vif_idx; 364a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } 365da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan 366a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan /* 367a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * Find out which station this packet is destined for. 368a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan */ 369fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sta) { 370fb9987d0f748c983bb795a86f47522313f701a08Sujith ista = (struct ath9k_htc_sta *) sta->drv_priv; 371fb9987d0f748c983bb795a86f47522313f701a08Sujith sta_idx = ista->index; 372fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 373a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan sta_idx = priv->vif_sta_pos[vif_idx]; 374fb9987d0f748c983bb795a86f47522313f701a08Sujith } 375fb9987d0f748c983bb795a86f47522313f701a08Sujith 376821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan if (ieee80211_is_data(hdr->frame_control)) 377821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan ath9k_htc_tx_data(priv, vif, skb, 378821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan sta_idx, vif_idx, slot, is_cab); 379821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan else 380821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan ath9k_htc_tx_mgmt(priv, avp, skb, 381821f9414c0546fbc99a999e9dc613d1756e1de8aSujith Manoharan sta_idx, vif_idx, slot); 382fb9987d0f748c983bb795a86f47522313f701a08Sujith 383fb9987d0f748c983bb795a86f47522313f701a08Sujith 384d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan return htc_send(priv->htc, skb); 385fb9987d0f748c983bb795a86f47522313f701a08Sujith} 386fb9987d0f748c983bb795a86f47522313f701a08Sujith 387f2820f4583b233827f10d91adea70225e196d852Sujith Manoharanstatic inline bool __ath9k_htc_check_tx_aggr(struct ath9k_htc_priv *priv, 388f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ath9k_htc_sta *ista, u8 tid) 389d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith{ 390d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith bool ret = false; 391d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 392658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 393d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith if ((tid < ATH9K_HTC_MAX_TID) && (ista->tid_state[tid] == AGGR_STOP)) 394d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith ret = true; 395658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 396d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 397d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith return ret; 398d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith} 399d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 400f2820f4583b233827f10d91adea70225e196d852Sujith Manoharanstatic void ath9k_htc_check_tx_aggr(struct ath9k_htc_priv *priv, 401f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ieee80211_vif *vif, 402f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct sk_buff *skb) 403fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 404fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_sta *sta; 405fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 406fb9987d0f748c983bb795a86f47522313f701a08Sujith __le16 fc; 407fb9987d0f748c983bb795a86f47522313f701a08Sujith 408f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan hdr = (struct ieee80211_hdr *) skb->data; 409f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan fc = hdr->frame_control; 410fb9987d0f748c983bb795a86f47522313f701a08Sujith 411f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan rcu_read_lock(); 412729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 413f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan sta = ieee80211_find_sta(vif, hdr->addr1); 414f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (!sta) { 415f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan rcu_read_unlock(); 416f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan return; 417f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan } 418ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 419f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (sta && conf_is_ht(&priv->hw->conf) && 420f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan !(skb->protocol == cpu_to_be16(ETH_P_PAE))) { 421f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (ieee80211_is_data_qos(fc)) { 422f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan u8 *qc, tid; 423f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ath9k_htc_sta *ista; 424fb9987d0f748c983bb795a86f47522313f701a08Sujith 425f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan qc = ieee80211_get_qos_ctl(hdr); 426f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan tid = qc[0] & 0xf; 427f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ista = (struct ath9k_htc_sta *)sta->drv_priv; 428f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (__ath9k_htc_check_tx_aggr(priv, ista, tid)) { 429f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ieee80211_start_tx_ba_session(sta, tid, 0); 430f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 431f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ista->tid_state[tid] = AGGR_PROGRESS; 432f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 433f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan } 434f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan } 435f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan } 436f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan 437f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan rcu_read_unlock(); 438f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan} 439729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 440f2820f4583b233827f10d91adea70225e196d852Sujith Manoharanstatic void ath9k_htc_tx_process(struct ath9k_htc_priv *priv, 44127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff *skb, 44227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct __wmi_event_txstatus *txs) 443f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan{ 444f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ieee80211_vif *vif; 445f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 446f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ieee80211_tx_info *tx_info; 44727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct ieee80211_tx_rate *rate; 44827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct ieee80211_conf *cur_conf = &priv->hw->conf; 449f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan bool txok; 450f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan int slot; 451729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 452f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan slot = strip_drv_header(priv, skb); 453f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (slot < 0) { 454f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan dev_kfree_skb_any(skb); 455f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan return; 456f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan } 4572299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan 458f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan tx_ctl = HTC_SKB_CB(skb); 459f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan txok = tx_ctl->txok; 460f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan tx_info = IEEE80211_SKB_CB(skb); 461f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan vif = tx_info->control.vif; 46227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate = &tx_info->status.rates[0]; 463fb9987d0f748c983bb795a86f47522313f701a08Sujith 464f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan memset(&tx_info->status, 0, sizeof(tx_info->status)); 465ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 466f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan /* 467f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan * URB submission failed for this frame, it never reached 468f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan * the target. 469f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan */ 47027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (!txok || !vif || !txs) 471f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan goto send_mac80211; 472ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 47327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_ACK) 47427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan tx_info->flags |= IEEE80211_TX_STAT_ACK; 47527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 47627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_FILT) 47727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan tx_info->flags |= IEEE80211_TX_STAT_TX_FILTERED; 47827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 47927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_RTC_CTS) 48027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->flags |= IEEE80211_TX_RC_USE_RTS_CTS; 48127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 48227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->count = 1; 48327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->idx = MS(txs->ts_rate, ATH9K_HTC_TXSTAT_RATE); 48427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 48527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_MCS) { 48627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->flags |= IEEE80211_TX_RC_MCS; 48727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 48827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_CW40) 48927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->flags |= IEEE80211_TX_RC_40_MHZ_WIDTH; 49027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (txs->ts_flags & ATH9K_HTC_TXSTAT_SGI) 49127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->flags |= IEEE80211_TX_RC_SHORT_GI; 49227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } else { 49327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (cur_conf->channel->band == IEEE80211_BAND_5GHZ) 49427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan rate->idx += 4; /* No CCK rates */ 49527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 496fb9987d0f748c983bb795a86f47522313f701a08Sujith 497f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ath9k_htc_check_tx_aggr(priv, vif, skb); 498fb9987d0f748c983bb795a86f47522313f701a08Sujith 499f2820f4583b233827f10d91adea70225e196d852Sujith Manoharansend_mac80211: 500f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 501f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan if (WARN_ON(--priv->tx.queued_cnt < 0)) 502f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan priv->tx.queued_cnt = 0; 503f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 504fb9987d0f748c983bb795a86f47522313f701a08Sujith 505f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ath9k_htc_tx_clear_slot(priv, slot); 506fb9987d0f748c983bb795a86f47522313f701a08Sujith 507f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan /* Send status to mac80211 */ 508f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan ieee80211_tx_status(priv->hw, skb); 509f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan} 5108e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan 51127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanstatic inline void ath9k_htc_tx_drainq(struct ath9k_htc_priv *priv, 51227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff_head *queue) 51327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan{ 51427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff *skb; 51527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 51627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan while ((skb = skb_dequeue(queue)) != NULL) { 51727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_process(priv, skb, NULL); 51827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 51927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan} 52027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 521b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharanvoid ath9k_htc_tx_drain(struct ath9k_htc_priv *priv) 522b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan{ 523859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath9k_htc_tx_event *event, *tmp; 524859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 52527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 52627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan priv->tx.flags |= ATH9K_HTC_OP_TX_DRAIN; 52727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 528b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 529b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan /* 530b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan * Ensure that all pending TX frames are flushed, 53127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan * and that the TX completion/failed tasklets is killed. 532b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan */ 533b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan htc_stop(priv->htc); 53427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan tasklet_kill(&priv->wmi->wmi_event_tasklet); 53527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan tasklet_kill(&priv->tx_failed_tasklet); 536b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 53727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.mgmt_ep_queue); 53827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.cab_ep_queue); 53927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.data_be_queue); 54027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.data_bk_queue); 54127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.data_vi_queue); 54227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.data_vo_queue); 54327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.tx_failed); 544b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 545859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan /* 546859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan * The TX cleanup timer has already been killed. 547859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan */ 548859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_lock_bh(&priv->wmi->event_lock); 549859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_for_each_entry_safe(event, tmp, &priv->wmi->pending_tx_events, list) { 550859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_del(&event->list); 551859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan kfree(event); 552859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 553859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_unlock_bh(&priv->wmi->event_lock); 554859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 55527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 55627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan priv->tx.flags &= ~ATH9K_HTC_OP_TX_DRAIN; 55727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 558b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan} 559b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 56027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanvoid ath9k_tx_failed_tasklet(unsigned long data) 561f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan{ 562f2820f4583b233827f10d91adea70225e196d852Sujith Manoharan struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)data; 5632c5d57f004673a9c8658e20b1fa3f992b5a10f70Sujith Manoharan 56427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 56527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (priv->tx.flags & ATH9K_HTC_OP_TX_DRAIN) { 56627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 56727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return; 56827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 56927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 57027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 57127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_drainq(priv, &priv->tx.tx_failed); 57227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan} 57327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 57427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanstatic inline bool check_cookie(struct ath9k_htc_priv *priv, 57527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff *skb, 57627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan u8 cookie, u8 epid) 57727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan{ 57827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan u8 fcookie = 0; 57927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 58027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (epid == priv->mgmt_ep) { 58127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct tx_mgmt_hdr *hdr; 58227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan hdr = (struct tx_mgmt_hdr *) skb->data; 58327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan fcookie = hdr->cookie; 58427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } else if ((epid == priv->data_bk_ep) || 58527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan (epid == priv->data_be_ep) || 58627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan (epid == priv->data_vi_ep) || 58727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan (epid == priv->data_vo_ep) || 58827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan (epid == priv->cab_ep)) { 58927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct tx_frame_hdr *hdr; 59027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan hdr = (struct tx_frame_hdr *) skb->data; 59127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan fcookie = hdr->cookie; 59227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 59327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 59427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (fcookie == cookie) 59527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return true; 59627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 59727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return false; 59827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan} 59927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 60027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanstatic struct sk_buff* ath9k_htc_tx_get_packet(struct ath9k_htc_priv *priv, 60127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct __wmi_event_txstatus *txs) 60227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan{ 60327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 60427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff_head *epid_queue; 60527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff *skb, *tmp; 60627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan unsigned long flags; 60727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan u8 epid = MS(txs->ts_rate, ATH9K_HTC_TXSTAT_EPID); 60827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 60927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = get_htc_epid_queue(priv, epid); 61027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (!epid_queue) 61127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return NULL; 61227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 61327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_lock_irqsave(&epid_queue->lock, flags); 61427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_walk_safe(epid_queue, skb, tmp) { 61527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (check_cookie(priv, skb, txs->cookie, epid)) { 61627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan __skb_unlink(skb, epid_queue); 61727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_irqrestore(&epid_queue->lock, flags); 61827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return skb; 61927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 620fb9987d0f748c983bb795a86f47522313f701a08Sujith } 62127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan spin_unlock_irqrestore(&epid_queue->lock, flags); 62227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 62327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath_dbg(common, ATH_DBG_XMIT, 62427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan "No matching packet for cookie: %d, epid: %d\n", 62527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan txs->cookie, epid); 6267757dfed5809b03aa61c7d7f5ff8092f85df8583Sujith 62727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return NULL; 62827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan} 62927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 63027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharanvoid ath9k_htc_txstatus(struct ath9k_htc_priv *priv, void *wmi_event) 63127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan{ 63227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct wmi_event_txstatus *txs = (struct wmi_event_txstatus *)wmi_event; 63327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct __wmi_event_txstatus *__txs; 63427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff *skb; 635859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath9k_htc_tx_event *tx_pend; 63627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan int i; 63727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 63827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan for (i = 0; i < txs->cnt; i++) { 63927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan WARN_ON(txs->cnt > HTC_MAX_TX_STATUS); 64027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 64127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan __txs = &txs->txstatus[i]; 64227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 64327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb = ath9k_htc_tx_get_packet(priv, __txs); 644859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (!skb) { 645859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan /* 646859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan * Store this event, so that the TX cleanup 647859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan * routine can check later for the needed packet. 648859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan */ 649859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan tx_pend = kzalloc(sizeof(struct ath9k_htc_tx_event), 650859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan GFP_ATOMIC); 651859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (!tx_pend) 652859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan continue; 653859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 654859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan memcpy(&tx_pend->txs, __txs, 655859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan sizeof(struct __wmi_event_txstatus)); 656859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 657859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_lock(&priv->wmi->event_lock); 658859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_add_tail(&tx_pend->list, 659859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan &priv->wmi->pending_tx_events); 660859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_unlock(&priv->wmi->event_lock); 661859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 66227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan continue; 663859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 66427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 66527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan ath9k_htc_tx_process(priv, skb, __txs); 666b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan } 667b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 6687757dfed5809b03aa61c7d7f5ff8092f85df8583Sujith /* Wake TX queues if needed */ 6698e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan ath9k_htc_check_wake_queues(priv); 670fb9987d0f748c983bb795a86f47522313f701a08Sujith} 671fb9987d0f748c983bb795a86f47522313f701a08Sujith 672fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_htc_txep(void *drv_priv, struct sk_buff *skb, 673fb9987d0f748c983bb795a86f47522313f701a08Sujith enum htc_endpoint_id ep_id, bool txok) 674fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 675fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) drv_priv; 676729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 67727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan struct sk_buff_head *epid_queue; 678fb9987d0f748c983bb795a86f47522313f701a08Sujith 679729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 680729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl->txok = txok; 681859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan tx_ctl->timestamp = jiffies; 682fb9987d0f748c983bb795a86f47522313f701a08Sujith 68327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (!txok) { 684b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan skb_queue_tail(&priv->tx.tx_failed, skb); 68527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan tasklet_schedule(&priv->tx_failed_tasklet); 68627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return; 68727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 68827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan 68927876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan epid_queue = get_htc_epid_queue(priv, ep_id); 69027876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan if (!epid_queue) { 69127876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan dev_kfree_skb_any(skb); 69227876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan return; 69327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan } 694b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan 69527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_tail(epid_queue, skb); 696fb9987d0f748c983bb795a86f47522313f701a08Sujith} 697fb9987d0f748c983bb795a86f47522313f701a08Sujith 698859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharanstatic inline bool check_packet(struct ath9k_htc_priv *priv, struct sk_buff *skb) 699859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan{ 700859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 701859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 702859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 703859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan tx_ctl = HTC_SKB_CB(skb); 704859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 705859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (time_after(jiffies, 706859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan tx_ctl->timestamp + 707859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan msecs_to_jiffies(ATH9K_HTC_TX_TIMEOUT_INTERVAL))) { 708859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath_dbg(common, ATH_DBG_XMIT, 709859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan "Dropping a packet due to TX timeout\n"); 710859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan return true; 711859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 712859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 713859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan return false; 714859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan} 715859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 716859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharanstatic void ath9k_htc_tx_cleanup_queue(struct ath9k_htc_priv *priv, 717859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct sk_buff_head *epid_queue) 718859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan{ 719859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan bool process = false; 720859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan unsigned long flags; 721859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct sk_buff *skb, *tmp; 722859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct sk_buff_head queue; 723859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 724859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan skb_queue_head_init(&queue); 725859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 726859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_lock_irqsave(&epid_queue->lock, flags); 727859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan skb_queue_walk_safe(epid_queue, skb, tmp) { 728859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (check_packet(priv, skb)) { 729859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan __skb_unlink(skb, epid_queue); 730859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan __skb_queue_tail(&queue, skb); 731859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan process = true; 732859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 733859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 734859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_unlock_irqrestore(&epid_queue->lock, flags); 735859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 736859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (process) { 737859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan skb_queue_walk_safe(&queue, skb, tmp) { 738859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan __skb_unlink(skb, &queue); 739859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_process(priv, skb, NULL); 740859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 741859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 742859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan} 743859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 744859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharanvoid ath9k_htc_tx_cleanup_timer(unsigned long data) 745859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan{ 746859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) data; 747859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 748859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct ath9k_htc_tx_event *event, *tmp; 749859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan struct sk_buff *skb; 750859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 751859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_lock(&priv->wmi->event_lock); 752859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_for_each_entry_safe(event, tmp, &priv->wmi->pending_tx_events, list) { 753859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 754859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan skb = ath9k_htc_tx_get_packet(priv, &event->txs); 755859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (skb) { 756859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath_dbg(common, ATH_DBG_XMIT, 757859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan "Found packet for cookie: %d, epid: %d\n", 758859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan event->txs.cookie, 759859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan MS(event->txs.ts_rate, ATH9K_HTC_TXSTAT_EPID)); 760859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 761859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_process(priv, skb, &event->txs); 762859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_del(&event->list); 763859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan kfree(event); 764859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan continue; 765859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 766859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 767859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan if (++event->count >= ATH9K_HTC_TX_TIMEOUT_COUNT) { 768859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan list_del(&event->list); 769859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan kfree(event); 770859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 771859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan } 772859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan spin_unlock(&priv->wmi->event_lock); 773859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 774859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan /* 775859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan * Check if status-pending packets have to be cleaned up. 776859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan */ 777859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.mgmt_ep_queue); 778859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.cab_ep_queue); 779859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.data_be_queue); 780859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.data_bk_queue); 781859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.data_vi_queue); 782859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_tx_cleanup_queue(priv, &priv->tx.data_vo_queue); 783859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 784859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan /* Wake TX queues if needed */ 785859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan ath9k_htc_check_wake_queues(priv); 786859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 787859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan mod_timer(&priv->tx.cleanup_timer, 788859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan jiffies + msecs_to_jiffies(ATH9K_HTC_TX_CLEANUP_INTERVAL)); 789859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan} 790859c3ca1e4608615788dc6cbc199210fe4b5efa2Sujith Manoharan 791fb9987d0f748c983bb795a86f47522313f701a08Sujithint ath9k_tx_init(struct ath9k_htc_priv *priv) 792fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 79327876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.mgmt_ep_queue); 79427876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.cab_ep_queue); 79527876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.data_be_queue); 79627876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.data_bk_queue); 79727876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.data_vi_queue); 79827876a29de221186c9d5883e5fe5f6da18ef9a45Sujith Manoharan skb_queue_head_init(&priv->tx.data_vo_queue); 799b587fc81a80b9656f64e89fe0a106ffa4b35abcaSujith Manoharan skb_queue_head_init(&priv->tx.tx_failed); 800fb9987d0f748c983bb795a86f47522313f701a08Sujith return 0; 801fb9987d0f748c983bb795a86f47522313f701a08Sujith} 802fb9987d0f748c983bb795a86f47522313f701a08Sujith 803fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_tx_cleanup(struct ath9k_htc_priv *priv) 804fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 805fb9987d0f748c983bb795a86f47522313f701a08Sujith 806fb9987d0f748c983bb795a86f47522313f701a08Sujith} 807fb9987d0f748c983bb795a86f47522313f701a08Sujith 808e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkaubool ath9k_htc_txq_setup(struct ath9k_htc_priv *priv, int subtype) 809fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 810fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 811fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 812fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_tx_queue_info qi; 813fb9987d0f748c983bb795a86f47522313f701a08Sujith int qnum; 814fb9987d0f748c983bb795a86f47522313f701a08Sujith 815fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(&qi, 0, sizeof(qi)); 816ca74b83b66dbd289a395c6243695d746c76676ccSujith ATH9K_HTC_INIT_TXQ(subtype); 817fb9987d0f748c983bb795a86f47522313f701a08Sujith 818fb9987d0f748c983bb795a86f47522313f701a08Sujith qnum = ath9k_hw_setuptxqueue(priv->ah, ATH9K_TX_QUEUE_DATA, &qi); 819fb9987d0f748c983bb795a86f47522313f701a08Sujith if (qnum == -1) 820fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 821fb9987d0f748c983bb795a86f47522313f701a08Sujith 822fb9987d0f748c983bb795a86f47522313f701a08Sujith if (qnum >= ARRAY_SIZE(priv->hwq_map)) { 8233800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, "qnum %u out of range, max %zu!\n", 8243800276a40751539a920ef8e0537ef2e19126799Joe Perches qnum, ARRAY_SIZE(priv->hwq_map)); 825fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_releasetxqueue(ah, qnum); 826fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 827fb9987d0f748c983bb795a86f47522313f701a08Sujith } 828fb9987d0f748c983bb795a86f47522313f701a08Sujith 829fb9987d0f748c983bb795a86f47522313f701a08Sujith priv->hwq_map[subtype] = qnum; 830fb9987d0f748c983bb795a86f47522313f701a08Sujith return true; 831fb9987d0f748c983bb795a86f47522313f701a08Sujith} 832fb9987d0f748c983bb795a86f47522313f701a08Sujith 833ca74b83b66dbd289a395c6243695d746c76676ccSujithint ath9k_htc_cabq_setup(struct ath9k_htc_priv *priv) 834ca74b83b66dbd289a395c6243695d746c76676ccSujith{ 835ca74b83b66dbd289a395c6243695d746c76676ccSujith struct ath9k_tx_queue_info qi; 836ca74b83b66dbd289a395c6243695d746c76676ccSujith 837ca74b83b66dbd289a395c6243695d746c76676ccSujith memset(&qi, 0, sizeof(qi)); 838ca74b83b66dbd289a395c6243695d746c76676ccSujith ATH9K_HTC_INIT_TXQ(0); 839ca74b83b66dbd289a395c6243695d746c76676ccSujith 840ca74b83b66dbd289a395c6243695d746c76676ccSujith return ath9k_hw_setuptxqueue(priv->ah, ATH9K_TX_QUEUE_CAB, &qi); 841ca74b83b66dbd289a395c6243695d746c76676ccSujith} 842ca74b83b66dbd289a395c6243695d746c76676ccSujith 843fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 844fb9987d0f748c983bb795a86f47522313f701a08Sujith/* RX */ 845fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 846fb9987d0f748c983bb795a86f47522313f701a08Sujith 8470995d110118b35c0dc5195e3ddddcc0dec263830Sujith/* 8480995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Calculate the RX filter to be set in the HW. 8490995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 8500995d110118b35c0dc5195e3ddddcc0dec263830Sujithu32 ath9k_htc_calcrxfilter(struct ath9k_htc_priv *priv) 8510995d110118b35c0dc5195e3ddddcc0dec263830Sujith{ 8520995d110118b35c0dc5195e3ddddcc0dec263830Sujith#define RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR) 8530995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8540995d110118b35c0dc5195e3ddddcc0dec263830Sujith struct ath_hw *ah = priv->ah; 8550995d110118b35c0dc5195e3ddddcc0dec263830Sujith u32 rfilt; 8560995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8570995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt = (ath9k_hw_getrxfilter(ah) & RX_FILTER_PRESERVE) 8580995d110118b35c0dc5195e3ddddcc0dec263830Sujith | ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST 8590995d110118b35c0dc5195e3ddddcc0dec263830Sujith | ATH9K_RX_FILTER_MCAST; 8600995d110118b35c0dc5195e3ddddcc0dec263830Sujith 86194a40c0c6bcc47ceba12e0247c5a23fb1e6c81e4Rajkumar Manoharan if (priv->rxfilter & FIF_PROBE_REQ) 8620995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_PROBEREQ; 8630995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8640995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* 8650995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station 8660995d110118b35c0dc5195e3ddddcc0dec263830Sujith * mode interface or when in monitor mode. AP mode does not need this 8670995d110118b35c0dc5195e3ddddcc0dec263830Sujith * since it receives all in-BSS frames anyway. 8680995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 8690995d110118b35c0dc5195e3ddddcc0dec263830Sujith if (((ah->opmode != NL80211_IFTYPE_AP) && 8700995d110118b35c0dc5195e3ddddcc0dec263830Sujith (priv->rxfilter & FIF_PROMISC_IN_BSS)) || 8714825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan ah->is_monitoring) 8720995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_PROM; 8730995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8740995d110118b35c0dc5195e3ddddcc0dec263830Sujith if (priv->rxfilter & FIF_CONTROL) 8750995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_CONTROL; 8760995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8770995d110118b35c0dc5195e3ddddcc0dec263830Sujith if ((ah->opmode == NL80211_IFTYPE_STATION) && 87833a5315f97e5b3964183f0cf74768ac47eabe631Sujith Manoharan (priv->nvifs <= 1) && 8790995d110118b35c0dc5195e3ddddcc0dec263830Sujith !(priv->rxfilter & FIF_BCN_PRBRESP_PROMISC)) 8800995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_MYBEACON; 8810995d110118b35c0dc5195e3ddddcc0dec263830Sujith else 8820995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_BEACON; 8830995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8844825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan if (conf_is_ht(&priv->hw->conf)) { 8850995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_COMP_BAR; 8864825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan rfilt |= ATH9K_RX_FILTER_UNCOMP_BA_BAR; 8874825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan } 8884825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan 8894825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan if (priv->rxfilter & FIF_PSPOLL) 8904825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan rfilt |= ATH9K_RX_FILTER_PSPOLL; 8910995d110118b35c0dc5195e3ddddcc0dec263830Sujith 89233a5315f97e5b3964183f0cf74768ac47eabe631Sujith Manoharan if (priv->nvifs > 1) 89333a5315f97e5b3964183f0cf74768ac47eabe631Sujith Manoharan rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL; 89433a5315f97e5b3964183f0cf74768ac47eabe631Sujith Manoharan 8950995d110118b35c0dc5195e3ddddcc0dec263830Sujith return rfilt; 8960995d110118b35c0dc5195e3ddddcc0dec263830Sujith 8970995d110118b35c0dc5195e3ddddcc0dec263830Sujith#undef RX_FILTER_PRESERVE 8980995d110118b35c0dc5195e3ddddcc0dec263830Sujith} 8990995d110118b35c0dc5195e3ddddcc0dec263830Sujith 9000995d110118b35c0dc5195e3ddddcc0dec263830Sujith/* 9010995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Recv initialization for opmode change. 9020995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 9030995d110118b35c0dc5195e3ddddcc0dec263830Sujithstatic void ath9k_htc_opmode_init(struct ath9k_htc_priv *priv) 9040995d110118b35c0dc5195e3ddddcc0dec263830Sujith{ 9050995d110118b35c0dc5195e3ddddcc0dec263830Sujith struct ath_hw *ah = priv->ah; 9060995d110118b35c0dc5195e3ddddcc0dec263830Sujith u32 rfilt, mfilt[2]; 9070995d110118b35c0dc5195e3ddddcc0dec263830Sujith 9080995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* configure rx filter */ 9090995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt = ath9k_htc_calcrxfilter(priv); 9100995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_hw_setrxfilter(ah, rfilt); 9110995d110118b35c0dc5195e3ddddcc0dec263830Sujith 9120995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* calculate and install multicast filter */ 9130995d110118b35c0dc5195e3ddddcc0dec263830Sujith mfilt[0] = mfilt[1] = ~0; 9140995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]); 9150995d110118b35c0dc5195e3ddddcc0dec263830Sujith} 9160995d110118b35c0dc5195e3ddddcc0dec263830Sujith 917fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_host_rx_init(struct ath9k_htc_priv *priv) 918fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 919fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_rxena(priv->ah); 9200995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_htc_opmode_init(priv); 92140346b66799b7d382e61bbb68a6b6bbdd20f320eLuis R. Rodriguez ath9k_hw_startpcureceive(priv->ah, (priv->op_flags & OP_SCANNING)); 922fb9987d0f748c983bb795a86f47522313f701a08Sujith priv->rx.last_rssi = ATH_RSSI_DUMMY_MARKER; 923fb9987d0f748c983bb795a86f47522313f701a08Sujith} 924fb9987d0f748c983bb795a86f47522313f701a08Sujith 925fb9987d0f748c983bb795a86f47522313f701a08Sujithstatic void ath9k_process_rate(struct ieee80211_hw *hw, 926fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status *rxs, 927fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 rx_rate, u8 rs_flags) 928fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 929fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_supported_band *sband; 930fb9987d0f748c983bb795a86f47522313f701a08Sujith enum ieee80211_band band; 931fb9987d0f748c983bb795a86f47522313f701a08Sujith unsigned int i = 0; 932fb9987d0f748c983bb795a86f47522313f701a08Sujith 933fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rx_rate & 0x80) { 934fb9987d0f748c983bb795a86f47522313f701a08Sujith /* HT rate */ 935fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_HT; 936fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rs_flags & ATH9K_RX_2040) 937fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_40MHZ; 938fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rs_flags & ATH9K_RX_GI) 939fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_SHORT_GI; 940fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = rx_rate & 0x7f; 941fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 942fb9987d0f748c983bb795a86f47522313f701a08Sujith } 943fb9987d0f748c983bb795a86f47522313f701a08Sujith 944fb9987d0f748c983bb795a86f47522313f701a08Sujith band = hw->conf.channel->band; 945fb9987d0f748c983bb795a86f47522313f701a08Sujith sband = hw->wiphy->bands[band]; 946fb9987d0f748c983bb795a86f47522313f701a08Sujith 947fb9987d0f748c983bb795a86f47522313f701a08Sujith for (i = 0; i < sband->n_bitrates; i++) { 948fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sband->bitrates[i].hw_value == rx_rate) { 949fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = i; 950fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 951fb9987d0f748c983bb795a86f47522313f701a08Sujith } 952fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sband->bitrates[i].hw_value_short == rx_rate) { 953fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = i; 954fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_SHORTPRE; 955fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 956fb9987d0f748c983bb795a86f47522313f701a08Sujith } 957fb9987d0f748c983bb795a86f47522313f701a08Sujith } 958fb9987d0f748c983bb795a86f47522313f701a08Sujith 959fb9987d0f748c983bb795a86f47522313f701a08Sujith} 960fb9987d0f748c983bb795a86f47522313f701a08Sujith 961fb9987d0f748c983bb795a86f47522313f701a08Sujithstatic bool ath9k_rx_prepare(struct ath9k_htc_priv *priv, 962fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf, 963fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status *rx_status) 964fb9987d0f748c983bb795a86f47522313f701a08Sujith 965fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 966fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 967fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hw *hw = priv->hw; 968fb9987d0f748c983bb795a86f47522313f701a08Sujith struct sk_buff *skb = rxbuf->skb; 969fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(priv->ah); 9704f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith struct ath_htc_rx_status *rxstatus; 971fb9987d0f748c983bb795a86f47522313f701a08Sujith int hdrlen, padpos, padsize; 972fb9987d0f748c983bb795a86f47522313f701a08Sujith int last_rssi = ATH_RSSI_DUMMY_MARKER; 973fb9987d0f748c983bb795a86f47522313f701a08Sujith __le16 fc; 974fb9987d0f748c983bb795a86f47522313f701a08Sujith 975b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan if (skb->len < HTC_RX_FRAME_HEADER_SIZE) { 976b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan ath_err(common, "Corrupted RX frame, dropping (len: %d)\n", 977b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan skb->len); 9784f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith goto rx_next; 9794f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith } 9804f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 9814f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith rxstatus = (struct ath_htc_rx_status *)skb->data; 9824f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 9834f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith if (be16_to_cpu(rxstatus->rs_datalen) - 9844f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith (skb->len - HTC_RX_FRAME_HEADER_SIZE) != 0) { 9853800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, 9863800276a40751539a920ef8e0537ef2e19126799Joe Perches "Corrupted RX data len, dropping (dlen: %d, skblen: %d)\n", 9873800276a40751539a920ef8e0537ef2e19126799Joe Perches rxstatus->rs_datalen, skb->len); 9884f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith goto rx_next; 9894f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith } 9904f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 991719c4cf6b1b113e9caf377c6607ae45758a85871Sujith Manoharan ath9k_htc_err_stat_rx(priv, rxstatus); 992719c4cf6b1b113e9caf377c6607ae45758a85871Sujith Manoharan 9934f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith /* Get the RX status information */ 9944f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith memcpy(&rxbuf->rxstatus, rxstatus, HTC_RX_FRAME_HEADER_SIZE); 9954f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith skb_pull(skb, HTC_RX_FRAME_HEADER_SIZE); 9964f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 997fb9987d0f748c983bb795a86f47522313f701a08Sujith hdr = (struct ieee80211_hdr *)skb->data; 998fb9987d0f748c983bb795a86f47522313f701a08Sujith fc = hdr->frame_control; 999fb9987d0f748c983bb795a86f47522313f701a08Sujith hdrlen = ieee80211_get_hdrlen_from_skb(skb); 1000fb9987d0f748c983bb795a86f47522313f701a08Sujith 1001fb9987d0f748c983bb795a86f47522313f701a08Sujith padpos = ath9k_cmn_padpos(fc); 1002fb9987d0f748c983bb795a86f47522313f701a08Sujith 1003fb9987d0f748c983bb795a86f47522313f701a08Sujith padsize = padpos & 3; 100432fbccafed7e935432b601f0453c2b702a385a25Sujith if (padsize && skb->len >= padpos+padsize+FCS_LEN) { 1005fb9987d0f748c983bb795a86f47522313f701a08Sujith memmove(skb->data + padsize, skb->data, padpos); 1006fb9987d0f748c983bb795a86f47522313f701a08Sujith skb_pull(skb, padsize); 1007fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1008fb9987d0f748c983bb795a86f47522313f701a08Sujith 1009fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(rx_status, 0, sizeof(struct ieee80211_rx_status)); 1010fb9987d0f748c983bb795a86f47522313f701a08Sujith 1011fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status != 0) { 1012fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_CRC) 1013fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; 1014fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_PHY) 1015fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 1016fb9987d0f748c983bb795a86f47522313f701a08Sujith 1017fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_DECRYPT) { 1018fb9987d0f748c983bb795a86f47522313f701a08Sujith /* FIXME */ 1019fb9987d0f748c983bb795a86f47522313f701a08Sujith } else if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_MIC) { 1020fb9987d0f748c983bb795a86f47522313f701a08Sujith if (ieee80211_is_ctl(fc)) 1021fb9987d0f748c983bb795a86f47522313f701a08Sujith /* 1022fb9987d0f748c983bb795a86f47522313f701a08Sujith * Sometimes, we get invalid 1023fb9987d0f748c983bb795a86f47522313f701a08Sujith * MIC failures on valid control frames. 1024fb9987d0f748c983bb795a86f47522313f701a08Sujith * Remove these mic errors. 1025fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 1026fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->rxstatus.rs_status &= ~ATH9K_RXERR_MIC; 1027fb9987d0f748c983bb795a86f47522313f701a08Sujith else 1028fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_MMIC_ERROR; 1029fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1030fb9987d0f748c983bb795a86f47522313f701a08Sujith 1031fb9987d0f748c983bb795a86f47522313f701a08Sujith /* 1032fb9987d0f748c983bb795a86f47522313f701a08Sujith * Reject error frames with the exception of 1033fb9987d0f748c983bb795a86f47522313f701a08Sujith * decryption and MIC failures. For monitor mode, 1034fb9987d0f748c983bb795a86f47522313f701a08Sujith * we also ignore the CRC error. 1035fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 1036fb9987d0f748c983bb795a86f47522313f701a08Sujith if (priv->ah->opmode == NL80211_IFTYPE_MONITOR) { 1037fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & 1038fb9987d0f748c983bb795a86f47522313f701a08Sujith ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC | 1039fb9987d0f748c983bb795a86f47522313f701a08Sujith ATH9K_RXERR_CRC)) 1040fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 1041fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 1042fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & 1043fb9987d0f748c983bb795a86f47522313f701a08Sujith ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) { 1044fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 1045fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1046fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1047fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1048fb9987d0f748c983bb795a86f47522313f701a08Sujith 1049fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!(rxbuf->rxstatus.rs_status & ATH9K_RXERR_DECRYPT)) { 1050fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 keyix; 1051fb9987d0f748c983bb795a86f47522313f701a08Sujith keyix = rxbuf->rxstatus.rs_keyix; 1052fb9987d0f748c983bb795a86f47522313f701a08Sujith if (keyix != ATH9K_RXKEYIX_INVALID) { 1053fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_DECRYPTED; 1054fb9987d0f748c983bb795a86f47522313f701a08Sujith } else if (ieee80211_has_protected(fc) && 1055fb9987d0f748c983bb795a86f47522313f701a08Sujith skb->len >= hdrlen + 4) { 1056fb9987d0f748c983bb795a86f47522313f701a08Sujith keyix = skb->data[hdrlen + 3] >> 6; 1057fb9987d0f748c983bb795a86f47522313f701a08Sujith if (test_bit(keyix, common->keymap)) 1058fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_DECRYPTED; 1059fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1060fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1061fb9987d0f748c983bb795a86f47522313f701a08Sujith 1062fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_process_rate(hw, rx_status, rxbuf->rxstatus.rs_rate, 1063fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->rxstatus.rs_flags); 1064fb9987d0f748c983bb795a86f47522313f701a08Sujith 10657c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (rxbuf->rxstatus.rs_rssi != ATH9K_RSSI_BAD && 10667c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan !rxbuf->rxstatus.rs_moreaggr) 10677c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan ATH_RSSI_LPF(priv->rx.last_rssi, 10687c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi); 1069fb9987d0f748c983bb795a86f47522313f701a08Sujith 10707c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan last_rssi = priv->rx.last_rssi; 1071fb9987d0f748c983bb795a86f47522313f701a08Sujith 10727c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER)) 10737c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi = ATH_EP_RND(last_rssi, 10747c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan ATH_RSSI_EP_MULTIPLIER); 1075fb9987d0f748c983bb795a86f47522313f701a08Sujith 10767c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (rxbuf->rxstatus.rs_rssi < 0) 10777c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi = 0; 1078fb9987d0f748c983bb795a86f47522313f701a08Sujith 10797c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (ieee80211_is_beacon(fc)) 10807c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan priv->ah->stats.avgbrssi = rxbuf->rxstatus.rs_rssi; 1081fb9987d0f748c983bb795a86f47522313f701a08Sujith 10827f1f5a0060e377ff6a15903487b39223e12b8568Sujith rx_status->mactime = be64_to_cpu(rxbuf->rxstatus.rs_tstamp); 1083fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->band = hw->conf.channel->band; 1084fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->freq = hw->conf.channel->center_freq; 1085fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->signal = rxbuf->rxstatus.rs_rssi + ATH_DEFAULT_NOISE_FLOOR; 1086fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->antenna = rxbuf->rxstatus.rs_antenna; 10876ebacbb79d2d05978ba50a24d8cbe2a76ff2014cJohannes Berg rx_status->flag |= RX_FLAG_MACTIME_MPDU; 1088fb9987d0f748c983bb795a86f47522313f701a08Sujith 1089fb9987d0f748c983bb795a86f47522313f701a08Sujith return true; 1090fb9987d0f748c983bb795a86f47522313f701a08Sujith 1091fb9987d0f748c983bb795a86f47522313f701a08Sujithrx_next: 1092fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 1093fb9987d0f748c983bb795a86f47522313f701a08Sujith} 1094fb9987d0f748c983bb795a86f47522313f701a08Sujith 1095fb9987d0f748c983bb795a86f47522313f701a08Sujith/* 1096fb9987d0f748c983bb795a86f47522313f701a08Sujith * FIXME: Handle FLUSH later on. 1097fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 1098fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_rx_tasklet(unsigned long data) 1099fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 1100fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)data; 1101fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf = NULL, *tmp_buf = NULL; 1102fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status rx_status; 1103fb9987d0f748c983bb795a86f47522313f701a08Sujith struct sk_buff *skb; 1104fb9987d0f748c983bb795a86f47522313f701a08Sujith unsigned long flags; 1105bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan struct ieee80211_hdr *hdr; 1106fb9987d0f748c983bb795a86f47522313f701a08Sujith 1107fb9987d0f748c983bb795a86f47522313f701a08Sujith do { 1108fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_irqsave(&priv->rx.rxbuflock, flags); 1109fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry(tmp_buf, &priv->rx.rxbuf, list) { 1110fb9987d0f748c983bb795a86f47522313f701a08Sujith if (tmp_buf->in_process) { 1111fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = tmp_buf; 1112fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 1113fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1114fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1115fb9987d0f748c983bb795a86f47522313f701a08Sujith 1116fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 1117fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 1118fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 1119fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1120fb9987d0f748c983bb795a86f47522313f701a08Sujith 1121fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!rxbuf->skb) 1122fb9987d0f748c983bb795a86f47522313f701a08Sujith goto requeue; 1123fb9987d0f748c983bb795a86f47522313f701a08Sujith 1124fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!ath9k_rx_prepare(priv, rxbuf, &rx_status)) { 1125fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(rxbuf->skb); 1126fb9987d0f748c983bb795a86f47522313f701a08Sujith goto requeue; 1127fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1128fb9987d0f748c983bb795a86f47522313f701a08Sujith 1129fb9987d0f748c983bb795a86f47522313f701a08Sujith memcpy(IEEE80211_SKB_RXCB(rxbuf->skb), &rx_status, 1130fb9987d0f748c983bb795a86f47522313f701a08Sujith sizeof(struct ieee80211_rx_status)); 1131fb9987d0f748c983bb795a86f47522313f701a08Sujith skb = rxbuf->skb; 1132bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan hdr = (struct ieee80211_hdr *) skb->data; 1133bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan 1134bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan if (ieee80211_is_beacon(hdr->frame_control) && priv->ps_enabled) 1135bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan ieee80211_queue_work(priv->hw, &priv->ps_work); 1136bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan 1137fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 1138fb9987d0f748c983bb795a86f47522313f701a08Sujith 1139fb9987d0f748c983bb795a86f47522313f701a08Sujith ieee80211_rx(priv->hw, skb); 1140fb9987d0f748c983bb795a86f47522313f701a08Sujith 1141fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_irqsave(&priv->rx.rxbuflock, flags); 1142fb9987d0f748c983bb795a86f47522313f701a08Sujithrequeue: 1143fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->in_process = false; 1144fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->skb = NULL; 1145fb9987d0f748c983bb795a86f47522313f701a08Sujith list_move_tail(&rxbuf->list, &priv->rx.rxbuf); 1146fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = NULL; 1147fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 1148fb9987d0f748c983bb795a86f47522313f701a08Sujith } while (1); 1149fb9987d0f748c983bb795a86f47522313f701a08Sujith 1150fb9987d0f748c983bb795a86f47522313f701a08Sujith} 1151fb9987d0f748c983bb795a86f47522313f701a08Sujith 1152fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_htc_rxep(void *drv_priv, struct sk_buff *skb, 1153fb9987d0f748c983bb795a86f47522313f701a08Sujith enum htc_endpoint_id ep_id) 1154fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 1155fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)drv_priv; 1156fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 1157fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 1158fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf = NULL, *tmp_buf = NULL; 1159fb9987d0f748c983bb795a86f47522313f701a08Sujith 1160fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock(&priv->rx.rxbuflock); 1161fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry(tmp_buf, &priv->rx.rxbuf, list) { 1162fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!tmp_buf->in_process) { 1163fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = tmp_buf; 1164fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 1165fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1166fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1167fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock(&priv->rx.rxbuflock); 1168fb9987d0f748c983bb795a86f47522313f701a08Sujith 1169fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 1170226afe68fdbd1aa3680158aca0a3631cbd019626Joe Perches ath_dbg(common, ATH_DBG_ANY, 1171226afe68fdbd1aa3680158aca0a3631cbd019626Joe Perches "No free RX buffer\n"); 1172fb9987d0f748c983bb795a86f47522313f701a08Sujith goto err; 1173fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1174fb9987d0f748c983bb795a86f47522313f701a08Sujith 1175fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock(&priv->rx.rxbuflock); 1176fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->skb = skb; 1177fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->in_process = true; 1178fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock(&priv->rx.rxbuflock); 1179fb9987d0f748c983bb795a86f47522313f701a08Sujith 1180fb9987d0f748c983bb795a86f47522313f701a08Sujith tasklet_schedule(&priv->rx_tasklet); 1181fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 1182fb9987d0f748c983bb795a86f47522313f701a08Sujitherr: 1183fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(skb); 1184fb9987d0f748c983bb795a86f47522313f701a08Sujith} 1185fb9987d0f748c983bb795a86f47522313f701a08Sujith 1186fb9987d0f748c983bb795a86f47522313f701a08Sujith/* FIXME: Locking for cleanup/init */ 1187fb9987d0f748c983bb795a86f47522313f701a08Sujith 1188fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_rx_cleanup(struct ath9k_htc_priv *priv) 1189fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 1190fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf, *tbuf; 1191fb9987d0f748c983bb795a86f47522313f701a08Sujith 1192fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry_safe(rxbuf, tbuf, &priv->rx.rxbuf, list) { 1193fb9987d0f748c983bb795a86f47522313f701a08Sujith list_del(&rxbuf->list); 1194fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->skb) 1195fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(rxbuf->skb); 1196fb9987d0f748c983bb795a86f47522313f701a08Sujith kfree(rxbuf); 1197fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1198fb9987d0f748c983bb795a86f47522313f701a08Sujith} 1199fb9987d0f748c983bb795a86f47522313f701a08Sujith 1200fb9987d0f748c983bb795a86f47522313f701a08Sujithint ath9k_rx_init(struct ath9k_htc_priv *priv) 1201fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 1202fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 1203fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 1204fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf; 1205fb9987d0f748c983bb795a86f47522313f701a08Sujith int i = 0; 1206fb9987d0f748c983bb795a86f47522313f701a08Sujith 1207fb9987d0f748c983bb795a86f47522313f701a08Sujith INIT_LIST_HEAD(&priv->rx.rxbuf); 1208fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_init(&priv->rx.rxbuflock); 1209fb9987d0f748c983bb795a86f47522313f701a08Sujith 1210fb9987d0f748c983bb795a86f47522313f701a08Sujith for (i = 0; i < ATH9K_HTC_RXBUF; i++) { 1211fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = kzalloc(sizeof(struct ath9k_htc_rxbuf), GFP_KERNEL); 1212fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 12133800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, "Unable to allocate RX buffers\n"); 1214fb9987d0f748c983bb795a86f47522313f701a08Sujith goto err; 1215fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1216fb9987d0f748c983bb795a86f47522313f701a08Sujith list_add_tail(&rxbuf->list, &priv->rx.rxbuf); 1217fb9987d0f748c983bb795a86f47522313f701a08Sujith } 1218fb9987d0f748c983bb795a86f47522313f701a08Sujith 1219fb9987d0f748c983bb795a86f47522313f701a08Sujith return 0; 1220fb9987d0f748c983bb795a86f47522313f701a08Sujith 1221fb9987d0f748c983bb795a86f47522313f701a08Sujitherr: 1222fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_rx_cleanup(priv); 1223fb9987d0f748c983bb795a86f47522313f701a08Sujith return -ENOMEM; 1224fb9987d0f748c983bb795a86f47522313f701a08Sujith} 1225