blob: c0db681d66d1e5fd95cefe48f69adb5070404038 [file] [log] [blame]
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001/******************************************************************************
2 *
Emmanuel Grumbach51368bf2013-12-30 13:15:54 +02003 * Copyright(c) 2003 - 2014 Intel Corporation. All rights reserved.
Sara Sharon26d535a2015-04-28 12:56:54 +03004 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
Sara Sharonbce97732016-01-25 18:14:49 +02005 * Copyright(c) 2016 Intel Deutschland GmbH
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07006 *
7 * Portions of this file are derived from the ipw3945 project, as well
8 * as portions of the ieee80211 subsystem header files.
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of version 2 of the GNU General Public License as
12 * published by the Free Software Foundation.
13 *
14 * This program is distributed in the hope that it will be useful, but WITHOUT
15 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
16 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
17 * more details.
18 *
19 * You should have received a copy of the GNU General Public License along with
20 * this program; if not, write to the Free Software Foundation, Inc.,
21 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
22 *
23 * The full GNU General Public License is included in this distribution in the
24 * file called LICENSE.
25 *
26 * Contact Information:
Emmanuel Grumbachd01c5362015-11-17 15:39:56 +020027 * Intel Linux Wireless <linuxwifi@intel.com>
Emmanuel Grumbachab697a92011-07-11 07:35:34 -070028 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
29 *
30 *****************************************************************************/
31#include <linux/sched.h>
32#include <linux/wait.h>
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -070033#include <linux/gfp.h>
Emmanuel Grumbachab697a92011-07-11 07:35:34 -070034
Johannes Berg1b29dc92012-03-06 13:30:50 -080035#include "iwl-prph.h"
Emmanuel Grumbachab697a92011-07-11 07:35:34 -070036#include "iwl-io.h"
Johannes Berg6468a012012-05-16 19:13:54 +020037#include "internal.h"
Emmanuel Grumbachdb70f292012-02-09 16:08:15 +020038#include "iwl-op-mode.h"
Emmanuel Grumbachab697a92011-07-11 07:35:34 -070039
40/******************************************************************************
41 *
42 * RX path functions
43 *
44 ******************************************************************************/
45
46/*
47 * Rx theory of operation
48 *
49 * Driver allocates a circular buffer of Receive Buffer Descriptors (RBDs),
50 * each of which point to Receive Buffers to be filled by the NIC. These get
51 * used not only for Rx frames, but for any command response or notification
52 * from the NIC. The driver and NIC manage the Rx buffers by means
53 * of indexes into the circular buffer.
54 *
55 * Rx Queue Indexes
56 * The host/firmware share two index registers for managing the Rx buffers.
57 *
58 * The READ index maps to the first position that the firmware may be writing
59 * to -- the driver can read up to (but not including) this position and get
60 * good data.
61 * The READ index is managed by the firmware once the card is enabled.
62 *
63 * The WRITE index maps to the last position the driver has read from -- the
64 * position preceding WRITE is the last slot the firmware can place a packet.
65 *
66 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
67 * WRITE = READ.
68 *
69 * During initialization, the host sets up the READ queue position to the first
70 * INDEX position, and WRITE to the last (READ - 1 wrapped)
71 *
72 * When the firmware places a packet in a buffer, it will advance the READ index
73 * and fire the RX interrupt. The driver can then query the READ index and
74 * process as many packets as possible, moving the WRITE index forward as it
75 * resets the Rx queue buffers with new memory.
76 *
77 * The management in the driver is as follows:
Sara Sharon26d535a2015-04-28 12:56:54 +030078 * + A list of pre-allocated RBDs is stored in iwl->rxq->rx_free.
79 * When the interrupt handler is called, the request is processed.
80 * The page is either stolen - transferred to the upper layer
81 * or reused - added immediately to the iwl->rxq->rx_free list.
82 * + When the page is stolen - the driver updates the matching queue's used
83 * count, detaches the RBD and transfers it to the queue used list.
84 * When there are two used RBDs - they are transferred to the allocator empty
85 * list. Work is then scheduled for the allocator to start allocating
86 * eight buffers.
87 * When there are another 6 used RBDs - they are transferred to the allocator
88 * empty list and the driver tries to claim the pre-allocated buffers and
89 * add them to iwl->rxq->rx_free. If it fails - it continues to claim them
90 * until ready.
91 * When there are 8+ buffers in the free list - either from allocation or from
92 * 8 reused unstolen pages - restock is called to update the FW and indexes.
93 * + In order to make sure the allocator always has RBDs to use for allocation
94 * the allocator has initial pool in the size of num_queues*(8-2) - the
95 * maximum missing RBDs per allocation request (request posted with 2
96 * empty RBDs, there is no guarantee when the other 6 RBDs are supplied).
97 * The queues supplies the recycle of the rest of the RBDs.
Emmanuel Grumbachab697a92011-07-11 07:35:34 -070098 * + A received packet is processed and handed to the kernel network stack,
99 * detached from the iwl->rxq. The driver 'processed' index is updated.
Sara Sharon26d535a2015-04-28 12:56:54 +0300100 * + If there are no allocated buffers in iwl->rxq->rx_free,
Johannes Berg2bfb5092012-12-27 21:43:48 +0100101 * the READ INDEX is not incremented and iwl->status(RX_STALLED) is set.
102 * If there were enough free buffers and RX_STALLED is set it is cleared.
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700103 *
104 *
105 * Driver sequence:
106 *
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200107 * iwl_rxq_alloc() Allocates rx_free
108 * iwl_pcie_rx_replenish() Replenishes rx_free list from rx_used, and calls
Sara Sharon26d535a2015-04-28 12:56:54 +0300109 * iwl_pcie_rxq_restock.
110 * Used only during initialization.
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200111 * iwl_pcie_rxq_restock() Moves available buffers from rx_free into Rx
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700112 * queue, updates firmware pointers, and updates
Sara Sharon26d535a2015-04-28 12:56:54 +0300113 * the WRITE index.
114 * iwl_pcie_rx_allocator() Background work for allocating pages.
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700115 *
116 * -- enable interrupts --
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200117 * ISR - iwl_rx() Detach iwl_rx_mem_buffers from pool up to the
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700118 * READ INDEX, detaching the SKB from the pool.
119 * Moves the packet buffer from queue to rx_used.
Sara Sharon26d535a2015-04-28 12:56:54 +0300120 * Posts and claims requests to the allocator.
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200121 * Calls iwl_pcie_rxq_restock to refill any empty
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700122 * slots.
Sara Sharon26d535a2015-04-28 12:56:54 +0300123 *
124 * RBD life-cycle:
125 *
126 * Init:
127 * rxq.pool -> rxq.rx_used -> rxq.rx_free -> rxq.queue
128 *
129 * Regular Receive interrupt:
130 * Page Stolen:
131 * rxq.queue -> rxq.rx_used -> allocator.rbd_empty ->
132 * allocator.rbd_allocated -> rxq.rx_free -> rxq.queue
133 * Page not Stolen:
134 * rxq.queue -> rxq.rx_free -> rxq.queue
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700135 * ...
136 *
137 */
138
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200139/*
140 * iwl_rxq_space - Return number of free slots available in queue.
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700141 */
Johannes Bergfecba092013-06-20 21:56:49 +0200142static int iwl_rxq_space(const struct iwl_rxq *rxq)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700143{
Sara Sharon96a64972015-12-23 15:10:03 +0200144 /* Make sure rx queue size is a power of 2 */
145 WARN_ON(rxq->queue_size & (rxq->queue_size - 1));
Johannes Bergfecba092013-06-20 21:56:49 +0200146
Ido Yariv351746c2013-07-15 12:41:27 -0400147 /*
148 * There can be up to (RX_QUEUE_SIZE - 1) free slots, to avoid ambiguity
149 * between empty and completely full queues.
150 * The following is equivalent to modulo by RX_QUEUE_SIZE and is well
151 * defined for negative dividends.
152 */
Sara Sharon96a64972015-12-23 15:10:03 +0200153 return (rxq->read - rxq->write - 1) & (rxq->queue_size - 1);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700154}
155
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200156/*
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200157 * iwl_dma_addr2rbd_ptr - convert a DMA address to a uCode read buffer ptr
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700158 */
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200159static inline __le32 iwl_pcie_dma_addr2rbd_ptr(dma_addr_t dma_addr)
160{
161 return cpu_to_le32((u32)(dma_addr >> 8));
162}
163
Sara Sharon96a64972015-12-23 15:10:03 +0200164static void iwl_pcie_write_prph_64(struct iwl_trans *trans, u64 ofs, u64 val)
165{
166 iwl_write_prph(trans, ofs, val & 0xffffffff);
167 iwl_write_prph(trans, ofs + 4, val >> 32);
168}
169
Emmanuel Grumbach49bd072d2012-11-18 13:14:51 +0200170/*
171 * iwl_pcie_rx_stop - stops the Rx DMA
172 */
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200173int iwl_pcie_rx_stop(struct iwl_trans *trans)
174{
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200175 iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
176 return iwl_poll_direct_bit(trans, FH_MEM_RSSR_RX_STATUS_REG,
177 FH_RSSR_CHNL0_RX_STATUS_CHNL_IDLE, 1000);
178}
179
180/*
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200181 * iwl_pcie_rxq_inc_wr_ptr - Update the write pointer for the RX queue
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700182 */
Sara Sharon78485052015-12-14 17:44:11 +0200183static void iwl_pcie_rxq_inc_wr_ptr(struct iwl_trans *trans,
184 struct iwl_rxq *rxq)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700185{
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700186 u32 reg;
187
Johannes Berg5d63f922014-02-27 11:20:07 +0100188 lockdep_assert_held(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700189
Eliad Peller50453882014-02-05 19:12:24 +0200190 /*
191 * explicitly wake up the NIC if:
192 * 1. shadow registers aren't enabled
193 * 2. there is a chance that the NIC is asleep
194 */
195 if (!trans->cfg->base_params->shadow_reg_enable &&
196 test_bit(STATUS_TPOWER_PMI, &trans->status)) {
197 reg = iwl_read32(trans, CSR_UCODE_DRV_GP1);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700198
Eliad Peller50453882014-02-05 19:12:24 +0200199 if (reg & CSR_UCODE_DRV_GP1_BIT_MAC_SLEEP) {
200 IWL_DEBUG_INFO(trans, "Rx queue requesting wakeup, GP1 = 0x%x\n",
201 reg);
202 iwl_set_bit(trans, CSR_GP_CNTRL,
203 CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
Johannes Berg5d63f922014-02-27 11:20:07 +0100204 rxq->need_update = true;
205 return;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700206 }
207 }
Eliad Peller50453882014-02-05 19:12:24 +0200208
209 rxq->write_actual = round_down(rxq->write, 8);
Sara Sharon96a64972015-12-23 15:10:03 +0200210 if (trans->cfg->mq_rx_supported)
211 iwl_write_prph(trans, RFH_Q_FRBDCB_WIDX(rxq->id),
212 rxq->write_actual);
213 else
214 iwl_write32(trans, FH_RSCSR_CHNL0_WPTR, rxq->write_actual);
Johannes Berg5d63f922014-02-27 11:20:07 +0100215}
216
217static void iwl_pcie_rxq_check_wrptr(struct iwl_trans *trans)
218{
219 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Sara Sharon78485052015-12-14 17:44:11 +0200220 int i;
Johannes Berg5d63f922014-02-27 11:20:07 +0100221
Sara Sharon78485052015-12-14 17:44:11 +0200222 for (i = 0; i < trans->num_rx_queues; i++) {
223 struct iwl_rxq *rxq = &trans_pcie->rxq[i];
Johannes Berg5d63f922014-02-27 11:20:07 +0100224
Sara Sharon78485052015-12-14 17:44:11 +0200225 if (!rxq->need_update)
226 continue;
227 spin_lock(&rxq->lock);
228 iwl_pcie_rxq_inc_wr_ptr(trans, rxq);
229 rxq->need_update = false;
230 spin_unlock(&rxq->lock);
231 }
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700232}
233
Sara Sharon96a64972015-12-23 15:10:03 +0200234static void iwl_pcie_rxq_mq_restock(struct iwl_trans *trans,
235 struct iwl_rxq *rxq)
236{
237 struct iwl_rx_mem_buffer *rxb;
238
239 /*
240 * If the device isn't enabled - no need to try to add buffers...
241 * This can happen when we stop the device and still have an interrupt
242 * pending. We stop the APM before we sync the interrupts because we
243 * have to (see comment there). On the other hand, since the APM is
244 * stopped, we cannot access the HW (in particular not prph).
245 * So don't try to restock if the APM has been already stopped.
246 */
247 if (!test_bit(STATUS_DEVICE_ENABLED, &trans->status))
248 return;
249
250 spin_lock(&rxq->lock);
251 while (rxq->free_count) {
252 __le64 *bd = (__le64 *)rxq->bd;
253
254 /* Get next free Rx buffer, remove from free list */
255 rxb = list_first_entry(&rxq->rx_free, struct iwl_rx_mem_buffer,
256 list);
257 list_del(&rxb->list);
258
259 /* 12 first bits are expected to be empty */
260 WARN_ON(rxb->page_dma & DMA_BIT_MASK(12));
261 /* Point to Rx buffer via next RBD in circular buffer */
262 bd[rxq->write] = cpu_to_le64(rxb->page_dma | rxb->vid);
263 rxq->write = (rxq->write + 1) & MQ_RX_TABLE_MASK;
264 rxq->free_count--;
265 }
266 spin_unlock(&rxq->lock);
267
268 /*
269 * If we've added more space for the firmware to place data, tell it.
270 * Increment device's write pointer in multiples of 8.
271 */
272 if (rxq->write_actual != (rxq->write & ~0x7)) {
273 spin_lock(&rxq->lock);
274 iwl_pcie_rxq_inc_wr_ptr(trans, rxq);
275 spin_unlock(&rxq->lock);
276 }
277}
278
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200279/*
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200280 * iwl_pcie_rxq_restock - refill RX queue from pre-allocated pool
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700281 *
282 * If there are slots in the RX queue that need to be restocked,
283 * and we have free pre-allocated buffers, fill the ranks as much
284 * as we can, pulling from rx_free.
285 *
286 * This moves the 'write' index forward to catch up with 'processed', and
287 * also updates the memory address in the firmware to reference the new
288 * target buffer.
289 */
Sara Sharon78485052015-12-14 17:44:11 +0200290static void iwl_pcie_rxq_restock(struct iwl_trans *trans, struct iwl_rxq *rxq)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700291{
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700292 struct iwl_rx_mem_buffer *rxb;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700293
Emmanuel Grumbach74390462012-09-09 16:58:07 +0300294 /*
295 * If the device isn't enabled - not need to try to add buffers...
296 * This can happen when we stop the device and still have an interrupt
Johannes Berg2bfb5092012-12-27 21:43:48 +0100297 * pending. We stop the APM before we sync the interrupts because we
298 * have to (see comment there). On the other hand, since the APM is
299 * stopped, we cannot access the HW (in particular not prph).
Emmanuel Grumbach74390462012-09-09 16:58:07 +0300300 * So don't try to restock if the APM has been already stopped.
301 */
Arik Nemtsoveb7ff772013-12-01 12:30:38 +0200302 if (!test_bit(STATUS_DEVICE_ENABLED, &trans->status))
Emmanuel Grumbach74390462012-09-09 16:58:07 +0300303 return;
304
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200305 spin_lock(&rxq->lock);
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200306 while ((iwl_rxq_space(rxq) > 0) && (rxq->free_count)) {
Sara Sharon96a64972015-12-23 15:10:03 +0200307 __le32 *bd = (__le32 *)rxq->bd;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700308 /* The overwritten rxb must be a used one */
309 rxb = rxq->queue[rxq->write];
310 BUG_ON(rxb && rxb->page);
311
312 /* Get next free Rx buffer, remove from free list */
Johannes Berge2b19302012-11-04 09:31:25 +0100313 rxb = list_first_entry(&rxq->rx_free, struct iwl_rx_mem_buffer,
314 list);
315 list_del(&rxb->list);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700316
317 /* Point to Rx buffer via next RBD in circular buffer */
Sara Sharon96a64972015-12-23 15:10:03 +0200318 bd[rxq->write] = iwl_pcie_dma_addr2rbd_ptr(rxb->page_dma);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700319 rxq->queue[rxq->write] = rxb;
320 rxq->write = (rxq->write + 1) & RX_QUEUE_MASK;
321 rxq->free_count--;
322 }
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200323 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700324
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700325 /* If we've added more space for the firmware to place data, tell it.
326 * Increment device's write pointer in multiples of 8. */
327 if (rxq->write_actual != (rxq->write & ~0x7)) {
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200328 spin_lock(&rxq->lock);
Sara Sharon78485052015-12-14 17:44:11 +0200329 iwl_pcie_rxq_inc_wr_ptr(trans, rxq);
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200330 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700331 }
332}
333
Emmanuel Grumbach358a46d2012-09-09 16:39:18 +0300334/*
Sara Sharon26d535a2015-04-28 12:56:54 +0300335 * iwl_pcie_rx_alloc_page - allocates and returns a page.
336 *
337 */
338static struct page *iwl_pcie_rx_alloc_page(struct iwl_trans *trans,
339 gfp_t priority)
340{
341 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Sara Sharon26d535a2015-04-28 12:56:54 +0300342 struct page *page;
343 gfp_t gfp_mask = priority;
344
Sara Sharon26d535a2015-04-28 12:56:54 +0300345 if (trans_pcie->rx_page_order > 0)
346 gfp_mask |= __GFP_COMP;
347
348 /* Alloc a new receive buffer */
349 page = alloc_pages(gfp_mask, trans_pcie->rx_page_order);
350 if (!page) {
351 if (net_ratelimit())
352 IWL_DEBUG_INFO(trans, "alloc_pages failed, order: %d\n",
353 trans_pcie->rx_page_order);
Sara Sharon78485052015-12-14 17:44:11 +0200354 /*
355 * Issue an error if we don't have enough pre-allocated
356 * buffers.
Sara Sharon26d535a2015-04-28 12:56:54 +0300357` */
Sara Sharon78485052015-12-14 17:44:11 +0200358 if (!(gfp_mask & __GFP_NOWARN) && net_ratelimit())
Sara Sharon26d535a2015-04-28 12:56:54 +0300359 IWL_CRIT(trans,
Sara Sharon78485052015-12-14 17:44:11 +0200360 "Failed to alloc_pages\n");
Sara Sharon26d535a2015-04-28 12:56:54 +0300361 return NULL;
362 }
363 return page;
364}
365
366/*
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200367 * iwl_pcie_rxq_alloc_rbs - allocate a page for each used RBD
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700368 *
Emmanuel Grumbach358a46d2012-09-09 16:39:18 +0300369 * A used RBD is an Rx buffer that has been given to the stack. To use it again
370 * a page must be allocated and the RBD must point to the page. This function
371 * doesn't change the HW pointer but handles the list of pages that is used by
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +0200372 * iwl_pcie_rxq_restock. The latter function will update the HW to use the newly
Emmanuel Grumbach358a46d2012-09-09 16:39:18 +0300373 * allocated buffers.
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700374 */
Sara Sharon78485052015-12-14 17:44:11 +0200375static void iwl_pcie_rxq_alloc_rbs(struct iwl_trans *trans, gfp_t priority,
376 struct iwl_rxq *rxq)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700377{
Johannes Berg20d3b642012-05-16 22:54:29 +0200378 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700379 struct iwl_rx_mem_buffer *rxb;
380 struct page *page;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700381
382 while (1) {
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200383 spin_lock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700384 if (list_empty(&rxq->rx_used)) {
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200385 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700386 return;
387 }
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200388 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700389
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700390 /* Alloc a new receive buffer */
Sara Sharon26d535a2015-04-28 12:56:54 +0300391 page = iwl_pcie_rx_alloc_page(trans, priority);
392 if (!page)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700393 return;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700394
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200395 spin_lock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700396
397 if (list_empty(&rxq->rx_used)) {
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200398 spin_unlock(&rxq->lock);
Johannes Bergb2cf4102012-04-09 17:46:51 -0700399 __free_pages(page, trans_pcie->rx_page_order);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700400 return;
401 }
Johannes Berge2b19302012-11-04 09:31:25 +0100402 rxb = list_first_entry(&rxq->rx_used, struct iwl_rx_mem_buffer,
403 list);
404 list_del(&rxb->list);
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200405 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700406
407 BUG_ON(rxb->page);
408 rxb->page = page;
409 /* Get physical address of the RB */
Johannes Berg20d3b642012-05-16 22:54:29 +0200410 rxb->page_dma =
411 dma_map_page(trans->dev, page, 0,
412 PAGE_SIZE << trans_pcie->rx_page_order,
413 DMA_FROM_DEVICE);
Johannes Berg7c3415822012-11-04 09:29:17 +0100414 if (dma_mapping_error(trans->dev, rxb->page_dma)) {
415 rxb->page = NULL;
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200416 spin_lock(&rxq->lock);
Johannes Berg7c3415822012-11-04 09:29:17 +0100417 list_add(&rxb->list, &rxq->rx_used);
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200418 spin_unlock(&rxq->lock);
Johannes Berg7c3415822012-11-04 09:29:17 +0100419 __free_pages(page, trans_pcie->rx_page_order);
420 return;
421 }
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700422
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200423 spin_lock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700424
425 list_add_tail(&rxb->list, &rxq->rx_free);
426 rxq->free_count++;
427
Emmanuel Grumbach51232f72013-12-11 10:22:28 +0200428 spin_unlock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700429 }
430}
431
Sara Sharon78485052015-12-14 17:44:11 +0200432static void iwl_pcie_free_rbs_pool(struct iwl_trans *trans)
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200433{
434 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200435 int i;
436
Sara Sharon96a64972015-12-23 15:10:03 +0200437 for (i = 0; i < MQ_RX_POOL_SIZE; i++) {
Sara Sharon78485052015-12-14 17:44:11 +0200438 if (!trans_pcie->rx_pool[i].page)
Johannes Bergc7df1f42013-06-20 20:59:34 +0200439 continue;
Sara Sharon78485052015-12-14 17:44:11 +0200440 dma_unmap_page(trans->dev, trans_pcie->rx_pool[i].page_dma,
Johannes Bergc7df1f42013-06-20 20:59:34 +0200441 PAGE_SIZE << trans_pcie->rx_page_order,
442 DMA_FROM_DEVICE);
Sara Sharon78485052015-12-14 17:44:11 +0200443 __free_pages(trans_pcie->rx_pool[i].page,
444 trans_pcie->rx_page_order);
445 trans_pcie->rx_pool[i].page = NULL;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200446 }
447}
448
Emmanuel Grumbach358a46d2012-09-09 16:39:18 +0300449/*
Sara Sharon26d535a2015-04-28 12:56:54 +0300450 * iwl_pcie_rx_allocator - Allocates pages in the background for RX queues
451 *
452 * Allocates for each received request 8 pages
453 * Called as a scheduled work item.
454 */
455static void iwl_pcie_rx_allocator(struct iwl_trans *trans)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700456{
Sara Sharon26d535a2015-04-28 12:56:54 +0300457 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
458 struct iwl_rb_allocator *rba = &trans_pcie->rba;
459 struct list_head local_empty;
460 int pending = atomic_xchg(&rba->req_pending, 0);
Sara Sharon5f175702015-04-28 12:56:54 +0300461
Sara Sharon26d535a2015-04-28 12:56:54 +0300462 IWL_DEBUG_RX(trans, "Pending allocation requests = %d\n", pending);
463
464 /* If we were scheduled - there is at least one request */
465 spin_lock(&rba->lock);
466 /* swap out the rba->rbd_empty to a local list */
467 list_replace_init(&rba->rbd_empty, &local_empty);
468 spin_unlock(&rba->lock);
469
470 while (pending) {
471 int i;
472 struct list_head local_allocated;
Sara Sharon78485052015-12-14 17:44:11 +0200473 gfp_t gfp_mask = GFP_KERNEL;
474
475 /* Do not post a warning if there are only a few requests */
476 if (pending < RX_PENDING_WATERMARK)
477 gfp_mask |= __GFP_NOWARN;
Sara Sharon26d535a2015-04-28 12:56:54 +0300478
479 INIT_LIST_HEAD(&local_allocated);
480
481 for (i = 0; i < RX_CLAIM_REQ_ALLOC;) {
482 struct iwl_rx_mem_buffer *rxb;
483 struct page *page;
484
485 /* List should never be empty - each reused RBD is
486 * returned to the list, and initial pool covers any
487 * possible gap between the time the page is allocated
488 * to the time the RBD is added.
489 */
490 BUG_ON(list_empty(&local_empty));
491 /* Get the first rxb from the rbd list */
492 rxb = list_first_entry(&local_empty,
493 struct iwl_rx_mem_buffer, list);
494 BUG_ON(rxb->page);
495
496 /* Alloc a new receive buffer */
Sara Sharon78485052015-12-14 17:44:11 +0200497 page = iwl_pcie_rx_alloc_page(trans, gfp_mask);
Sara Sharon26d535a2015-04-28 12:56:54 +0300498 if (!page)
499 continue;
500 rxb->page = page;
501
502 /* Get physical address of the RB */
503 rxb->page_dma = dma_map_page(trans->dev, page, 0,
504 PAGE_SIZE << trans_pcie->rx_page_order,
505 DMA_FROM_DEVICE);
506 if (dma_mapping_error(trans->dev, rxb->page_dma)) {
507 rxb->page = NULL;
508 __free_pages(page, trans_pcie->rx_page_order);
509 continue;
510 }
Sara Sharon26d535a2015-04-28 12:56:54 +0300511
512 /* move the allocated entry to the out list */
513 list_move(&rxb->list, &local_allocated);
514 i++;
515 }
516
517 pending--;
518 if (!pending) {
519 pending = atomic_xchg(&rba->req_pending, 0);
520 IWL_DEBUG_RX(trans,
521 "Pending allocation requests = %d\n",
522 pending);
523 }
524
525 spin_lock(&rba->lock);
526 /* add the allocated rbds to the allocator allocated list */
527 list_splice_tail(&local_allocated, &rba->rbd_allocated);
528 /* get more empty RBDs for current pending requests */
529 list_splice_tail_init(&rba->rbd_empty, &local_empty);
530 spin_unlock(&rba->lock);
531
532 atomic_inc(&rba->req_ready);
533 }
534
535 spin_lock(&rba->lock);
536 /* return unused rbds to the allocator empty list */
537 list_splice_tail(&local_empty, &rba->rbd_empty);
538 spin_unlock(&rba->lock);
539}
540
541/*
542 * iwl_pcie_rx_allocator_get - Returns the pre-allocated pages
543.*
544.* Called by queue when the queue posted allocation request and
545 * has freed 8 RBDs in order to restock itself.
546 */
547static int iwl_pcie_rx_allocator_get(struct iwl_trans *trans,
548 struct iwl_rx_mem_buffer
549 *out[RX_CLAIM_REQ_ALLOC])
550{
551 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
552 struct iwl_rb_allocator *rba = &trans_pcie->rba;
553 int i;
554
555 /*
556 * atomic_dec_if_positive returns req_ready - 1 for any scenario.
557 * If req_ready is 0 atomic_dec_if_positive will return -1 and this
558 * function will return -ENOMEM, as there are no ready requests.
559 * atomic_dec_if_positive will perofrm the *actual* decrement only if
560 * req_ready > 0, i.e. - there are ready requests and the function
561 * hands one request to the caller.
562 */
563 if (atomic_dec_if_positive(&rba->req_ready) < 0)
564 return -ENOMEM;
565
566 spin_lock(&rba->lock);
567 for (i = 0; i < RX_CLAIM_REQ_ALLOC; i++) {
568 /* Get next free Rx buffer, remove it from free list */
569 out[i] = list_first_entry(&rba->rbd_allocated,
570 struct iwl_rx_mem_buffer, list);
571 list_del(&out[i]->list);
572 }
573 spin_unlock(&rba->lock);
574
575 return 0;
576}
577
578static void iwl_pcie_rx_allocator_work(struct work_struct *data)
579{
580 struct iwl_rb_allocator *rba_p =
581 container_of(data, struct iwl_rb_allocator, rx_alloc);
582 struct iwl_trans_pcie *trans_pcie =
583 container_of(rba_p, struct iwl_trans_pcie, rba);
584
585 iwl_pcie_rx_allocator(trans_pcie->trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -0700586}
587
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200588static int iwl_pcie_rx_alloc(struct iwl_trans *trans)
589{
590 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Sara Sharon26d535a2015-04-28 12:56:54 +0300591 struct iwl_rb_allocator *rba = &trans_pcie->rba;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200592 struct device *dev = trans->dev;
Sara Sharon78485052015-12-14 17:44:11 +0200593 int i;
Sara Sharon96a64972015-12-23 15:10:03 +0200594 int free_size = trans->cfg->mq_rx_supported ? sizeof(__le64) :
595 sizeof(__le32);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200596
Sara Sharon78485052015-12-14 17:44:11 +0200597 if (WARN_ON(trans_pcie->rxq))
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200598 return -EINVAL;
599
Sara Sharon78485052015-12-14 17:44:11 +0200600 trans_pcie->rxq = kcalloc(trans->num_rx_queues, sizeof(struct iwl_rxq),
601 GFP_KERNEL);
602 if (!trans_pcie->rxq)
603 return -EINVAL;
604
605 spin_lock_init(&rba->lock);
606
607 for (i = 0; i < trans->num_rx_queues; i++) {
608 struct iwl_rxq *rxq = &trans_pcie->rxq[i];
609
610 spin_lock_init(&rxq->lock);
Sara Sharon96a64972015-12-23 15:10:03 +0200611 if (trans->cfg->mq_rx_supported)
612 rxq->queue_size = MQ_RX_TABLE_SIZE;
613 else
614 rxq->queue_size = RX_QUEUE_SIZE;
615
Sara Sharon78485052015-12-14 17:44:11 +0200616 /*
617 * Allocate the circular buffer of Read Buffer Descriptors
618 * (RBDs)
619 */
620 rxq->bd = dma_zalloc_coherent(dev,
Sara Sharon96a64972015-12-23 15:10:03 +0200621 free_size * rxq->queue_size,
622 &rxq->bd_dma, GFP_KERNEL);
Sara Sharon78485052015-12-14 17:44:11 +0200623 if (!rxq->bd)
624 goto err;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200625
Sara Sharon96a64972015-12-23 15:10:03 +0200626 if (trans->cfg->mq_rx_supported) {
627 rxq->used_bd = dma_zalloc_coherent(dev,
628 sizeof(__le32) *
629 rxq->queue_size,
630 &rxq->used_bd_dma,
631 GFP_KERNEL);
632 if (!rxq->used_bd)
633 goto err;
634 }
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200635
Sara Sharon78485052015-12-14 17:44:11 +0200636 /*Allocate the driver's pointer to receive buffer status */
637 rxq->rb_stts = dma_zalloc_coherent(dev, sizeof(*rxq->rb_stts),
638 &rxq->rb_stts_dma,
639 GFP_KERNEL);
640 if (!rxq->rb_stts)
641 goto err;
642 }
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200643 return 0;
644
Sara Sharon78485052015-12-14 17:44:11 +0200645err:
646 for (i = 0; i < trans->num_rx_queues; i++) {
647 struct iwl_rxq *rxq = &trans_pcie->rxq[i];
648
649 if (rxq->bd)
Sara Sharon96a64972015-12-23 15:10:03 +0200650 dma_free_coherent(dev, free_size * rxq->queue_size,
Sara Sharon78485052015-12-14 17:44:11 +0200651 rxq->bd, rxq->bd_dma);
652 rxq->bd_dma = 0;
653 rxq->bd = NULL;
654
655 if (rxq->rb_stts)
656 dma_free_coherent(trans->dev,
657 sizeof(struct iwl_rb_status),
658 rxq->rb_stts, rxq->rb_stts_dma);
Sara Sharon96a64972015-12-23 15:10:03 +0200659
660 if (rxq->used_bd)
661 dma_free_coherent(dev, sizeof(__le32) * rxq->queue_size,
662 rxq->used_bd, rxq->used_bd_dma);
663 rxq->used_bd_dma = 0;
664 rxq->used_bd = NULL;
Sara Sharon78485052015-12-14 17:44:11 +0200665 }
666 kfree(trans_pcie->rxq);
Sara Sharon96a64972015-12-23 15:10:03 +0200667
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200668 return -ENOMEM;
669}
670
671static void iwl_pcie_rx_hw_init(struct iwl_trans *trans, struct iwl_rxq *rxq)
672{
673 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
674 u32 rb_size;
675 const u32 rfdnlog = RX_QUEUE_SIZE_LOG; /* 256 RBDs */
676
Emmanuel Grumbach6c4fbcb2015-11-10 11:57:41 +0200677 switch (trans_pcie->rx_buf_size) {
678 case IWL_AMSDU_4K:
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200679 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_4K;
Emmanuel Grumbach6c4fbcb2015-11-10 11:57:41 +0200680 break;
681 case IWL_AMSDU_8K:
682 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_8K;
683 break;
684 case IWL_AMSDU_12K:
685 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_12K;
686 break;
687 default:
688 WARN_ON(1);
689 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_4K;
690 }
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200691
692 /* Stop Rx DMA */
693 iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
Johannes Bergddaf5a52013-01-08 11:25:44 +0100694 /* reset and flush pointers */
695 iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_RBDCB_WPTR, 0);
696 iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_FLUSH_RB_REQ, 0);
697 iwl_write_direct32(trans, FH_RSCSR_CHNL0_RDPTR, 0);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200698
699 /* Reset driver's Rx queue write index */
700 iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_WPTR_REG, 0);
701
702 /* Tell device where to find RBD circular buffer in DRAM */
703 iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_BASE_REG,
704 (u32)(rxq->bd_dma >> 8));
705
706 /* Tell device where in DRAM to update its Rx status */
707 iwl_write_direct32(trans, FH_RSCSR_CHNL0_STTS_WPTR_REG,
708 rxq->rb_stts_dma >> 4);
709
710 /* Enable Rx DMA
711 * FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY is set because of HW bug in
712 * the credit mechanism in 5000 HW RX FIFO
713 * Direct rx interrupts to hosts
Emmanuel Grumbach6c4fbcb2015-11-10 11:57:41 +0200714 * Rx buffer size 4 or 8k or 12k
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200715 * RB timeout 0x10
716 * 256 RBDs
717 */
718 iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG,
719 FH_RCSR_RX_CONFIG_CHNL_EN_ENABLE_VAL |
720 FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY |
721 FH_RCSR_CHNL0_RX_CONFIG_IRQ_DEST_INT_HOST_VAL |
722 rb_size|
Emmanuel Grumbach49bd072d2012-11-18 13:14:51 +0200723 (RX_RB_TIMEOUT << FH_RCSR_RX_CONFIG_REG_IRQ_RBTH_POS)|
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200724 (rfdnlog << FH_RCSR_RX_CONFIG_RBDCB_SIZE_POS));
725
726 /* Set interrupt coalescing timer to default (2048 usecs) */
727 iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF);
Emmanuel Grumbach6960a052013-11-11 15:23:01 +0200728
729 /* W/A for interrupt coalescing bug in 7260 and 3160 */
730 if (trans->cfg->host_interrupt_operation_mode)
731 iwl_set_bit(trans, CSR_INT_COALESCING, IWL_HOST_INT_OPER_MODE);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200732}
733
Sara Sharonbce97732016-01-25 18:14:49 +0200734static void iwl_pcie_rx_mq_hw_init(struct iwl_trans *trans)
Sara Sharon96a64972015-12-23 15:10:03 +0200735{
736 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
737 u32 rb_size, enabled = 0;
738 int i;
739
740 switch (trans_pcie->rx_buf_size) {
741 case IWL_AMSDU_4K:
742 rb_size = RFH_RXF_DMA_RB_SIZE_4K;
743 break;
744 case IWL_AMSDU_8K:
745 rb_size = RFH_RXF_DMA_RB_SIZE_8K;
746 break;
747 case IWL_AMSDU_12K:
748 rb_size = RFH_RXF_DMA_RB_SIZE_12K;
749 break;
750 default:
751 WARN_ON(1);
752 rb_size = RFH_RXF_DMA_RB_SIZE_4K;
753 }
754
755 /* Stop Rx DMA */
756 iwl_write_prph(trans, RFH_RXF_DMA_CFG, 0);
757 /* disable free amd used rx queue operation */
758 iwl_write_prph(trans, RFH_RXF_RXQ_ACTIVE, 0);
759
760 for (i = 0; i < trans->num_rx_queues; i++) {
761 /* Tell device where to find RBD free table in DRAM */
762 iwl_pcie_write_prph_64(trans, RFH_Q_FRBDCB_BA_LSB(i),
Sara Sharonbce97732016-01-25 18:14:49 +0200763 (u64)(trans_pcie->rxq[i].bd_dma));
Sara Sharon96a64972015-12-23 15:10:03 +0200764 /* Tell device where to find RBD used table in DRAM */
765 iwl_pcie_write_prph_64(trans, RFH_Q_URBDCB_BA_LSB(i),
Sara Sharonbce97732016-01-25 18:14:49 +0200766 (u64)(trans_pcie->rxq[i].used_bd_dma));
Sara Sharon96a64972015-12-23 15:10:03 +0200767 /* Tell device where in DRAM to update its Rx status */
768 iwl_pcie_write_prph_64(trans, RFH_Q_URBD_STTS_WPTR_LSB(i),
Sara Sharonbce97732016-01-25 18:14:49 +0200769 trans_pcie->rxq[i].rb_stts_dma);
Sara Sharon96a64972015-12-23 15:10:03 +0200770 /* Reset device indice tables */
771 iwl_write_prph(trans, RFH_Q_FRBDCB_WIDX(i), 0);
772 iwl_write_prph(trans, RFH_Q_FRBDCB_RIDX(i), 0);
773 iwl_write_prph(trans, RFH_Q_URBDCB_WIDX(i), 0);
774
775 enabled |= BIT(i) | BIT(i + 16);
776 }
777
778 /* restock default queue */
779 iwl_pcie_rxq_mq_restock(trans, &trans_pcie->rxq[0]);
780
781 /*
782 * Enable Rx DMA
783 * Single frame mode
784 * Rx buffer size 4 or 8k or 12k
785 * Min RB size 4 or 8
786 * 512 RBDs
787 */
788 iwl_write_prph(trans, RFH_RXF_DMA_CFG,
789 RFH_DMA_EN_ENABLE_VAL |
790 rb_size | RFH_RXF_DMA_SINGLE_FRAME_MASK |
791 RFH_RXF_DMA_MIN_RB_4_8 |
792 RFH_RXF_DMA_RBDCB_SIZE_512);
793
794 iwl_write_prph(trans, RFH_GEN_CFG, RFH_GEN_CFG_RFH_DMA_SNOOP |
795 RFH_GEN_CFG_SERVICE_DMA_SNOOP);
796 iwl_write_prph(trans, RFH_RXF_RXQ_ACTIVE, enabled);
797
798 /* Set interrupt coalescing timer to default (2048 usecs) */
799 iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF);
800}
801
Johannes Bergc7df1f42013-06-20 20:59:34 +0200802static void iwl_pcie_rx_init_rxb_lists(struct iwl_rxq *rxq)
803{
Johannes Bergc7df1f42013-06-20 20:59:34 +0200804 lockdep_assert_held(&rxq->lock);
805
806 INIT_LIST_HEAD(&rxq->rx_free);
807 INIT_LIST_HEAD(&rxq->rx_used);
808 rxq->free_count = 0;
Sara Sharon26d535a2015-04-28 12:56:54 +0300809 rxq->used_count = 0;
Johannes Bergc7df1f42013-06-20 20:59:34 +0200810}
811
Sara Sharonbce97732016-01-25 18:14:49 +0200812static int iwl_pcie_dummy_napi_poll(struct napi_struct *napi, int budget)
813{
814 WARN_ON(1);
815 return 0;
816}
817
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200818int iwl_pcie_rx_init(struct iwl_trans *trans)
819{
820 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Sara Sharon78485052015-12-14 17:44:11 +0200821 struct iwl_rxq *def_rxq;
Sara Sharon26d535a2015-04-28 12:56:54 +0300822 struct iwl_rb_allocator *rba = &trans_pcie->rba;
Sara Sharon96a64972015-12-23 15:10:03 +0200823 int i, err, num_rbds, allocator_pool_size;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200824
Sara Sharon78485052015-12-14 17:44:11 +0200825 if (!trans_pcie->rxq) {
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200826 err = iwl_pcie_rx_alloc(trans);
827 if (err)
828 return err;
829 }
Sara Sharon78485052015-12-14 17:44:11 +0200830 def_rxq = trans_pcie->rxq;
Sara Sharon26d535a2015-04-28 12:56:54 +0300831 if (!rba->alloc_wq)
832 rba->alloc_wq = alloc_workqueue("rb_allocator",
833 WQ_HIGHPRI | WQ_UNBOUND, 1);
834 INIT_WORK(&rba->rx_alloc, iwl_pcie_rx_allocator_work);
835
836 spin_lock(&rba->lock);
837 atomic_set(&rba->req_pending, 0);
838 atomic_set(&rba->req_ready, 0);
Sara Sharon96a64972015-12-23 15:10:03 +0200839 INIT_LIST_HEAD(&rba->rbd_allocated);
840 INIT_LIST_HEAD(&rba->rbd_empty);
Sara Sharon26d535a2015-04-28 12:56:54 +0300841 spin_unlock(&rba->lock);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200842
Johannes Bergc7df1f42013-06-20 20:59:34 +0200843 /* free all first - we might be reconfigured for a different size */
Sara Sharon78485052015-12-14 17:44:11 +0200844 iwl_pcie_free_rbs_pool(trans);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200845
846 for (i = 0; i < RX_QUEUE_SIZE; i++)
Sara Sharon78485052015-12-14 17:44:11 +0200847 def_rxq->queue[i] = NULL;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200848
Sara Sharon78485052015-12-14 17:44:11 +0200849 for (i = 0; i < trans->num_rx_queues; i++) {
850 struct iwl_rxq *rxq = &trans_pcie->rxq[i];
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200851
Sara Sharon96a64972015-12-23 15:10:03 +0200852 rxq->id = i;
853
Sara Sharon78485052015-12-14 17:44:11 +0200854 spin_lock(&rxq->lock);
855 /*
856 * Set read write pointer to reflect that we have processed
857 * and used all buffers, but have not restocked the Rx queue
858 * with fresh buffers
859 */
860 rxq->read = 0;
861 rxq->write = 0;
862 rxq->write_actual = 0;
863 memset(rxq->rb_stts, 0, sizeof(*rxq->rb_stts));
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200864
Sara Sharon78485052015-12-14 17:44:11 +0200865 iwl_pcie_rx_init_rxb_lists(rxq);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200866
Sara Sharonbce97732016-01-25 18:14:49 +0200867 if (!rxq->napi.poll)
868 netif_napi_add(&trans_pcie->napi_dev, &rxq->napi,
869 iwl_pcie_dummy_napi_poll, 64);
870
Sara Sharon78485052015-12-14 17:44:11 +0200871 spin_unlock(&rxq->lock);
872 }
873
Sara Sharon96a64972015-12-23 15:10:03 +0200874 /* move the pool to the default queue and allocator ownerships */
875 num_rbds = trans->cfg->mq_rx_supported ?
876 MQ_RX_POOL_SIZE : RX_QUEUE_SIZE;
877 allocator_pool_size = trans->num_rx_queues *
878 (RX_CLAIM_REQ_ALLOC - RX_POST_REQ_ALLOC);
879 for (i = 0; i < num_rbds; i++) {
880 struct iwl_rx_mem_buffer *rxb = &trans_pcie->rx_pool[i];
881
882 if (i < allocator_pool_size)
883 list_add(&rxb->list, &rba->rbd_empty);
884 else
885 list_add(&rxb->list, &def_rxq->rx_used);
886 trans_pcie->global_table[i] = rxb;
887 rxb->vid = (u16)i;
888 }
Sara Sharon78485052015-12-14 17:44:11 +0200889
890 iwl_pcie_rxq_alloc_rbs(trans, GFP_KERNEL, def_rxq);
Sara Sharon96a64972015-12-23 15:10:03 +0200891 if (trans->cfg->mq_rx_supported) {
Sara Sharonbce97732016-01-25 18:14:49 +0200892 iwl_pcie_rx_mq_hw_init(trans);
Sara Sharon96a64972015-12-23 15:10:03 +0200893 } else {
894 iwl_pcie_rxq_restock(trans, def_rxq);
895 iwl_pcie_rx_hw_init(trans, def_rxq);
896 }
Sara Sharon78485052015-12-14 17:44:11 +0200897
898 spin_lock(&def_rxq->lock);
899 iwl_pcie_rxq_inc_wr_ptr(trans, def_rxq);
900 spin_unlock(&def_rxq->lock);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200901
902 return 0;
903}
904
905void iwl_pcie_rx_free(struct iwl_trans *trans)
906{
907 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Sara Sharon26d535a2015-04-28 12:56:54 +0300908 struct iwl_rb_allocator *rba = &trans_pcie->rba;
Sara Sharon96a64972015-12-23 15:10:03 +0200909 int free_size = trans->cfg->mq_rx_supported ? sizeof(__le64) :
910 sizeof(__le32);
Sara Sharon78485052015-12-14 17:44:11 +0200911 int i;
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200912
Sara Sharon78485052015-12-14 17:44:11 +0200913 /*
914 * if rxq is NULL, it means that nothing has been allocated,
915 * exit now
916 */
917 if (!trans_pcie->rxq) {
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200918 IWL_DEBUG_INFO(trans, "Free NULL rx context\n");
919 return;
920 }
921
Sara Sharon26d535a2015-04-28 12:56:54 +0300922 cancel_work_sync(&rba->rx_alloc);
923 if (rba->alloc_wq) {
924 destroy_workqueue(rba->alloc_wq);
925 rba->alloc_wq = NULL;
926 }
927
Sara Sharon78485052015-12-14 17:44:11 +0200928 iwl_pcie_free_rbs_pool(trans);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200929
Sara Sharon78485052015-12-14 17:44:11 +0200930 for (i = 0; i < trans->num_rx_queues; i++) {
931 struct iwl_rxq *rxq = &trans_pcie->rxq[i];
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200932
Sara Sharon78485052015-12-14 17:44:11 +0200933 if (rxq->bd)
934 dma_free_coherent(trans->dev,
Sara Sharon96a64972015-12-23 15:10:03 +0200935 free_size * rxq->queue_size,
Sara Sharon78485052015-12-14 17:44:11 +0200936 rxq->bd, rxq->bd_dma);
937 rxq->bd_dma = 0;
938 rxq->bd = NULL;
939
940 if (rxq->rb_stts)
941 dma_free_coherent(trans->dev,
942 sizeof(struct iwl_rb_status),
943 rxq->rb_stts, rxq->rb_stts_dma);
944 else
945 IWL_DEBUG_INFO(trans,
946 "Free rxq->rb_stts which is NULL\n");
Sara Sharon78485052015-12-14 17:44:11 +0200947
Sara Sharon96a64972015-12-23 15:10:03 +0200948 if (rxq->used_bd)
949 dma_free_coherent(trans->dev,
950 sizeof(__le32) * rxq->queue_size,
951 rxq->used_bd, rxq->used_bd_dma);
952 rxq->used_bd_dma = 0;
953 rxq->used_bd = NULL;
Sara Sharonbce97732016-01-25 18:14:49 +0200954
955 if (rxq->napi.poll)
956 netif_napi_del(&rxq->napi);
Sara Sharon96a64972015-12-23 15:10:03 +0200957 }
Sara Sharon78485052015-12-14 17:44:11 +0200958 kfree(trans_pcie->rxq);
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +0200959}
960
Sara Sharon26d535a2015-04-28 12:56:54 +0300961/*
962 * iwl_pcie_rx_reuse_rbd - Recycle used RBDs
963 *
964 * Called when a RBD can be reused. The RBD is transferred to the allocator.
965 * When there are 2 empty RBDs - a request for allocation is posted
966 */
967static void iwl_pcie_rx_reuse_rbd(struct iwl_trans *trans,
968 struct iwl_rx_mem_buffer *rxb,
969 struct iwl_rxq *rxq, bool emergency)
970{
971 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
972 struct iwl_rb_allocator *rba = &trans_pcie->rba;
973
974 /* Move the RBD to the used list, will be moved to allocator in batches
975 * before claiming or posting a request*/
976 list_add_tail(&rxb->list, &rxq->rx_used);
977
978 if (unlikely(emergency))
979 return;
980
981 /* Count the allocator owned RBDs */
982 rxq->used_count++;
983
984 /* If we have RX_POST_REQ_ALLOC new released rx buffers -
985 * issue a request for allocator. Modulo RX_CLAIM_REQ_ALLOC is
986 * used for the case we failed to claim RX_CLAIM_REQ_ALLOC,
987 * after but we still need to post another request.
988 */
989 if ((rxq->used_count % RX_CLAIM_REQ_ALLOC) == RX_POST_REQ_ALLOC) {
990 /* Move the 2 RBDs to the allocator ownership.
991 Allocator has another 6 from pool for the request completion*/
992 spin_lock(&rba->lock);
993 list_splice_tail_init(&rxq->rx_used, &rba->rbd_empty);
994 spin_unlock(&rba->lock);
995
996 atomic_inc(&rba->req_pending);
997 queue_work(rba->alloc_wq, &rba->rx_alloc);
998 }
999}
1000
Emmanuel Grumbach9805c4462012-11-14 14:44:18 +02001001static void iwl_pcie_rx_handle_rb(struct iwl_trans *trans,
Sara Sharon78485052015-12-14 17:44:11 +02001002 struct iwl_rxq *rxq,
Sara Sharon26d535a2015-04-28 12:56:54 +03001003 struct iwl_rx_mem_buffer *rxb,
1004 bool emergency)
Johannes Bergdf2f3212012-03-05 11:24:40 -08001005{
1006 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001007 struct iwl_txq *txq = &trans_pcie->txq[trans_pcie->cmd_queue];
Johannes Berg0c197442012-03-15 13:26:43 -07001008 bool page_stolen = false;
Johannes Bergb2cf4102012-04-09 17:46:51 -07001009 int max_len = PAGE_SIZE << trans_pcie->rx_page_order;
Johannes Berg0c197442012-03-15 13:26:43 -07001010 u32 offset = 0;
Johannes Bergdf2f3212012-03-05 11:24:40 -08001011
1012 if (WARN_ON(!rxb))
1013 return;
1014
Johannes Berg0c197442012-03-15 13:26:43 -07001015 dma_unmap_page(trans->dev, rxb->page_dma, max_len, DMA_FROM_DEVICE);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001016
Johannes Berg0c197442012-03-15 13:26:43 -07001017 while (offset + sizeof(u32) + sizeof(struct iwl_cmd_header) < max_len) {
1018 struct iwl_rx_packet *pkt;
Johannes Berg0c197442012-03-15 13:26:43 -07001019 u16 sequence;
1020 bool reclaim;
Johannes Bergf7e64692015-06-23 21:58:17 +02001021 int index, cmd_index, len;
Johannes Berg0c197442012-03-15 13:26:43 -07001022 struct iwl_rx_cmd_buffer rxcb = {
1023 ._offset = offset,
Emmanuel Grumbachd13f1862013-01-23 10:59:29 +02001024 ._rx_page_order = trans_pcie->rx_page_order,
Johannes Berg0c197442012-03-15 13:26:43 -07001025 ._page = rxb->page,
1026 ._page_stolen = false,
David S. Miller0d6c4a22012-05-07 23:35:40 -04001027 .truesize = max_len,
Johannes Berg0c197442012-03-15 13:26:43 -07001028 };
Johannes Bergdf2f3212012-03-05 11:24:40 -08001029
Johannes Berg0c197442012-03-15 13:26:43 -07001030 pkt = rxb_addr(&rxcb);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001031
Johannes Berg0c197442012-03-15 13:26:43 -07001032 if (pkt->len_n_flags == cpu_to_le32(FH_RSCSR_FRAME_INVALID))
1033 break;
Johannes Bergdf2f3212012-03-05 11:24:40 -08001034
Liad Kaufman9243efc2015-03-15 17:38:22 +02001035 IWL_DEBUG_RX(trans,
1036 "cmd at offset %d: %s (0x%.2x, seq 0x%x)\n",
1037 rxcb._offset,
Sharon Dvir39bdb172015-10-15 18:18:09 +03001038 iwl_get_cmd_string(trans,
1039 iwl_cmd_id(pkt->hdr.cmd,
1040 pkt->hdr.group_id,
1041 0)),
Liad Kaufman9243efc2015-03-15 17:38:22 +02001042 pkt->hdr.cmd, le16_to_cpu(pkt->hdr.sequence));
Johannes Bergdf2f3212012-03-05 11:24:40 -08001043
Johannes Berg65b30342014-01-08 13:16:33 +01001044 len = iwl_rx_packet_len(pkt);
Johannes Berg0c197442012-03-15 13:26:43 -07001045 len += sizeof(u32); /* account for status word */
Johannes Bergf042c2e2012-09-05 22:34:44 +02001046 trace_iwlwifi_dev_rx(trans->dev, trans, pkt, len);
1047 trace_iwlwifi_dev_rx_data(trans->dev, trans, pkt, len);
Johannes Bergd663ee72012-03-10 13:00:07 -08001048
Johannes Berg0c197442012-03-15 13:26:43 -07001049 /* Reclaim a command buffer only if this packet is a response
1050 * to a (driver-originated) command.
1051 * If the packet (e.g. Rx frame) originated from uCode,
1052 * there is no command buffer to reclaim.
1053 * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
1054 * but apparently a few don't get set; catch them here. */
1055 reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME);
1056 if (reclaim) {
1057 int i;
1058
1059 for (i = 0; i < trans_pcie->n_no_reclaim_cmds; i++) {
1060 if (trans_pcie->no_reclaim_cmds[i] ==
1061 pkt->hdr.cmd) {
1062 reclaim = false;
1063 break;
1064 }
Johannes Bergd663ee72012-03-10 13:00:07 -08001065 }
1066 }
Johannes Bergdf2f3212012-03-05 11:24:40 -08001067
Johannes Berg0c197442012-03-15 13:26:43 -07001068 sequence = le16_to_cpu(pkt->hdr.sequence);
1069 index = SEQ_TO_INDEX(sequence);
1070 cmd_index = get_cmd_index(&txq->q, index);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001071
Sara Sharonbce97732016-01-25 18:14:49 +02001072 if (rxq->id == 0)
1073 iwl_op_mode_rx(trans->op_mode, &rxq->napi,
1074 &rxcb);
1075 else
1076 iwl_op_mode_rx_rss(trans->op_mode, &rxq->napi,
1077 &rxcb, rxq->id);
Johannes Berg0c197442012-03-15 13:26:43 -07001078
Emmanuel Grumbach96791422012-07-24 01:58:32 +03001079 if (reclaim) {
Johannes Berg5d4185a2014-09-09 21:16:06 +02001080 kzfree(txq->entries[cmd_index].free_buf);
Johannes Bergf4feb8a2012-10-19 14:24:43 +02001081 txq->entries[cmd_index].free_buf = NULL;
Emmanuel Grumbach96791422012-07-24 01:58:32 +03001082 }
1083
Johannes Berg0c197442012-03-15 13:26:43 -07001084 /*
1085 * After here, we should always check rxcb._page_stolen,
1086 * if it is true then one of the handlers took the page.
1087 */
1088
1089 if (reclaim) {
1090 /* Invoke any callbacks, transfer the buffer to caller,
1091 * and fire off the (possibly) blocking
1092 * iwl_trans_send_cmd()
1093 * as we reclaim the driver command queue */
1094 if (!rxcb._page_stolen)
Johannes Bergf7e64692015-06-23 21:58:17 +02001095 iwl_pcie_hcmd_complete(trans, &rxcb);
Johannes Berg0c197442012-03-15 13:26:43 -07001096 else
1097 IWL_WARN(trans, "Claim null rxb?\n");
1098 }
1099
1100 page_stolen |= rxcb._page_stolen;
1101 offset += ALIGN(len, FH_RSCSR_FRAME_ALIGN);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001102 }
1103
Johannes Berg0c197442012-03-15 13:26:43 -07001104 /* page was stolen from us -- free our reference */
1105 if (page_stolen) {
Johannes Bergb2cf4102012-04-09 17:46:51 -07001106 __free_pages(rxb->page, trans_pcie->rx_page_order);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001107 rxb->page = NULL;
Johannes Berg0c197442012-03-15 13:26:43 -07001108 }
Johannes Bergdf2f3212012-03-05 11:24:40 -08001109
1110 /* Reuse the page if possible. For notification packets and
1111 * SKBs that fail to Rx correctly, add them back into the
1112 * rx_free list for reuse later. */
Johannes Bergdf2f3212012-03-05 11:24:40 -08001113 if (rxb->page != NULL) {
1114 rxb->page_dma =
1115 dma_map_page(trans->dev, rxb->page, 0,
Johannes Berg20d3b642012-05-16 22:54:29 +02001116 PAGE_SIZE << trans_pcie->rx_page_order,
1117 DMA_FROM_DEVICE);
Johannes Berg7c3415822012-11-04 09:29:17 +01001118 if (dma_mapping_error(trans->dev, rxb->page_dma)) {
1119 /*
1120 * free the page(s) as well to not break
1121 * the invariant that the items on the used
1122 * list have no page(s)
1123 */
1124 __free_pages(rxb->page, trans_pcie->rx_page_order);
1125 rxb->page = NULL;
Sara Sharon26d535a2015-04-28 12:56:54 +03001126 iwl_pcie_rx_reuse_rbd(trans, rxb, rxq, emergency);
Johannes Berg7c3415822012-11-04 09:29:17 +01001127 } else {
1128 list_add_tail(&rxb->list, &rxq->rx_free);
1129 rxq->free_count++;
1130 }
Johannes Bergdf2f3212012-03-05 11:24:40 -08001131 } else
Sara Sharon26d535a2015-04-28 12:56:54 +03001132 iwl_pcie_rx_reuse_rbd(trans, rxb, rxq, emergency);
Johannes Bergdf2f3212012-03-05 11:24:40 -08001133}
1134
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001135/*
1136 * iwl_pcie_rx_handle - Main entry function for receiving responses from fw
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001137 */
Haim Dreyfuss2e5d4a82015-12-17 12:17:58 +02001138static void iwl_pcie_rx_handle(struct iwl_trans *trans, int queue)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001139{
Johannes Bergdf2f3212012-03-05 11:24:40 -08001140 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Haim Dreyfuss2e5d4a82015-12-17 12:17:58 +02001141 struct iwl_rxq *rxq = &trans_pcie->rxq[queue];
Sara Sharon26d535a2015-04-28 12:56:54 +03001142 u32 r, i, j, count = 0;
1143 bool emergency = false;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001144
Johannes Bergf14d6b32014-03-21 13:30:03 +01001145restart:
1146 spin_lock(&rxq->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001147 /* uCode's read index (stored in shared DRAM) indicates the last Rx
1148 * buffer that the driver may process (last buffer filled by ucode). */
Emmanuel Grumbach52e2a992012-11-25 14:42:25 +02001149 r = le16_to_cpu(ACCESS_ONCE(rxq->rb_stts->closed_rb_num)) & 0x0FFF;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001150 i = rxq->read;
1151
1152 /* Rx interrupt, but nothing sent from uCode */
1153 if (i == r)
Emmanuel Grumbach726f23f2012-05-16 22:40:49 +02001154 IWL_DEBUG_RX(trans, "HW = SW = %d\n", r);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001155
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001156 while (i != r) {
Johannes Berg48a2d662012-03-05 11:24:39 -08001157 struct iwl_rx_mem_buffer *rxb;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001158
Sara Sharon96a64972015-12-23 15:10:03 +02001159 if (unlikely(rxq->used_count == rxq->queue_size / 2))
Sara Sharon26d535a2015-04-28 12:56:54 +03001160 emergency = true;
1161
Sara Sharon96a64972015-12-23 15:10:03 +02001162 if (trans->cfg->mq_rx_supported) {
1163 /*
1164 * used_bd is a 32 bit but only 12 are used to retrieve
1165 * the vid
1166 */
1167 u16 vid = (u16)le32_to_cpu(rxq->used_bd[i]);
1168
1169 rxb = trans_pcie->global_table[vid];
1170 } else {
1171 rxb = rxq->queue[i];
1172 rxq->queue[i] = NULL;
1173 }
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001174
Johannes Bergf02d2cc2015-11-06 11:27:23 +01001175 IWL_DEBUG_RX(trans, "rxbuf: HW = %d, SW = %d\n", r, i);
Sara Sharon78485052015-12-14 17:44:11 +02001176 iwl_pcie_rx_handle_rb(trans, rxq, rxb, emergency);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001177
Sara Sharon96a64972015-12-23 15:10:03 +02001178 i = (i + 1) & (rxq->queue_size - 1);
Sara Sharon26d535a2015-04-28 12:56:54 +03001179
1180 /* If we have RX_CLAIM_REQ_ALLOC released rx buffers -
1181 * try to claim the pre-allocated buffers from the allocator */
1182 if (rxq->used_count >= RX_CLAIM_REQ_ALLOC) {
1183 struct iwl_rb_allocator *rba = &trans_pcie->rba;
1184 struct iwl_rx_mem_buffer *out[RX_CLAIM_REQ_ALLOC];
1185
1186 if (rxq->used_count % RX_CLAIM_REQ_ALLOC == 0 &&
1187 !emergency) {
1188 /* Add the remaining 6 empty RBDs
1189 * for allocator use
1190 */
1191 spin_lock(&rba->lock);
1192 list_splice_tail_init(&rxq->rx_used,
1193 &rba->rbd_empty);
1194 spin_unlock(&rba->lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001195 }
Sara Sharon26d535a2015-04-28 12:56:54 +03001196
1197 /* If not ready - continue, will try to reclaim later.
1198 * No need to reschedule work - allocator exits only on
1199 * success */
1200 if (!iwl_pcie_rx_allocator_get(trans, out)) {
1201 /* If success - then RX_CLAIM_REQ_ALLOC
1202 * buffers were retrieved and should be added
1203 * to free list */
1204 rxq->used_count -= RX_CLAIM_REQ_ALLOC;
1205 for (j = 0; j < RX_CLAIM_REQ_ALLOC; j++) {
1206 list_add_tail(&out[j]->list,
1207 &rxq->rx_free);
1208 rxq->free_count++;
1209 }
1210 }
1211 }
1212 if (emergency) {
1213 count++;
1214 if (count == 8) {
1215 count = 0;
Sara Sharon96a64972015-12-23 15:10:03 +02001216 if (rxq->used_count < rxq->queue_size / 3)
Sara Sharon26d535a2015-04-28 12:56:54 +03001217 emergency = false;
1218 spin_unlock(&rxq->lock);
Sara Sharon78485052015-12-14 17:44:11 +02001219 iwl_pcie_rxq_alloc_rbs(trans, GFP_ATOMIC, rxq);
Sara Sharon26d535a2015-04-28 12:56:54 +03001220 spin_lock(&rxq->lock);
1221 }
1222 }
1223 /* handle restock for three cases, can be all of them at once:
1224 * - we just pulled buffers from the allocator
1225 * - we have 8+ unstolen pages accumulated
1226 * - we are in emergency and allocated buffers
1227 */
1228 if (rxq->free_count >= RX_CLAIM_REQ_ALLOC) {
1229 rxq->read = i;
1230 spin_unlock(&rxq->lock);
Sara Sharon96a64972015-12-23 15:10:03 +02001231 if (trans->cfg->mq_rx_supported)
1232 iwl_pcie_rxq_mq_restock(trans, rxq);
1233 else
1234 iwl_pcie_rxq_restock(trans, rxq);
Sara Sharon26d535a2015-04-28 12:56:54 +03001235 goto restart;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001236 }
1237 }
1238
1239 /* Backtrack one entry */
1240 rxq->read = i;
Johannes Bergf14d6b32014-03-21 13:30:03 +01001241 spin_unlock(&rxq->lock);
1242
Sara Sharon26d535a2015-04-28 12:56:54 +03001243 /*
1244 * handle a case where in emergency there are some unallocated RBDs.
1245 * those RBDs are in the used list, but are not tracked by the queue's
1246 * used_count which counts allocator owned RBDs.
1247 * unallocated emergency RBDs must be allocated on exit, otherwise
1248 * when called again the function may not be in emergency mode and
1249 * they will be handed to the allocator with no tracking in the RBD
1250 * allocator counters, which will lead to them never being claimed back
1251 * by the queue.
1252 * by allocating them here, they are now in the queue free list, and
1253 * will be restocked by the next call of iwl_pcie_rxq_restock.
1254 */
1255 if (unlikely(emergency && count))
Sara Sharon78485052015-12-14 17:44:11 +02001256 iwl_pcie_rxq_alloc_rbs(trans, GFP_ATOMIC, rxq);
Emmanuel Grumbach255ba062015-07-11 22:30:49 +03001257
Sara Sharonbce97732016-01-25 18:14:49 +02001258 if (rxq->napi.poll)
1259 napi_gro_flush(&rxq->napi, false);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001260}
1261
Haim Dreyfuss2e5d4a82015-12-17 12:17:58 +02001262static struct iwl_trans_pcie *iwl_pcie_get_trans_pcie(struct msix_entry *entry)
1263{
1264 u8 queue = entry->entry;
1265 struct msix_entry *entries = entry - queue;
1266
1267 return container_of(entries, struct iwl_trans_pcie, msix_entries[0]);
1268}
1269
1270static inline void iwl_pcie_clear_irq(struct iwl_trans *trans,
1271 struct msix_entry *entry)
1272{
1273 /*
1274 * Before sending the interrupt the HW disables it to prevent
1275 * a nested interrupt. This is done by writing 1 to the corresponding
1276 * bit in the mask register. After handling the interrupt, it should be
1277 * re-enabled by clearing this bit. This register is defined as
1278 * write 1 clear (W1C) register, meaning that it's being clear
1279 * by writing 1 to the bit.
1280 */
1281 iwl_write_direct32(trans, CSR_MSIX_AUTOMASK_ST_AD, BIT(entry->entry));
1282}
1283
1284/*
1285 * iwl_pcie_rx_msix_handle - Main entry function for receiving responses from fw
1286 * This interrupt handler should be used with RSS queue only.
1287 */
1288irqreturn_t iwl_pcie_irq_rx_msix_handler(int irq, void *dev_id)
1289{
1290 struct msix_entry *entry = dev_id;
1291 struct iwl_trans_pcie *trans_pcie = iwl_pcie_get_trans_pcie(entry);
1292 struct iwl_trans *trans = trans_pcie->trans;
1293
1294 lock_map_acquire(&trans->sync_cmd_lockdep_map);
1295
1296 local_bh_disable();
1297 iwl_pcie_rx_handle(trans, entry->entry);
1298 local_bh_enable();
1299
1300 iwl_pcie_clear_irq(trans, entry);
1301
1302 lock_map_release(&trans->sync_cmd_lockdep_map);
1303
1304 return IRQ_HANDLED;
1305}
1306
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001307/*
1308 * iwl_pcie_irq_handle_error - called for HW or SW error interrupt from card
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001309 */
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001310static void iwl_pcie_irq_handle_error(struct iwl_trans *trans)
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001311{
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001312 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach11033232015-06-24 14:58:13 +03001313 int i;
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001314
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001315 /* W/A for WiFi/WiMAX coex and WiMAX own the RF */
Emmanuel Grumbach035f7ff2012-03-26 08:57:01 -07001316 if (trans->cfg->internal_wimax_coex &&
Avri Altman95411d02015-05-11 11:04:34 +03001317 !trans->cfg->apmg_not_supported &&
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001318 (!(iwl_read_prph(trans, APMG_CLK_CTRL_REG) &
Johannes Berg20d3b642012-05-16 22:54:29 +02001319 APMS_CLK_VAL_MRB_FUNC_MODE) ||
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001320 (iwl_read_prph(trans, APMG_PS_CTRL_REG) &
Johannes Berg20d3b642012-05-16 22:54:29 +02001321 APMG_PS_CTRL_VAL_RESET_REQ))) {
Arik Nemtsoveb7ff772013-12-01 12:30:38 +02001322 clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
Don Fry8a8bbdb2012-03-20 10:33:34 -07001323 iwl_op_mode_wimax_active(trans->op_mode);
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001324 wake_up(&trans_pcie->wait_command_queue);
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001325 return;
1326 }
1327
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001328 iwl_pcie_dump_csr(trans);
Inbal Hacohen313b0a22013-06-24 10:35:53 +03001329 iwl_dump_fh(trans, NULL);
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001330
Arik Nemtsov2a988e92013-12-01 13:50:40 +02001331 local_bh_disable();
1332 /* The STATUS_FW_ERROR bit is set in this function. This must happen
1333 * before we wake up the command caller, to ensure a proper cleanup. */
1334 iwl_trans_fw_error(trans);
1335 local_bh_enable();
1336
Emmanuel Grumbach11033232015-06-24 14:58:13 +03001337 for (i = 0; i < trans->cfg->base_params->num_of_queues; i++)
1338 del_timer(&trans_pcie->txq[i].stuck_timer);
1339
Arik Nemtsoveb7ff772013-12-01 12:30:38 +02001340 clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001341 wake_up(&trans_pcie->wait_command_queue);
Emmanuel Grumbach7ff94702011-08-25 23:10:54 -07001342}
1343
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001344static u32 iwl_pcie_int_cause_non_ict(struct iwl_trans *trans)
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001345{
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001346 u32 inta;
1347
Emmanuel Grumbach46e81af2014-01-14 10:33:54 +02001348 lockdep_assert_held(&IWL_TRANS_GET_PCIE_TRANS(trans)->irq_lock);
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001349
1350 trace_iwlwifi_dev_irq(trans->dev);
1351
1352 /* Discover which interrupts are active/pending */
1353 inta = iwl_read32(trans, CSR_INT);
1354
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001355 /* the thread will service interrupts and re-enable them */
Emmanuel Grumbachfe523dc2013-12-11 09:24:39 +02001356 return inta;
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001357}
1358
1359/* a device (PCI-E) page is 4096 bytes long */
1360#define ICT_SHIFT 12
1361#define ICT_SIZE (1 << ICT_SHIFT)
1362#define ICT_COUNT (ICT_SIZE / sizeof(u32))
1363
1364/* interrupt handler using ict table, with this interrupt driver will
1365 * stop using INTA register to get device's interrupt, reading this register
1366 * is expensive, device will write interrupts in ICT dram table, increment
1367 * index then will fire interrupt to driver, driver will OR all ICT table
1368 * entries from current index up to table entry with 0 value. the result is
1369 * the interrupt we need to service, driver will set the entries back to 0 and
1370 * set index.
1371 */
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001372static u32 iwl_pcie_int_cause_ict(struct iwl_trans *trans)
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001373{
1374 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001375 u32 inta;
1376 u32 val = 0;
1377 u32 read;
1378
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001379 trace_iwlwifi_dev_irq(trans->dev);
1380
1381 /* Ignore interrupt if there's nothing in NIC to service.
1382 * This may be due to IRQ shared with another device,
1383 * or due to sporadic interrupts thrown from our NIC. */
1384 read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1385 trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index, read);
Emmanuel Grumbach7ba1faa2013-12-11 09:39:30 +02001386 if (!read)
1387 return 0;
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001388
1389 /*
1390 * Collect all entries up to the first 0, starting from ict_index;
1391 * note we already read at ict_index.
1392 */
1393 do {
1394 val |= read;
1395 IWL_DEBUG_ISR(trans, "ICT index %d value 0x%08X\n",
1396 trans_pcie->ict_index, read);
1397 trans_pcie->ict_tbl[trans_pcie->ict_index] = 0;
1398 trans_pcie->ict_index =
Johannes Berg83f32a42014-04-24 09:57:40 +02001399 ((trans_pcie->ict_index + 1) & (ICT_COUNT - 1));
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001400
1401 read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1402 trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index,
1403 read);
1404 } while (read);
1405
1406 /* We should not get this value, just ignore it. */
1407 if (val == 0xffffffff)
1408 val = 0;
1409
1410 /*
1411 * this is a w/a for a h/w bug. the h/w bug may cause the Rx bit
1412 * (bit 15 before shifting it to 31) to clear when using interrupt
1413 * coalescing. fortunately, bits 18 and 19 stay set when this happens
1414 * so we use them to decide on the real state of the Rx bit.
1415 * In order words, bit 15 is set if bit 18 or bit 19 are set.
1416 */
1417 if (val & 0xC0000)
1418 val |= 0x8000;
1419
1420 inta = (0xff & val) | ((0xff00 & val) << 16);
Emmanuel Grumbachfe523dc2013-12-11 09:24:39 +02001421 return inta;
Emmanuel Grumbachfc844722013-12-09 14:27:44 +02001422}
1423
Johannes Berg2bfb5092012-12-27 21:43:48 +01001424irqreturn_t iwl_pcie_irq_handler(int irq, void *dev_id)
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001425{
Johannes Berg2bfb5092012-12-27 21:43:48 +01001426 struct iwl_trans *trans = dev_id;
Johannes Berg20d3b642012-05-16 22:54:29 +02001427 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1428 struct isr_statistics *isr_stats = &trans_pcie->isr_stats;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001429 u32 inta = 0;
1430 u32 handled = 0;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001431
Johannes Berg2bfb5092012-12-27 21:43:48 +01001432 lock_map_acquire(&trans->sync_cmd_lockdep_map);
1433
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001434 spin_lock(&trans_pcie->irq_lock);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001435
Emmanuel Grumbach0fec9542013-12-11 09:02:25 +02001436 /* dram interrupt table not set yet,
1437 * use legacy interrupt.
1438 */
1439 if (likely(trans_pcie->use_ict))
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001440 inta = iwl_pcie_int_cause_ict(trans);
Emmanuel Grumbach0fec9542013-12-11 09:02:25 +02001441 else
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001442 inta = iwl_pcie_int_cause_non_ict(trans);
Emmanuel Grumbach0fec9542013-12-11 09:02:25 +02001443
Emmanuel Grumbach7ba1faa2013-12-11 09:39:30 +02001444 if (iwl_have_debug_level(IWL_DL_ISR)) {
1445 IWL_DEBUG_ISR(trans,
1446 "ISR inta 0x%08x, enabled 0x%08x(sw), enabled(hw) 0x%08x, fh 0x%08x\n",
1447 inta, trans_pcie->inta_mask,
1448 iwl_read32(trans, CSR_INT_MASK),
1449 iwl_read32(trans, CSR_FH_INT_STATUS));
1450 if (inta & (~trans_pcie->inta_mask))
1451 IWL_DEBUG_ISR(trans,
1452 "We got a masked interrupt (0x%08x)\n",
1453 inta & (~trans_pcie->inta_mask));
1454 }
1455
1456 inta &= trans_pcie->inta_mask;
1457
1458 /*
1459 * Ignore interrupt if there's nothing in NIC to service.
1460 * This may be due to IRQ shared with another device,
1461 * or due to sporadic interrupts thrown from our NIC.
1462 */
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001463 if (unlikely(!inta)) {
Emmanuel Grumbach7ba1faa2013-12-11 09:39:30 +02001464 IWL_DEBUG_ISR(trans, "Ignore interrupt, inta == 0\n");
1465 /*
1466 * Re-enable interrupts here since we don't
1467 * have anything to service
1468 */
1469 if (test_bit(STATUS_INT_ENABLED, &trans->status))
1470 iwl_enable_interrupts(trans);
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001471 spin_unlock(&trans_pcie->irq_lock);
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001472 lock_map_release(&trans->sync_cmd_lockdep_map);
1473 return IRQ_NONE;
1474 }
1475
Emmanuel Grumbach7ba1faa2013-12-11 09:39:30 +02001476 if (unlikely(inta == 0xFFFFFFFF || (inta & 0xFFFFFFF0) == 0xa5a5a5a0)) {
1477 /*
1478 * Hardware disappeared. It might have
1479 * already raised an interrupt.
1480 */
1481 IWL_WARN(trans, "HARDWARE GONE?? INTA == 0x%08x\n", inta);
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001482 spin_unlock(&trans_pcie->irq_lock);
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001483 goto out;
Emmanuel Grumbacha0f337c2013-12-11 09:00:03 +02001484 }
1485
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001486 /* Ack/clear/reset pending uCode interrupts.
1487 * Note: Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
1488 */
1489 /* There is a hardware bug in the interrupt mask function that some
1490 * interrupts (i.e. CSR_INT_BIT_SCD) can still be generated even if
1491 * they are disabled in the CSR_INT_MASK register. Furthermore the
1492 * ICT interrupt handling mechanism has another bug that might cause
1493 * these unmasked interrupts fail to be detected. We workaround the
1494 * hardware bugs here by ACKing all the possible interrupts so that
1495 * interrupt coalescing can still be achieved.
1496 */
Emmanuel Grumbach7117c002013-12-11 09:20:34 +02001497 iwl_write32(trans, CSR_INT, inta | ~trans_pcie->inta_mask);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001498
Johannes Berg51cd53a2013-06-12 09:56:51 +02001499 if (iwl_have_debug_level(IWL_DL_ISR))
Johannes Berg0ca24da2012-03-15 13:26:46 -07001500 IWL_DEBUG_ISR(trans, "inta 0x%08x, enabled 0x%08x\n",
Johannes Berg51cd53a2013-06-12 09:56:51 +02001501 inta, iwl_read32(trans, CSR_INT_MASK));
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001502
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001503 spin_unlock(&trans_pcie->irq_lock);
Johannes Bergb49ba042012-01-19 08:20:57 -08001504
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001505 /* Now service all interrupt bits discovered above. */
1506 if (inta & CSR_INT_BIT_HW_ERR) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001507 IWL_ERR(trans, "Hardware error detected. Restarting.\n");
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001508
1509 /* Tell the device to stop sending interrupts */
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001510 iwl_disable_interrupts(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001511
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001512 isr_stats->hw++;
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001513 iwl_pcie_irq_handle_error(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001514
1515 handled |= CSR_INT_BIT_HW_ERR;
1516
Johannes Berg2bfb5092012-12-27 21:43:48 +01001517 goto out;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001518 }
1519
Johannes Berga8bceb32012-03-05 11:24:30 -08001520 if (iwl_have_debug_level(IWL_DL_ISR)) {
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001521 /* NIC fires this, but we don't use it, redundant with WAKEUP */
1522 if (inta & CSR_INT_BIT_SCD) {
Johannes Berg51cd53a2013-06-12 09:56:51 +02001523 IWL_DEBUG_ISR(trans,
1524 "Scheduler finished to transmit the frame/frames.\n");
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001525 isr_stats->sch++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001526 }
1527
1528 /* Alive notification via Rx interrupt will do the real work */
1529 if (inta & CSR_INT_BIT_ALIVE) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001530 IWL_DEBUG_ISR(trans, "Alive interrupt\n");
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001531 isr_stats->alive++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001532 }
1533 }
Johannes Berg51cd53a2013-06-12 09:56:51 +02001534
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001535 /* Safely ignore these bits for debug checks below */
1536 inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
1537
1538 /* HW RF KILL switch toggled */
1539 if (inta & CSR_INT_BIT_RF_KILL) {
Johannes Bergc9eec952012-03-06 13:30:43 -08001540 bool hw_rfkill;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001541
Emmanuel Grumbach8d425512012-03-28 11:00:58 +02001542 hw_rfkill = iwl_is_rfkill_set(trans);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001543 IWL_WARN(trans, "RF_KILL bit toggled to %s.\n",
Johannes Berg20d3b642012-05-16 22:54:29 +02001544 hw_rfkill ? "disable radio" : "enable radio");
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001545
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001546 isr_stats->rfkill++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001547
Emmanuel Grumbachfa9f3282015-06-11 20:45:49 +03001548 mutex_lock(&trans_pcie->mutex);
Johannes Berg14cfca72014-02-25 20:50:53 +01001549 iwl_trans_pcie_rf_kill(trans, hw_rfkill);
Emmanuel Grumbachfa9f3282015-06-11 20:45:49 +03001550 mutex_unlock(&trans_pcie->mutex);
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001551 if (hw_rfkill) {
Arik Nemtsoveb7ff772013-12-01 12:30:38 +02001552 set_bit(STATUS_RFKILL, &trans->status);
1553 if (test_and_clear_bit(STATUS_SYNC_HCMD_ACTIVE,
1554 &trans->status))
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001555 IWL_DEBUG_RF_KILL(trans,
1556 "Rfkill while SYNC HCMD in flight\n");
1557 wake_up(&trans_pcie->wait_command_queue);
1558 } else {
Arik Nemtsoveb7ff772013-12-01 12:30:38 +02001559 clear_bit(STATUS_RFKILL, &trans->status);
Emmanuel Grumbachf946b522012-10-25 17:25:52 +02001560 }
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001561
1562 handled |= CSR_INT_BIT_RF_KILL;
1563 }
1564
1565 /* Chip got too hot and stopped itself */
1566 if (inta & CSR_INT_BIT_CT_KILL) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001567 IWL_ERR(trans, "Microcode CT kill error detected.\n");
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001568 isr_stats->ctkill++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001569 handled |= CSR_INT_BIT_CT_KILL;
1570 }
1571
1572 /* Error detected by uCode */
1573 if (inta & CSR_INT_BIT_SW_ERR) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001574 IWL_ERR(trans, "Microcode SW error detected. "
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001575 " Restarting 0x%X.\n", inta);
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001576 isr_stats->sw++;
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001577 iwl_pcie_irq_handle_error(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001578 handled |= CSR_INT_BIT_SW_ERR;
1579 }
1580
1581 /* uCode wakes up after power-down sleep */
1582 if (inta & CSR_INT_BIT_WAKEUP) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001583 IWL_DEBUG_ISR(trans, "Wakeup interrupt\n");
Johannes Berg5d63f922014-02-27 11:20:07 +01001584 iwl_pcie_rxq_check_wrptr(trans);
Johannes Bergea68f462014-02-27 14:36:55 +01001585 iwl_pcie_txq_check_wrptrs(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001586
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001587 isr_stats->wakeup++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001588
1589 handled |= CSR_INT_BIT_WAKEUP;
1590 }
1591
1592 /* All uCode command responses, including Tx command responses,
1593 * Rx "responses" (frame-received notification), and other
1594 * notifications from uCode come through here*/
1595 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
Johannes Berg20d3b642012-05-16 22:54:29 +02001596 CSR_INT_BIT_RX_PERIODIC)) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001597 IWL_DEBUG_ISR(trans, "Rx interrupt\n");
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001598 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
1599 handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001600 iwl_write32(trans, CSR_FH_INT_STATUS,
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001601 CSR_FH_INT_RX_MASK);
1602 }
1603 if (inta & CSR_INT_BIT_RX_PERIODIC) {
1604 handled |= CSR_INT_BIT_RX_PERIODIC;
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001605 iwl_write32(trans,
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001606 CSR_INT, CSR_INT_BIT_RX_PERIODIC);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001607 }
1608 /* Sending RX interrupt require many steps to be done in the
1609 * the device:
1610 * 1- write interrupt to current index in ICT table.
1611 * 2- dma RX frame.
1612 * 3- update RX shared data to indicate last write index.
1613 * 4- send interrupt.
1614 * This could lead to RX race, driver could receive RX interrupt
1615 * but the shared data changes does not reflect this;
1616 * periodic interrupt will detect any dangling Rx activity.
1617 */
1618
1619 /* Disable periodic interrupt; we use it as just a one-shot. */
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001620 iwl_write8(trans, CSR_INT_PERIODIC_REG,
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001621 CSR_INT_PERIODIC_DIS);
Johannes Berg63791032012-09-06 15:33:42 +02001622
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001623 /*
1624 * Enable periodic interrupt in 8 msec only if we received
1625 * real RX interrupt (instead of just periodic int), to catch
1626 * any dangling Rx interrupt. If it was just the periodic
1627 * interrupt, there was no dangling Rx activity, and no need
1628 * to extend the periodic interrupt; one-shot is enough.
1629 */
1630 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001631 iwl_write8(trans, CSR_INT_PERIODIC_REG,
Johannes Berg20d3b642012-05-16 22:54:29 +02001632 CSR_INT_PERIODIC_ENA);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001633
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001634 isr_stats->rx++;
Johannes Bergf14d6b32014-03-21 13:30:03 +01001635
1636 local_bh_disable();
Haim Dreyfuss2e5d4a82015-12-17 12:17:58 +02001637 iwl_pcie_rx_handle(trans, 0);
Johannes Bergf14d6b32014-03-21 13:30:03 +01001638 local_bh_enable();
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001639 }
1640
1641 /* This "Tx" DMA channel is used only for loading uCode */
1642 if (inta & CSR_INT_BIT_FH_TX) {
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001643 iwl_write32(trans, CSR_FH_INT_STATUS, CSR_FH_INT_TX_MASK);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001644 IWL_DEBUG_ISR(trans, "uCode load interrupt\n");
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001645 isr_stats->tx++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001646 handled |= CSR_INT_BIT_FH_TX;
1647 /* Wake up uCode load routine, now that load is complete */
Johannes Berg13df1aa2012-03-06 13:31:00 -08001648 trans_pcie->ucode_write_complete = true;
1649 wake_up(&trans_pcie->ucode_write_waitq);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001650 }
1651
1652 if (inta & ~handled) {
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001653 IWL_ERR(trans, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
Emmanuel Grumbach1f7b6172011-08-25 23:10:59 -07001654 isr_stats->unhandled++;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001655 }
1656
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001657 if (inta & ~(trans_pcie->inta_mask)) {
1658 IWL_WARN(trans, "Disabled INTA bits 0x%08x were pending\n",
1659 inta & ~trans_pcie->inta_mask);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001660 }
1661
Emmanuel Grumbacha6bd0052016-01-31 15:02:30 +02001662 /* we are loading the firmware, enable FH_TX interrupt only */
1663 if (handled & CSR_INT_BIT_FH_TX)
1664 iwl_enable_fw_load_int(trans);
1665 /* only Re-enable all interrupt if disabled by irq */
1666 else if (test_bit(STATUS_INT_ENABLED, &trans->status))
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001667 iwl_enable_interrupts(trans);
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001668 /* Re-enable RF_KILL if it occurred */
Stanislaw Gruszka8722c892012-03-07 09:52:28 -08001669 else if (handled & CSR_INT_BIT_RF_KILL)
1670 iwl_enable_rfkill_int(trans);
Johannes Berg2bfb5092012-12-27 21:43:48 +01001671
1672out:
1673 lock_map_release(&trans->sync_cmd_lockdep_map);
1674 return IRQ_HANDLED;
Emmanuel Grumbachab697a92011-07-11 07:35:34 -07001675}
1676
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001677/******************************************************************************
1678 *
1679 * ICT functions
1680 *
1681 ******************************************************************************/
Johannes Berg10667132011-12-19 14:00:59 -08001682
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001683/* Free dram table */
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001684void iwl_pcie_free_ict(struct iwl_trans *trans)
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001685{
Johannes Berg20d3b642012-05-16 22:54:29 +02001686 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001687
Johannes Berg10667132011-12-19 14:00:59 -08001688 if (trans_pcie->ict_tbl) {
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001689 dma_free_coherent(trans->dev, ICT_SIZE,
Johannes Berg10667132011-12-19 14:00:59 -08001690 trans_pcie->ict_tbl,
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001691 trans_pcie->ict_tbl_dma);
Johannes Berg10667132011-12-19 14:00:59 -08001692 trans_pcie->ict_tbl = NULL;
1693 trans_pcie->ict_tbl_dma = 0;
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001694 }
1695}
1696
Johannes Berg10667132011-12-19 14:00:59 -08001697/*
1698 * allocate dram shared table, it is an aligned memory
1699 * block of ICT_SIZE.
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001700 * also reset all data related to ICT table interrupt.
1701 */
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001702int iwl_pcie_alloc_ict(struct iwl_trans *trans)
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001703{
Johannes Berg20d3b642012-05-16 22:54:29 +02001704 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001705
Johannes Berg10667132011-12-19 14:00:59 -08001706 trans_pcie->ict_tbl =
Emmanuel Grumbacheef31712013-12-09 09:47:46 +02001707 dma_zalloc_coherent(trans->dev, ICT_SIZE,
Johannes Berg10667132011-12-19 14:00:59 -08001708 &trans_pcie->ict_tbl_dma,
1709 GFP_KERNEL);
1710 if (!trans_pcie->ict_tbl)
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001711 return -ENOMEM;
1712
Johannes Berg10667132011-12-19 14:00:59 -08001713 /* just an API sanity check ... it is guaranteed to be aligned */
1714 if (WARN_ON(trans_pcie->ict_tbl_dma & (ICT_SIZE - 1))) {
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001715 iwl_pcie_free_ict(trans);
Johannes Berg10667132011-12-19 14:00:59 -08001716 return -EINVAL;
1717 }
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001718
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001719 return 0;
1720}
1721
1722/* Device is going up inform it about using ICT interrupt table,
1723 * also we need to tell the driver to start using ICT interrupt.
1724 */
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001725void iwl_pcie_reset_ict(struct iwl_trans *trans)
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001726{
Johannes Berg20d3b642012-05-16 22:54:29 +02001727 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001728 u32 val;
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001729
Johannes Berg10667132011-12-19 14:00:59 -08001730 if (!trans_pcie->ict_tbl)
Emmanuel Grumbached6a3802012-01-02 16:10:08 +02001731 return;
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001732
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001733 spin_lock(&trans_pcie->irq_lock);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001734 iwl_disable_interrupts(trans);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001735
Johannes Berg10667132011-12-19 14:00:59 -08001736 memset(trans_pcie->ict_tbl, 0, ICT_SIZE);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001737
Johannes Berg10667132011-12-19 14:00:59 -08001738 val = trans_pcie->ict_tbl_dma >> ICT_SHIFT;
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001739
Eliad Peller18f5a372015-07-16 20:17:42 +03001740 val |= CSR_DRAM_INT_TBL_ENABLE |
1741 CSR_DRAM_INIT_TBL_WRAP_CHECK |
1742 CSR_DRAM_INIT_TBL_WRITE_POINTER;
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001743
Johannes Berg10667132011-12-19 14:00:59 -08001744 IWL_DEBUG_ISR(trans, "CSR_DRAM_INT_TBL_REG =0x%x\n", val);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001745
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001746 iwl_write32(trans, CSR_DRAM_INT_TBL_REG, val);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001747 trans_pcie->use_ict = true;
1748 trans_pcie->ict_index = 0;
Emmanuel Grumbach1042db22012-01-03 16:56:15 +02001749 iwl_write32(trans, CSR_INT, trans_pcie->inta_mask);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001750 iwl_enable_interrupts(trans);
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001751 spin_unlock(&trans_pcie->irq_lock);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001752}
1753
1754/* Device is going down disable ict interrupt usage */
Emmanuel Grumbach990aa6d2012-11-14 12:39:52 +02001755void iwl_pcie_disable_ict(struct iwl_trans *trans)
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001756{
Johannes Berg20d3b642012-05-16 22:54:29 +02001757 struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001758
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001759 spin_lock(&trans_pcie->irq_lock);
Emmanuel Grumbach0c325762011-08-25 23:10:53 -07001760 trans_pcie->use_ict = false;
Emmanuel Grumbach7b70bd62013-12-11 10:22:28 +02001761 spin_unlock(&trans_pcie->irq_lock);
Emmanuel Grumbach1a361cd2011-07-11 07:44:57 -07001762}
1763
Emmanuel Grumbach85bf9da2013-12-09 11:48:30 +02001764irqreturn_t iwl_pcie_isr(int irq, void *data)
1765{
1766 struct iwl_trans *trans = data;
1767
1768 if (!trans)
1769 return IRQ_NONE;
1770
1771 /* Disable (but don't clear!) interrupts here to avoid
1772 * back-to-back ISRs and sporadic interrupts from our NIC.
1773 * If we have something to service, the tasklet will re-enable ints.
1774 * If we *don't* have something, we'll re-enable before leaving here.
1775 */
1776 iwl_write32(trans, CSR_INT_MASK, 0x00000000);
1777
Emmanuel Grumbacha0f337c2013-12-11 09:00:03 +02001778 return IRQ_WAKE_THREAD;
Emmanuel Grumbach85bf9da2013-12-09 11:48:30 +02001779}
Haim Dreyfuss2e5d4a82015-12-17 12:17:58 +02001780
1781irqreturn_t iwl_pcie_msix_isr(int irq, void *data)
1782{
1783 return IRQ_WAKE_THREAD;
1784}
1785
1786irqreturn_t iwl_pcie_irq_msix_handler(int irq, void *dev_id)
1787{
1788 struct msix_entry *entry = dev_id;
1789 struct iwl_trans_pcie *trans_pcie = iwl_pcie_get_trans_pcie(entry);
1790 struct iwl_trans *trans = trans_pcie->trans;
1791 struct isr_statistics *isr_stats = isr_stats = &trans_pcie->isr_stats;
1792 u32 inta_fh, inta_hw;
1793
1794 lock_map_acquire(&trans->sync_cmd_lockdep_map);
1795
1796 spin_lock(&trans_pcie->irq_lock);
1797 inta_fh = iwl_read_direct32(trans, CSR_MSIX_FH_INT_CAUSES_AD);
1798 inta_hw = iwl_read_direct32(trans, CSR_MSIX_HW_INT_CAUSES_AD);
1799 /*
1800 * Clear causes registers to avoid being handling the same cause.
1801 */
1802 iwl_write_direct32(trans, CSR_MSIX_FH_INT_CAUSES_AD, inta_fh);
1803 iwl_write_direct32(trans, CSR_MSIX_HW_INT_CAUSES_AD, inta_hw);
1804 spin_unlock(&trans_pcie->irq_lock);
1805
1806 if (unlikely(!(inta_fh | inta_hw))) {
1807 IWL_DEBUG_ISR(trans, "Ignore interrupt, inta == 0\n");
1808 lock_map_release(&trans->sync_cmd_lockdep_map);
1809 return IRQ_NONE;
1810 }
1811
1812 if (iwl_have_debug_level(IWL_DL_ISR))
1813 IWL_DEBUG_ISR(trans, "ISR inta_fh 0x%08x, enabled 0x%08x\n",
1814 inta_fh,
1815 iwl_read32(trans, CSR_MSIX_FH_INT_MASK_AD));
1816
1817 /* This "Tx" DMA channel is used only for loading uCode */
1818 if (inta_fh & MSIX_FH_INT_CAUSES_D2S_CH0_NUM) {
1819 IWL_DEBUG_ISR(trans, "uCode load interrupt\n");
1820 isr_stats->tx++;
1821 /*
1822 * Wake up uCode load routine,
1823 * now that load is complete
1824 */
1825 trans_pcie->ucode_write_complete = true;
1826 wake_up(&trans_pcie->ucode_write_waitq);
1827 }
1828
1829 /* Error detected by uCode */
1830 if ((inta_fh & MSIX_FH_INT_CAUSES_FH_ERR) ||
1831 (inta_hw & MSIX_HW_INT_CAUSES_REG_SW_ERR)) {
1832 IWL_ERR(trans,
1833 "Microcode SW error detected. Restarting 0x%X.\n",
1834 inta_fh);
1835 isr_stats->sw++;
1836 iwl_pcie_irq_handle_error(trans);
1837 }
1838
1839 /* After checking FH register check HW register */
1840 if (iwl_have_debug_level(IWL_DL_ISR))
1841 IWL_DEBUG_ISR(trans,
1842 "ISR inta_hw 0x%08x, enabled 0x%08x\n",
1843 inta_hw,
1844 iwl_read32(trans, CSR_MSIX_HW_INT_MASK_AD));
1845
1846 /* Alive notification via Rx interrupt will do the real work */
1847 if (inta_hw & MSIX_HW_INT_CAUSES_REG_ALIVE) {
1848 IWL_DEBUG_ISR(trans, "Alive interrupt\n");
1849 isr_stats->alive++;
1850 }
1851
1852 /* uCode wakes up after power-down sleep */
1853 if (inta_hw & MSIX_HW_INT_CAUSES_REG_WAKEUP) {
1854 IWL_DEBUG_ISR(trans, "Wakeup interrupt\n");
1855 iwl_pcie_rxq_check_wrptr(trans);
1856 iwl_pcie_txq_check_wrptrs(trans);
1857
1858 isr_stats->wakeup++;
1859 }
1860
1861 /* Chip got too hot and stopped itself */
1862 if (inta_hw & MSIX_HW_INT_CAUSES_REG_CT_KILL) {
1863 IWL_ERR(trans, "Microcode CT kill error detected.\n");
1864 isr_stats->ctkill++;
1865 }
1866
1867 /* HW RF KILL switch toggled */
1868 if (inta_hw & MSIX_HW_INT_CAUSES_REG_RF_KILL) {
1869 bool hw_rfkill;
1870
1871 hw_rfkill = iwl_is_rfkill_set(trans);
1872 IWL_WARN(trans, "RF_KILL bit toggled to %s.\n",
1873 hw_rfkill ? "disable radio" : "enable radio");
1874
1875 isr_stats->rfkill++;
1876
1877 mutex_lock(&trans_pcie->mutex);
1878 iwl_trans_pcie_rf_kill(trans, hw_rfkill);
1879 mutex_unlock(&trans_pcie->mutex);
1880 if (hw_rfkill) {
1881 set_bit(STATUS_RFKILL, &trans->status);
1882 if (test_and_clear_bit(STATUS_SYNC_HCMD_ACTIVE,
1883 &trans->status))
1884 IWL_DEBUG_RF_KILL(trans,
1885 "Rfkill while SYNC HCMD in flight\n");
1886 wake_up(&trans_pcie->wait_command_queue);
1887 } else {
1888 clear_bit(STATUS_RFKILL, &trans->status);
1889 }
1890 }
1891
1892 if (inta_hw & MSIX_HW_INT_CAUSES_REG_HW_ERR) {
1893 IWL_ERR(trans,
1894 "Hardware error detected. Restarting.\n");
1895
1896 isr_stats->hw++;
1897 iwl_pcie_irq_handle_error(trans);
1898 }
1899
1900 iwl_pcie_clear_irq(trans, entry);
1901
1902 lock_map_release(&trans->sync_cmd_lockdep_map);
1903
1904 return IRQ_HANDLED;
1905}