htc_drv_txrx.c revision 729bd3ab460d3bb8236cc8f6fd0289201124112d
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 79d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharanstatic enum htc_endpoint_id get_htc_epid(struct ath9k_htc_priv *priv, 80d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan u16 qnum) 81d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan{ 82d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan enum htc_endpoint_id epid; 83d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 84d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan switch (qnum) { 85d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 0: 86d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_VO); 87d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_vo_ep; 88d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 89d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 1: 90d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_VI); 91d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_vi_ep; 92d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 93d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 2: 94d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_BE); 95d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_be_ep; 96d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 97d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan case 3: 98d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan default: 99d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan TX_QSTAT_INC(WME_AC_BK); 100d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan epid = priv->data_bk_ep; 101d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan break; 102d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan } 103d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 104d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan return epid; 105d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan} 106d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan 107729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharanstatic inline int strip_drv_header(struct ath9k_htc_priv *priv, 108729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct sk_buff *skb) 109729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan{ 110729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath_common *common = ath9k_hw_common(priv->ah); 111729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 112729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 113729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 114729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 115729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan if (tx_ctl->epid == priv->mgmt_ep) { 116729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan skb_pull(skb, sizeof(struct tx_mgmt_hdr)); 117729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } else if ((tx_ctl->epid == priv->data_bk_ep) || 118729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_be_ep) || 119729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_vi_ep) || 120729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->data_vo_ep) || 121729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan (tx_ctl->epid == priv->cab_ep)) { 122729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan skb_pull(skb, sizeof(struct tx_frame_hdr)); 123729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } else { 124729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan ath_err(common, "Unsupported EPID: %d\n", tx_ctl->epid); 125729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan return -EINVAL; 126729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } 127729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 128729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan return 0; 129729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan} 130729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 131e1572c5eeca8ef87a250322364584458b2dadb35Sujithint ath_htc_txq_update(struct ath9k_htc_priv *priv, int qnum, 132e1572c5eeca8ef87a250322364584458b2dadb35Sujith struct ath9k_tx_queue_info *qinfo) 133fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 134fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 135fb9987d0f748c983bb795a86f47522313f701a08Sujith int error = 0; 136fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_tx_queue_info qi; 137fb9987d0f748c983bb795a86f47522313f701a08Sujith 138fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_get_txq_props(ah, qnum, &qi); 139fb9987d0f748c983bb795a86f47522313f701a08Sujith 140fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_aifs = qinfo->tqi_aifs; 141fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_cwmin = qinfo->tqi_cwmin / 2; /* XXX */ 142fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_cwmax = qinfo->tqi_cwmax; 143fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_burstTime = qinfo->tqi_burstTime; 144fb9987d0f748c983bb795a86f47522313f701a08Sujith qi.tqi_readyTime = qinfo->tqi_readyTime; 145fb9987d0f748c983bb795a86f47522313f701a08Sujith 146fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!ath9k_hw_set_txq_props(ah, qnum, &qi)) { 1473800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(ath9k_hw_common(ah), 1483800276a40751539a920ef8e0537ef2e19126799Joe Perches "Unable to update hardware queue %u!\n", qnum); 149fb9987d0f748c983bb795a86f47522313f701a08Sujith error = -EIO; 150fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 151fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_resettxqueue(ah, qnum); 152fb9987d0f748c983bb795a86f47522313f701a08Sujith } 153fb9987d0f748c983bb795a86f47522313f701a08Sujith 154fb9987d0f748c983bb795a86f47522313f701a08Sujith return error; 155fb9987d0f748c983bb795a86f47522313f701a08Sujith} 156fb9987d0f748c983bb795a86f47522313f701a08Sujith 1577d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharanint ath9k_htc_tx_start(struct ath9k_htc_priv *priv, 1587d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan struct sk_buff *skb, bool is_cab) 159fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 160fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 1619b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan struct ieee80211_mgmt *mgmt; 162fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb); 163fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_sta *sta = tx_info->control.sta; 164a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan struct ieee80211_vif *vif = tx_info->control.vif; 165fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_sta *ista; 1669b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan struct ath9k_htc_vif *avp = NULL; 16740dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 168b80841c91f42dc048a60bff5e1614a619f725e38Sujith u16 qnum; 169fb9987d0f748c983bb795a86f47522313f701a08Sujith __le16 fc; 170fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 *tx_fhdr; 171da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan u8 sta_idx, vif_idx; 172fb9987d0f748c983bb795a86f47522313f701a08Sujith 17340dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan tx_ctl = HTC_SKB_CB(skb); 17440dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan memset(tx_ctl, 0, sizeof(*tx_ctl)); 17540dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan 176fb9987d0f748c983bb795a86f47522313f701a08Sujith hdr = (struct ieee80211_hdr *) skb->data; 177fb9987d0f748c983bb795a86f47522313f701a08Sujith fc = hdr->frame_control; 178fb9987d0f748c983bb795a86f47522313f701a08Sujith 179a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan /* 180a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * Find out on which interface this packet has to be 181a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * sent out. 182a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan */ 183a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan if (vif) { 184a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan avp = (struct ath9k_htc_vif *) vif->drv_priv; 185a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan vif_idx = avp->index; 186a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } else { 187a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan if (!priv->ah->is_monitoring) { 188a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan ath_dbg(ath9k_hw_common(priv->ah), ATH_DBG_XMIT, 189a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan "VIF is null, but no monitor interface !\n"); 190a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan return -EINVAL; 191a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } 192a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan 193a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan vif_idx = priv->mon_vif_idx; 194a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan } 195da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan 196a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan /* 197a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan * Find out which station this packet is destined for. 198a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan */ 199fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sta) { 200fb9987d0f748c983bb795a86f47522313f701a08Sujith ista = (struct ath9k_htc_sta *) sta->drv_priv; 201fb9987d0f748c983bb795a86f47522313f701a08Sujith sta_idx = ista->index; 202fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 203a97b478c92c14255d375ed9ceb7a882083523593Sujith Manoharan sta_idx = priv->vif_sta_pos[vif_idx]; 204fb9987d0f748c983bb795a86f47522313f701a08Sujith } 205fb9987d0f748c983bb795a86f47522313f701a08Sujith 206fb9987d0f748c983bb795a86f47522313f701a08Sujith if (ieee80211_is_data(fc)) { 207fb9987d0f748c983bb795a86f47522313f701a08Sujith struct tx_frame_hdr tx_hdr; 208dc738cb6c5d5594de4bdf3b7839a250b032152e7Rajkumar Manoharan u32 flags = 0; 209fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 *qc; 210fb9987d0f748c983bb795a86f47522313f701a08Sujith 211fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(&tx_hdr, 0, sizeof(struct tx_frame_hdr)); 212fb9987d0f748c983bb795a86f47522313f701a08Sujith 213fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.node_idx = sta_idx; 214da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan tx_hdr.vif_idx = vif_idx; 215fb9987d0f748c983bb795a86f47522313f701a08Sujith 216fb9987d0f748c983bb795a86f47522313f701a08Sujith if (tx_info->flags & IEEE80211_TX_CTL_AMPDU) { 21740dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan tx_ctl->type = ATH9K_HTC_AMPDU; 218fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.data_type = ATH9K_HTC_AMPDU; 219fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 22040dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan tx_ctl->type = ATH9K_HTC_NORMAL; 221fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.data_type = ATH9K_HTC_NORMAL; 222fb9987d0f748c983bb795a86f47522313f701a08Sujith } 223fb9987d0f748c983bb795a86f47522313f701a08Sujith 2243bf30b56c4f0a1c4fae34050b7db4527c92891e8Rajkumar Manoharan if (ieee80211_is_data_qos(fc)) { 225fb9987d0f748c983bb795a86f47522313f701a08Sujith qc = ieee80211_get_qos_ctl(hdr); 226fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.tidno = qc[0] & IEEE80211_QOS_CTL_TID_MASK; 227fb9987d0f748c983bb795a86f47522313f701a08Sujith } 228fb9987d0f748c983bb795a86f47522313f701a08Sujith 229fb9987d0f748c983bb795a86f47522313f701a08Sujith /* Check for RTS protection */ 230fb9987d0f748c983bb795a86f47522313f701a08Sujith if (priv->hw->wiphy->rts_threshold != (u32) -1) 231fb9987d0f748c983bb795a86f47522313f701a08Sujith if (skb->len > priv->hw->wiphy->rts_threshold) 232dc738cb6c5d5594de4bdf3b7839a250b032152e7Rajkumar Manoharan flags |= ATH9K_HTC_TX_RTSCTS; 233fb9987d0f748c983bb795a86f47522313f701a08Sujith 234fb9987d0f748c983bb795a86f47522313f701a08Sujith /* CTS-to-self */ 235dc738cb6c5d5594de4bdf3b7839a250b032152e7Rajkumar Manoharan if (!(flags & ATH9K_HTC_TX_RTSCTS) && 2369304c82d8f3b40eb31c2d04f5849fbd9802c06efSujith Manoharan (vif && vif->bss_conf.use_cts_prot)) 237dc738cb6c5d5594de4bdf3b7839a250b032152e7Rajkumar Manoharan flags |= ATH9K_HTC_TX_CTSONLY; 238fb9987d0f748c983bb795a86f47522313f701a08Sujith 239dc738cb6c5d5594de4bdf3b7839a250b032152e7Rajkumar Manoharan tx_hdr.flags = cpu_to_be32(flags); 240fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.key_type = ath9k_cmn_get_hw_crypto_keytype(skb); 241fb9987d0f748c983bb795a86f47522313f701a08Sujith if (tx_hdr.key_type == ATH9K_KEY_TYPE_CLEAR) 242fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.keyix = (u8) ATH9K_TXKEYIX_INVALID; 243fb9987d0f748c983bb795a86f47522313f701a08Sujith else 244fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_hdr.keyix = tx_info->control.hw_key->hw_key_idx; 245fb9987d0f748c983bb795a86f47522313f701a08Sujith 246fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_fhdr = skb_push(skb, sizeof(tx_hdr)); 247fb9987d0f748c983bb795a86f47522313f701a08Sujith memcpy(tx_fhdr, (u8 *) &tx_hdr, sizeof(tx_hdr)); 248fb9987d0f748c983bb795a86f47522313f701a08Sujith 2497d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan if (is_cab) { 2507d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan CAB_STAT_INC; 251d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan tx_ctl->epid = priv->cab_ep; 2527d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan goto send; 2537d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan } 2547d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharan 255fb9987d0f748c983bb795a86f47522313f701a08Sujith qnum = skb_get_queue_mapping(skb); 256d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan tx_ctl->epid = get_htc_epid(priv, qnum); 257fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 258fb9987d0f748c983bb795a86f47522313f701a08Sujith struct tx_mgmt_hdr mgmt_hdr; 259fb9987d0f748c983bb795a86f47522313f701a08Sujith 260fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(&mgmt_hdr, 0, sizeof(struct tx_mgmt_hdr)); 261fb9987d0f748c983bb795a86f47522313f701a08Sujith 2629b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan /* 2639b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan * Set the TSF adjust value for probe response 2649b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan * frame also. 2659b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan */ 2669b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan if (avp && unlikely(ieee80211_is_probe_resp(fc))) { 2679b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan mgmt = (struct ieee80211_mgmt *)skb->data; 2689b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan mgmt->u.probe_resp.timestamp = avp->tsfadjust; 2699b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan } 2709b674a0207c9b75ddcdcdb07e46843fac8267507Sujith Manoharan 27140dc9e4b86963b77918f1b8fa02b98c1e420a7e1Sujith Manoharan tx_ctl->type = ATH9K_HTC_MGMT; 272fb9987d0f748c983bb795a86f47522313f701a08Sujith 273fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.node_idx = sta_idx; 274da93f10684bfba2983a70c10b5d417232b6a5245Rajkumar Manoharan mgmt_hdr.vif_idx = vif_idx; 275fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.tidno = 0; 276fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.flags = 0; 277fb9987d0f748c983bb795a86f47522313f701a08Sujith 278fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.key_type = ath9k_cmn_get_hw_crypto_keytype(skb); 279fb9987d0f748c983bb795a86f47522313f701a08Sujith if (mgmt_hdr.key_type == ATH9K_KEY_TYPE_CLEAR) 280fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.keyix = (u8) ATH9K_TXKEYIX_INVALID; 281fb9987d0f748c983bb795a86f47522313f701a08Sujith else 282fb9987d0f748c983bb795a86f47522313f701a08Sujith mgmt_hdr.keyix = tx_info->control.hw_key->hw_key_idx; 283fb9987d0f748c983bb795a86f47522313f701a08Sujith 284fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_fhdr = skb_push(skb, sizeof(mgmt_hdr)); 285fb9987d0f748c983bb795a86f47522313f701a08Sujith memcpy(tx_fhdr, (u8 *) &mgmt_hdr, sizeof(mgmt_hdr)); 286d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan tx_ctl->epid = priv->mgmt_ep; 287fb9987d0f748c983bb795a86f47522313f701a08Sujith } 2887d547eb4bb664c5a6b7c8790c2ecb0aec5d15385Sujith Manoharansend: 289d67ee5339363608adce786ec8fd62a0fb2b66116Sujith Manoharan return htc_send(priv->htc, skb); 290fb9987d0f748c983bb795a86f47522313f701a08Sujith} 291fb9987d0f748c983bb795a86f47522313f701a08Sujith 292d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujithstatic bool ath9k_htc_check_tx_aggr(struct ath9k_htc_priv *priv, 293d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith struct ath9k_htc_sta *ista, u8 tid) 294d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith{ 295d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith bool ret = false; 296d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 297658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 298d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith if ((tid < ATH9K_HTC_MAX_TID) && (ista->tid_state[tid] == AGGR_STOP)) 299d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith ret = true; 300658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 301d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 302d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith return ret; 303d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith} 304d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith 305fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_tx_tasklet(unsigned long data) 306fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 307fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)data; 308729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 3092299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan struct ieee80211_vif *vif; 310fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_sta *sta; 311fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 312fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_tx_info *tx_info; 313fb9987d0f748c983bb795a86f47522313f701a08Sujith struct sk_buff *skb = NULL; 314fb9987d0f748c983bb795a86f47522313f701a08Sujith __le16 fc; 315729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan bool txok; 316fb9987d0f748c983bb795a86f47522313f701a08Sujith 317658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan while ((skb = skb_dequeue(&priv->tx.tx_queue)) != NULL) { 318fb9987d0f748c983bb795a86f47522313f701a08Sujith 319729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan if (strip_drv_header(priv, skb) < 0) { 320729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan dev_kfree_skb_any(skb); 321729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan continue; 322729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan } 323729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 324729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 325fb9987d0f748c983bb795a86f47522313f701a08Sujith hdr = (struct ieee80211_hdr *) skb->data; 326fb9987d0f748c983bb795a86f47522313f701a08Sujith fc = hdr->frame_control; 327fb9987d0f748c983bb795a86f47522313f701a08Sujith tx_info = IEEE80211_SKB_CB(skb); 3282299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan vif = tx_info->control.vif; 329729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan txok = tx_ctl->txok; 330ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 331ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith memset(&tx_info->status, 0, sizeof(tx_info->status)); 332fb9987d0f748c983bb795a86f47522313f701a08Sujith 333729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan /* 334729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan * URB submission failed for this frame, it never reached 335729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan * the target. 336729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan */ 337729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan if (!txok) 338729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan goto send_mac80211; 339729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 340729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_info->flags |= IEEE80211_TX_STAT_ACK; 341729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan 3422299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan if (!vif) 3432299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan goto send_mac80211; 3442299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan 345fb9987d0f748c983bb795a86f47522313f701a08Sujith rcu_read_lock(); 346fb9987d0f748c983bb795a86f47522313f701a08Sujith 3472299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan sta = ieee80211_find_sta(vif, hdr->addr1); 348ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith if (!sta) { 349ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith rcu_read_unlock(); 350ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith ieee80211_tx_status(priv->hw, skb); 351ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith continue; 352ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith } 353ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 354ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith /* Check if we need to start aggregation */ 355ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith 356fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sta && conf_is_ht(&priv->hw->conf) && 357d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith !(skb->protocol == cpu_to_be16(ETH_P_PAE))) { 358fb9987d0f748c983bb795a86f47522313f701a08Sujith if (ieee80211_is_data_qos(fc)) { 359fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 *qc, tid; 360fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_sta *ista; 361fb9987d0f748c983bb795a86f47522313f701a08Sujith 362fb9987d0f748c983bb795a86f47522313f701a08Sujith qc = ieee80211_get_qos_ctl(hdr); 363fb9987d0f748c983bb795a86f47522313f701a08Sujith tid = qc[0] & 0xf; 364fb9987d0f748c983bb795a86f47522313f701a08Sujith ista = (struct ath9k_htc_sta *)sta->drv_priv; 365fb9987d0f748c983bb795a86f47522313f701a08Sujith 366d7ca21393d39cb2e73dfc4c516e7be37ba01789eSujith if (ath9k_htc_check_tx_aggr(priv, ista, tid)) { 367bd2ce6e43f65127bc723e7fcc044758cf8113260Sujith Manoharan ieee80211_start_tx_ba_session(sta, tid, 0); 368658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 369fb9987d0f748c983bb795a86f47522313f701a08Sujith ista->tid_state[tid] = AGGR_PROGRESS; 370658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 371fb9987d0f748c983bb795a86f47522313f701a08Sujith } 372fb9987d0f748c983bb795a86f47522313f701a08Sujith } 373fb9987d0f748c983bb795a86f47522313f701a08Sujith } 374fb9987d0f748c983bb795a86f47522313f701a08Sujith 375fb9987d0f748c983bb795a86f47522313f701a08Sujith rcu_read_unlock(); 376fb9987d0f748c983bb795a86f47522313f701a08Sujith 3772299423bd0e32ccef78bbf1d4075617e3fd6cfd3Sujith Manoharan send_mac80211: 3788e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_lock_bh(&priv->tx.tx_lock); 3798e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan if (WARN_ON(--priv->tx.queued_cnt < 0)) 3808e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan priv->tx.queued_cnt = 0; 3818e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan spin_unlock_bh(&priv->tx.tx_lock); 3828e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan 383ef98c3cd9b68ed27eeb94b833f74860fa1a734b7Sujith /* Send status to mac80211 */ 384fb9987d0f748c983bb795a86f47522313f701a08Sujith ieee80211_tx_status(priv->hw, skb); 385fb9987d0f748c983bb795a86f47522313f701a08Sujith } 3867757dfed5809b03aa61c7d7f5ff8092f85df8583Sujith 3877757dfed5809b03aa61c7d7f5ff8092f85df8583Sujith /* Wake TX queues if needed */ 3888e86a54715c4102a8ed697939de9ebd9715dc59cSujith Manoharan ath9k_htc_check_wake_queues(priv); 389fb9987d0f748c983bb795a86f47522313f701a08Sujith} 390fb9987d0f748c983bb795a86f47522313f701a08Sujith 391fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_htc_txep(void *drv_priv, struct sk_buff *skb, 392fb9987d0f748c983bb795a86f47522313f701a08Sujith enum htc_endpoint_id ep_id, bool txok) 393fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 394fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) drv_priv; 395729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan struct ath9k_htc_tx_ctl *tx_ctl; 396fb9987d0f748c983bb795a86f47522313f701a08Sujith 397729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl = HTC_SKB_CB(skb); 398729bd3ab460d3bb8236cc8f6fd0289201124112dSujith Manoharan tx_ctl->txok = txok; 399fb9987d0f748c983bb795a86f47522313f701a08Sujith 400658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan skb_queue_tail(&priv->tx.tx_queue, skb); 401fb9987d0f748c983bb795a86f47522313f701a08Sujith tasklet_schedule(&priv->tx_tasklet); 402fb9987d0f748c983bb795a86f47522313f701a08Sujith} 403fb9987d0f748c983bb795a86f47522313f701a08Sujith 404fb9987d0f748c983bb795a86f47522313f701a08Sujithint ath9k_tx_init(struct ath9k_htc_priv *priv) 405fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 406658ef04fd42a587b17a379ad9208023473442dddSujith Manoharan skb_queue_head_init(&priv->tx.tx_queue); 407fb9987d0f748c983bb795a86f47522313f701a08Sujith return 0; 408fb9987d0f748c983bb795a86f47522313f701a08Sujith} 409fb9987d0f748c983bb795a86f47522313f701a08Sujith 410fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_tx_cleanup(struct ath9k_htc_priv *priv) 411fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 412fb9987d0f748c983bb795a86f47522313f701a08Sujith 413fb9987d0f748c983bb795a86f47522313f701a08Sujith} 414fb9987d0f748c983bb795a86f47522313f701a08Sujith 415e8c35a77e3408171852bde4914b650cf5b83e0d1Felix Fietkaubool ath9k_htc_txq_setup(struct ath9k_htc_priv *priv, int subtype) 416fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 417fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 418fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 419fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_tx_queue_info qi; 420fb9987d0f748c983bb795a86f47522313f701a08Sujith int qnum; 421fb9987d0f748c983bb795a86f47522313f701a08Sujith 422fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(&qi, 0, sizeof(qi)); 423ca74b83b66dbd289a395c6243695d746c76676ccSujith ATH9K_HTC_INIT_TXQ(subtype); 424fb9987d0f748c983bb795a86f47522313f701a08Sujith 425fb9987d0f748c983bb795a86f47522313f701a08Sujith qnum = ath9k_hw_setuptxqueue(priv->ah, ATH9K_TX_QUEUE_DATA, &qi); 426fb9987d0f748c983bb795a86f47522313f701a08Sujith if (qnum == -1) 427fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 428fb9987d0f748c983bb795a86f47522313f701a08Sujith 429fb9987d0f748c983bb795a86f47522313f701a08Sujith if (qnum >= ARRAY_SIZE(priv->hwq_map)) { 4303800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, "qnum %u out of range, max %zu!\n", 4313800276a40751539a920ef8e0537ef2e19126799Joe Perches qnum, ARRAY_SIZE(priv->hwq_map)); 432fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_releasetxqueue(ah, qnum); 433fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 434fb9987d0f748c983bb795a86f47522313f701a08Sujith } 435fb9987d0f748c983bb795a86f47522313f701a08Sujith 436fb9987d0f748c983bb795a86f47522313f701a08Sujith priv->hwq_map[subtype] = qnum; 437fb9987d0f748c983bb795a86f47522313f701a08Sujith return true; 438fb9987d0f748c983bb795a86f47522313f701a08Sujith} 439fb9987d0f748c983bb795a86f47522313f701a08Sujith 440ca74b83b66dbd289a395c6243695d746c76676ccSujithint ath9k_htc_cabq_setup(struct ath9k_htc_priv *priv) 441ca74b83b66dbd289a395c6243695d746c76676ccSujith{ 442ca74b83b66dbd289a395c6243695d746c76676ccSujith struct ath9k_tx_queue_info qi; 443ca74b83b66dbd289a395c6243695d746c76676ccSujith 444ca74b83b66dbd289a395c6243695d746c76676ccSujith memset(&qi, 0, sizeof(qi)); 445ca74b83b66dbd289a395c6243695d746c76676ccSujith ATH9K_HTC_INIT_TXQ(0); 446ca74b83b66dbd289a395c6243695d746c76676ccSujith 447ca74b83b66dbd289a395c6243695d746c76676ccSujith return ath9k_hw_setuptxqueue(priv->ah, ATH9K_TX_QUEUE_CAB, &qi); 448ca74b83b66dbd289a395c6243695d746c76676ccSujith} 449ca74b83b66dbd289a395c6243695d746c76676ccSujith 450fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 451fb9987d0f748c983bb795a86f47522313f701a08Sujith/* RX */ 452fb9987d0f748c983bb795a86f47522313f701a08Sujith/******/ 453fb9987d0f748c983bb795a86f47522313f701a08Sujith 4540995d110118b35c0dc5195e3ddddcc0dec263830Sujith/* 4550995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Calculate the RX filter to be set in the HW. 4560995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 4570995d110118b35c0dc5195e3ddddcc0dec263830Sujithu32 ath9k_htc_calcrxfilter(struct ath9k_htc_priv *priv) 4580995d110118b35c0dc5195e3ddddcc0dec263830Sujith{ 4590995d110118b35c0dc5195e3ddddcc0dec263830Sujith#define RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR) 4600995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4610995d110118b35c0dc5195e3ddddcc0dec263830Sujith struct ath_hw *ah = priv->ah; 4620995d110118b35c0dc5195e3ddddcc0dec263830Sujith u32 rfilt; 4630995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4640995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt = (ath9k_hw_getrxfilter(ah) & RX_FILTER_PRESERVE) 4650995d110118b35c0dc5195e3ddddcc0dec263830Sujith | ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST 4660995d110118b35c0dc5195e3ddddcc0dec263830Sujith | ATH9K_RX_FILTER_MCAST; 4670995d110118b35c0dc5195e3ddddcc0dec263830Sujith 46894a40c0c6bcc47ceba12e0247c5a23fb1e6c81e4Rajkumar Manoharan if (priv->rxfilter & FIF_PROBE_REQ) 4690995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_PROBEREQ; 4700995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4710995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* 4720995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station 4730995d110118b35c0dc5195e3ddddcc0dec263830Sujith * mode interface or when in monitor mode. AP mode does not need this 4740995d110118b35c0dc5195e3ddddcc0dec263830Sujith * since it receives all in-BSS frames anyway. 4750995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 4760995d110118b35c0dc5195e3ddddcc0dec263830Sujith if (((ah->opmode != NL80211_IFTYPE_AP) && 4770995d110118b35c0dc5195e3ddddcc0dec263830Sujith (priv->rxfilter & FIF_PROMISC_IN_BSS)) || 4784825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan ah->is_monitoring) 4790995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_PROM; 4800995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4810995d110118b35c0dc5195e3ddddcc0dec263830Sujith if (priv->rxfilter & FIF_CONTROL) 4820995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_CONTROL; 4830995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4840995d110118b35c0dc5195e3ddddcc0dec263830Sujith if ((ah->opmode == NL80211_IFTYPE_STATION) && 4850995d110118b35c0dc5195e3ddddcc0dec263830Sujith !(priv->rxfilter & FIF_BCN_PRBRESP_PROMISC)) 4860995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_MYBEACON; 4870995d110118b35c0dc5195e3ddddcc0dec263830Sujith else 4880995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_BEACON; 4890995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4904825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan if (conf_is_ht(&priv->hw->conf)) { 4910995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt |= ATH9K_RX_FILTER_COMP_BAR; 4924825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan rfilt |= ATH9K_RX_FILTER_UNCOMP_BA_BAR; 4934825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan } 4944825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan 4954825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan if (priv->rxfilter & FIF_PSPOLL) 4964825f54a44fc7280bf02c6d48c83d7a3df864e17Sujith Manoharan rfilt |= ATH9K_RX_FILTER_PSPOLL; 4970995d110118b35c0dc5195e3ddddcc0dec263830Sujith 4980995d110118b35c0dc5195e3ddddcc0dec263830Sujith return rfilt; 4990995d110118b35c0dc5195e3ddddcc0dec263830Sujith 5000995d110118b35c0dc5195e3ddddcc0dec263830Sujith#undef RX_FILTER_PRESERVE 5010995d110118b35c0dc5195e3ddddcc0dec263830Sujith} 5020995d110118b35c0dc5195e3ddddcc0dec263830Sujith 5030995d110118b35c0dc5195e3ddddcc0dec263830Sujith/* 5040995d110118b35c0dc5195e3ddddcc0dec263830Sujith * Recv initialization for opmode change. 5050995d110118b35c0dc5195e3ddddcc0dec263830Sujith */ 5060995d110118b35c0dc5195e3ddddcc0dec263830Sujithstatic void ath9k_htc_opmode_init(struct ath9k_htc_priv *priv) 5070995d110118b35c0dc5195e3ddddcc0dec263830Sujith{ 5080995d110118b35c0dc5195e3ddddcc0dec263830Sujith struct ath_hw *ah = priv->ah; 5090995d110118b35c0dc5195e3ddddcc0dec263830Sujith u32 rfilt, mfilt[2]; 5100995d110118b35c0dc5195e3ddddcc0dec263830Sujith 5110995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* configure rx filter */ 5120995d110118b35c0dc5195e3ddddcc0dec263830Sujith rfilt = ath9k_htc_calcrxfilter(priv); 5130995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_hw_setrxfilter(ah, rfilt); 5140995d110118b35c0dc5195e3ddddcc0dec263830Sujith 5150995d110118b35c0dc5195e3ddddcc0dec263830Sujith /* calculate and install multicast filter */ 5160995d110118b35c0dc5195e3ddddcc0dec263830Sujith mfilt[0] = mfilt[1] = ~0; 5170995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]); 5180995d110118b35c0dc5195e3ddddcc0dec263830Sujith} 5190995d110118b35c0dc5195e3ddddcc0dec263830Sujith 520fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_host_rx_init(struct ath9k_htc_priv *priv) 521fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 522fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_hw_rxena(priv->ah); 5230995d110118b35c0dc5195e3ddddcc0dec263830Sujith ath9k_htc_opmode_init(priv); 52440346b66799b7d382e61bbb68a6b6bbdd20f320eLuis R. Rodriguez ath9k_hw_startpcureceive(priv->ah, (priv->op_flags & OP_SCANNING)); 525fb9987d0f748c983bb795a86f47522313f701a08Sujith priv->rx.last_rssi = ATH_RSSI_DUMMY_MARKER; 526fb9987d0f748c983bb795a86f47522313f701a08Sujith} 527fb9987d0f748c983bb795a86f47522313f701a08Sujith 528fb9987d0f748c983bb795a86f47522313f701a08Sujithstatic void ath9k_process_rate(struct ieee80211_hw *hw, 529fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status *rxs, 530fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 rx_rate, u8 rs_flags) 531fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 532fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_supported_band *sband; 533fb9987d0f748c983bb795a86f47522313f701a08Sujith enum ieee80211_band band; 534fb9987d0f748c983bb795a86f47522313f701a08Sujith unsigned int i = 0; 535fb9987d0f748c983bb795a86f47522313f701a08Sujith 536fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rx_rate & 0x80) { 537fb9987d0f748c983bb795a86f47522313f701a08Sujith /* HT rate */ 538fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_HT; 539fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rs_flags & ATH9K_RX_2040) 540fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_40MHZ; 541fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rs_flags & ATH9K_RX_GI) 542fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_SHORT_GI; 543fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = rx_rate & 0x7f; 544fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 545fb9987d0f748c983bb795a86f47522313f701a08Sujith } 546fb9987d0f748c983bb795a86f47522313f701a08Sujith 547fb9987d0f748c983bb795a86f47522313f701a08Sujith band = hw->conf.channel->band; 548fb9987d0f748c983bb795a86f47522313f701a08Sujith sband = hw->wiphy->bands[band]; 549fb9987d0f748c983bb795a86f47522313f701a08Sujith 550fb9987d0f748c983bb795a86f47522313f701a08Sujith for (i = 0; i < sband->n_bitrates; i++) { 551fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sband->bitrates[i].hw_value == rx_rate) { 552fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = i; 553fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 554fb9987d0f748c983bb795a86f47522313f701a08Sujith } 555fb9987d0f748c983bb795a86f47522313f701a08Sujith if (sband->bitrates[i].hw_value_short == rx_rate) { 556fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->rate_idx = i; 557fb9987d0f748c983bb795a86f47522313f701a08Sujith rxs->flag |= RX_FLAG_SHORTPRE; 558fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 559fb9987d0f748c983bb795a86f47522313f701a08Sujith } 560fb9987d0f748c983bb795a86f47522313f701a08Sujith } 561fb9987d0f748c983bb795a86f47522313f701a08Sujith 562fb9987d0f748c983bb795a86f47522313f701a08Sujith} 563fb9987d0f748c983bb795a86f47522313f701a08Sujith 564fb9987d0f748c983bb795a86f47522313f701a08Sujithstatic bool ath9k_rx_prepare(struct ath9k_htc_priv *priv, 565fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf, 566fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status *rx_status) 567fb9987d0f748c983bb795a86f47522313f701a08Sujith 568fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 569fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hdr *hdr; 570fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_hw *hw = priv->hw; 571fb9987d0f748c983bb795a86f47522313f701a08Sujith struct sk_buff *skb = rxbuf->skb; 572fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(priv->ah); 5734f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith struct ath_htc_rx_status *rxstatus; 574fb9987d0f748c983bb795a86f47522313f701a08Sujith int hdrlen, padpos, padsize; 575fb9987d0f748c983bb795a86f47522313f701a08Sujith int last_rssi = ATH_RSSI_DUMMY_MARKER; 576fb9987d0f748c983bb795a86f47522313f701a08Sujith __le16 fc; 577fb9987d0f748c983bb795a86f47522313f701a08Sujith 578b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan if (skb->len < HTC_RX_FRAME_HEADER_SIZE) { 579b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan ath_err(common, "Corrupted RX frame, dropping (len: %d)\n", 580b1563a4c3d721cb0496b8e1fb874f08a8f2b62ccSujith Manoharan skb->len); 5814f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith goto rx_next; 5824f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith } 5834f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 5844f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith rxstatus = (struct ath_htc_rx_status *)skb->data; 5854f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 5864f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith if (be16_to_cpu(rxstatus->rs_datalen) - 5874f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith (skb->len - HTC_RX_FRAME_HEADER_SIZE) != 0) { 5883800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, 5893800276a40751539a920ef8e0537ef2e19126799Joe Perches "Corrupted RX data len, dropping (dlen: %d, skblen: %d)\n", 5903800276a40751539a920ef8e0537ef2e19126799Joe Perches rxstatus->rs_datalen, skb->len); 5914f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith goto rx_next; 5924f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith } 5934f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 594719c4cf6b1b113e9caf377c6607ae45758a85871Sujith Manoharan ath9k_htc_err_stat_rx(priv, rxstatus); 595719c4cf6b1b113e9caf377c6607ae45758a85871Sujith Manoharan 5964f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith /* Get the RX status information */ 5974f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith memcpy(&rxbuf->rxstatus, rxstatus, HTC_RX_FRAME_HEADER_SIZE); 5984f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith skb_pull(skb, HTC_RX_FRAME_HEADER_SIZE); 5994f824719a2729f1a6bb78de20c4d3b3dbdd81a09Sujith 600fb9987d0f748c983bb795a86f47522313f701a08Sujith hdr = (struct ieee80211_hdr *)skb->data; 601fb9987d0f748c983bb795a86f47522313f701a08Sujith fc = hdr->frame_control; 602fb9987d0f748c983bb795a86f47522313f701a08Sujith hdrlen = ieee80211_get_hdrlen_from_skb(skb); 603fb9987d0f748c983bb795a86f47522313f701a08Sujith 604fb9987d0f748c983bb795a86f47522313f701a08Sujith padpos = ath9k_cmn_padpos(fc); 605fb9987d0f748c983bb795a86f47522313f701a08Sujith 606fb9987d0f748c983bb795a86f47522313f701a08Sujith padsize = padpos & 3; 60732fbccafed7e935432b601f0453c2b702a385a25Sujith if (padsize && skb->len >= padpos+padsize+FCS_LEN) { 608fb9987d0f748c983bb795a86f47522313f701a08Sujith memmove(skb->data + padsize, skb->data, padpos); 609fb9987d0f748c983bb795a86f47522313f701a08Sujith skb_pull(skb, padsize); 610fb9987d0f748c983bb795a86f47522313f701a08Sujith } 611fb9987d0f748c983bb795a86f47522313f701a08Sujith 612fb9987d0f748c983bb795a86f47522313f701a08Sujith memset(rx_status, 0, sizeof(struct ieee80211_rx_status)); 613fb9987d0f748c983bb795a86f47522313f701a08Sujith 614fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status != 0) { 615fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_CRC) 616fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; 617fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_PHY) 618fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 619fb9987d0f748c983bb795a86f47522313f701a08Sujith 620fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_DECRYPT) { 621fb9987d0f748c983bb795a86f47522313f701a08Sujith /* FIXME */ 622fb9987d0f748c983bb795a86f47522313f701a08Sujith } else if (rxbuf->rxstatus.rs_status & ATH9K_RXERR_MIC) { 623fb9987d0f748c983bb795a86f47522313f701a08Sujith if (ieee80211_is_ctl(fc)) 624fb9987d0f748c983bb795a86f47522313f701a08Sujith /* 625fb9987d0f748c983bb795a86f47522313f701a08Sujith * Sometimes, we get invalid 626fb9987d0f748c983bb795a86f47522313f701a08Sujith * MIC failures on valid control frames. 627fb9987d0f748c983bb795a86f47522313f701a08Sujith * Remove these mic errors. 628fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 629fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->rxstatus.rs_status &= ~ATH9K_RXERR_MIC; 630fb9987d0f748c983bb795a86f47522313f701a08Sujith else 631fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_MMIC_ERROR; 632fb9987d0f748c983bb795a86f47522313f701a08Sujith } 633fb9987d0f748c983bb795a86f47522313f701a08Sujith 634fb9987d0f748c983bb795a86f47522313f701a08Sujith /* 635fb9987d0f748c983bb795a86f47522313f701a08Sujith * Reject error frames with the exception of 636fb9987d0f748c983bb795a86f47522313f701a08Sujith * decryption and MIC failures. For monitor mode, 637fb9987d0f748c983bb795a86f47522313f701a08Sujith * we also ignore the CRC error. 638fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 639fb9987d0f748c983bb795a86f47522313f701a08Sujith if (priv->ah->opmode == NL80211_IFTYPE_MONITOR) { 640fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & 641fb9987d0f748c983bb795a86f47522313f701a08Sujith ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC | 642fb9987d0f748c983bb795a86f47522313f701a08Sujith ATH9K_RXERR_CRC)) 643fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 644fb9987d0f748c983bb795a86f47522313f701a08Sujith } else { 645fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->rxstatus.rs_status & 646fb9987d0f748c983bb795a86f47522313f701a08Sujith ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) { 647fb9987d0f748c983bb795a86f47522313f701a08Sujith goto rx_next; 648fb9987d0f748c983bb795a86f47522313f701a08Sujith } 649fb9987d0f748c983bb795a86f47522313f701a08Sujith } 650fb9987d0f748c983bb795a86f47522313f701a08Sujith } 651fb9987d0f748c983bb795a86f47522313f701a08Sujith 652fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!(rxbuf->rxstatus.rs_status & ATH9K_RXERR_DECRYPT)) { 653fb9987d0f748c983bb795a86f47522313f701a08Sujith u8 keyix; 654fb9987d0f748c983bb795a86f47522313f701a08Sujith keyix = rxbuf->rxstatus.rs_keyix; 655fb9987d0f748c983bb795a86f47522313f701a08Sujith if (keyix != ATH9K_RXKEYIX_INVALID) { 656fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_DECRYPTED; 657fb9987d0f748c983bb795a86f47522313f701a08Sujith } else if (ieee80211_has_protected(fc) && 658fb9987d0f748c983bb795a86f47522313f701a08Sujith skb->len >= hdrlen + 4) { 659fb9987d0f748c983bb795a86f47522313f701a08Sujith keyix = skb->data[hdrlen + 3] >> 6; 660fb9987d0f748c983bb795a86f47522313f701a08Sujith if (test_bit(keyix, common->keymap)) 661fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->flag |= RX_FLAG_DECRYPTED; 662fb9987d0f748c983bb795a86f47522313f701a08Sujith } 663fb9987d0f748c983bb795a86f47522313f701a08Sujith } 664fb9987d0f748c983bb795a86f47522313f701a08Sujith 665fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_process_rate(hw, rx_status, rxbuf->rxstatus.rs_rate, 666fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->rxstatus.rs_flags); 667fb9987d0f748c983bb795a86f47522313f701a08Sujith 6687c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (rxbuf->rxstatus.rs_rssi != ATH9K_RSSI_BAD && 6697c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan !rxbuf->rxstatus.rs_moreaggr) 6707c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan ATH_RSSI_LPF(priv->rx.last_rssi, 6717c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi); 672fb9987d0f748c983bb795a86f47522313f701a08Sujith 6737c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan last_rssi = priv->rx.last_rssi; 674fb9987d0f748c983bb795a86f47522313f701a08Sujith 6757c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER)) 6767c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi = ATH_EP_RND(last_rssi, 6777c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan ATH_RSSI_EP_MULTIPLIER); 678fb9987d0f748c983bb795a86f47522313f701a08Sujith 6797c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (rxbuf->rxstatus.rs_rssi < 0) 6807c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan rxbuf->rxstatus.rs_rssi = 0; 681fb9987d0f748c983bb795a86f47522313f701a08Sujith 6827c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan if (ieee80211_is_beacon(fc)) 6837c277349ecbd66e19fad3d949fa6ef6c131a3b62Sujith Manoharan priv->ah->stats.avgbrssi = rxbuf->rxstatus.rs_rssi; 684fb9987d0f748c983bb795a86f47522313f701a08Sujith 6857f1f5a0060e377ff6a15903487b39223e12b8568Sujith rx_status->mactime = be64_to_cpu(rxbuf->rxstatus.rs_tstamp); 686fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->band = hw->conf.channel->band; 687fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->freq = hw->conf.channel->center_freq; 688fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->signal = rxbuf->rxstatus.rs_rssi + ATH_DEFAULT_NOISE_FLOOR; 689fb9987d0f748c983bb795a86f47522313f701a08Sujith rx_status->antenna = rxbuf->rxstatus.rs_antenna; 6906ebacbb79d2d05978ba50a24d8cbe2a76ff2014cJohannes Berg rx_status->flag |= RX_FLAG_MACTIME_MPDU; 691fb9987d0f748c983bb795a86f47522313f701a08Sujith 692fb9987d0f748c983bb795a86f47522313f701a08Sujith return true; 693fb9987d0f748c983bb795a86f47522313f701a08Sujith 694fb9987d0f748c983bb795a86f47522313f701a08Sujithrx_next: 695fb9987d0f748c983bb795a86f47522313f701a08Sujith return false; 696fb9987d0f748c983bb795a86f47522313f701a08Sujith} 697fb9987d0f748c983bb795a86f47522313f701a08Sujith 698fb9987d0f748c983bb795a86f47522313f701a08Sujith/* 699fb9987d0f748c983bb795a86f47522313f701a08Sujith * FIXME: Handle FLUSH later on. 700fb9987d0f748c983bb795a86f47522313f701a08Sujith */ 701fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_rx_tasklet(unsigned long data) 702fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 703fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)data; 704fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf = NULL, *tmp_buf = NULL; 705fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ieee80211_rx_status rx_status; 706fb9987d0f748c983bb795a86f47522313f701a08Sujith struct sk_buff *skb; 707fb9987d0f748c983bb795a86f47522313f701a08Sujith unsigned long flags; 708bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan struct ieee80211_hdr *hdr; 709fb9987d0f748c983bb795a86f47522313f701a08Sujith 710fb9987d0f748c983bb795a86f47522313f701a08Sujith do { 711fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_irqsave(&priv->rx.rxbuflock, flags); 712fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry(tmp_buf, &priv->rx.rxbuf, list) { 713fb9987d0f748c983bb795a86f47522313f701a08Sujith if (tmp_buf->in_process) { 714fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = tmp_buf; 715fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 716fb9987d0f748c983bb795a86f47522313f701a08Sujith } 717fb9987d0f748c983bb795a86f47522313f701a08Sujith } 718fb9987d0f748c983bb795a86f47522313f701a08Sujith 719fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 720fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 721fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 722fb9987d0f748c983bb795a86f47522313f701a08Sujith } 723fb9987d0f748c983bb795a86f47522313f701a08Sujith 724fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!rxbuf->skb) 725fb9987d0f748c983bb795a86f47522313f701a08Sujith goto requeue; 726fb9987d0f748c983bb795a86f47522313f701a08Sujith 727fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!ath9k_rx_prepare(priv, rxbuf, &rx_status)) { 728fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(rxbuf->skb); 729fb9987d0f748c983bb795a86f47522313f701a08Sujith goto requeue; 730fb9987d0f748c983bb795a86f47522313f701a08Sujith } 731fb9987d0f748c983bb795a86f47522313f701a08Sujith 732fb9987d0f748c983bb795a86f47522313f701a08Sujith memcpy(IEEE80211_SKB_RXCB(rxbuf->skb), &rx_status, 733fb9987d0f748c983bb795a86f47522313f701a08Sujith sizeof(struct ieee80211_rx_status)); 734fb9987d0f748c983bb795a86f47522313f701a08Sujith skb = rxbuf->skb; 735bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan hdr = (struct ieee80211_hdr *) skb->data; 736bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan 737bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan if (ieee80211_is_beacon(hdr->frame_control) && priv->ps_enabled) 738bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan ieee80211_queue_work(priv->hw, &priv->ps_work); 739bde748a40d4d5a9915def6772e208848c105e616Vivek Natarajan 740fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 741fb9987d0f748c983bb795a86f47522313f701a08Sujith 742fb9987d0f748c983bb795a86f47522313f701a08Sujith ieee80211_rx(priv->hw, skb); 743fb9987d0f748c983bb795a86f47522313f701a08Sujith 744fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_irqsave(&priv->rx.rxbuflock, flags); 745fb9987d0f748c983bb795a86f47522313f701a08Sujithrequeue: 746fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->in_process = false; 747fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->skb = NULL; 748fb9987d0f748c983bb795a86f47522313f701a08Sujith list_move_tail(&rxbuf->list, &priv->rx.rxbuf); 749fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = NULL; 750fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock_irqrestore(&priv->rx.rxbuflock, flags); 751fb9987d0f748c983bb795a86f47522313f701a08Sujith } while (1); 752fb9987d0f748c983bb795a86f47522313f701a08Sujith 753fb9987d0f748c983bb795a86f47522313f701a08Sujith} 754fb9987d0f748c983bb795a86f47522313f701a08Sujith 755fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_htc_rxep(void *drv_priv, struct sk_buff *skb, 756fb9987d0f748c983bb795a86f47522313f701a08Sujith enum htc_endpoint_id ep_id) 757fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 758fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *)drv_priv; 759fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 760fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 761fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf = NULL, *tmp_buf = NULL; 762fb9987d0f748c983bb795a86f47522313f701a08Sujith 763fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock(&priv->rx.rxbuflock); 764fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry(tmp_buf, &priv->rx.rxbuf, list) { 765fb9987d0f748c983bb795a86f47522313f701a08Sujith if (!tmp_buf->in_process) { 766fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = tmp_buf; 767fb9987d0f748c983bb795a86f47522313f701a08Sujith break; 768fb9987d0f748c983bb795a86f47522313f701a08Sujith } 769fb9987d0f748c983bb795a86f47522313f701a08Sujith } 770fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock(&priv->rx.rxbuflock); 771fb9987d0f748c983bb795a86f47522313f701a08Sujith 772fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 773226afe68fdbd1aa3680158aca0a3631cbd019626Joe Perches ath_dbg(common, ATH_DBG_ANY, 774226afe68fdbd1aa3680158aca0a3631cbd019626Joe Perches "No free RX buffer\n"); 775fb9987d0f748c983bb795a86f47522313f701a08Sujith goto err; 776fb9987d0f748c983bb795a86f47522313f701a08Sujith } 777fb9987d0f748c983bb795a86f47522313f701a08Sujith 778fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock(&priv->rx.rxbuflock); 779fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->skb = skb; 780fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf->in_process = true; 781fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_unlock(&priv->rx.rxbuflock); 782fb9987d0f748c983bb795a86f47522313f701a08Sujith 783fb9987d0f748c983bb795a86f47522313f701a08Sujith tasklet_schedule(&priv->rx_tasklet); 784fb9987d0f748c983bb795a86f47522313f701a08Sujith return; 785fb9987d0f748c983bb795a86f47522313f701a08Sujitherr: 786fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(skb); 787fb9987d0f748c983bb795a86f47522313f701a08Sujith} 788fb9987d0f748c983bb795a86f47522313f701a08Sujith 789fb9987d0f748c983bb795a86f47522313f701a08Sujith/* FIXME: Locking for cleanup/init */ 790fb9987d0f748c983bb795a86f47522313f701a08Sujith 791fb9987d0f748c983bb795a86f47522313f701a08Sujithvoid ath9k_rx_cleanup(struct ath9k_htc_priv *priv) 792fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 793fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf, *tbuf; 794fb9987d0f748c983bb795a86f47522313f701a08Sujith 795fb9987d0f748c983bb795a86f47522313f701a08Sujith list_for_each_entry_safe(rxbuf, tbuf, &priv->rx.rxbuf, list) { 796fb9987d0f748c983bb795a86f47522313f701a08Sujith list_del(&rxbuf->list); 797fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf->skb) 798fb9987d0f748c983bb795a86f47522313f701a08Sujith dev_kfree_skb_any(rxbuf->skb); 799fb9987d0f748c983bb795a86f47522313f701a08Sujith kfree(rxbuf); 800fb9987d0f748c983bb795a86f47522313f701a08Sujith } 801fb9987d0f748c983bb795a86f47522313f701a08Sujith} 802fb9987d0f748c983bb795a86f47522313f701a08Sujith 803fb9987d0f748c983bb795a86f47522313f701a08Sujithint ath9k_rx_init(struct ath9k_htc_priv *priv) 804fb9987d0f748c983bb795a86f47522313f701a08Sujith{ 805fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_hw *ah = priv->ah; 806fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath_common *common = ath9k_hw_common(ah); 807fb9987d0f748c983bb795a86f47522313f701a08Sujith struct ath9k_htc_rxbuf *rxbuf; 808fb9987d0f748c983bb795a86f47522313f701a08Sujith int i = 0; 809fb9987d0f748c983bb795a86f47522313f701a08Sujith 810fb9987d0f748c983bb795a86f47522313f701a08Sujith INIT_LIST_HEAD(&priv->rx.rxbuf); 811fb9987d0f748c983bb795a86f47522313f701a08Sujith spin_lock_init(&priv->rx.rxbuflock); 812fb9987d0f748c983bb795a86f47522313f701a08Sujith 813fb9987d0f748c983bb795a86f47522313f701a08Sujith for (i = 0; i < ATH9K_HTC_RXBUF; i++) { 814fb9987d0f748c983bb795a86f47522313f701a08Sujith rxbuf = kzalloc(sizeof(struct ath9k_htc_rxbuf), GFP_KERNEL); 815fb9987d0f748c983bb795a86f47522313f701a08Sujith if (rxbuf == NULL) { 8163800276a40751539a920ef8e0537ef2e19126799Joe Perches ath_err(common, "Unable to allocate RX buffers\n"); 817fb9987d0f748c983bb795a86f47522313f701a08Sujith goto err; 818fb9987d0f748c983bb795a86f47522313f701a08Sujith } 819fb9987d0f748c983bb795a86f47522313f701a08Sujith list_add_tail(&rxbuf->list, &priv->rx.rxbuf); 820fb9987d0f748c983bb795a86f47522313f701a08Sujith } 821fb9987d0f748c983bb795a86f47522313f701a08Sujith 822fb9987d0f748c983bb795a86f47522313f701a08Sujith return 0; 823fb9987d0f748c983bb795a86f47522313f701a08Sujith 824fb9987d0f748c983bb795a86f47522313f701a08Sujitherr: 825fb9987d0f748c983bb795a86f47522313f701a08Sujith ath9k_rx_cleanup(priv); 826fb9987d0f748c983bb795a86f47522313f701a08Sujith return -ENOMEM; 827fb9987d0f748c983bb795a86f47522313f701a08Sujith} 828