]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/net/wireless/iwlwifi/pcie/rx.c
32ec95bd4973d5cd8c49f2181e9e63d3109cedc3
[karo-tx-linux.git] / drivers / net / wireless / iwlwifi / pcie / rx.c
1 /******************************************************************************
2  *
3  * Copyright(c) 2003 - 2014 Intel Corporation. All rights reserved.
4  * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
5  *
6  * Portions of this file are derived from the ipw3945 project, as well
7  * as portions of the ieee80211 subsystem header files.
8  *
9  * This program is free software; you can redistribute it and/or modify it
10  * under the terms of version 2 of the GNU General Public License as
11  * published by the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful, but WITHOUT
14  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
16  * more details.
17  *
18  * You should have received a copy of the GNU General Public License along with
19  * this program; if not, write to the Free Software Foundation, Inc.,
20  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
21  *
22  * The full GNU General Public License is included in this distribution in the
23  * file called LICENSE.
24  *
25  * Contact Information:
26  *  Intel Linux Wireless <ilw@linux.intel.com>
27  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
28  *
29  *****************************************************************************/
30 #include <linux/sched.h>
31 #include <linux/wait.h>
32 #include <linux/gfp.h>
33
34 #include "iwl-prph.h"
35 #include "iwl-io.h"
36 #include "internal.h"
37 #include "iwl-op-mode.h"
38
39 /******************************************************************************
40  *
41  * RX path functions
42  *
43  ******************************************************************************/
44
45 /*
46  * Rx theory of operation
47  *
48  * Driver allocates a circular buffer of Receive Buffer Descriptors (RBDs),
49  * each of which point to Receive Buffers to be filled by the NIC.  These get
50  * used not only for Rx frames, but for any command response or notification
51  * from the NIC.  The driver and NIC manage the Rx buffers by means
52  * of indexes into the circular buffer.
53  *
54  * Rx Queue Indexes
55  * The host/firmware share two index registers for managing the Rx buffers.
56  *
57  * The READ index maps to the first position that the firmware may be writing
58  * to -- the driver can read up to (but not including) this position and get
59  * good data.
60  * The READ index is managed by the firmware once the card is enabled.
61  *
62  * The WRITE index maps to the last position the driver has read from -- the
63  * position preceding WRITE is the last slot the firmware can place a packet.
64  *
65  * The queue is empty (no good data) if WRITE = READ - 1, and is full if
66  * WRITE = READ.
67  *
68  * During initialization, the host sets up the READ queue position to the first
69  * INDEX position, and WRITE to the last (READ - 1 wrapped)
70  *
71  * When the firmware places a packet in a buffer, it will advance the READ index
72  * and fire the RX interrupt.  The driver can then query the READ index and
73  * process as many packets as possible, moving the WRITE index forward as it
74  * resets the Rx queue buffers with new memory.
75  *
76  * The management in the driver is as follows:
77  * + A list of pre-allocated RBDs is stored in iwl->rxq->rx_free.
78  *   When the interrupt handler is called, the request is processed.
79  *   The page is either stolen - transferred to the upper layer
80  *   or reused - added immediately to the iwl->rxq->rx_free list.
81  * + When the page is stolen - the driver updates the matching queue's used
82  *   count, detaches the RBD and transfers it to the queue used list.
83  *   When there are two used RBDs - they are transferred to the allocator empty
84  *   list. Work is then scheduled for the allocator to start allocating
85  *   eight buffers.
86  *   When there are another 6 used RBDs - they are transferred to the allocator
87  *   empty list and the driver tries to claim the pre-allocated buffers and
88  *   add them to iwl->rxq->rx_free. If it fails - it continues to claim them
89  *   until ready.
90  *   When there are 8+ buffers in the free list - either from allocation or from
91  *   8 reused unstolen pages - restock is called to update the FW and indexes.
92  * + In order to make sure the allocator always has RBDs to use for allocation
93  *   the allocator has initial pool in the size of num_queues*(8-2) - the
94  *   maximum missing RBDs per allocation request (request posted with 2
95  *    empty RBDs, there is no guarantee when the other 6 RBDs are supplied).
96  *   The queues supplies the recycle of the rest of the RBDs.
97  * + A received packet is processed and handed to the kernel network stack,
98  *   detached from the iwl->rxq.  The driver 'processed' index is updated.
99  * + If there are no allocated buffers in iwl->rxq->rx_free,
100  *   the READ INDEX is not incremented and iwl->status(RX_STALLED) is set.
101  *   If there were enough free buffers and RX_STALLED is set it is cleared.
102  *
103  *
104  * Driver sequence:
105  *
106  * iwl_rxq_alloc()            Allocates rx_free
107  * iwl_pcie_rx_replenish()    Replenishes rx_free list from rx_used, and calls
108  *                            iwl_pcie_rxq_restock.
109  *                            Used only during initialization.
110  * iwl_pcie_rxq_restock()     Moves available buffers from rx_free into Rx
111  *                            queue, updates firmware pointers, and updates
112  *                            the WRITE index.
113  * iwl_pcie_rx_allocator()     Background work for allocating pages.
114  *
115  * -- enable interrupts --
116  * ISR - iwl_rx()             Detach iwl_rx_mem_buffers from pool up to the
117  *                            READ INDEX, detaching the SKB from the pool.
118  *                            Moves the packet buffer from queue to rx_used.
119  *                            Posts and claims requests to the allocator.
120  *                            Calls iwl_pcie_rxq_restock to refill any empty
121  *                            slots.
122  *
123  * RBD life-cycle:
124  *
125  * Init:
126  * rxq.pool -> rxq.rx_used -> rxq.rx_free -> rxq.queue
127  *
128  * Regular Receive interrupt:
129  * Page Stolen:
130  * rxq.queue -> rxq.rx_used -> allocator.rbd_empty ->
131  * allocator.rbd_allocated -> rxq.rx_free -> rxq.queue
132  * Page not Stolen:
133  * rxq.queue -> rxq.rx_free -> rxq.queue
134  * ...
135  *
136  */
137
138 /*
139  * iwl_rxq_space - Return number of free slots available in queue.
140  */
141 static int iwl_rxq_space(const struct iwl_rxq *rxq)
142 {
143         /* Make sure RX_QUEUE_SIZE is a power of 2 */
144         BUILD_BUG_ON(RX_QUEUE_SIZE & (RX_QUEUE_SIZE - 1));
145
146         /*
147          * There can be up to (RX_QUEUE_SIZE - 1) free slots, to avoid ambiguity
148          * between empty and completely full queues.
149          * The following is equivalent to modulo by RX_QUEUE_SIZE and is well
150          * defined for negative dividends.
151          */
152         return (rxq->read - rxq->write - 1) & (RX_QUEUE_SIZE - 1);
153 }
154
155 /*
156  * iwl_dma_addr2rbd_ptr - convert a DMA address to a uCode read buffer ptr
157  */
158 static inline __le32 iwl_pcie_dma_addr2rbd_ptr(dma_addr_t dma_addr)
159 {
160         return cpu_to_le32((u32)(dma_addr >> 8));
161 }
162
163 /*
164  * iwl_pcie_rx_stop - stops the Rx DMA
165  */
166 int iwl_pcie_rx_stop(struct iwl_trans *trans)
167 {
168         iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
169         return iwl_poll_direct_bit(trans, FH_MEM_RSSR_RX_STATUS_REG,
170                                    FH_RSSR_CHNL0_RX_STATUS_CHNL_IDLE, 1000);
171 }
172
173 /*
174  * iwl_pcie_rxq_inc_wr_ptr - Update the write pointer for the RX queue
175  */
176 static void iwl_pcie_rxq_inc_wr_ptr(struct iwl_trans *trans)
177 {
178         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
179         struct iwl_rxq *rxq = &trans_pcie->rxq;
180         u32 reg;
181
182         lockdep_assert_held(&rxq->lock);
183
184         /*
185          * explicitly wake up the NIC if:
186          * 1. shadow registers aren't enabled
187          * 2. there is a chance that the NIC is asleep
188          */
189         if (!trans->cfg->base_params->shadow_reg_enable &&
190             test_bit(STATUS_TPOWER_PMI, &trans->status)) {
191                 reg = iwl_read32(trans, CSR_UCODE_DRV_GP1);
192
193                 if (reg & CSR_UCODE_DRV_GP1_BIT_MAC_SLEEP) {
194                         IWL_DEBUG_INFO(trans, "Rx queue requesting wakeup, GP1 = 0x%x\n",
195                                        reg);
196                         iwl_set_bit(trans, CSR_GP_CNTRL,
197                                     CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
198                         rxq->need_update = true;
199                         return;
200                 }
201         }
202
203         rxq->write_actual = round_down(rxq->write, 8);
204         iwl_write32(trans, FH_RSCSR_CHNL0_WPTR, rxq->write_actual);
205 }
206
207 static void iwl_pcie_rxq_check_wrptr(struct iwl_trans *trans)
208 {
209         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
210         struct iwl_rxq *rxq = &trans_pcie->rxq;
211
212         spin_lock(&rxq->lock);
213
214         if (!rxq->need_update)
215                 goto exit_unlock;
216
217         iwl_pcie_rxq_inc_wr_ptr(trans);
218         rxq->need_update = false;
219
220  exit_unlock:
221         spin_unlock(&rxq->lock);
222 }
223
224 /*
225  * iwl_pcie_rxq_restock - refill RX queue from pre-allocated pool
226  *
227  * If there are slots in the RX queue that need to be restocked,
228  * and we have free pre-allocated buffers, fill the ranks as much
229  * as we can, pulling from rx_free.
230  *
231  * This moves the 'write' index forward to catch up with 'processed', and
232  * also updates the memory address in the firmware to reference the new
233  * target buffer.
234  */
235 static void iwl_pcie_rxq_restock(struct iwl_trans *trans)
236 {
237         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
238         struct iwl_rxq *rxq = &trans_pcie->rxq;
239         struct iwl_rx_mem_buffer *rxb;
240
241         /*
242          * If the device isn't enabled - not need to try to add buffers...
243          * This can happen when we stop the device and still have an interrupt
244          * pending. We stop the APM before we sync the interrupts because we
245          * have to (see comment there). On the other hand, since the APM is
246          * stopped, we cannot access the HW (in particular not prph).
247          * So don't try to restock if the APM has been already stopped.
248          */
249         if (!test_bit(STATUS_DEVICE_ENABLED, &trans->status))
250                 return;
251
252         spin_lock(&rxq->lock);
253         while ((iwl_rxq_space(rxq) > 0) && (rxq->free_count)) {
254                 /* The overwritten rxb must be a used one */
255                 rxb = rxq->queue[rxq->write];
256                 BUG_ON(rxb && rxb->page);
257
258                 /* Get next free Rx buffer, remove from free list */
259                 rxb = list_first_entry(&rxq->rx_free, struct iwl_rx_mem_buffer,
260                                        list);
261                 list_del(&rxb->list);
262
263                 /* Point to Rx buffer via next RBD in circular buffer */
264                 rxq->bd[rxq->write] = iwl_pcie_dma_addr2rbd_ptr(rxb->page_dma);
265                 rxq->queue[rxq->write] = rxb;
266                 rxq->write = (rxq->write + 1) & RX_QUEUE_MASK;
267                 rxq->free_count--;
268         }
269         spin_unlock(&rxq->lock);
270
271         /* If we've added more space for the firmware to place data, tell it.
272          * Increment device's write pointer in multiples of 8. */
273         if (rxq->write_actual != (rxq->write & ~0x7)) {
274                 spin_lock(&rxq->lock);
275                 iwl_pcie_rxq_inc_wr_ptr(trans);
276                 spin_unlock(&rxq->lock);
277         }
278 }
279
280 /*
281  * iwl_pcie_rx_alloc_page - allocates and returns a page.
282  *
283  */
284 static struct page *iwl_pcie_rx_alloc_page(struct iwl_trans *trans)
285 {
286         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
287         struct iwl_rxq *rxq = &trans_pcie->rxq;
288         struct page *page;
289         gfp_t gfp_mask = GFP_KERNEL;
290
291         if (rxq->free_count > RX_LOW_WATERMARK)
292                 gfp_mask |= __GFP_NOWARN;
293
294         if (trans_pcie->rx_page_order > 0)
295                 gfp_mask |= __GFP_COMP;
296
297         /* Alloc a new receive buffer */
298         page = alloc_pages(gfp_mask, trans_pcie->rx_page_order);
299         if (!page) {
300                 if (net_ratelimit())
301                         IWL_DEBUG_INFO(trans, "alloc_pages failed, order: %d\n",
302                                        trans_pcie->rx_page_order);
303                 /* Issue an error if the hardware has consumed more than half
304                  * of its free buffer list and we don't have enough
305                  * pre-allocated buffers.
306 `                */
307                 if (rxq->free_count <= RX_LOW_WATERMARK &&
308                     iwl_rxq_space(rxq) > (RX_QUEUE_SIZE / 2) &&
309                     net_ratelimit())
310                         IWL_CRIT(trans,
311                                  "Failed to alloc_pages with GFP_KERNEL. Only %u free buffers remaining.\n",
312                                  rxq->free_count);
313                 return NULL;
314         }
315         return page;
316 }
317
318 /*
319  * iwl_pcie_rxq_alloc_rbs - allocate a page for each used RBD
320  *
321  * A used RBD is an Rx buffer that has been given to the stack. To use it again
322  * a page must be allocated and the RBD must point to the page. This function
323  * doesn't change the HW pointer but handles the list of pages that is used by
324  * iwl_pcie_rxq_restock. The latter function will update the HW to use the newly
325  * allocated buffers.
326  */
327 static void iwl_pcie_rxq_alloc_rbs(struct iwl_trans *trans)
328 {
329         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
330         struct iwl_rxq *rxq = &trans_pcie->rxq;
331         struct iwl_rx_mem_buffer *rxb;
332         struct page *page;
333
334         while (1) {
335                 spin_lock(&rxq->lock);
336                 if (list_empty(&rxq->rx_used)) {
337                         spin_unlock(&rxq->lock);
338                         return;
339                 }
340                 spin_unlock(&rxq->lock);
341
342                 /* Alloc a new receive buffer */
343                 page = iwl_pcie_rx_alloc_page(trans);
344                 if (!page)
345                         return;
346
347                 spin_lock(&rxq->lock);
348
349                 if (list_empty(&rxq->rx_used)) {
350                         spin_unlock(&rxq->lock);
351                         __free_pages(page, trans_pcie->rx_page_order);
352                         return;
353                 }
354                 rxb = list_first_entry(&rxq->rx_used, struct iwl_rx_mem_buffer,
355                                        list);
356                 list_del(&rxb->list);
357                 spin_unlock(&rxq->lock);
358
359                 BUG_ON(rxb->page);
360                 rxb->page = page;
361                 /* Get physical address of the RB */
362                 rxb->page_dma =
363                         dma_map_page(trans->dev, page, 0,
364                                      PAGE_SIZE << trans_pcie->rx_page_order,
365                                      DMA_FROM_DEVICE);
366                 if (dma_mapping_error(trans->dev, rxb->page_dma)) {
367                         rxb->page = NULL;
368                         spin_lock(&rxq->lock);
369                         list_add(&rxb->list, &rxq->rx_used);
370                         spin_unlock(&rxq->lock);
371                         __free_pages(page, trans_pcie->rx_page_order);
372                         return;
373                 }
374                 /* dma address must be no more than 36 bits */
375                 BUG_ON(rxb->page_dma & ~DMA_BIT_MASK(36));
376                 /* and also 256 byte aligned! */
377                 BUG_ON(rxb->page_dma & DMA_BIT_MASK(8));
378
379                 spin_lock(&rxq->lock);
380
381                 list_add_tail(&rxb->list, &rxq->rx_free);
382                 rxq->free_count++;
383
384                 spin_unlock(&rxq->lock);
385         }
386 }
387
388 static void iwl_pcie_rxq_free_rbs(struct iwl_trans *trans)
389 {
390         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
391         struct iwl_rxq *rxq = &trans_pcie->rxq;
392         int i;
393
394         lockdep_assert_held(&rxq->lock);
395
396         for (i = 0; i < RX_QUEUE_SIZE; i++) {
397                 if (!rxq->pool[i].page)
398                         continue;
399                 dma_unmap_page(trans->dev, rxq->pool[i].page_dma,
400                                PAGE_SIZE << trans_pcie->rx_page_order,
401                                DMA_FROM_DEVICE);
402                 __free_pages(rxq->pool[i].page, trans_pcie->rx_page_order);
403                 rxq->pool[i].page = NULL;
404         }
405 }
406
407 /*
408  * iwl_pcie_rx_replenish - Move all used buffers from rx_used to rx_free
409  *
410  * When moving to rx_free an page is allocated for the slot.
411  *
412  * Also restock the Rx queue via iwl_pcie_rxq_restock.
413  * This is called only during initialization
414  */
415 static void iwl_pcie_rx_replenish(struct iwl_trans *trans)
416 {
417         iwl_pcie_rxq_alloc_rbs(trans);
418
419         iwl_pcie_rxq_restock(trans);
420 }
421
422 /*
423  * iwl_pcie_rx_allocator - Allocates pages in the background for RX queues
424  *
425  * Allocates for each received request 8 pages
426  * Called as a scheduled work item.
427  */
428 static void iwl_pcie_rx_allocator(struct iwl_trans *trans)
429 {
430         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
431         struct iwl_rb_allocator *rba = &trans_pcie->rba;
432
433         while (atomic_read(&rba->req_pending)) {
434                 int i;
435                 struct list_head local_empty;
436                 struct list_head local_allocated;
437
438                 INIT_LIST_HEAD(&local_allocated);
439                 spin_lock(&rba->lock);
440                 /* swap out the entire rba->rbd_empty to a local list */
441                 list_replace_init(&rba->rbd_empty, &local_empty);
442                 spin_unlock(&rba->lock);
443
444                 for (i = 0; i < RX_CLAIM_REQ_ALLOC;) {
445                         struct iwl_rx_mem_buffer *rxb;
446                         struct page *page;
447
448                         /* List should never be empty - each reused RBD is
449                          * returned to the list, and initial pool covers any
450                          * possible gap between the time the page is allocated
451                          * to the time the RBD is added.
452                          */
453                         BUG_ON(list_empty(&local_empty));
454                         /* Get the first rxb from the rbd list */
455                         rxb = list_first_entry(&local_empty,
456                                                struct iwl_rx_mem_buffer, list);
457                         BUG_ON(rxb->page);
458
459                         /* Alloc a new receive buffer */
460                         page = iwl_pcie_rx_alloc_page(trans);
461                         if (!page)
462                                 continue;
463                         rxb->page = page;
464
465                         /* Get physical address of the RB */
466                         rxb->page_dma = dma_map_page(trans->dev, page, 0,
467                                         PAGE_SIZE << trans_pcie->rx_page_order,
468                                         DMA_FROM_DEVICE);
469                         if (dma_mapping_error(trans->dev, rxb->page_dma)) {
470                                 rxb->page = NULL;
471                                 __free_pages(page, trans_pcie->rx_page_order);
472                                 continue;
473                         }
474                         /* dma address must be no more than 36 bits */
475                         BUG_ON(rxb->page_dma & ~DMA_BIT_MASK(36));
476                         /* and also 256 byte aligned! */
477                         BUG_ON(rxb->page_dma & DMA_BIT_MASK(8));
478
479                         /* move the allocated entry to the out list */
480                         list_move(&rxb->list, &local_allocated);
481                         i++;
482                 }
483
484                 spin_lock(&rba->lock);
485                 /* add the allocated rbds to the allocator allocated list */
486                 list_splice_tail(&local_allocated, &rba->rbd_allocated);
487                 /* add the unused rbds back to the allocator empty list */
488                 list_splice_tail(&local_empty, &rba->rbd_empty);
489                 spin_unlock(&rba->lock);
490
491                 atomic_dec(&rba->req_pending);
492                 atomic_inc(&rba->req_ready);
493         }
494 }
495
496 /*
497  * iwl_pcie_rx_allocator_get - Returns the pre-allocated pages
498 .*
499 .* Called by queue when the queue posted allocation request and
500  * has freed 8 RBDs in order to restock itself.
501  */
502 static int iwl_pcie_rx_allocator_get(struct iwl_trans *trans,
503                                      struct iwl_rx_mem_buffer
504                                      *out[RX_CLAIM_REQ_ALLOC])
505 {
506         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
507         struct iwl_rb_allocator *rba = &trans_pcie->rba;
508         int i;
509
510         if (atomic_dec_return(&rba->req_ready) < 0) {
511                 atomic_inc(&rba->req_ready);
512                 IWL_DEBUG_RX(trans,
513                              "Allocation request not ready, pending requests = %d\n",
514                              atomic_read(&rba->req_pending));
515                 return -ENOMEM;
516         }
517
518         spin_lock(&rba->lock);
519         for (i = 0; i < RX_CLAIM_REQ_ALLOC; i++) {
520                 /* Get next free Rx buffer, remove it from free list */
521                 out[i] = list_first_entry(&rba->rbd_allocated,
522                                struct iwl_rx_mem_buffer, list);
523                 list_del(&out[i]->list);
524         }
525         spin_unlock(&rba->lock);
526
527         return 0;
528 }
529
530 static void iwl_pcie_rx_allocator_work(struct work_struct *data)
531 {
532         struct iwl_rb_allocator *rba_p =
533                 container_of(data, struct iwl_rb_allocator, rx_alloc);
534         struct iwl_trans_pcie *trans_pcie =
535                 container_of(rba_p, struct iwl_trans_pcie, rba);
536
537         iwl_pcie_rx_allocator(trans_pcie->trans);
538 }
539
540 static int iwl_pcie_rx_alloc(struct iwl_trans *trans)
541 {
542         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
543         struct iwl_rxq *rxq = &trans_pcie->rxq;
544         struct iwl_rb_allocator *rba = &trans_pcie->rba;
545         struct device *dev = trans->dev;
546
547         memset(&trans_pcie->rxq, 0, sizeof(trans_pcie->rxq));
548
549         spin_lock_init(&rxq->lock);
550         spin_lock_init(&rba->lock);
551
552         if (WARN_ON(rxq->bd || rxq->rb_stts))
553                 return -EINVAL;
554
555         /* Allocate the circular buffer of Read Buffer Descriptors (RBDs) */
556         rxq->bd = dma_zalloc_coherent(dev, sizeof(__le32) * RX_QUEUE_SIZE,
557                                       &rxq->bd_dma, GFP_KERNEL);
558         if (!rxq->bd)
559                 goto err_bd;
560
561         /*Allocate the driver's pointer to receive buffer status */
562         rxq->rb_stts = dma_zalloc_coherent(dev, sizeof(*rxq->rb_stts),
563                                            &rxq->rb_stts_dma, GFP_KERNEL);
564         if (!rxq->rb_stts)
565                 goto err_rb_stts;
566
567         return 0;
568
569 err_rb_stts:
570         dma_free_coherent(dev, sizeof(__le32) * RX_QUEUE_SIZE,
571                           rxq->bd, rxq->bd_dma);
572         rxq->bd_dma = 0;
573         rxq->bd = NULL;
574 err_bd:
575         return -ENOMEM;
576 }
577
578 static void iwl_pcie_rx_hw_init(struct iwl_trans *trans, struct iwl_rxq *rxq)
579 {
580         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
581         u32 rb_size;
582         const u32 rfdnlog = RX_QUEUE_SIZE_LOG; /* 256 RBDs */
583
584         if (trans_pcie->rx_buf_size_8k)
585                 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_8K;
586         else
587                 rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_4K;
588
589         /* Stop Rx DMA */
590         iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
591         /* reset and flush pointers */
592         iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_RBDCB_WPTR, 0);
593         iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_FLUSH_RB_REQ, 0);
594         iwl_write_direct32(trans, FH_RSCSR_CHNL0_RDPTR, 0);
595
596         /* Reset driver's Rx queue write index */
597         iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_WPTR_REG, 0);
598
599         /* Tell device where to find RBD circular buffer in DRAM */
600         iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_BASE_REG,
601                            (u32)(rxq->bd_dma >> 8));
602
603         /* Tell device where in DRAM to update its Rx status */
604         iwl_write_direct32(trans, FH_RSCSR_CHNL0_STTS_WPTR_REG,
605                            rxq->rb_stts_dma >> 4);
606
607         /* Enable Rx DMA
608          * FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY is set because of HW bug in
609          *      the credit mechanism in 5000 HW RX FIFO
610          * Direct rx interrupts to hosts
611          * Rx buffer size 4 or 8k
612          * RB timeout 0x10
613          * 256 RBDs
614          */
615         iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG,
616                            FH_RCSR_RX_CONFIG_CHNL_EN_ENABLE_VAL |
617                            FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY |
618                            FH_RCSR_CHNL0_RX_CONFIG_IRQ_DEST_INT_HOST_VAL |
619                            rb_size|
620                            (RX_RB_TIMEOUT << FH_RCSR_RX_CONFIG_REG_IRQ_RBTH_POS)|
621                            (rfdnlog << FH_RCSR_RX_CONFIG_RBDCB_SIZE_POS));
622
623         /* Set interrupt coalescing timer to default (2048 usecs) */
624         iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF);
625
626         /* W/A for interrupt coalescing bug in 7260 and 3160 */
627         if (trans->cfg->host_interrupt_operation_mode)
628                 iwl_set_bit(trans, CSR_INT_COALESCING, IWL_HOST_INT_OPER_MODE);
629 }
630
631 static void iwl_pcie_rx_init_rxb_lists(struct iwl_rxq *rxq)
632 {
633         int i;
634
635         lockdep_assert_held(&rxq->lock);
636
637         INIT_LIST_HEAD(&rxq->rx_free);
638         INIT_LIST_HEAD(&rxq->rx_used);
639         rxq->free_count = 0;
640         rxq->used_count = 0;
641
642         for (i = 0; i < RX_QUEUE_SIZE; i++)
643                 list_add(&rxq->pool[i].list, &rxq->rx_used);
644 }
645
646 static void iwl_pcie_rx_init_rba(struct iwl_rb_allocator *rba)
647 {
648         int i;
649
650         lockdep_assert_held(&rba->lock);
651
652         INIT_LIST_HEAD(&rba->rbd_allocated);
653         INIT_LIST_HEAD(&rba->rbd_empty);
654
655         for (i = 0; i < RX_POOL_SIZE; i++)
656                 list_add(&rba->pool[i].list, &rba->rbd_empty);
657 }
658
659 static void iwl_pcie_rx_free_rba(struct iwl_trans *trans)
660 {
661         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
662         struct iwl_rb_allocator *rba = &trans_pcie->rba;
663         int i;
664
665         lockdep_assert_held(&rba->lock);
666
667         for (i = 0; i < RX_POOL_SIZE; i++) {
668                 if (!rba->pool[i].page)
669                         continue;
670                 dma_unmap_page(trans->dev, rba->pool[i].page_dma,
671                                PAGE_SIZE << trans_pcie->rx_page_order,
672                                DMA_FROM_DEVICE);
673                 __free_pages(rba->pool[i].page, trans_pcie->rx_page_order);
674                 rba->pool[i].page = NULL;
675         }
676 }
677
678 int iwl_pcie_rx_init(struct iwl_trans *trans)
679 {
680         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
681         struct iwl_rxq *rxq = &trans_pcie->rxq;
682         struct iwl_rb_allocator *rba = &trans_pcie->rba;
683         int i, err;
684
685         if (!rxq->bd) {
686                 err = iwl_pcie_rx_alloc(trans);
687                 if (err)
688                         return err;
689         }
690         if (!rba->alloc_wq)
691                 rba->alloc_wq = alloc_workqueue("rb_allocator",
692                                                 WQ_HIGHPRI | WQ_UNBOUND, 1);
693         INIT_WORK(&rba->rx_alloc, iwl_pcie_rx_allocator_work);
694
695         spin_lock(&rba->lock);
696         atomic_set(&rba->req_pending, 0);
697         atomic_set(&rba->req_ready, 0);
698         /* free all first - we might be reconfigured for a different size */
699         iwl_pcie_rx_free_rba(trans);
700         iwl_pcie_rx_init_rba(rba);
701         spin_unlock(&rba->lock);
702
703         spin_lock(&rxq->lock);
704
705         /* free all first - we might be reconfigured for a different size */
706         iwl_pcie_rxq_free_rbs(trans);
707         iwl_pcie_rx_init_rxb_lists(rxq);
708
709         for (i = 0; i < RX_QUEUE_SIZE; i++)
710                 rxq->queue[i] = NULL;
711
712         /* Set us so that we have processed and used all buffers, but have
713          * not restocked the Rx queue with fresh buffers */
714         rxq->read = rxq->write = 0;
715         rxq->write_actual = 0;
716         memset(rxq->rb_stts, 0, sizeof(*rxq->rb_stts));
717         spin_unlock(&rxq->lock);
718
719         iwl_pcie_rx_replenish(trans);
720
721         iwl_pcie_rx_hw_init(trans, rxq);
722
723         spin_lock(&rxq->lock);
724         iwl_pcie_rxq_inc_wr_ptr(trans);
725         spin_unlock(&rxq->lock);
726
727         return 0;
728 }
729
730 void iwl_pcie_rx_free(struct iwl_trans *trans)
731 {
732         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
733         struct iwl_rxq *rxq = &trans_pcie->rxq;
734         struct iwl_rb_allocator *rba = &trans_pcie->rba;
735
736         /*if rxq->bd is NULL, it means that nothing has been allocated,
737          * exit now */
738         if (!rxq->bd) {
739                 IWL_DEBUG_INFO(trans, "Free NULL rx context\n");
740                 return;
741         }
742
743         cancel_work_sync(&rba->rx_alloc);
744         if (rba->alloc_wq) {
745                 destroy_workqueue(rba->alloc_wq);
746                 rba->alloc_wq = NULL;
747         }
748
749         spin_lock(&rba->lock);
750         iwl_pcie_rx_free_rba(trans);
751         spin_unlock(&rba->lock);
752
753         spin_lock(&rxq->lock);
754         iwl_pcie_rxq_free_rbs(trans);
755         spin_unlock(&rxq->lock);
756
757         dma_free_coherent(trans->dev, sizeof(__le32) * RX_QUEUE_SIZE,
758                           rxq->bd, rxq->bd_dma);
759         rxq->bd_dma = 0;
760         rxq->bd = NULL;
761
762         if (rxq->rb_stts)
763                 dma_free_coherent(trans->dev,
764                                   sizeof(struct iwl_rb_status),
765                                   rxq->rb_stts, rxq->rb_stts_dma);
766         else
767                 IWL_DEBUG_INFO(trans, "Free rxq->rb_stts which is NULL\n");
768         rxq->rb_stts_dma = 0;
769         rxq->rb_stts = NULL;
770 }
771
772 /*
773  * iwl_pcie_rx_reuse_rbd - Recycle used RBDs
774  *
775  * Called when a RBD can be reused. The RBD is transferred to the allocator.
776  * When there are 2 empty RBDs - a request for allocation is posted
777  */
778 static void iwl_pcie_rx_reuse_rbd(struct iwl_trans *trans,
779                                   struct iwl_rx_mem_buffer *rxb,
780                                   struct iwl_rxq *rxq)
781 {
782         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
783         struct iwl_rb_allocator *rba = &trans_pcie->rba;
784
785         /* Count the used RBDs */
786         rxq->used_count++;
787
788         /* Move the RBD to the used list, will be moved to allocator in batches
789          * before claiming or posting a request*/
790         list_add_tail(&rxb->list, &rxq->rx_used);
791
792         /* If we have RX_POST_REQ_ALLOC new released rx buffers -
793          * issue a request for allocator. Modulo RX_CLAIM_REQ_ALLOC is
794          * used for the case we failed to claim RX_CLAIM_REQ_ALLOC,
795          * after but we still need to post another request.
796          */
797         if ((rxq->used_count % RX_CLAIM_REQ_ALLOC) == RX_POST_REQ_ALLOC) {
798                 /* Move the 2 RBDs to the allocator ownership.
799                  Allocator has another 6 from pool for the request completion*/
800                 spin_lock(&rba->lock);
801                 list_splice_tail_init(&rxq->rx_used, &rba->rbd_empty);
802                 spin_unlock(&rba->lock);
803
804                 atomic_inc(&rba->req_pending);
805                 queue_work(rba->alloc_wq, &rba->rx_alloc);
806         }
807 }
808
809 static void iwl_pcie_rx_handle_rb(struct iwl_trans *trans,
810                                 struct iwl_rx_mem_buffer *rxb)
811 {
812         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
813         struct iwl_rxq *rxq = &trans_pcie->rxq;
814         struct iwl_txq *txq = &trans_pcie->txq[trans_pcie->cmd_queue];
815         bool page_stolen = false;
816         int max_len = PAGE_SIZE << trans_pcie->rx_page_order;
817         u32 offset = 0;
818
819         if (WARN_ON(!rxb))
820                 return;
821
822         dma_unmap_page(trans->dev, rxb->page_dma, max_len, DMA_FROM_DEVICE);
823
824         while (offset + sizeof(u32) + sizeof(struct iwl_cmd_header) < max_len) {
825                 struct iwl_rx_packet *pkt;
826                 u16 sequence;
827                 bool reclaim;
828                 int index, cmd_index, len;
829                 struct iwl_rx_cmd_buffer rxcb = {
830                         ._offset = offset,
831                         ._rx_page_order = trans_pcie->rx_page_order,
832                         ._page = rxb->page,
833                         ._page_stolen = false,
834                         .truesize = max_len,
835                 };
836
837                 pkt = rxb_addr(&rxcb);
838
839                 if (pkt->len_n_flags == cpu_to_le32(FH_RSCSR_FRAME_INVALID))
840                         break;
841
842                 IWL_DEBUG_RX(trans,
843                              "cmd at offset %d: %s (0x%.2x, seq 0x%x)\n",
844                              rxcb._offset,
845                              get_cmd_string(trans_pcie, pkt->hdr.cmd),
846                              pkt->hdr.cmd, le16_to_cpu(pkt->hdr.sequence));
847
848                 len = iwl_rx_packet_len(pkt);
849                 len += sizeof(u32); /* account for status word */
850                 trace_iwlwifi_dev_rx(trans->dev, trans, pkt, len);
851                 trace_iwlwifi_dev_rx_data(trans->dev, trans, pkt, len);
852
853                 /* Reclaim a command buffer only if this packet is a response
854                  *   to a (driver-originated) command.
855                  * If the packet (e.g. Rx frame) originated from uCode,
856                  *   there is no command buffer to reclaim.
857                  * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
858                  *   but apparently a few don't get set; catch them here. */
859                 reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME);
860                 if (reclaim) {
861                         int i;
862
863                         for (i = 0; i < trans_pcie->n_no_reclaim_cmds; i++) {
864                                 if (trans_pcie->no_reclaim_cmds[i] ==
865                                                         pkt->hdr.cmd) {
866                                         reclaim = false;
867                                         break;
868                                 }
869                         }
870                 }
871
872                 sequence = le16_to_cpu(pkt->hdr.sequence);
873                 index = SEQ_TO_INDEX(sequence);
874                 cmd_index = get_cmd_index(&txq->q, index);
875
876                 iwl_op_mode_rx(trans->op_mode, &rxcb);
877
878                 if (reclaim) {
879                         kzfree(txq->entries[cmd_index].free_buf);
880                         txq->entries[cmd_index].free_buf = NULL;
881                 }
882
883                 /*
884                  * After here, we should always check rxcb._page_stolen,
885                  * if it is true then one of the handlers took the page.
886                  */
887
888                 if (reclaim) {
889                         /* Invoke any callbacks, transfer the buffer to caller,
890                          * and fire off the (possibly) blocking
891                          * iwl_trans_send_cmd()
892                          * as we reclaim the driver command queue */
893                         if (!rxcb._page_stolen)
894                                 iwl_pcie_hcmd_complete(trans, &rxcb);
895                         else
896                                 IWL_WARN(trans, "Claim null rxb?\n");
897                 }
898
899                 page_stolen |= rxcb._page_stolen;
900                 offset += ALIGN(len, FH_RSCSR_FRAME_ALIGN);
901         }
902
903         /* page was stolen from us -- free our reference */
904         if (page_stolen) {
905                 __free_pages(rxb->page, trans_pcie->rx_page_order);
906                 rxb->page = NULL;
907         }
908
909         /* Reuse the page if possible. For notification packets and
910          * SKBs that fail to Rx correctly, add them back into the
911          * rx_free list for reuse later. */
912         if (rxb->page != NULL) {
913                 rxb->page_dma =
914                         dma_map_page(trans->dev, rxb->page, 0,
915                                      PAGE_SIZE << trans_pcie->rx_page_order,
916                                      DMA_FROM_DEVICE);
917                 if (dma_mapping_error(trans->dev, rxb->page_dma)) {
918                         /*
919                          * free the page(s) as well to not break
920                          * the invariant that the items on the used
921                          * list have no page(s)
922                          */
923                         __free_pages(rxb->page, trans_pcie->rx_page_order);
924                         rxb->page = NULL;
925                         iwl_pcie_rx_reuse_rbd(trans, rxb, rxq);
926                 } else {
927                         list_add_tail(&rxb->list, &rxq->rx_free);
928                         rxq->free_count++;
929                 }
930         } else
931                 iwl_pcie_rx_reuse_rbd(trans, rxb, rxq);
932 }
933
934 /*
935  * iwl_pcie_rx_handle - Main entry function for receiving responses from fw
936  */
937 static void iwl_pcie_rx_handle(struct iwl_trans *trans)
938 {
939         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
940         struct iwl_rxq *rxq = &trans_pcie->rxq;
941         u32 r, i, j;
942
943 restart:
944         spin_lock(&rxq->lock);
945         /* uCode's read index (stored in shared DRAM) indicates the last Rx
946          * buffer that the driver may process (last buffer filled by ucode). */
947         r = le16_to_cpu(ACCESS_ONCE(rxq->rb_stts->closed_rb_num)) & 0x0FFF;
948         i = rxq->read;
949
950         /* Rx interrupt, but nothing sent from uCode */
951         if (i == r)
952                 IWL_DEBUG_RX(trans, "HW = SW = %d\n", r);
953
954         while (i != r) {
955                 struct iwl_rx_mem_buffer *rxb;
956
957                 rxb = rxq->queue[i];
958                 rxq->queue[i] = NULL;
959
960                 IWL_DEBUG_RX(trans, "rxbuf: HW = %d, SW = %d (%p)\n",
961                              r, i, rxb);
962                 iwl_pcie_rx_handle_rb(trans, rxb);
963
964                 i = (i + 1) & RX_QUEUE_MASK;
965
966                 /* If we have RX_CLAIM_REQ_ALLOC released rx buffers -
967                  * try to claim the pre-allocated buffers from the allocator */
968                 if (rxq->used_count >= RX_CLAIM_REQ_ALLOC) {
969                         struct iwl_rb_allocator *rba = &trans_pcie->rba;
970                         struct iwl_rx_mem_buffer *out[RX_CLAIM_REQ_ALLOC];
971
972                         /* Add the remaining 6 empty RBDs for allocator use */
973                         spin_lock(&rba->lock);
974                         list_splice_tail_init(&rxq->rx_used, &rba->rbd_empty);
975                         spin_unlock(&rba->lock);
976
977                         /* If not ready - continue, will try to reclaim later.
978                         * No need to reschedule work - allocator exits only on
979                         * success */
980                         if (!iwl_pcie_rx_allocator_get(trans, out)) {
981                                 /* If success - then RX_CLAIM_REQ_ALLOC
982                                  * buffers were retrieved and should be added
983                                  * to free list */
984                                 rxq->used_count -= RX_CLAIM_REQ_ALLOC;
985                                 for (j = 0; j < RX_CLAIM_REQ_ALLOC; j++) {
986                                         list_add_tail(&out[j]->list,
987                                                       &rxq->rx_free);
988                                         rxq->free_count++;
989                                 }
990                         }
991                 }
992                 /* handle restock for two cases:
993                 * - we just pulled buffers from the allocator
994                 * - we have 8+ unstolen pages accumulated */
995                 if (rxq->free_count >=  RX_CLAIM_REQ_ALLOC) {
996                         rxq->read = i;
997                         spin_unlock(&rxq->lock);
998                         iwl_pcie_rxq_restock(trans);
999                         goto restart;
1000                 }
1001         }
1002
1003         /* Backtrack one entry */
1004         rxq->read = i;
1005         spin_unlock(&rxq->lock);
1006
1007         if (trans_pcie->napi.poll)
1008                 napi_gro_flush(&trans_pcie->napi, false);
1009 }
1010
1011 /*
1012  * iwl_pcie_irq_handle_error - called for HW or SW error interrupt from card
1013  */
1014 static void iwl_pcie_irq_handle_error(struct iwl_trans *trans)
1015 {
1016         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1017
1018         /* W/A for WiFi/WiMAX coex and WiMAX own the RF */
1019         if (trans->cfg->internal_wimax_coex &&
1020             !trans->cfg->apmg_not_supported &&
1021             (!(iwl_read_prph(trans, APMG_CLK_CTRL_REG) &
1022                              APMS_CLK_VAL_MRB_FUNC_MODE) ||
1023              (iwl_read_prph(trans, APMG_PS_CTRL_REG) &
1024                             APMG_PS_CTRL_VAL_RESET_REQ))) {
1025                 clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
1026                 iwl_op_mode_wimax_active(trans->op_mode);
1027                 wake_up(&trans_pcie->wait_command_queue);
1028                 return;
1029         }
1030
1031         iwl_pcie_dump_csr(trans);
1032         iwl_dump_fh(trans, NULL);
1033
1034         local_bh_disable();
1035         /* The STATUS_FW_ERROR bit is set in this function. This must happen
1036          * before we wake up the command caller, to ensure a proper cleanup. */
1037         iwl_trans_fw_error(trans);
1038         local_bh_enable();
1039
1040         clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
1041         wake_up(&trans_pcie->wait_command_queue);
1042 }
1043
1044 static u32 iwl_pcie_int_cause_non_ict(struct iwl_trans *trans)
1045 {
1046         u32 inta;
1047
1048         lockdep_assert_held(&IWL_TRANS_GET_PCIE_TRANS(trans)->irq_lock);
1049
1050         trace_iwlwifi_dev_irq(trans->dev);
1051
1052         /* Discover which interrupts are active/pending */
1053         inta = iwl_read32(trans, CSR_INT);
1054
1055         /* the thread will service interrupts and re-enable them */
1056         return inta;
1057 }
1058
1059 /* a device (PCI-E) page is 4096 bytes long */
1060 #define ICT_SHIFT       12
1061 #define ICT_SIZE        (1 << ICT_SHIFT)
1062 #define ICT_COUNT       (ICT_SIZE / sizeof(u32))
1063
1064 /* interrupt handler using ict table, with this interrupt driver will
1065  * stop using INTA register to get device's interrupt, reading this register
1066  * is expensive, device will write interrupts in ICT dram table, increment
1067  * index then will fire interrupt to driver, driver will OR all ICT table
1068  * entries from current index up to table entry with 0 value. the result is
1069  * the interrupt we need to service, driver will set the entries back to 0 and
1070  * set index.
1071  */
1072 static u32 iwl_pcie_int_cause_ict(struct iwl_trans *trans)
1073 {
1074         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1075         u32 inta;
1076         u32 val = 0;
1077         u32 read;
1078
1079         trace_iwlwifi_dev_irq(trans->dev);
1080
1081         /* Ignore interrupt if there's nothing in NIC to service.
1082          * This may be due to IRQ shared with another device,
1083          * or due to sporadic interrupts thrown from our NIC. */
1084         read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1085         trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index, read);
1086         if (!read)
1087                 return 0;
1088
1089         /*
1090          * Collect all entries up to the first 0, starting from ict_index;
1091          * note we already read at ict_index.
1092          */
1093         do {
1094                 val |= read;
1095                 IWL_DEBUG_ISR(trans, "ICT index %d value 0x%08X\n",
1096                                 trans_pcie->ict_index, read);
1097                 trans_pcie->ict_tbl[trans_pcie->ict_index] = 0;
1098                 trans_pcie->ict_index =
1099                         ((trans_pcie->ict_index + 1) & (ICT_COUNT - 1));
1100
1101                 read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1102                 trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index,
1103                                            read);
1104         } while (read);
1105
1106         /* We should not get this value, just ignore it. */
1107         if (val == 0xffffffff)
1108                 val = 0;
1109
1110         /*
1111          * this is a w/a for a h/w bug. the h/w bug may cause the Rx bit
1112          * (bit 15 before shifting it to 31) to clear when using interrupt
1113          * coalescing. fortunately, bits 18 and 19 stay set when this happens
1114          * so we use them to decide on the real state of the Rx bit.
1115          * In order words, bit 15 is set if bit 18 or bit 19 are set.
1116          */
1117         if (val & 0xC0000)
1118                 val |= 0x8000;
1119
1120         inta = (0xff & val) | ((0xff00 & val) << 16);
1121         return inta;
1122 }
1123
1124 irqreturn_t iwl_pcie_irq_handler(int irq, void *dev_id)
1125 {
1126         struct iwl_trans *trans = dev_id;
1127         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1128         struct isr_statistics *isr_stats = &trans_pcie->isr_stats;
1129         u32 inta = 0;
1130         u32 handled = 0;
1131
1132         lock_map_acquire(&trans->sync_cmd_lockdep_map);
1133
1134         spin_lock(&trans_pcie->irq_lock);
1135
1136         /* dram interrupt table not set yet,
1137          * use legacy interrupt.
1138          */
1139         if (likely(trans_pcie->use_ict))
1140                 inta = iwl_pcie_int_cause_ict(trans);
1141         else
1142                 inta = iwl_pcie_int_cause_non_ict(trans);
1143
1144         if (iwl_have_debug_level(IWL_DL_ISR)) {
1145                 IWL_DEBUG_ISR(trans,
1146                               "ISR inta 0x%08x, enabled 0x%08x(sw), enabled(hw) 0x%08x, fh 0x%08x\n",
1147                               inta, trans_pcie->inta_mask,
1148                               iwl_read32(trans, CSR_INT_MASK),
1149                               iwl_read32(trans, CSR_FH_INT_STATUS));
1150                 if (inta & (~trans_pcie->inta_mask))
1151                         IWL_DEBUG_ISR(trans,
1152                                       "We got a masked interrupt (0x%08x)\n",
1153                                       inta & (~trans_pcie->inta_mask));
1154         }
1155
1156         inta &= trans_pcie->inta_mask;
1157
1158         /*
1159          * Ignore interrupt if there's nothing in NIC to service.
1160          * This may be due to IRQ shared with another device,
1161          * or due to sporadic interrupts thrown from our NIC.
1162          */
1163         if (unlikely(!inta)) {
1164                 IWL_DEBUG_ISR(trans, "Ignore interrupt, inta == 0\n");
1165                 /*
1166                  * Re-enable interrupts here since we don't
1167                  * have anything to service
1168                  */
1169                 if (test_bit(STATUS_INT_ENABLED, &trans->status))
1170                         iwl_enable_interrupts(trans);
1171                 spin_unlock(&trans_pcie->irq_lock);
1172                 lock_map_release(&trans->sync_cmd_lockdep_map);
1173                 return IRQ_NONE;
1174         }
1175
1176         if (unlikely(inta == 0xFFFFFFFF || (inta & 0xFFFFFFF0) == 0xa5a5a5a0)) {
1177                 /*
1178                  * Hardware disappeared. It might have
1179                  * already raised an interrupt.
1180                  */
1181                 IWL_WARN(trans, "HARDWARE GONE?? INTA == 0x%08x\n", inta);
1182                 spin_unlock(&trans_pcie->irq_lock);
1183                 goto out;
1184         }
1185
1186         /* Ack/clear/reset pending uCode interrupts.
1187          * Note:  Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
1188          */
1189         /* There is a hardware bug in the interrupt mask function that some
1190          * interrupts (i.e. CSR_INT_BIT_SCD) can still be generated even if
1191          * they are disabled in the CSR_INT_MASK register. Furthermore the
1192          * ICT interrupt handling mechanism has another bug that might cause
1193          * these unmasked interrupts fail to be detected. We workaround the
1194          * hardware bugs here by ACKing all the possible interrupts so that
1195          * interrupt coalescing can still be achieved.
1196          */
1197         iwl_write32(trans, CSR_INT, inta | ~trans_pcie->inta_mask);
1198
1199         if (iwl_have_debug_level(IWL_DL_ISR))
1200                 IWL_DEBUG_ISR(trans, "inta 0x%08x, enabled 0x%08x\n",
1201                               inta, iwl_read32(trans, CSR_INT_MASK));
1202
1203         spin_unlock(&trans_pcie->irq_lock);
1204
1205         /* Now service all interrupt bits discovered above. */
1206         if (inta & CSR_INT_BIT_HW_ERR) {
1207                 IWL_ERR(trans, "Hardware error detected.  Restarting.\n");
1208
1209                 /* Tell the device to stop sending interrupts */
1210                 iwl_disable_interrupts(trans);
1211
1212                 isr_stats->hw++;
1213                 iwl_pcie_irq_handle_error(trans);
1214
1215                 handled |= CSR_INT_BIT_HW_ERR;
1216
1217                 goto out;
1218         }
1219
1220         if (iwl_have_debug_level(IWL_DL_ISR)) {
1221                 /* NIC fires this, but we don't use it, redundant with WAKEUP */
1222                 if (inta & CSR_INT_BIT_SCD) {
1223                         IWL_DEBUG_ISR(trans,
1224                                       "Scheduler finished to transmit the frame/frames.\n");
1225                         isr_stats->sch++;
1226                 }
1227
1228                 /* Alive notification via Rx interrupt will do the real work */
1229                 if (inta & CSR_INT_BIT_ALIVE) {
1230                         IWL_DEBUG_ISR(trans, "Alive interrupt\n");
1231                         isr_stats->alive++;
1232                 }
1233         }
1234
1235         /* Safely ignore these bits for debug checks below */
1236         inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
1237
1238         /* HW RF KILL switch toggled */
1239         if (inta & CSR_INT_BIT_RF_KILL) {
1240                 bool hw_rfkill;
1241
1242                 hw_rfkill = iwl_is_rfkill_set(trans);
1243                 IWL_WARN(trans, "RF_KILL bit toggled to %s.\n",
1244                          hw_rfkill ? "disable radio" : "enable radio");
1245
1246                 isr_stats->rfkill++;
1247
1248                 mutex_lock(&trans_pcie->mutex);
1249                 iwl_trans_pcie_rf_kill(trans, hw_rfkill);
1250                 mutex_unlock(&trans_pcie->mutex);
1251                 if (hw_rfkill) {
1252                         set_bit(STATUS_RFKILL, &trans->status);
1253                         if (test_and_clear_bit(STATUS_SYNC_HCMD_ACTIVE,
1254                                                &trans->status))
1255                                 IWL_DEBUG_RF_KILL(trans,
1256                                                   "Rfkill while SYNC HCMD in flight\n");
1257                         wake_up(&trans_pcie->wait_command_queue);
1258                 } else {
1259                         clear_bit(STATUS_RFKILL, &trans->status);
1260                 }
1261
1262                 handled |= CSR_INT_BIT_RF_KILL;
1263         }
1264
1265         /* Chip got too hot and stopped itself */
1266         if (inta & CSR_INT_BIT_CT_KILL) {
1267                 IWL_ERR(trans, "Microcode CT kill error detected.\n");
1268                 isr_stats->ctkill++;
1269                 handled |= CSR_INT_BIT_CT_KILL;
1270         }
1271
1272         /* Error detected by uCode */
1273         if (inta & CSR_INT_BIT_SW_ERR) {
1274                 IWL_ERR(trans, "Microcode SW error detected. "
1275                         " Restarting 0x%X.\n", inta);
1276                 isr_stats->sw++;
1277                 iwl_pcie_irq_handle_error(trans);
1278                 handled |= CSR_INT_BIT_SW_ERR;
1279         }
1280
1281         /* uCode wakes up after power-down sleep */
1282         if (inta & CSR_INT_BIT_WAKEUP) {
1283                 IWL_DEBUG_ISR(trans, "Wakeup interrupt\n");
1284                 iwl_pcie_rxq_check_wrptr(trans);
1285                 iwl_pcie_txq_check_wrptrs(trans);
1286
1287                 isr_stats->wakeup++;
1288
1289                 handled |= CSR_INT_BIT_WAKEUP;
1290         }
1291
1292         /* All uCode command responses, including Tx command responses,
1293          * Rx "responses" (frame-received notification), and other
1294          * notifications from uCode come through here*/
1295         if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
1296                     CSR_INT_BIT_RX_PERIODIC)) {
1297                 IWL_DEBUG_ISR(trans, "Rx interrupt\n");
1298                 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
1299                         handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
1300                         iwl_write32(trans, CSR_FH_INT_STATUS,
1301                                         CSR_FH_INT_RX_MASK);
1302                 }
1303                 if (inta & CSR_INT_BIT_RX_PERIODIC) {
1304                         handled |= CSR_INT_BIT_RX_PERIODIC;
1305                         iwl_write32(trans,
1306                                 CSR_INT, CSR_INT_BIT_RX_PERIODIC);
1307                 }
1308                 /* Sending RX interrupt require many steps to be done in the
1309                  * the device:
1310                  * 1- write interrupt to current index in ICT table.
1311                  * 2- dma RX frame.
1312                  * 3- update RX shared data to indicate last write index.
1313                  * 4- send interrupt.
1314                  * This could lead to RX race, driver could receive RX interrupt
1315                  * but the shared data changes does not reflect this;
1316                  * periodic interrupt will detect any dangling Rx activity.
1317                  */
1318
1319                 /* Disable periodic interrupt; we use it as just a one-shot. */
1320                 iwl_write8(trans, CSR_INT_PERIODIC_REG,
1321                             CSR_INT_PERIODIC_DIS);
1322
1323                 /*
1324                  * Enable periodic interrupt in 8 msec only if we received
1325                  * real RX interrupt (instead of just periodic int), to catch
1326                  * any dangling Rx interrupt.  If it was just the periodic
1327                  * interrupt, there was no dangling Rx activity, and no need
1328                  * to extend the periodic interrupt; one-shot is enough.
1329                  */
1330                 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
1331                         iwl_write8(trans, CSR_INT_PERIODIC_REG,
1332                                    CSR_INT_PERIODIC_ENA);
1333
1334                 isr_stats->rx++;
1335
1336                 local_bh_disable();
1337                 iwl_pcie_rx_handle(trans);
1338                 local_bh_enable();
1339         }
1340
1341         /* This "Tx" DMA channel is used only for loading uCode */
1342         if (inta & CSR_INT_BIT_FH_TX) {
1343                 iwl_write32(trans, CSR_FH_INT_STATUS, CSR_FH_INT_TX_MASK);
1344                 IWL_DEBUG_ISR(trans, "uCode load interrupt\n");
1345                 isr_stats->tx++;
1346                 handled |= CSR_INT_BIT_FH_TX;
1347                 /* Wake up uCode load routine, now that load is complete */
1348                 trans_pcie->ucode_write_complete = true;
1349                 wake_up(&trans_pcie->ucode_write_waitq);
1350         }
1351
1352         if (inta & ~handled) {
1353                 IWL_ERR(trans, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
1354                 isr_stats->unhandled++;
1355         }
1356
1357         if (inta & ~(trans_pcie->inta_mask)) {
1358                 IWL_WARN(trans, "Disabled INTA bits 0x%08x were pending\n",
1359                          inta & ~trans_pcie->inta_mask);
1360         }
1361
1362         /* Re-enable all interrupts */
1363         /* only Re-enable if disabled by irq */
1364         if (test_bit(STATUS_INT_ENABLED, &trans->status))
1365                 iwl_enable_interrupts(trans);
1366         /* Re-enable RF_KILL if it occurred */
1367         else if (handled & CSR_INT_BIT_RF_KILL)
1368                 iwl_enable_rfkill_int(trans);
1369
1370 out:
1371         lock_map_release(&trans->sync_cmd_lockdep_map);
1372         return IRQ_HANDLED;
1373 }
1374
1375 /******************************************************************************
1376  *
1377  * ICT functions
1378  *
1379  ******************************************************************************/
1380
1381 /* Free dram table */
1382 void iwl_pcie_free_ict(struct iwl_trans *trans)
1383 {
1384         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1385
1386         if (trans_pcie->ict_tbl) {
1387                 dma_free_coherent(trans->dev, ICT_SIZE,
1388                                   trans_pcie->ict_tbl,
1389                                   trans_pcie->ict_tbl_dma);
1390                 trans_pcie->ict_tbl = NULL;
1391                 trans_pcie->ict_tbl_dma = 0;
1392         }
1393 }
1394
1395 /*
1396  * allocate dram shared table, it is an aligned memory
1397  * block of ICT_SIZE.
1398  * also reset all data related to ICT table interrupt.
1399  */
1400 int iwl_pcie_alloc_ict(struct iwl_trans *trans)
1401 {
1402         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1403
1404         trans_pcie->ict_tbl =
1405                 dma_zalloc_coherent(trans->dev, ICT_SIZE,
1406                                    &trans_pcie->ict_tbl_dma,
1407                                    GFP_KERNEL);
1408         if (!trans_pcie->ict_tbl)
1409                 return -ENOMEM;
1410
1411         /* just an API sanity check ... it is guaranteed to be aligned */
1412         if (WARN_ON(trans_pcie->ict_tbl_dma & (ICT_SIZE - 1))) {
1413                 iwl_pcie_free_ict(trans);
1414                 return -EINVAL;
1415         }
1416
1417         IWL_DEBUG_ISR(trans, "ict dma addr %Lx ict vir addr %p\n",
1418                       (unsigned long long)trans_pcie->ict_tbl_dma,
1419                       trans_pcie->ict_tbl);
1420
1421         return 0;
1422 }
1423
1424 /* Device is going up inform it about using ICT interrupt table,
1425  * also we need to tell the driver to start using ICT interrupt.
1426  */
1427 void iwl_pcie_reset_ict(struct iwl_trans *trans)
1428 {
1429         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1430         u32 val;
1431
1432         if (!trans_pcie->ict_tbl)
1433                 return;
1434
1435         spin_lock(&trans_pcie->irq_lock);
1436         iwl_disable_interrupts(trans);
1437
1438         memset(trans_pcie->ict_tbl, 0, ICT_SIZE);
1439
1440         val = trans_pcie->ict_tbl_dma >> ICT_SHIFT;
1441
1442         val |= CSR_DRAM_INT_TBL_ENABLE;
1443         val |= CSR_DRAM_INIT_TBL_WRAP_CHECK;
1444
1445         IWL_DEBUG_ISR(trans, "CSR_DRAM_INT_TBL_REG =0x%x\n", val);
1446
1447         iwl_write32(trans, CSR_DRAM_INT_TBL_REG, val);
1448         trans_pcie->use_ict = true;
1449         trans_pcie->ict_index = 0;
1450         iwl_write32(trans, CSR_INT, trans_pcie->inta_mask);
1451         iwl_enable_interrupts(trans);
1452         spin_unlock(&trans_pcie->irq_lock);
1453 }
1454
1455 /* Device is going down disable ict interrupt usage */
1456 void iwl_pcie_disable_ict(struct iwl_trans *trans)
1457 {
1458         struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1459
1460         spin_lock(&trans_pcie->irq_lock);
1461         trans_pcie->use_ict = false;
1462         spin_unlock(&trans_pcie->irq_lock);
1463 }
1464
1465 irqreturn_t iwl_pcie_isr(int irq, void *data)
1466 {
1467         struct iwl_trans *trans = data;
1468
1469         if (!trans)
1470                 return IRQ_NONE;
1471
1472         /* Disable (but don't clear!) interrupts here to avoid
1473          * back-to-back ISRs and sporadic interrupts from our NIC.
1474          * If we have something to service, the tasklet will re-enable ints.
1475          * If we *don't* have something, we'll re-enable before leaving here.
1476          */
1477         iwl_write32(trans, CSR_INT_MASK, 0x00000000);
1478
1479         return IRQ_WAKE_THREAD;
1480 }