Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * GPL LICENSE SUMMARY |
| 4 | * |
Wey-Yi Guy | 901069c | 2011-04-05 09:42:00 -0700 | [diff] [blame] | 5 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of version 2 of the GNU General Public License as |
| 9 | * published by the Free Software Foundation. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, but |
| 12 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 14 | * General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License |
| 17 | * along with this program; if not, write to the Free Software |
| 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, |
| 19 | * USA |
| 20 | * |
| 21 | * The full GNU General Public License is included in this distribution |
| 22 | * in the file called LICENSE.GPL. |
| 23 | * |
| 24 | * Contact Information: |
| 25 | * Intel Linux Wireless <ilw@linux.intel.com> |
| 26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
| 27 | * |
| 28 | *****************************************************************************/ |
| 29 | |
| 30 | #include <linux/kernel.h> |
| 31 | #include <linux/module.h> |
| 32 | #include <linux/init.h> |
| 33 | #include <linux/sched.h> |
| 34 | |
| 35 | #include "iwl-dev.h" |
| 36 | #include "iwl-core.h" |
| 37 | #include "iwl-sta.h" |
| 38 | #include "iwl-io.h" |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 39 | #include "iwl-helpers.h" |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 40 | #include "iwl-agn-hw.h" |
Wey-Yi Guy | 8d80108 | 2010-03-17 13:34:36 -0700 | [diff] [blame] | 41 | #include "iwl-agn.h" |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 42 | #include "iwl-trans.h" |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 43 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 44 | /* |
| 45 | * mac80211 queues, ACs, hardware queues, FIFOs. |
| 46 | * |
| 47 | * Cf. http://wireless.kernel.org/en/developers/Documentation/mac80211/queues |
| 48 | * |
| 49 | * Mac80211 uses the following numbers, which we get as from it |
| 50 | * by way of skb_get_queue_mapping(skb): |
| 51 | * |
| 52 | * VO 0 |
| 53 | * VI 1 |
| 54 | * BE 2 |
| 55 | * BK 3 |
| 56 | * |
| 57 | * |
| 58 | * Regular (not A-MPDU) frames are put into hardware queues corresponding |
| 59 | * to the FIFOs, see comments in iwl-prph.h. Aggregated frames get their |
| 60 | * own queue per aggregation session (RA/TID combination), such queues are |
| 61 | * set up to map into FIFOs too, for which we need an AC->FIFO mapping. In |
| 62 | * order to map frames to the right queue, we also need an AC->hw queue |
| 63 | * mapping. This is implemented here. |
| 64 | * |
| 65 | * Due to the way hw queues are set up (by the hw specific modules like |
| 66 | * iwl-4965.c, iwl-5000.c etc.), the AC->hw queue mapping is the identity |
| 67 | * mapping. |
| 68 | */ |
| 69 | |
| 70 | static const u8 tid_to_ac[] = { |
Johannes Berg | 0c4ac34 | 2010-11-17 11:33:27 -0800 | [diff] [blame] | 71 | IEEE80211_AC_BE, |
| 72 | IEEE80211_AC_BK, |
| 73 | IEEE80211_AC_BK, |
| 74 | IEEE80211_AC_BE, |
| 75 | IEEE80211_AC_VI, |
| 76 | IEEE80211_AC_VI, |
| 77 | IEEE80211_AC_VO, |
| 78 | IEEE80211_AC_VO |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 79 | }; |
| 80 | |
Shanyu Zhao | c2845d0 | 2010-04-14 15:35:14 -0700 | [diff] [blame] | 81 | static inline int get_ac_from_tid(u16 tid) |
| 82 | { |
| 83 | if (likely(tid < ARRAY_SIZE(tid_to_ac))) |
| 84 | return tid_to_ac[tid]; |
| 85 | |
| 86 | /* no support for TIDs 8-15 yet */ |
| 87 | return -EINVAL; |
| 88 | } |
| 89 | |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 90 | static inline int get_fifo_from_tid(struct iwl_rxon_context *ctx, u16 tid) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 91 | { |
| 92 | if (likely(tid < ARRAY_SIZE(tid_to_ac))) |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 93 | return ctx->ac_to_fifo[tid_to_ac[tid]]; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 94 | |
| 95 | /* no support for TIDs 8-15 yet */ |
| 96 | return -EINVAL; |
| 97 | } |
| 98 | |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 99 | /** |
| 100 | * iwlagn_txq_update_byte_cnt_tbl - Set up entry in Tx byte-count array |
| 101 | */ |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 102 | void iwlagn_txq_update_byte_cnt_tbl(struct iwl_priv *priv, |
Johannes Berg | 94b0065 | 2011-04-28 07:27:09 -0700 | [diff] [blame] | 103 | struct iwl_tx_queue *txq, |
| 104 | u16 byte_cnt) |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 105 | { |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 106 | struct iwlagn_scd_bc_tbl *scd_bc_tbl = priv->scd_bc_tbls.addr; |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 107 | int write_ptr = txq->q.write_ptr; |
| 108 | int txq_id = txq->q.id; |
| 109 | u8 sec_ctl = 0; |
| 110 | u8 sta_id = 0; |
| 111 | u16 len = byte_cnt + IWL_TX_CRC_SIZE + IWL_TX_DELIMITER_SIZE; |
| 112 | __le16 bc_ent; |
| 113 | |
| 114 | WARN_ON(len > 0xFFF || write_ptr >= TFD_QUEUE_SIZE_MAX); |
| 115 | |
Johannes Berg | ccb6c1c | 2011-04-28 07:27:08 -0700 | [diff] [blame] | 116 | sta_id = txq->cmd[txq->q.write_ptr]->cmd.tx.sta_id; |
| 117 | sec_ctl = txq->cmd[txq->q.write_ptr]->cmd.tx.sec_ctl; |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 118 | |
Johannes Berg | ccb6c1c | 2011-04-28 07:27:08 -0700 | [diff] [blame] | 119 | switch (sec_ctl & TX_CMD_SEC_MSK) { |
| 120 | case TX_CMD_SEC_CCM: |
| 121 | len += CCMP_MIC_LEN; |
| 122 | break; |
| 123 | case TX_CMD_SEC_TKIP: |
| 124 | len += TKIP_ICV_LEN; |
| 125 | break; |
| 126 | case TX_CMD_SEC_WEP: |
| 127 | len += WEP_IV_LEN + WEP_ICV_LEN; |
| 128 | break; |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 129 | } |
| 130 | |
| 131 | bc_ent = cpu_to_le16((len & 0xFFF) | (sta_id << 12)); |
| 132 | |
| 133 | scd_bc_tbl[txq_id].tfd_offset[write_ptr] = bc_ent; |
| 134 | |
| 135 | if (write_ptr < TFD_QUEUE_SIZE_BC_DUP) |
| 136 | scd_bc_tbl[txq_id]. |
| 137 | tfd_offset[TFD_QUEUE_SIZE_MAX + write_ptr] = bc_ent; |
| 138 | } |
| 139 | |
Johannes Berg | 94b0065 | 2011-04-28 07:27:09 -0700 | [diff] [blame] | 140 | static void iwlagn_txq_inval_byte_cnt_tbl(struct iwl_priv *priv, |
| 141 | struct iwl_tx_queue *txq) |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 142 | { |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 143 | struct iwlagn_scd_bc_tbl *scd_bc_tbl = priv->scd_bc_tbls.addr; |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 144 | int txq_id = txq->q.id; |
| 145 | int read_ptr = txq->q.read_ptr; |
| 146 | u8 sta_id = 0; |
| 147 | __le16 bc_ent; |
| 148 | |
| 149 | WARN_ON(read_ptr >= TFD_QUEUE_SIZE_MAX); |
| 150 | |
Johannes Berg | 13bb948 | 2010-08-23 10:46:33 +0200 | [diff] [blame] | 151 | if (txq_id != priv->cmd_queue) |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 152 | sta_id = txq->cmd[read_ptr]->cmd.tx.sta_id; |
| 153 | |
| 154 | bc_ent = cpu_to_le16(1 | (sta_id << 12)); |
| 155 | scd_bc_tbl[txq_id].tfd_offset[read_ptr] = bc_ent; |
| 156 | |
| 157 | if (read_ptr < TFD_QUEUE_SIZE_BC_DUP) |
| 158 | scd_bc_tbl[txq_id]. |
| 159 | tfd_offset[TFD_QUEUE_SIZE_MAX + read_ptr] = bc_ent; |
| 160 | } |
| 161 | |
| 162 | static int iwlagn_tx_queue_set_q2ratid(struct iwl_priv *priv, u16 ra_tid, |
| 163 | u16 txq_id) |
| 164 | { |
| 165 | u32 tbl_dw_addr; |
| 166 | u32 tbl_dw; |
| 167 | u16 scd_q2ratid; |
| 168 | |
| 169 | scd_q2ratid = ra_tid & IWL_SCD_QUEUE_RA_TID_MAP_RATID_MSK; |
| 170 | |
| 171 | tbl_dw_addr = priv->scd_base_addr + |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 172 | IWLAGN_SCD_TRANSLATE_TBL_OFFSET_QUEUE(txq_id); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 173 | |
| 174 | tbl_dw = iwl_read_targ_mem(priv, tbl_dw_addr); |
| 175 | |
| 176 | if (txq_id & 0x1) |
| 177 | tbl_dw = (scd_q2ratid << 16) | (tbl_dw & 0x0000FFFF); |
| 178 | else |
| 179 | tbl_dw = scd_q2ratid | (tbl_dw & 0xFFFF0000); |
| 180 | |
| 181 | iwl_write_targ_mem(priv, tbl_dw_addr, tbl_dw); |
| 182 | |
| 183 | return 0; |
| 184 | } |
| 185 | |
| 186 | static void iwlagn_tx_queue_stop_scheduler(struct iwl_priv *priv, u16 txq_id) |
| 187 | { |
| 188 | /* Simply stop the queue, but don't change any configuration; |
| 189 | * the SCD_ACT_EN bit is the write-enable mask for the ACTIVE bit. */ |
| 190 | iwl_write_prph(priv, |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 191 | IWLAGN_SCD_QUEUE_STATUS_BITS(txq_id), |
| 192 | (0 << IWLAGN_SCD_QUEUE_STTS_REG_POS_ACTIVE)| |
| 193 | (1 << IWLAGN_SCD_QUEUE_STTS_REG_POS_SCD_ACT_EN)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 194 | } |
| 195 | |
| 196 | void iwlagn_set_wr_ptrs(struct iwl_priv *priv, |
| 197 | int txq_id, u32 index) |
| 198 | { |
| 199 | iwl_write_direct32(priv, HBUS_TARG_WRPTR, |
| 200 | (index & 0xff) | (txq_id << 8)); |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 201 | iwl_write_prph(priv, IWLAGN_SCD_QUEUE_RDPTR(txq_id), index); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 202 | } |
| 203 | |
| 204 | void iwlagn_tx_queue_set_status(struct iwl_priv *priv, |
| 205 | struct iwl_tx_queue *txq, |
| 206 | int tx_fifo_id, int scd_retry) |
| 207 | { |
| 208 | int txq_id = txq->q.id; |
| 209 | int active = test_bit(txq_id, &priv->txq_ctx_active_msk) ? 1 : 0; |
| 210 | |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 211 | iwl_write_prph(priv, IWLAGN_SCD_QUEUE_STATUS_BITS(txq_id), |
| 212 | (active << IWLAGN_SCD_QUEUE_STTS_REG_POS_ACTIVE) | |
| 213 | (tx_fifo_id << IWLAGN_SCD_QUEUE_STTS_REG_POS_TXF) | |
| 214 | (1 << IWLAGN_SCD_QUEUE_STTS_REG_POS_WSL) | |
| 215 | IWLAGN_SCD_QUEUE_STTS_REG_MSK); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 216 | |
| 217 | txq->sched_retry = scd_retry; |
| 218 | |
| 219 | IWL_DEBUG_INFO(priv, "%s %s Queue %d on FIFO %d\n", |
| 220 | active ? "Activate" : "Deactivate", |
| 221 | scd_retry ? "BA" : "AC/CMD", txq_id, tx_fifo_id); |
| 222 | } |
| 223 | |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 224 | static int iwlagn_txq_agg_enable(struct iwl_priv *priv, int txq_id, int sta_id, int tid) |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 225 | { |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 226 | if ((IWLAGN_FIRST_AMPDU_QUEUE > txq_id) || |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 227 | (IWLAGN_FIRST_AMPDU_QUEUE + |
| 228 | priv->cfg->base_params->num_of_ampdu_queues <= txq_id)) { |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 229 | IWL_WARN(priv, |
| 230 | "queue number out of range: %d, must be %d to %d\n", |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 231 | txq_id, IWLAGN_FIRST_AMPDU_QUEUE, |
| 232 | IWLAGN_FIRST_AMPDU_QUEUE + |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 233 | priv->cfg->base_params->num_of_ampdu_queues - 1); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 234 | return -EINVAL; |
| 235 | } |
| 236 | |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 237 | /* Modify device's station table to Tx this TID */ |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 238 | return iwl_sta_tx_modify_enable_tid(priv, sta_id, tid); |
| 239 | } |
| 240 | |
| 241 | void iwlagn_txq_agg_queue_setup(struct iwl_priv *priv, |
| 242 | struct ieee80211_sta *sta, |
| 243 | int tid, int frame_limit) |
| 244 | { |
| 245 | int sta_id, tx_fifo, txq_id, ssn_idx; |
| 246 | u16 ra_tid; |
| 247 | unsigned long flags; |
| 248 | struct iwl_tid_data *tid_data; |
| 249 | |
| 250 | sta_id = iwl_sta_id(sta); |
| 251 | if (WARN_ON(sta_id == IWL_INVALID_STATION)) |
| 252 | return; |
| 253 | if (WARN_ON(tid >= MAX_TID_COUNT)) |
| 254 | return; |
| 255 | |
| 256 | spin_lock_irqsave(&priv->sta_lock, flags); |
| 257 | tid_data = &priv->stations[sta_id].tid[tid]; |
| 258 | ssn_idx = SEQ_TO_SN(tid_data->seq_number); |
| 259 | txq_id = tid_data->agg.txq_id; |
| 260 | tx_fifo = tid_data->agg.tx_fifo; |
| 261 | spin_unlock_irqrestore(&priv->sta_lock, flags); |
| 262 | |
| 263 | ra_tid = BUILD_RAxTID(sta_id, tid); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 264 | |
| 265 | spin_lock_irqsave(&priv->lock, flags); |
| 266 | |
| 267 | /* Stop this Tx queue before configuring it */ |
| 268 | iwlagn_tx_queue_stop_scheduler(priv, txq_id); |
| 269 | |
| 270 | /* Map receiver-address / traffic-ID to this queue */ |
| 271 | iwlagn_tx_queue_set_q2ratid(priv, ra_tid, txq_id); |
| 272 | |
| 273 | /* Set this queue as a chain-building queue */ |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 274 | iwl_set_bits_prph(priv, IWLAGN_SCD_QUEUECHAIN_SEL, (1<<txq_id)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 275 | |
| 276 | /* enable aggregations for the queue */ |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 277 | iwl_set_bits_prph(priv, IWLAGN_SCD_AGGR_SEL, (1<<txq_id)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 278 | |
| 279 | /* Place first TFD at index corresponding to start sequence number. |
| 280 | * Assumes that ssn_idx is valid (!= 0xFFF) */ |
| 281 | priv->txq[txq_id].q.read_ptr = (ssn_idx & 0xff); |
| 282 | priv->txq[txq_id].q.write_ptr = (ssn_idx & 0xff); |
| 283 | iwlagn_set_wr_ptrs(priv, txq_id, ssn_idx); |
| 284 | |
| 285 | /* Set up Tx window size and frame limit for this queue */ |
| 286 | iwl_write_targ_mem(priv, priv->scd_base_addr + |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 287 | IWLAGN_SCD_CONTEXT_QUEUE_OFFSET(txq_id) + |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 288 | sizeof(u32), |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 289 | ((frame_limit << |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 290 | IWLAGN_SCD_QUEUE_CTX_REG2_WIN_SIZE_POS) & |
| 291 | IWLAGN_SCD_QUEUE_CTX_REG2_WIN_SIZE_MSK) | |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 292 | ((frame_limit << |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 293 | IWLAGN_SCD_QUEUE_CTX_REG2_FRAME_LIMIT_POS) & |
| 294 | IWLAGN_SCD_QUEUE_CTX_REG2_FRAME_LIMIT_MSK)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 295 | |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 296 | iwl_set_bits_prph(priv, IWLAGN_SCD_INTERRUPT_MASK, (1 << txq_id)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 297 | |
| 298 | /* Set up Status area in SRAM, map to Tx DMA/FIFO, activate the queue */ |
| 299 | iwlagn_tx_queue_set_status(priv, &priv->txq[txq_id], tx_fifo, 1); |
| 300 | |
| 301 | spin_unlock_irqrestore(&priv->lock, flags); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 302 | } |
| 303 | |
Johannes Berg | 7ffef13 | 2011-03-15 04:59:10 -0700 | [diff] [blame] | 304 | static int iwlagn_txq_agg_disable(struct iwl_priv *priv, u16 txq_id, |
| 305 | u16 ssn_idx, u8 tx_fifo) |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 306 | { |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 307 | if ((IWLAGN_FIRST_AMPDU_QUEUE > txq_id) || |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 308 | (IWLAGN_FIRST_AMPDU_QUEUE + |
| 309 | priv->cfg->base_params->num_of_ampdu_queues <= txq_id)) { |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 310 | IWL_ERR(priv, |
| 311 | "queue number out of range: %d, must be %d to %d\n", |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 312 | txq_id, IWLAGN_FIRST_AMPDU_QUEUE, |
| 313 | IWLAGN_FIRST_AMPDU_QUEUE + |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 314 | priv->cfg->base_params->num_of_ampdu_queues - 1); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 315 | return -EINVAL; |
| 316 | } |
| 317 | |
| 318 | iwlagn_tx_queue_stop_scheduler(priv, txq_id); |
| 319 | |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 320 | iwl_clear_bits_prph(priv, IWLAGN_SCD_AGGR_SEL, (1 << txq_id)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 321 | |
| 322 | priv->txq[txq_id].q.read_ptr = (ssn_idx & 0xff); |
| 323 | priv->txq[txq_id].q.write_ptr = (ssn_idx & 0xff); |
| 324 | /* supposes that ssn_idx is valid (!= 0xFFF) */ |
| 325 | iwlagn_set_wr_ptrs(priv, txq_id, ssn_idx); |
| 326 | |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 327 | iwl_clear_bits_prph(priv, IWLAGN_SCD_INTERRUPT_MASK, (1 << txq_id)); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 328 | iwl_txq_ctx_deactivate(priv, txq_id); |
| 329 | iwlagn_tx_queue_set_status(priv, &priv->txq[txq_id], tx_fifo, 0); |
| 330 | |
| 331 | return 0; |
| 332 | } |
| 333 | |
| 334 | /* |
| 335 | * Activate/Deactivate Tx DMA/FIFO channels according tx fifos mask |
| 336 | * must be called under priv->lock and mac access |
| 337 | */ |
| 338 | void iwlagn_txq_set_sched(struct iwl_priv *priv, u32 mask) |
| 339 | { |
Wey-Yi Guy | f4388ad | 2010-04-12 18:32:11 -0700 | [diff] [blame] | 340 | iwl_write_prph(priv, IWLAGN_SCD_TXFACT, mask); |
Wey-Yi Guy | b305a08 | 2010-03-16 17:41:22 -0700 | [diff] [blame] | 341 | } |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 342 | |
Don Fry | 5c3d29f | 2011-07-08 08:46:29 -0700 | [diff] [blame] | 343 | static void iwlagn_tx_cmd_protection(struct iwl_priv *priv, |
| 344 | struct ieee80211_tx_info *info, |
| 345 | __le16 fc, __le32 *tx_flags) |
| 346 | { |
| 347 | if (info->control.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS || |
| 348 | info->control.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT || |
| 349 | info->flags & IEEE80211_TX_CTL_AMPDU) |
| 350 | *tx_flags |= TX_CMD_FLG_PROT_REQUIRE_MSK; |
| 351 | } |
| 352 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 353 | /* |
| 354 | * handle build REPLY_TX command notification. |
| 355 | */ |
| 356 | static void iwlagn_tx_cmd_build_basic(struct iwl_priv *priv, |
Johannes Berg | d44ae69 | 2010-08-23 07:56:56 -0700 | [diff] [blame] | 357 | struct sk_buff *skb, |
| 358 | struct iwl_tx_cmd *tx_cmd, |
| 359 | struct ieee80211_tx_info *info, |
| 360 | struct ieee80211_hdr *hdr, |
| 361 | u8 std_id) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 362 | { |
| 363 | __le16 fc = hdr->frame_control; |
| 364 | __le32 tx_flags = tx_cmd->tx_flags; |
| 365 | |
| 366 | tx_cmd->stop_time.life_time = TX_CMD_LIFE_TIME_INFINITE; |
| 367 | if (!(info->flags & IEEE80211_TX_CTL_NO_ACK)) { |
| 368 | tx_flags |= TX_CMD_FLG_ACK_MSK; |
| 369 | if (ieee80211_is_mgmt(fc)) |
| 370 | tx_flags |= TX_CMD_FLG_SEQ_CTL_MSK; |
| 371 | if (ieee80211_is_probe_resp(fc) && |
| 372 | !(le16_to_cpu(hdr->seq_ctrl) & 0xf)) |
| 373 | tx_flags |= TX_CMD_FLG_TSF_MSK; |
| 374 | } else { |
| 375 | tx_flags &= (~TX_CMD_FLG_ACK_MSK); |
| 376 | tx_flags |= TX_CMD_FLG_SEQ_CTL_MSK; |
| 377 | } |
| 378 | |
| 379 | if (ieee80211_is_back_req(fc)) |
| 380 | tx_flags |= TX_CMD_FLG_ACK_MSK | TX_CMD_FLG_IMM_BA_RSP_MASK; |
Johannes Berg | d44ae69 | 2010-08-23 07:56:56 -0700 | [diff] [blame] | 381 | else if (info->band == IEEE80211_BAND_2GHZ && |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 382 | priv->cfg->bt_params && |
| 383 | priv->cfg->bt_params->advanced_bt_coexist && |
Johannes Berg | d44ae69 | 2010-08-23 07:56:56 -0700 | [diff] [blame] | 384 | (ieee80211_is_auth(fc) || ieee80211_is_assoc_req(fc) || |
| 385 | ieee80211_is_reassoc_req(fc) || |
| 386 | skb->protocol == cpu_to_be16(ETH_P_PAE))) |
| 387 | tx_flags |= TX_CMD_FLG_IGNORE_BT; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 388 | |
| 389 | |
| 390 | tx_cmd->sta_id = std_id; |
| 391 | if (ieee80211_has_morefrags(fc)) |
| 392 | tx_flags |= TX_CMD_FLG_MORE_FRAG_MSK; |
| 393 | |
| 394 | if (ieee80211_is_data_qos(fc)) { |
| 395 | u8 *qc = ieee80211_get_qos_ctl(hdr); |
| 396 | tx_cmd->tid_tspec = qc[0] & 0xf; |
| 397 | tx_flags &= ~TX_CMD_FLG_SEQ_CTL_MSK; |
| 398 | } else { |
| 399 | tx_flags |= TX_CMD_FLG_SEQ_CTL_MSK; |
| 400 | } |
| 401 | |
Don Fry | 5c3d29f | 2011-07-08 08:46:29 -0700 | [diff] [blame] | 402 | iwlagn_tx_cmd_protection(priv, info, fc, &tx_flags); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 403 | |
| 404 | tx_flags &= ~(TX_CMD_FLG_ANT_SEL_MSK); |
| 405 | if (ieee80211_is_mgmt(fc)) { |
| 406 | if (ieee80211_is_assoc_req(fc) || ieee80211_is_reassoc_req(fc)) |
| 407 | tx_cmd->timeout.pm_frame_timeout = cpu_to_le16(3); |
| 408 | else |
| 409 | tx_cmd->timeout.pm_frame_timeout = cpu_to_le16(2); |
| 410 | } else { |
| 411 | tx_cmd->timeout.pm_frame_timeout = 0; |
| 412 | } |
| 413 | |
| 414 | tx_cmd->driver_txop = 0; |
| 415 | tx_cmd->tx_flags = tx_flags; |
| 416 | tx_cmd->next_frame_len = 0; |
| 417 | } |
| 418 | |
| 419 | #define RTS_DFAULT_RETRY_LIMIT 60 |
| 420 | |
| 421 | static void iwlagn_tx_cmd_build_rate(struct iwl_priv *priv, |
| 422 | struct iwl_tx_cmd *tx_cmd, |
| 423 | struct ieee80211_tx_info *info, |
| 424 | __le16 fc) |
| 425 | { |
| 426 | u32 rate_flags; |
| 427 | int rate_idx; |
| 428 | u8 rts_retry_limit; |
| 429 | u8 data_retry_limit; |
| 430 | u8 rate_plcp; |
| 431 | |
| 432 | /* Set retry limit on DATA packets and Probe Responses*/ |
| 433 | if (ieee80211_is_probe_resp(fc)) |
| 434 | data_retry_limit = 3; |
| 435 | else |
Wey-Yi Guy | b744cb7 | 2010-03-23 11:37:59 -0700 | [diff] [blame] | 436 | data_retry_limit = IWLAGN_DEFAULT_TX_RETRY; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 437 | tx_cmd->data_retry_limit = data_retry_limit; |
| 438 | |
| 439 | /* Set retry limit on RTS packets */ |
| 440 | rts_retry_limit = RTS_DFAULT_RETRY_LIMIT; |
| 441 | if (data_retry_limit < rts_retry_limit) |
| 442 | rts_retry_limit = data_retry_limit; |
| 443 | tx_cmd->rts_retry_limit = rts_retry_limit; |
| 444 | |
| 445 | /* DATA packets will use the uCode station table for rate/antenna |
| 446 | * selection */ |
| 447 | if (ieee80211_is_data(fc)) { |
| 448 | tx_cmd->initial_rate_index = 0; |
| 449 | tx_cmd->tx_flags |= TX_CMD_FLG_STA_RATE_MSK; |
Wey-Yi Guy | 4e30811 | 2011-07-08 08:46:28 -0700 | [diff] [blame] | 450 | if (priv->tm_fixed_rate) { |
| 451 | /* |
| 452 | * rate overwrite by testmode |
| 453 | * we not only send lq command to change rate |
| 454 | * we also re-enforce per data pkt base. |
| 455 | */ |
| 456 | tx_cmd->tx_flags &= ~TX_CMD_FLG_STA_RATE_MSK; |
| 457 | memcpy(&tx_cmd->rate_n_flags, &priv->tm_fixed_rate, |
| 458 | sizeof(tx_cmd->rate_n_flags)); |
| 459 | } |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 460 | return; |
| 461 | } |
| 462 | |
| 463 | /** |
| 464 | * If the current TX rate stored in mac80211 has the MCS bit set, it's |
| 465 | * not really a TX rate. Thus, we use the lowest supported rate for |
| 466 | * this band. Also use the lowest supported rate if the stored rate |
| 467 | * index is invalid. |
| 468 | */ |
| 469 | rate_idx = info->control.rates[0].idx; |
| 470 | if (info->control.rates[0].flags & IEEE80211_TX_RC_MCS || |
| 471 | (rate_idx < 0) || (rate_idx > IWL_RATE_COUNT_LEGACY)) |
| 472 | rate_idx = rate_lowest_index(&priv->bands[info->band], |
| 473 | info->control.sta); |
| 474 | /* For 5 GHZ band, remap mac80211 rate indices into driver indices */ |
| 475 | if (info->band == IEEE80211_BAND_5GHZ) |
| 476 | rate_idx += IWL_FIRST_OFDM_RATE; |
| 477 | /* Get PLCP rate for tx_cmd->rate_n_flags */ |
| 478 | rate_plcp = iwl_rates[rate_idx].plcp; |
| 479 | /* Zero out flags for this packet */ |
| 480 | rate_flags = 0; |
| 481 | |
| 482 | /* Set CCK flag as needed */ |
| 483 | if ((rate_idx >= IWL_FIRST_CCK_RATE) && (rate_idx <= IWL_LAST_CCK_RATE)) |
| 484 | rate_flags |= RATE_MCS_CCK_MSK; |
| 485 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 486 | /* Set up antennas */ |
Wey-Yi Guy | 7cb1b08 | 2010-10-06 08:10:00 -0700 | [diff] [blame] | 487 | if (priv->cfg->bt_params && |
| 488 | priv->cfg->bt_params->advanced_bt_coexist && |
| 489 | priv->bt_full_concurrent) { |
Wey-Yi Guy | bee008b | 2010-08-23 07:57:04 -0700 | [diff] [blame] | 490 | /* operated as 1x1 in full concurrency mode */ |
| 491 | priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant, |
| 492 | first_antenna(priv->hw_params.valid_tx_ant)); |
| 493 | } else |
| 494 | priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant, |
Johannes Berg | 0e1654f | 2010-05-18 02:48:36 -0700 | [diff] [blame] | 495 | priv->hw_params.valid_tx_ant); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 496 | rate_flags |= iwl_ant_idx_to_flags(priv->mgmt_tx_ant); |
| 497 | |
| 498 | /* Set the rate in the TX cmd */ |
| 499 | tx_cmd->rate_n_flags = iwl_hw_set_rate_n_flags(rate_plcp, rate_flags); |
| 500 | } |
| 501 | |
| 502 | static void iwlagn_tx_cmd_build_hwcrypto(struct iwl_priv *priv, |
| 503 | struct ieee80211_tx_info *info, |
| 504 | struct iwl_tx_cmd *tx_cmd, |
| 505 | struct sk_buff *skb_frag, |
| 506 | int sta_id) |
| 507 | { |
| 508 | struct ieee80211_key_conf *keyconf = info->control.hw_key; |
| 509 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 510 | switch (keyconf->cipher) { |
| 511 | case WLAN_CIPHER_SUITE_CCMP: |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 512 | tx_cmd->sec_ctl = TX_CMD_SEC_CCM; |
| 513 | memcpy(tx_cmd->key, keyconf->key, keyconf->keylen); |
| 514 | if (info->flags & IEEE80211_TX_CTL_AMPDU) |
| 515 | tx_cmd->tx_flags |= TX_CMD_FLG_AGG_CCMP_MSK; |
| 516 | IWL_DEBUG_TX(priv, "tx_cmd with AES hwcrypto\n"); |
| 517 | break; |
| 518 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 519 | case WLAN_CIPHER_SUITE_TKIP: |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 520 | tx_cmd->sec_ctl = TX_CMD_SEC_TKIP; |
Johannes Berg | 523b02e | 2011-07-07 22:28:01 +0200 | [diff] [blame] | 521 | ieee80211_get_tkip_p2k(keyconf, skb_frag, tx_cmd->key); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 522 | IWL_DEBUG_TX(priv, "tx_cmd with tkip hwcrypto\n"); |
| 523 | break; |
| 524 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 525 | case WLAN_CIPHER_SUITE_WEP104: |
| 526 | tx_cmd->sec_ctl |= TX_CMD_SEC_KEY128; |
| 527 | /* fall through */ |
| 528 | case WLAN_CIPHER_SUITE_WEP40: |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 529 | tx_cmd->sec_ctl |= (TX_CMD_SEC_WEP | |
| 530 | (keyconf->keyidx & TX_CMD_SEC_MSK) << TX_CMD_SEC_SHIFT); |
| 531 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 532 | memcpy(&tx_cmd->key[3], keyconf->key, keyconf->keylen); |
| 533 | |
| 534 | IWL_DEBUG_TX(priv, "Configuring packet for WEP encryption " |
| 535 | "with key %d\n", keyconf->keyidx); |
| 536 | break; |
| 537 | |
| 538 | default: |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 539 | IWL_ERR(priv, "Unknown encode cipher %x\n", keyconf->cipher); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 540 | break; |
| 541 | } |
| 542 | } |
| 543 | |
| 544 | /* |
| 545 | * start REPLY_TX command process |
| 546 | */ |
| 547 | int iwlagn_tx_skb(struct iwl_priv *priv, struct sk_buff *skb) |
| 548 | { |
| 549 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; |
| 550 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 551 | struct iwl_station_priv *sta_priv = NULL; |
Johannes Berg | a194e32 | 2010-08-27 08:53:46 -0700 | [diff] [blame] | 552 | struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS]; |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 553 | struct iwl_tx_cmd *tx_cmd; |
Johannes Berg | 8d56396 | 2010-11-10 18:25:42 -0800 | [diff] [blame] | 554 | int txq_id; |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 555 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 556 | u16 seq_number = 0; |
| 557 | __le16 fc; |
| 558 | u8 hdr_len; |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 559 | u16 len; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 560 | u8 sta_id; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 561 | u8 tid = 0; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 562 | unsigned long flags; |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 563 | bool is_agg = false; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 564 | |
Johannes Berg | 9b9190d | 2011-01-06 08:07:10 -0800 | [diff] [blame] | 565 | /* |
| 566 | * If the frame needs to go out off-channel, then |
| 567 | * we'll have put the PAN context to that channel, |
| 568 | * so make the frame go out there. |
| 569 | */ |
| 570 | if (info->flags & IEEE80211_TX_CTL_TX_OFFCHAN) |
| 571 | ctx = &priv->contexts[IWL_RXON_CTX_PAN]; |
| 572 | else if (info->control.vif) |
Johannes Berg | a194e32 | 2010-08-27 08:53:46 -0700 | [diff] [blame] | 573 | ctx = iwl_rxon_ctx_from_vif(info->control.vif); |
| 574 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 575 | spin_lock_irqsave(&priv->lock, flags); |
| 576 | if (iwl_is_rfkill(priv)) { |
| 577 | IWL_DEBUG_DROP(priv, "Dropping - RF KILL\n"); |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 578 | goto drop_unlock_priv; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 579 | } |
| 580 | |
| 581 | fc = hdr->frame_control; |
| 582 | |
| 583 | #ifdef CONFIG_IWLWIFI_DEBUG |
| 584 | if (ieee80211_is_auth(fc)) |
| 585 | IWL_DEBUG_TX(priv, "Sending AUTH frame\n"); |
| 586 | else if (ieee80211_is_assoc_req(fc)) |
| 587 | IWL_DEBUG_TX(priv, "Sending ASSOC frame\n"); |
| 588 | else if (ieee80211_is_reassoc_req(fc)) |
| 589 | IWL_DEBUG_TX(priv, "Sending REASSOC frame\n"); |
| 590 | #endif |
| 591 | |
| 592 | hdr_len = ieee80211_hdrlen(fc); |
| 593 | |
Stanislaw Gruszka | bfd3610 | 2011-04-29 17:51:06 +0200 | [diff] [blame] | 594 | /* For management frames use broadcast id to do not break aggregation */ |
| 595 | if (!ieee80211_is_data(fc)) |
| 596 | sta_id = ctx->bcast_sta_id; |
| 597 | else { |
| 598 | /* Find index into station table for destination station */ |
| 599 | sta_id = iwl_sta_id_or_broadcast(priv, ctx, info->control.sta); |
| 600 | if (sta_id == IWL_INVALID_STATION) { |
| 601 | IWL_DEBUG_DROP(priv, "Dropping - INVALID STATION: %pM\n", |
| 602 | hdr->addr1); |
John W. Linville | e00cf3b | 2011-05-16 14:55:42 -0400 | [diff] [blame] | 603 | goto drop_unlock_priv; |
Stanislaw Gruszka | bfd3610 | 2011-04-29 17:51:06 +0200 | [diff] [blame] | 604 | } |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 605 | } |
| 606 | |
| 607 | IWL_DEBUG_TX(priv, "station Id %d\n", sta_id); |
| 608 | |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 609 | if (info->control.sta) |
| 610 | sta_priv = (void *)info->control.sta->drv_priv; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 611 | |
Johannes Berg | 67158b6 | 2010-11-16 11:51:04 -0800 | [diff] [blame] | 612 | if (sta_priv && sta_priv->asleep && |
| 613 | (info->flags & IEEE80211_TX_CTL_PSPOLL_RESPONSE)) { |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 614 | /* |
| 615 | * This sends an asynchronous command to the device, |
| 616 | * but we can rely on it being processed before the |
| 617 | * next frame is processed -- and the next frame to |
| 618 | * this station is the one that will consume this |
| 619 | * counter. |
| 620 | * For now set the counter to just 1 since we do not |
| 621 | * support uAPSD yet. |
| 622 | */ |
| 623 | iwl_sta_modify_sleep_tx_count(priv, sta_id, 1); |
| 624 | } |
| 625 | |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 626 | /* |
| 627 | * Send this frame after DTIM -- there's a special queue |
| 628 | * reserved for this for contexts that support AP mode. |
| 629 | */ |
| 630 | if (info->flags & IEEE80211_TX_CTL_SEND_AFTER_DTIM) { |
| 631 | txq_id = ctx->mcast_queue; |
| 632 | /* |
| 633 | * The microcode will clear the more data |
| 634 | * bit in the last frame it transmits. |
| 635 | */ |
| 636 | hdr->frame_control |= |
| 637 | cpu_to_le16(IEEE80211_FCTL_MOREDATA); |
| 638 | } else |
| 639 | txq_id = ctx->ac_to_queue[skb_get_queue_mapping(skb)]; |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 640 | |
| 641 | /* irqs already disabled/saved above when locking priv->lock */ |
| 642 | spin_lock(&priv->sta_lock); |
| 643 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 644 | if (ieee80211_is_data_qos(fc)) { |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 645 | u8 *qc = NULL; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 646 | qc = ieee80211_get_qos_ctl(hdr); |
| 647 | tid = qc[0] & IEEE80211_QOS_CTL_TID_MASK; |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 648 | |
| 649 | if (WARN_ON_ONCE(tid >= MAX_TID_COUNT)) |
| 650 | goto drop_unlock_sta; |
| 651 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 652 | seq_number = priv->stations[sta_id].tid[tid].seq_number; |
| 653 | seq_number &= IEEE80211_SCTL_SEQ; |
| 654 | hdr->seq_ctrl = hdr->seq_ctrl & |
| 655 | cpu_to_le16(IEEE80211_SCTL_FRAG); |
| 656 | hdr->seq_ctrl |= cpu_to_le16(seq_number); |
| 657 | seq_number += 0x10; |
| 658 | /* aggregation is on for this <sta,tid> */ |
| 659 | if (info->flags & IEEE80211_TX_CTL_AMPDU && |
| 660 | priv->stations[sta_id].tid[tid].agg.state == IWL_AGG_ON) { |
| 661 | txq_id = priv->stations[sta_id].tid[tid].agg.txq_id; |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 662 | is_agg = true; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 663 | } |
| 664 | } |
| 665 | |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 666 | tx_cmd = trans_get_tx_cmd(priv, txq_id); |
| 667 | if (unlikely(!tx_cmd)) |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 668 | goto drop_unlock_sta; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 669 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 670 | /* Copy MAC header from skb into command buffer */ |
| 671 | memcpy(tx_cmd->hdr, hdr, hdr_len); |
| 672 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 673 | /* Total # bytes to be transmitted */ |
| 674 | len = (u16)skb->len; |
| 675 | tx_cmd->len = cpu_to_le16(len); |
| 676 | |
| 677 | if (info->control.hw_key) |
| 678 | iwlagn_tx_cmd_build_hwcrypto(priv, info, tx_cmd, skb, sta_id); |
| 679 | |
| 680 | /* TODO need this for burst mode later on */ |
Johannes Berg | d44ae69 | 2010-08-23 07:56:56 -0700 | [diff] [blame] | 681 | iwlagn_tx_cmd_build_basic(priv, skb, tx_cmd, info, hdr, sta_id); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 682 | iwl_dbg_log_tx_data_frame(priv, len, hdr); |
| 683 | |
| 684 | iwlagn_tx_cmd_build_rate(priv, tx_cmd, info, fc); |
| 685 | |
| 686 | iwl_update_stats(priv, true, fc, len); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 687 | |
Emmanuel Grumbach | 47c1b49 | 2011-07-03 11:22:15 +0300 | [diff] [blame^] | 688 | if (trans_tx(priv, skb, tx_cmd, txq_id, fc, is_agg, ctx)) |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 689 | goto drop_unlock_sta; |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 690 | |
| 691 | if (ieee80211_is_data_qos(fc)) { |
| 692 | priv->stations[sta_id].tid[tid].tfds_in_queue++; |
| 693 | if (!ieee80211_has_morefrags(fc)) |
| 694 | priv->stations[sta_id].tid[tid].seq_number = seq_number; |
| 695 | } |
| 696 | |
| 697 | spin_unlock(&priv->sta_lock); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 698 | spin_unlock_irqrestore(&priv->lock, flags); |
| 699 | |
| 700 | /* |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 701 | * Avoid atomic ops if it isn't an associated client. |
| 702 | * Also, if this is a packet for aggregation, don't |
| 703 | * increase the counter because the ucode will stop |
| 704 | * aggregation queues when their respective station |
| 705 | * goes to sleep. |
| 706 | */ |
| 707 | if (sta_priv && sta_priv->client && !is_agg) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 708 | atomic_inc(&sta_priv->pending_frames); |
| 709 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 710 | return 0; |
| 711 | |
Johannes Berg | 2c46f72 | 2011-04-28 07:27:10 -0700 | [diff] [blame] | 712 | drop_unlock_sta: |
| 713 | spin_unlock(&priv->sta_lock); |
| 714 | drop_unlock_priv: |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 715 | spin_unlock_irqrestore(&priv->lock, flags); |
| 716 | return -1; |
| 717 | } |
| 718 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 719 | /* |
| 720 | * Find first available (lowest unused) Tx Queue, mark it "active". |
| 721 | * Called only when finding queue for aggregation. |
| 722 | * Should never return anything < 7, because they should already |
| 723 | * be in use as EDCA AC (0-3), Command (4), reserved (5, 6) |
| 724 | */ |
| 725 | static int iwlagn_txq_ctx_activate_free(struct iwl_priv *priv) |
| 726 | { |
| 727 | int txq_id; |
| 728 | |
| 729 | for (txq_id = 0; txq_id < priv->hw_params.max_txq_num; txq_id++) |
| 730 | if (!test_and_set_bit(txq_id, &priv->txq_ctx_active_msk)) |
| 731 | return txq_id; |
| 732 | return -1; |
| 733 | } |
| 734 | |
Johannes Berg | 832f47e | 2010-04-29 04:43:07 -0700 | [diff] [blame] | 735 | int iwlagn_tx_agg_start(struct iwl_priv *priv, struct ieee80211_vif *vif, |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 736 | struct ieee80211_sta *sta, u16 tid, u16 *ssn) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 737 | { |
| 738 | int sta_id; |
| 739 | int tx_fifo; |
| 740 | int txq_id; |
| 741 | int ret; |
| 742 | unsigned long flags; |
| 743 | struct iwl_tid_data *tid_data; |
| 744 | |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 745 | tx_fifo = get_fifo_from_tid(iwl_rxon_ctx_from_vif(vif), tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 746 | if (unlikely(tx_fifo < 0)) |
| 747 | return tx_fifo; |
| 748 | |
Wey-Yi Guy | 5bc9890 | 2011-05-27 08:40:32 -0700 | [diff] [blame] | 749 | IWL_DEBUG_HT(priv, "TX AGG request on ra = %pM tid = %d\n", |
| 750 | sta->addr, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 751 | |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 752 | sta_id = iwl_sta_id(sta); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 753 | if (sta_id == IWL_INVALID_STATION) { |
| 754 | IWL_ERR(priv, "Start AGG on invalid station\n"); |
| 755 | return -ENXIO; |
| 756 | } |
| 757 | if (unlikely(tid >= MAX_TID_COUNT)) |
| 758 | return -EINVAL; |
| 759 | |
| 760 | if (priv->stations[sta_id].tid[tid].agg.state != IWL_AGG_OFF) { |
| 761 | IWL_ERR(priv, "Start AGG when state is not IWL_AGG_OFF !\n"); |
| 762 | return -ENXIO; |
| 763 | } |
| 764 | |
| 765 | txq_id = iwlagn_txq_ctx_activate_free(priv); |
| 766 | if (txq_id == -1) { |
| 767 | IWL_ERR(priv, "No free aggregation queue available\n"); |
| 768 | return -ENXIO; |
| 769 | } |
| 770 | |
| 771 | spin_lock_irqsave(&priv->sta_lock, flags); |
| 772 | tid_data = &priv->stations[sta_id].tid[tid]; |
| 773 | *ssn = SEQ_TO_SN(tid_data->seq_number); |
| 774 | tid_data->agg.txq_id = txq_id; |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 775 | tid_data->agg.tx_fifo = tx_fifo; |
Johannes Berg | ea9b307 | 2010-11-10 18:25:45 -0800 | [diff] [blame] | 776 | iwl_set_swq_id(&priv->txq[txq_id], get_ac_from_tid(tid), txq_id); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 777 | spin_unlock_irqrestore(&priv->sta_lock, flags); |
| 778 | |
Johannes Berg | c8823ec | 2011-03-15 11:33:03 -0700 | [diff] [blame] | 779 | ret = iwlagn_txq_agg_enable(priv, txq_id, sta_id, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 780 | if (ret) |
| 781 | return ret; |
| 782 | |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 783 | spin_lock_irqsave(&priv->sta_lock, flags); |
| 784 | tid_data = &priv->stations[sta_id].tid[tid]; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 785 | if (tid_data->tfds_in_queue == 0) { |
| 786 | IWL_DEBUG_HT(priv, "HW queue is empty\n"); |
| 787 | tid_data->agg.state = IWL_AGG_ON; |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 788 | ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 789 | } else { |
| 790 | IWL_DEBUG_HT(priv, "HW queue is NOT empty: %d packets in HW queue\n", |
| 791 | tid_data->tfds_in_queue); |
| 792 | tid_data->agg.state = IWL_EMPTYING_HW_QUEUE_ADDBA; |
| 793 | } |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 794 | spin_unlock_irqrestore(&priv->sta_lock, flags); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 795 | return ret; |
| 796 | } |
| 797 | |
Johannes Berg | 832f47e | 2010-04-29 04:43:07 -0700 | [diff] [blame] | 798 | int iwlagn_tx_agg_stop(struct iwl_priv *priv, struct ieee80211_vif *vif, |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 799 | struct ieee80211_sta *sta, u16 tid) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 800 | { |
Johannes Berg | 18c121d | 2010-08-23 07:57:17 -0700 | [diff] [blame] | 801 | int tx_fifo_id, txq_id, sta_id, ssn; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 802 | struct iwl_tid_data *tid_data; |
| 803 | int write_ptr, read_ptr; |
| 804 | unsigned long flags; |
| 805 | |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 806 | tx_fifo_id = get_fifo_from_tid(iwl_rxon_ctx_from_vif(vif), tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 807 | if (unlikely(tx_fifo_id < 0)) |
| 808 | return tx_fifo_id; |
| 809 | |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 810 | sta_id = iwl_sta_id(sta); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 811 | |
| 812 | if (sta_id == IWL_INVALID_STATION) { |
| 813 | IWL_ERR(priv, "Invalid station for AGG tid %d\n", tid); |
| 814 | return -ENXIO; |
| 815 | } |
| 816 | |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 817 | spin_lock_irqsave(&priv->sta_lock, flags); |
| 818 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 819 | tid_data = &priv->stations[sta_id].tid[tid]; |
| 820 | ssn = (tid_data->seq_number & IEEE80211_SCTL_SEQ) >> 4; |
| 821 | txq_id = tid_data->agg.txq_id; |
Johannes Berg | 18c121d | 2010-08-23 07:57:17 -0700 | [diff] [blame] | 822 | |
| 823 | switch (priv->stations[sta_id].tid[tid].agg.state) { |
| 824 | case IWL_EMPTYING_HW_QUEUE_ADDBA: |
| 825 | /* |
| 826 | * This can happen if the peer stops aggregation |
| 827 | * again before we've had a chance to drain the |
| 828 | * queue we selected previously, i.e. before the |
| 829 | * session was really started completely. |
| 830 | */ |
| 831 | IWL_DEBUG_HT(priv, "AGG stop before setup done\n"); |
| 832 | goto turn_off; |
| 833 | case IWL_AGG_ON: |
| 834 | break; |
| 835 | default: |
| 836 | IWL_WARN(priv, "Stopping AGG while state not ON or starting\n"); |
| 837 | } |
| 838 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 839 | write_ptr = priv->txq[txq_id].q.write_ptr; |
| 840 | read_ptr = priv->txq[txq_id].q.read_ptr; |
| 841 | |
| 842 | /* The queue is not empty */ |
| 843 | if (write_ptr != read_ptr) { |
| 844 | IWL_DEBUG_HT(priv, "Stopping a non empty AGG HW QUEUE\n"); |
| 845 | priv->stations[sta_id].tid[tid].agg.state = |
| 846 | IWL_EMPTYING_HW_QUEUE_DELBA; |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 847 | spin_unlock_irqrestore(&priv->sta_lock, flags); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 848 | return 0; |
| 849 | } |
| 850 | |
| 851 | IWL_DEBUG_HT(priv, "HW queue is empty\n"); |
Johannes Berg | 18c121d | 2010-08-23 07:57:17 -0700 | [diff] [blame] | 852 | turn_off: |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 853 | priv->stations[sta_id].tid[tid].agg.state = IWL_AGG_OFF; |
| 854 | |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 855 | /* do not restore/save irqs */ |
| 856 | spin_unlock(&priv->sta_lock); |
| 857 | spin_lock(&priv->lock); |
| 858 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 859 | /* |
| 860 | * the only reason this call can fail is queue number out of range, |
| 861 | * which can happen if uCode is reloaded and all the station |
| 862 | * information are lost. if it is outside the range, there is no need |
| 863 | * to deactivate the uCode queue, just return "success" to allow |
| 864 | * mac80211 to clean up it own data. |
| 865 | */ |
Johannes Berg | 7ffef13 | 2011-03-15 04:59:10 -0700 | [diff] [blame] | 866 | iwlagn_txq_agg_disable(priv, txq_id, ssn, tx_fifo_id); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 867 | spin_unlock_irqrestore(&priv->lock, flags); |
| 868 | |
Johannes Berg | 619753f | 2010-04-30 11:30:46 -0700 | [diff] [blame] | 869 | ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 870 | |
| 871 | return 0; |
| 872 | } |
| 873 | |
| 874 | int iwlagn_txq_check_empty(struct iwl_priv *priv, |
| 875 | int sta_id, u8 tid, int txq_id) |
| 876 | { |
| 877 | struct iwl_queue *q = &priv->txq[txq_id].q; |
| 878 | u8 *addr = priv->stations[sta_id].sta.sta.addr; |
| 879 | struct iwl_tid_data *tid_data = &priv->stations[sta_id].tid[tid]; |
Johannes Berg | 8bd413e | 2010-08-23 10:46:40 +0200 | [diff] [blame] | 880 | struct iwl_rxon_context *ctx; |
| 881 | |
| 882 | ctx = &priv->contexts[priv->stations[sta_id].ctxid]; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 883 | |
Johannes Berg | a24d52f | 2010-08-06 16:17:53 +0200 | [diff] [blame] | 884 | lockdep_assert_held(&priv->sta_lock); |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 885 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 886 | switch (priv->stations[sta_id].tid[tid].agg.state) { |
| 887 | case IWL_EMPTYING_HW_QUEUE_DELBA: |
| 888 | /* We are reclaiming the last packet of the */ |
| 889 | /* aggregated HW queue */ |
| 890 | if ((txq_id == tid_data->agg.txq_id) && |
| 891 | (q->read_ptr == q->write_ptr)) { |
| 892 | u16 ssn = SEQ_TO_SN(tid_data->seq_number); |
Johannes Berg | e72f368 | 2010-08-23 10:46:51 +0200 | [diff] [blame] | 893 | int tx_fifo = get_fifo_from_tid(ctx, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 894 | IWL_DEBUG_HT(priv, "HW queue empty: continue DELBA flow\n"); |
Johannes Berg | 7ffef13 | 2011-03-15 04:59:10 -0700 | [diff] [blame] | 895 | iwlagn_txq_agg_disable(priv, txq_id, ssn, tx_fifo); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 896 | tid_data->agg.state = IWL_AGG_OFF; |
Johannes Berg | 8bd413e | 2010-08-23 10:46:40 +0200 | [diff] [blame] | 897 | ieee80211_stop_tx_ba_cb_irqsafe(ctx->vif, addr, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 898 | } |
| 899 | break; |
| 900 | case IWL_EMPTYING_HW_QUEUE_ADDBA: |
| 901 | /* We are reclaiming the last packet of the queue */ |
| 902 | if (tid_data->tfds_in_queue == 0) { |
| 903 | IWL_DEBUG_HT(priv, "HW queue empty: continue ADDBA flow\n"); |
| 904 | tid_data->agg.state = IWL_AGG_ON; |
Johannes Berg | 8bd413e | 2010-08-23 10:46:40 +0200 | [diff] [blame] | 905 | ieee80211_start_tx_ba_cb_irqsafe(ctx->vif, addr, tid); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 906 | } |
| 907 | break; |
| 908 | } |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 909 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 910 | return 0; |
| 911 | } |
| 912 | |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 913 | static void iwlagn_non_agg_tx_status(struct iwl_priv *priv, |
| 914 | struct iwl_rxon_context *ctx, |
| 915 | const u8 *addr1) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 916 | { |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 917 | struct ieee80211_sta *sta; |
| 918 | struct iwl_station_priv *sta_priv; |
| 919 | |
Johannes Berg | 6db6340 | 2010-06-07 21:20:38 +0200 | [diff] [blame] | 920 | rcu_read_lock(); |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 921 | sta = ieee80211_find_sta(ctx->vif, addr1); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 922 | if (sta) { |
| 923 | sta_priv = (void *)sta->drv_priv; |
| 924 | /* avoid atomic ops if this isn't a client */ |
| 925 | if (sta_priv->client && |
| 926 | atomic_dec_return(&sta_priv->pending_frames) == 0) |
| 927 | ieee80211_sta_block_awake(priv->hw, sta, false); |
| 928 | } |
Johannes Berg | 6db6340 | 2010-06-07 21:20:38 +0200 | [diff] [blame] | 929 | rcu_read_unlock(); |
Johannes Berg | 2e34034 | 2010-11-16 11:51:38 -0800 | [diff] [blame] | 930 | } |
| 931 | |
| 932 | static void iwlagn_tx_status(struct iwl_priv *priv, struct iwl_tx_info *tx_info, |
| 933 | bool is_agg) |
| 934 | { |
| 935 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) tx_info->skb->data; |
| 936 | |
| 937 | if (!is_agg) |
| 938 | iwlagn_non_agg_tx_status(priv, tx_info->ctx, hdr->addr1); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 939 | |
Johannes Berg | 8bd413e | 2010-08-23 10:46:40 +0200 | [diff] [blame] | 940 | ieee80211_tx_status_irqsafe(priv->hw, tx_info->skb); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 941 | } |
| 942 | |
| 943 | int iwlagn_tx_queue_reclaim(struct iwl_priv *priv, int txq_id, int index) |
| 944 | { |
| 945 | struct iwl_tx_queue *txq = &priv->txq[txq_id]; |
| 946 | struct iwl_queue *q = &txq->q; |
| 947 | struct iwl_tx_info *tx_info; |
| 948 | int nfreed = 0; |
| 949 | struct ieee80211_hdr *hdr; |
| 950 | |
| 951 | if ((index >= q->n_bd) || (iwl_queue_used(q, index) == 0)) { |
Daniel Halperin | 2e5d04d | 2011-05-27 08:40:28 -0700 | [diff] [blame] | 952 | IWL_ERR(priv, "%s: Read index for DMA queue txq id (%d), " |
| 953 | "index %d is out of range [0-%d] %d %d.\n", __func__, |
| 954 | txq_id, index, q->n_bd, q->write_ptr, q->read_ptr); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 955 | return 0; |
| 956 | } |
| 957 | |
| 958 | for (index = iwl_queue_inc_wrap(index, q->n_bd); |
| 959 | q->read_ptr != index; |
| 960 | q->read_ptr = iwl_queue_inc_wrap(q->read_ptr, q->n_bd)) { |
| 961 | |
| 962 | tx_info = &txq->txb[txq->q.read_ptr]; |
Stanislaw Gruszka | b250269 | 2011-04-20 15:57:14 +0200 | [diff] [blame] | 963 | |
| 964 | if (WARN_ON_ONCE(tx_info->skb == NULL)) |
| 965 | continue; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 966 | |
Johannes Berg | ff0d91c | 2010-05-17 02:37:34 -0700 | [diff] [blame] | 967 | hdr = (struct ieee80211_hdr *)tx_info->skb->data; |
Stanislaw Gruszka | b250269 | 2011-04-20 15:57:14 +0200 | [diff] [blame] | 968 | if (ieee80211_is_data_qos(hdr->frame_control)) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 969 | nfreed++; |
Stanislaw Gruszka | b250269 | 2011-04-20 15:57:14 +0200 | [diff] [blame] | 970 | |
| 971 | iwlagn_tx_status(priv, tx_info, |
| 972 | txq_id >= IWLAGN_FIRST_AMPDU_QUEUE); |
Johannes Berg | ff0d91c | 2010-05-17 02:37:34 -0700 | [diff] [blame] | 973 | tx_info->skb = NULL; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 974 | |
Johannes Berg | 94b0065 | 2011-04-28 07:27:09 -0700 | [diff] [blame] | 975 | iwlagn_txq_inval_byte_cnt_tbl(priv, txq); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 976 | |
Emmanuel Grumbach | 1359ca4 | 2011-07-08 08:46:10 -0700 | [diff] [blame] | 977 | iwlagn_txq_free_tfd(priv, txq, txq->q.read_ptr); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 978 | } |
| 979 | return nfreed; |
| 980 | } |
| 981 | |
| 982 | /** |
| 983 | * iwlagn_tx_status_reply_compressed_ba - Update tx status from block-ack |
| 984 | * |
| 985 | * Go through block-ack's bitmap of ACK'd frames, update driver's record of |
| 986 | * ACK vs. not. This gets sent to mac80211, then to rate scaling algo. |
| 987 | */ |
| 988 | static int iwlagn_tx_status_reply_compressed_ba(struct iwl_priv *priv, |
| 989 | struct iwl_ht_agg *agg, |
| 990 | struct iwl_compressed_ba_resp *ba_resp) |
| 991 | |
| 992 | { |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 993 | int sh; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 994 | u16 seq_ctl = le16_to_cpu(ba_resp->seq_ctl); |
| 995 | u16 scd_flow = le16_to_cpu(ba_resp->scd_flow); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 996 | struct ieee80211_tx_info *info; |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 997 | u64 bitmap, sent_bitmap; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 998 | |
| 999 | if (unlikely(!agg->wait_for_ba)) { |
Don Fry | 822395b | 2010-10-23 09:02:50 -0700 | [diff] [blame] | 1000 | if (unlikely(ba_resp->bitmap)) |
| 1001 | IWL_ERR(priv, "Received BA when not expected\n"); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1002 | return -EINVAL; |
| 1003 | } |
| 1004 | |
| 1005 | /* Mark that the expected block-ack response arrived */ |
| 1006 | agg->wait_for_ba = 0; |
| 1007 | IWL_DEBUG_TX_REPLY(priv, "BA %d %d\n", agg->start_idx, ba_resp->seq_ctl); |
| 1008 | |
| 1009 | /* Calculate shift to align block-ack bits with our Tx window bits */ |
| 1010 | sh = agg->start_idx - SEQ_TO_INDEX(seq_ctl >> 4); |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1011 | if (sh < 0) |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1012 | sh += 0x100; |
| 1013 | |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1014 | /* |
| 1015 | * Check for success or failure according to the |
| 1016 | * transmitted bitmap and block-ack bitmap |
| 1017 | */ |
| 1018 | bitmap = le64_to_cpu(ba_resp->bitmap) >> sh; |
| 1019 | sent_bitmap = bitmap & agg->bitmap; |
| 1020 | |
| 1021 | /* Sanity check values reported by uCode */ |
| 1022 | if (ba_resp->txed_2_done > ba_resp->txed) { |
| 1023 | IWL_DEBUG_TX_REPLY(priv, |
| 1024 | "bogus sent(%d) and ack(%d) count\n", |
| 1025 | ba_resp->txed, ba_resp->txed_2_done); |
Wey-Yi Guy | 8829c9e | 2010-11-10 11:05:38 -0800 | [diff] [blame] | 1026 | /* |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1027 | * set txed_2_done = txed, |
| 1028 | * so it won't impact rate scale |
Wey-Yi Guy | 8829c9e | 2010-11-10 11:05:38 -0800 | [diff] [blame] | 1029 | */ |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1030 | ba_resp->txed = ba_resp->txed_2_done; |
| 1031 | } |
| 1032 | IWL_DEBUG_HT(priv, "agg frames sent:%d, acked:%d\n", |
| 1033 | ba_resp->txed, ba_resp->txed_2_done); |
Johannes Berg | 9decde9 | 2010-11-30 13:24:36 -0800 | [diff] [blame] | 1034 | |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1035 | /* Find the first ACKed frame to store the TX status */ |
| 1036 | while (sent_bitmap && !(sent_bitmap & 1)) { |
| 1037 | agg->start_idx = (agg->start_idx + 1) & 0xff; |
| 1038 | sent_bitmap >>= 1; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1039 | } |
Johannes Berg | 9decde9 | 2010-11-30 13:24:36 -0800 | [diff] [blame] | 1040 | |
Johannes Berg | ff0d91c | 2010-05-17 02:37:34 -0700 | [diff] [blame] | 1041 | info = IEEE80211_SKB_CB(priv->txq[scd_flow].txb[agg->start_idx].skb); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1042 | memset(&info->status, 0, sizeof(info->status)); |
| 1043 | info->flags |= IEEE80211_TX_STAT_ACK; |
| 1044 | info->flags |= IEEE80211_TX_STAT_AMPDU; |
Daniel Halperin | d0eb633 | 2011-03-16 17:17:36 -0700 | [diff] [blame] | 1045 | info->status.ampdu_ack_len = ba_resp->txed_2_done; |
| 1046 | info->status.ampdu_len = ba_resp->txed; |
Wey-Yi Guy | 8d80108 | 2010-03-17 13:34:36 -0700 | [diff] [blame] | 1047 | iwlagn_hwrate_to_tx_control(priv, agg->rate_n_flags, info); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1048 | |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1049 | return 0; |
| 1050 | } |
| 1051 | |
| 1052 | /** |
Wey-Yi Guy | 8d80108 | 2010-03-17 13:34:36 -0700 | [diff] [blame] | 1053 | * translate ucode response to mac80211 tx status control values |
| 1054 | */ |
| 1055 | void iwlagn_hwrate_to_tx_control(struct iwl_priv *priv, u32 rate_n_flags, |
| 1056 | struct ieee80211_tx_info *info) |
| 1057 | { |
| 1058 | struct ieee80211_tx_rate *r = &info->control.rates[0]; |
| 1059 | |
| 1060 | info->antenna_sel_tx = |
| 1061 | ((rate_n_flags & RATE_MCS_ANT_ABC_MSK) >> RATE_MCS_ANT_POS); |
| 1062 | if (rate_n_flags & RATE_MCS_HT_MSK) |
| 1063 | r->flags |= IEEE80211_TX_RC_MCS; |
| 1064 | if (rate_n_flags & RATE_MCS_GF_MSK) |
| 1065 | r->flags |= IEEE80211_TX_RC_GREEN_FIELD; |
| 1066 | if (rate_n_flags & RATE_MCS_HT40_MSK) |
| 1067 | r->flags |= IEEE80211_TX_RC_40_MHZ_WIDTH; |
| 1068 | if (rate_n_flags & RATE_MCS_DUP_MSK) |
| 1069 | r->flags |= IEEE80211_TX_RC_DUP_DATA; |
| 1070 | if (rate_n_flags & RATE_MCS_SGI_MSK) |
| 1071 | r->flags |= IEEE80211_TX_RC_SHORT_GI; |
| 1072 | r->idx = iwlagn_hwrate_to_mac80211_idx(rate_n_flags, info->band); |
| 1073 | } |
| 1074 | |
| 1075 | /** |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1076 | * iwlagn_rx_reply_compressed_ba - Handler for REPLY_COMPRESSED_BA |
| 1077 | * |
| 1078 | * Handles block-acknowledge notification from device, which reports success |
| 1079 | * of frames sent via aggregation. |
| 1080 | */ |
| 1081 | void iwlagn_rx_reply_compressed_ba(struct iwl_priv *priv, |
| 1082 | struct iwl_rx_mem_buffer *rxb) |
| 1083 | { |
| 1084 | struct iwl_rx_packet *pkt = rxb_addr(rxb); |
| 1085 | struct iwl_compressed_ba_resp *ba_resp = &pkt->u.compressed_ba; |
| 1086 | struct iwl_tx_queue *txq = NULL; |
| 1087 | struct iwl_ht_agg *agg; |
| 1088 | int index; |
| 1089 | int sta_id; |
| 1090 | int tid; |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 1091 | unsigned long flags; |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1092 | |
| 1093 | /* "flow" corresponds to Tx queue */ |
| 1094 | u16 scd_flow = le16_to_cpu(ba_resp->scd_flow); |
| 1095 | |
| 1096 | /* "ssn" is start of block-ack Tx window, corresponds to index |
| 1097 | * (in Tx queue's circular buffer) of first TFD/frame in window */ |
| 1098 | u16 ba_resp_scd_ssn = le16_to_cpu(ba_resp->scd_ssn); |
| 1099 | |
| 1100 | if (scd_flow >= priv->hw_params.max_txq_num) { |
| 1101 | IWL_ERR(priv, |
| 1102 | "BUG_ON scd_flow is bigger than number of queues\n"); |
| 1103 | return; |
| 1104 | } |
| 1105 | |
| 1106 | txq = &priv->txq[scd_flow]; |
| 1107 | sta_id = ba_resp->sta_id; |
| 1108 | tid = ba_resp->tid; |
| 1109 | agg = &priv->stations[sta_id].tid[tid].agg; |
Shanyu Zhao | b561e82 | 2010-06-01 17:13:58 -0700 | [diff] [blame] | 1110 | if (unlikely(agg->txq_id != scd_flow)) { |
Wey-Yi Guy | 735df29 | 2010-07-31 08:34:11 -0700 | [diff] [blame] | 1111 | /* |
| 1112 | * FIXME: this is a uCode bug which need to be addressed, |
| 1113 | * log the information and return for now! |
| 1114 | * since it is possible happen very often and in order |
| 1115 | * not to fill the syslog, don't enable the logging by default |
| 1116 | */ |
| 1117 | IWL_DEBUG_TX_REPLY(priv, |
| 1118 | "BA scd_flow %d does not match txq_id %d\n", |
Shanyu Zhao | b561e82 | 2010-06-01 17:13:58 -0700 | [diff] [blame] | 1119 | scd_flow, agg->txq_id); |
| 1120 | return; |
| 1121 | } |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1122 | |
| 1123 | /* Find index just before block-ack window */ |
| 1124 | index = iwl_queue_dec_wrap(ba_resp_scd_ssn & 0xff, txq->q.n_bd); |
| 1125 | |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 1126 | spin_lock_irqsave(&priv->sta_lock, flags); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1127 | |
| 1128 | IWL_DEBUG_TX_REPLY(priv, "REPLY_COMPRESSED_BA [%d] Received from %pM, " |
| 1129 | "sta_id = %d\n", |
| 1130 | agg->wait_for_ba, |
| 1131 | (u8 *) &ba_resp->sta_addr_lo32, |
| 1132 | ba_resp->sta_id); |
| 1133 | IWL_DEBUG_TX_REPLY(priv, "TID = %d, SeqCtl = %d, bitmap = 0x%llx, scd_flow = " |
| 1134 | "%d, scd_ssn = %d\n", |
| 1135 | ba_resp->tid, |
| 1136 | ba_resp->seq_ctl, |
| 1137 | (unsigned long long)le64_to_cpu(ba_resp->bitmap), |
| 1138 | ba_resp->scd_flow, |
| 1139 | ba_resp->scd_ssn); |
Frans Pop | 91dd6c2 | 2010-03-24 14:19:58 -0700 | [diff] [blame] | 1140 | IWL_DEBUG_TX_REPLY(priv, "DAT start_idx = %d, bitmap = 0x%llx\n", |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1141 | agg->start_idx, |
| 1142 | (unsigned long long)agg->bitmap); |
| 1143 | |
| 1144 | /* Update driver's record of ACK vs. not for each frame in window */ |
| 1145 | iwlagn_tx_status_reply_compressed_ba(priv, agg, ba_resp); |
| 1146 | |
| 1147 | /* Release all TFDs before the SSN, i.e. all TFDs in front of |
| 1148 | * block-ack window (we assume that they've been successfully |
| 1149 | * transmitted ... if not, it's too late anyway). */ |
| 1150 | if (txq->q.read_ptr != (ba_resp_scd_ssn & 0xff)) { |
| 1151 | /* calculate mac80211 ampdu sw queue to wake */ |
| 1152 | int freed = iwlagn_tx_queue_reclaim(priv, scd_flow, index); |
| 1153 | iwl_free_tfds_in_queue(priv, sta_id, tid, freed); |
| 1154 | |
| 1155 | if ((iwl_queue_space(&txq->q) > txq->q.low_mark) && |
| 1156 | priv->mac80211_registered && |
| 1157 | (agg->state != IWL_EMPTYING_HW_QUEUE_DELBA)) |
Johannes Berg | 549a04e | 2010-11-10 18:25:44 -0800 | [diff] [blame] | 1158 | iwl_wake_queue(priv, txq); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1159 | |
| 1160 | iwlagn_txq_check_empty(priv, sta_id, tid, scd_flow); |
| 1161 | } |
Reinette Chatre | 9c5ac09 | 2010-05-05 02:26:06 -0700 | [diff] [blame] | 1162 | |
| 1163 | spin_unlock_irqrestore(&priv->sta_lock, flags); |
Wey-Yi Guy | 74bcdb3 | 2010-03-17 13:34:34 -0700 | [diff] [blame] | 1164 | } |
Johannes Berg | 69fdb71 | 2010-09-22 18:02:02 +0200 | [diff] [blame] | 1165 | |
| 1166 | #ifdef CONFIG_IWLWIFI_DEBUG |
| 1167 | const char *iwl_get_tx_fail_reason(u32 status) |
| 1168 | { |
| 1169 | #define TX_STATUS_FAIL(x) case TX_STATUS_FAIL_ ## x: return #x |
| 1170 | #define TX_STATUS_POSTPONE(x) case TX_STATUS_POSTPONE_ ## x: return #x |
| 1171 | |
| 1172 | switch (status & TX_STATUS_MSK) { |
| 1173 | case TX_STATUS_SUCCESS: |
| 1174 | return "SUCCESS"; |
| 1175 | TX_STATUS_POSTPONE(DELAY); |
| 1176 | TX_STATUS_POSTPONE(FEW_BYTES); |
| 1177 | TX_STATUS_POSTPONE(BT_PRIO); |
| 1178 | TX_STATUS_POSTPONE(QUIET_PERIOD); |
| 1179 | TX_STATUS_POSTPONE(CALC_TTAK); |
| 1180 | TX_STATUS_FAIL(INTERNAL_CROSSED_RETRY); |
| 1181 | TX_STATUS_FAIL(SHORT_LIMIT); |
| 1182 | TX_STATUS_FAIL(LONG_LIMIT); |
| 1183 | TX_STATUS_FAIL(FIFO_UNDERRUN); |
| 1184 | TX_STATUS_FAIL(DRAIN_FLOW); |
| 1185 | TX_STATUS_FAIL(RFKILL_FLUSH); |
| 1186 | TX_STATUS_FAIL(LIFE_EXPIRE); |
| 1187 | TX_STATUS_FAIL(DEST_PS); |
| 1188 | TX_STATUS_FAIL(HOST_ABORTED); |
| 1189 | TX_STATUS_FAIL(BT_RETRY); |
| 1190 | TX_STATUS_FAIL(STA_INVALID); |
| 1191 | TX_STATUS_FAIL(FRAG_DROPPED); |
| 1192 | TX_STATUS_FAIL(TID_DISABLE); |
| 1193 | TX_STATUS_FAIL(FIFO_FLUSHED); |
| 1194 | TX_STATUS_FAIL(INSUFFICIENT_CF_POLL); |
| 1195 | TX_STATUS_FAIL(PASSIVE_NO_RX); |
| 1196 | TX_STATUS_FAIL(NO_BEACON_ON_RADAR); |
| 1197 | } |
| 1198 | |
| 1199 | return "UNKNOWN"; |
| 1200 | |
| 1201 | #undef TX_STATUS_FAIL |
| 1202 | #undef TX_STATUS_POSTPONE |
| 1203 | } |
| 1204 | #endif /* CONFIG_IWLWIFI_DEBUG */ |