rx.c 39.1 KB
Newer Older
1 2
/******************************************************************************
 *
J
Johannes Berg 已提交
3
 * Copyright(c) 2003 - 2013 Intel Corporation. All rights reserved.
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
 *
 * Portions of this file are derived from the ipw3945 project, as well
 * as portions of the ieee80211 subsystem header files.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 *  Intel Linux Wireless <ilw@linux.intel.com>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 *****************************************************************************/
#include <linux/sched.h>
#include <linux/wait.h>
31
#include <linux/gfp.h>
32

33
#include "iwl-prph.h"
34
#include "iwl-io.h"
35
#include "internal.h"
36
#include "iwl-op-mode.h"
37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78

/******************************************************************************
 *
 * RX path functions
 *
 ******************************************************************************/

/*
 * Rx theory of operation
 *
 * Driver allocates a circular buffer of Receive Buffer Descriptors (RBDs),
 * each of which point to Receive Buffers to be filled by the NIC.  These get
 * used not only for Rx frames, but for any command response or notification
 * from the NIC.  The driver and NIC manage the Rx buffers by means
 * of indexes into the circular buffer.
 *
 * Rx Queue Indexes
 * The host/firmware share two index registers for managing the Rx buffers.
 *
 * The READ index maps to the first position that the firmware may be writing
 * to -- the driver can read up to (but not including) this position and get
 * good data.
 * The READ index is managed by the firmware once the card is enabled.
 *
 * The WRITE index maps to the last position the driver has read from -- the
 * position preceding WRITE is the last slot the firmware can place a packet.
 *
 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
 * WRITE = READ.
 *
 * During initialization, the host sets up the READ queue position to the first
 * INDEX position, and WRITE to the last (READ - 1 wrapped)
 *
 * When the firmware places a packet in a buffer, it will advance the READ index
 * and fire the RX interrupt.  The driver can then query the READ index and
 * process as many packets as possible, moving the WRITE index forward as it
 * resets the Rx queue buffers with new memory.
 *
 * The management in the driver is as follows:
 * + A list of pre-allocated SKBs is stored in iwl->rxq->rx_free.  When
 *   iwl->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
 *   to replenish the iwl->rxq->rx_free.
79
 * + In iwl_pcie_rx_replenish (scheduled) if 'processed' != 'read' then the
80 81 82 83
 *   iwl->rxq is replenished and the READ INDEX is updated (updating the
 *   'processed' and 'read' driver indexes as well)
 * + A received packet is processed and handed to the kernel network stack,
 *   detached from the iwl->rxq.  The driver 'processed' index is updated.
84 85 86 87
 * + The Host/Firmware iwl->rxq is replenished at irq thread time from the
 *   rx_free list. If there are no allocated buffers in iwl->rxq->rx_free,
 *   the READ INDEX is not incremented and iwl->status(RX_STALLED) is set.
 *   If there were enough free buffers and RX_STALLED is set it is cleared.
88 89 90 91
 *
 *
 * Driver sequence:
 *
92 93 94 95
 * iwl_rxq_alloc()            Allocates rx_free
 * iwl_pcie_rx_replenish()    Replenishes rx_free list from rx_used, and calls
 *                            iwl_pcie_rxq_restock
 * iwl_pcie_rxq_restock()     Moves available buffers from rx_free into Rx
96 97
 *                            queue, updates firmware pointers, and updates
 *                            the WRITE index.  If insufficient rx_free buffers
98
 *                            are available, schedules iwl_pcie_rx_replenish
99 100
 *
 * -- enable interrupts --
101
 * ISR - iwl_rx()             Detach iwl_rx_mem_buffers from pool up to the
102 103
 *                            READ INDEX, detaching the SKB from the pool.
 *                            Moves the packet buffer from queue to rx_used.
104
 *                            Calls iwl_pcie_rxq_restock to refill any empty
105 106 107 108 109
 *                            slots.
 * ...
 *
 */

110 111
/*
 * iwl_rxq_space - Return number of free slots available in queue.
112
 */
113
static int iwl_rxq_space(const struct iwl_rxq *rxq)
114
{
115 116
	/* Make sure RX_QUEUE_SIZE is a power of 2 */
	BUILD_BUG_ON(RX_QUEUE_SIZE & (RX_QUEUE_SIZE - 1));
117

118 119 120 121 122 123 124
	/*
	 * There can be up to (RX_QUEUE_SIZE - 1) free slots, to avoid ambiguity
	 * between empty and completely full queues.
	 * The following is equivalent to modulo by RX_QUEUE_SIZE and is well
	 * defined for negative dividends.
	 */
	return (rxq->read - rxq->write - 1) & (RX_QUEUE_SIZE - 1);
125 126
}

127 128 129 130 131 132 133 134
/*
 * iwl_dma_addr2rbd_ptr - convert a DMA address to a uCode read buffer ptr
 */
static inline __le32 iwl_pcie_dma_addr2rbd_ptr(dma_addr_t dma_addr)
{
	return cpu_to_le32((u32)(dma_addr >> 8));
}

135 136 137
/*
 * iwl_pcie_rx_stop - stops the Rx DMA
 */
138 139 140 141 142 143 144
int iwl_pcie_rx_stop(struct iwl_trans *trans)
{
	iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
	return iwl_poll_direct_bit(trans, FH_MEM_RSSR_RX_STATUS_REG,
				   FH_RSSR_CHNL0_RX_STATUS_CHNL_IDLE, 1000);
}

145 146
/*
 * iwl_pcie_rxq_inc_wr_ptr - Update the write pointer for the RX queue
147
 */
148 149
static void iwl_pcie_rxq_inc_wr_ptr(struct iwl_trans *trans,
				    struct iwl_rxq *rxq)
150 151 152 153
{
	unsigned long flags;
	u32 reg;

154
	spin_lock_irqsave(&rxq->lock, flags);
155

156
	if (rxq->need_update == 0)
157 158
		goto exit_unlock;

159
	if (trans->cfg->base_params->shadow_reg_enable) {
160 161
		/* shadow register enabled */
		/* Device expects a multiple of 8 */
162 163
		rxq->write_actual = (rxq->write & ~0x7);
		iwl_write32(trans, FH_RSCSR_CHNL0_WPTR, rxq->write_actual);
164 165
	} else {
		/* If power-saving is in use, make sure device is awake */
166
		if (test_bit(STATUS_TPOWER_PMI, &trans->status)) {
167
			reg = iwl_read32(trans, CSR_UCODE_DRV_GP1);
168 169

			if (reg & CSR_UCODE_DRV_GP1_BIT_MAC_SLEEP) {
170
				IWL_DEBUG_INFO(trans,
171 172
					"Rx queue requesting wakeup,"
					" GP1 = 0x%x\n", reg);
173
				iwl_set_bit(trans, CSR_GP_CNTRL,
174 175 176 177
					CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
				goto exit_unlock;
			}

178
			rxq->write_actual = (rxq->write & ~0x7);
179
			iwl_write_direct32(trans, FH_RSCSR_CHNL0_WPTR,
180
					   rxq->write_actual);
181 182 183 184

		/* Else device is assumed to be awake */
		} else {
			/* Device expects a multiple of 8 */
185
			rxq->write_actual = (rxq->write & ~0x7);
186
			iwl_write_direct32(trans, FH_RSCSR_CHNL0_WPTR,
187
					   rxq->write_actual);
188 189
		}
	}
190
	rxq->need_update = 0;
191 192

 exit_unlock:
193
	spin_unlock_irqrestore(&rxq->lock, flags);
194 195
}

196 197
/*
 * iwl_pcie_rxq_restock - refill RX queue from pre-allocated pool
198 199 200 201 202 203 204 205 206
 *
 * If there are slots in the RX queue that need to be restocked,
 * and we have free pre-allocated buffers, fill the ranks as much
 * as we can, pulling from rx_free.
 *
 * This moves the 'write' index forward to catch up with 'processed', and
 * also updates the memory address in the firmware to reference the new
 * target buffer.
 */
207
static void iwl_pcie_rxq_restock(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 213
	struct iwl_rx_mem_buffer *rxb;
	unsigned long flags;

214 215 216
	/*
	 * If the device isn't enabled - not need to try to add buffers...
	 * This can happen when we stop the device and still have an interrupt
217 218 219
	 * pending. We stop the APM before we sync the interrupts because we
	 * have to (see comment there). On the other hand, since the APM is
	 * stopped, we cannot access the HW (in particular not prph).
220 221
	 * So don't try to restock if the APM has been already stopped.
	 */
222
	if (!test_bit(STATUS_DEVICE_ENABLED, &trans->status))
223 224
		return;

225
	spin_lock_irqsave(&rxq->lock, flags);
226
	while ((iwl_rxq_space(rxq) > 0) && (rxq->free_count)) {
227 228 229 230 231
		/* The overwritten rxb must be a used one */
		rxb = rxq->queue[rxq->write];
		BUG_ON(rxb && rxb->page);

		/* Get next free Rx buffer, remove from free list */
J
Johannes Berg 已提交
232 233 234
		rxb = list_first_entry(&rxq->rx_free, struct iwl_rx_mem_buffer,
				       list);
		list_del(&rxb->list);
235 236

		/* Point to Rx buffer via next RBD in circular buffer */
237
		rxq->bd[rxq->write] = iwl_pcie_dma_addr2rbd_ptr(rxb->page_dma);
238 239 240 241 242 243 244 245
		rxq->queue[rxq->write] = rxb;
		rxq->write = (rxq->write + 1) & RX_QUEUE_MASK;
		rxq->free_count--;
	}
	spin_unlock_irqrestore(&rxq->lock, flags);
	/* If the pre-allocated buffer pool is dropping low, schedule to
	 * refill it */
	if (rxq->free_count <= RX_LOW_WATERMARK)
J
Johannes Berg 已提交
246
		schedule_work(&trans_pcie->rx_replenish);
247 248 249 250 251 252 253

	/* If we've added more space for the firmware to place data, tell it.
	 * Increment device's write pointer in multiples of 8. */
	if (rxq->write_actual != (rxq->write & ~0x7)) {
		spin_lock_irqsave(&rxq->lock, flags);
		rxq->need_update = 1;
		spin_unlock_irqrestore(&rxq->lock, flags);
254
		iwl_pcie_rxq_inc_wr_ptr(trans, rxq);
255 256 257
	}
}

258
/*
259
 * iwl_pcie_rxq_alloc_rbs - allocate a page for each used RBD
260
 *
261 262 263
 * A used RBD is an Rx buffer that has been given to the stack. To use it again
 * a page must be allocated and the RBD must point to the page. This function
 * doesn't change the HW pointer but handles the list of pages that is used by
264
 * iwl_pcie_rxq_restock. The latter function will update the HW to use the newly
265
 * allocated buffers.
266
 */
267
static void iwl_pcie_rxq_alloc_rbs(struct iwl_trans *trans, gfp_t priority)
268
{
269
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
270
	struct iwl_rxq *rxq = &trans_pcie->rxq;
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
	struct iwl_rx_mem_buffer *rxb;
	struct page *page;
	unsigned long flags;
	gfp_t gfp_mask = priority;

	while (1) {
		spin_lock_irqsave(&rxq->lock, flags);
		if (list_empty(&rxq->rx_used)) {
			spin_unlock_irqrestore(&rxq->lock, flags);
			return;
		}
		spin_unlock_irqrestore(&rxq->lock, flags);

		if (rxq->free_count > RX_LOW_WATERMARK)
			gfp_mask |= __GFP_NOWARN;

287
		if (trans_pcie->rx_page_order > 0)
288 289 290
			gfp_mask |= __GFP_COMP;

		/* Alloc a new receive buffer */
291
		page = alloc_pages(gfp_mask, trans_pcie->rx_page_order);
292 293
		if (!page) {
			if (net_ratelimit())
294
				IWL_DEBUG_INFO(trans, "alloc_pages failed, "
295
					   "order: %d\n",
296
					   trans_pcie->rx_page_order);
297 298 299

			if ((rxq->free_count <= RX_LOW_WATERMARK) &&
			    net_ratelimit())
300
				IWL_CRIT(trans, "Failed to alloc_pages with %s."
301 302 303 304 305 306 307 308 309 310 311 312 313 314
					 "Only %u free buffers remaining.\n",
					 priority == GFP_ATOMIC ?
					 "GFP_ATOMIC" : "GFP_KERNEL",
					 rxq->free_count);
			/* We don't reschedule replenish work here -- we will
			 * call the restock method and if it still needs
			 * more buffers it will schedule replenish */
			return;
		}

		spin_lock_irqsave(&rxq->lock, flags);

		if (list_empty(&rxq->rx_used)) {
			spin_unlock_irqrestore(&rxq->lock, flags);
315
			__free_pages(page, trans_pcie->rx_page_order);
316 317
			return;
		}
J
Johannes Berg 已提交
318 319 320
		rxb = list_first_entry(&rxq->rx_used, struct iwl_rx_mem_buffer,
				       list);
		list_del(&rxb->list);
321 322 323 324 325
		spin_unlock_irqrestore(&rxq->lock, flags);

		BUG_ON(rxb->page);
		rxb->page = page;
		/* Get physical address of the RB */
326 327 328 329
		rxb->page_dma =
			dma_map_page(trans->dev, page, 0,
				     PAGE_SIZE << trans_pcie->rx_page_order,
				     DMA_FROM_DEVICE);
330 331 332 333 334 335 336 337
		if (dma_mapping_error(trans->dev, rxb->page_dma)) {
			rxb->page = NULL;
			spin_lock_irqsave(&rxq->lock, flags);
			list_add(&rxb->list, &rxq->rx_used);
			spin_unlock_irqrestore(&rxq->lock, flags);
			__free_pages(page, trans_pcie->rx_page_order);
			return;
		}
338 339 340 341 342 343 344 345 346 347 348 349 350 351
		/* dma address must be no more than 36 bits */
		BUG_ON(rxb->page_dma & ~DMA_BIT_MASK(36));
		/* and also 256 byte aligned! */
		BUG_ON(rxb->page_dma & DMA_BIT_MASK(8));

		spin_lock_irqsave(&rxq->lock, flags);

		list_add_tail(&rxb->list, &rxq->rx_free);
		rxq->free_count++;

		spin_unlock_irqrestore(&rxq->lock, flags);
	}
}

352 353 354 355 356 357
static void iwl_pcie_rxq_free_rbs(struct iwl_trans *trans)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	struct iwl_rxq *rxq = &trans_pcie->rxq;
	int i;

358 359
	lockdep_assert_held(&rxq->lock);

360
	for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
361 362 363 364 365 366 367
		if (!rxq->pool[i].page)
			continue;
		dma_unmap_page(trans->dev, rxq->pool[i].page_dma,
			       PAGE_SIZE << trans_pcie->rx_page_order,
			       DMA_FROM_DEVICE);
		__free_pages(rxq->pool[i].page, trans_pcie->rx_page_order);
		rxq->pool[i].page = NULL;
368 369 370
	}
}

371
/*
372
 * iwl_pcie_rx_replenish - Move all used buffers from rx_used to rx_free
373 374 375
 *
 * When moving to rx_free an page is allocated for the slot.
 *
376
 * Also restock the Rx queue via iwl_pcie_rxq_restock.
377 378
 * This is called as a scheduled work item (except for during initialization)
 */
379
static void iwl_pcie_rx_replenish(struct iwl_trans *trans)
380
{
J
Johannes Berg 已提交
381
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
382 383
	unsigned long flags;

384
	iwl_pcie_rxq_alloc_rbs(trans, GFP_KERNEL);
385

J
Johannes Berg 已提交
386
	spin_lock_irqsave(&trans_pcie->irq_lock, flags);
387
	iwl_pcie_rxq_restock(trans);
J
Johannes Berg 已提交
388
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
389 390
}

391
static void iwl_pcie_rx_replenish_now(struct iwl_trans *trans)
392
{
393
	iwl_pcie_rxq_alloc_rbs(trans, GFP_ATOMIC);
394

395
	iwl_pcie_rxq_restock(trans);
396 397
}

398
static void iwl_pcie_rx_replenish_work(struct work_struct *data)
399
{
400 401
	struct iwl_trans_pcie *trans_pcie =
	    container_of(data, struct iwl_trans_pcie, rx_replenish);
402

403
	iwl_pcie_rx_replenish(trans_pcie->trans);
404 405
}

406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435
static int iwl_pcie_rx_alloc(struct iwl_trans *trans)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	struct iwl_rxq *rxq = &trans_pcie->rxq;
	struct device *dev = trans->dev;

	memset(&trans_pcie->rxq, 0, sizeof(trans_pcie->rxq));

	spin_lock_init(&rxq->lock);

	if (WARN_ON(rxq->bd || rxq->rb_stts))
		return -EINVAL;

	/* Allocate the circular buffer of Read Buffer Descriptors (RBDs) */
	rxq->bd = dma_zalloc_coherent(dev, sizeof(__le32) * RX_QUEUE_SIZE,
				      &rxq->bd_dma, GFP_KERNEL);
	if (!rxq->bd)
		goto err_bd;

	/*Allocate the driver's pointer to receive buffer status */
	rxq->rb_stts = dma_zalloc_coherent(dev, sizeof(*rxq->rb_stts),
					   &rxq->rb_stts_dma, GFP_KERNEL);
	if (!rxq->rb_stts)
		goto err_rb_stts;

	return 0;

err_rb_stts:
	dma_free_coherent(dev, sizeof(__le32) * RX_QUEUE_SIZE,
			  rxq->bd, rxq->bd_dma);
436
	rxq->bd_dma = 0;
437 438 439
	rxq->bd = NULL;
err_bd:
	return -ENOMEM;
440 441
}

442 443 444 445 446 447 448 449 450 451 452 453 454
static void iwl_pcie_rx_hw_init(struct iwl_trans *trans, struct iwl_rxq *rxq)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	u32 rb_size;
	const u32 rfdnlog = RX_QUEUE_SIZE_LOG; /* 256 RBDs */

	if (trans_pcie->rx_buf_size_8k)
		rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_8K;
	else
		rb_size = FH_RCSR_RX_CONFIG_REG_VAL_RB_SIZE_4K;

	/* Stop Rx DMA */
	iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG, 0);
455 456 457 458
	/* reset and flush pointers */
	iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_RBDCB_WPTR, 0);
	iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_FLUSH_RB_REQ, 0);
	iwl_write_direct32(trans, FH_RSCSR_CHNL0_RDPTR, 0);
459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483

	/* Reset driver's Rx queue write index */
	iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_WPTR_REG, 0);

	/* Tell device where to find RBD circular buffer in DRAM */
	iwl_write_direct32(trans, FH_RSCSR_CHNL0_RBDCB_BASE_REG,
			   (u32)(rxq->bd_dma >> 8));

	/* Tell device where in DRAM to update its Rx status */
	iwl_write_direct32(trans, FH_RSCSR_CHNL0_STTS_WPTR_REG,
			   rxq->rb_stts_dma >> 4);

	/* Enable Rx DMA
	 * FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY is set because of HW bug in
	 *      the credit mechanism in 5000 HW RX FIFO
	 * Direct rx interrupts to hosts
	 * Rx buffer size 4 or 8k
	 * RB timeout 0x10
	 * 256 RBDs
	 */
	iwl_write_direct32(trans, FH_MEM_RCSR_CHNL0_CONFIG_REG,
			   FH_RCSR_RX_CONFIG_CHNL_EN_ENABLE_VAL |
			   FH_RCSR_CHNL0_RX_IGNORE_RXF_EMPTY |
			   FH_RCSR_CHNL0_RX_CONFIG_IRQ_DEST_INT_HOST_VAL |
			   rb_size|
484
			   (RX_RB_TIMEOUT << FH_RCSR_RX_CONFIG_REG_IRQ_RBTH_POS)|
485 486 487 488
			   (rfdnlog << FH_RCSR_RX_CONFIG_RBDCB_SIZE_POS));

	/* Set interrupt coalescing timer to default (2048 usecs) */
	iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_TIMEOUT_DEF);
489 490 491 492

	/* W/A for interrupt coalescing bug in 7260 and 3160 */
	if (trans->cfg->host_interrupt_operation_mode)
		iwl_set_bit(trans, CSR_INT_COALESCING, IWL_HOST_INT_OPER_MODE);
493 494
}

495 496 497 498 499 500 501 502 503 504 505 506 507 508
static void iwl_pcie_rx_init_rxb_lists(struct iwl_rxq *rxq)
{
	int i;

	lockdep_assert_held(&rxq->lock);

	INIT_LIST_HEAD(&rxq->rx_free);
	INIT_LIST_HEAD(&rxq->rx_used);
	rxq->free_count = 0;

	for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
		list_add(&rxq->pool[i].list, &rxq->rx_used);
}

509 510 511 512 513 514 515 516 517 518 519 520 521 522 523
int iwl_pcie_rx_init(struct iwl_trans *trans)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	struct iwl_rxq *rxq = &trans_pcie->rxq;
	int i, err;
	unsigned long flags;

	if (!rxq->bd) {
		err = iwl_pcie_rx_alloc(trans);
		if (err)
			return err;
	}

	spin_lock_irqsave(&rxq->lock, flags);

524
	INIT_WORK(&trans_pcie->rx_replenish, iwl_pcie_rx_replenish_work);
525

526
	/* free all first - we might be reconfigured for a different size */
527
	iwl_pcie_rxq_free_rbs(trans);
528
	iwl_pcie_rx_init_rxb_lists(rxq);
529 530 531 532 533 534 535 536

	for (i = 0; i < RX_QUEUE_SIZE; i++)
		rxq->queue[i] = NULL;

	/* Set us so that we have processed and used all buffers, but have
	 * not restocked the Rx queue with fresh buffers */
	rxq->read = rxq->write = 0;
	rxq->write_actual = 0;
537
	memset(rxq->rb_stts, 0, sizeof(*rxq->rb_stts));
538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564
	spin_unlock_irqrestore(&rxq->lock, flags);

	iwl_pcie_rx_replenish(trans);

	iwl_pcie_rx_hw_init(trans, rxq);

	spin_lock_irqsave(&trans_pcie->irq_lock, flags);
	rxq->need_update = 1;
	iwl_pcie_rxq_inc_wr_ptr(trans, rxq);
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);

	return 0;
}

void iwl_pcie_rx_free(struct iwl_trans *trans)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	struct iwl_rxq *rxq = &trans_pcie->rxq;
	unsigned long flags;

	/*if rxq->bd is NULL, it means that nothing has been allocated,
	 * exit now */
	if (!rxq->bd) {
		IWL_DEBUG_INFO(trans, "Free NULL rx context\n");
		return;
	}

565 566
	cancel_work_sync(&trans_pcie->rx_replenish);

567 568 569 570 571 572
	spin_lock_irqsave(&rxq->lock, flags);
	iwl_pcie_rxq_free_rbs(trans);
	spin_unlock_irqrestore(&rxq->lock, flags);

	dma_free_coherent(trans->dev, sizeof(__le32) * RX_QUEUE_SIZE,
			  rxq->bd, rxq->bd_dma);
573
	rxq->bd_dma = 0;
574 575 576 577 578 579 580 581
	rxq->bd = NULL;

	if (rxq->rb_stts)
		dma_free_coherent(trans->dev,
				  sizeof(struct iwl_rb_status),
				  rxq->rb_stts, rxq->rb_stts_dma);
	else
		IWL_DEBUG_INFO(trans, "Free rxq->rb_stts which is NULL\n");
582
	rxq->rb_stts_dma = 0;
583 584 585 586
	rxq->rb_stts = NULL;
}

static void iwl_pcie_rx_handle_rb(struct iwl_trans *trans,
J
Johannes Berg 已提交
587 588 589
				struct iwl_rx_mem_buffer *rxb)
{
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
590 591
	struct iwl_rxq *rxq = &trans_pcie->rxq;
	struct iwl_txq *txq = &trans_pcie->txq[trans_pcie->cmd_queue];
J
Johannes Berg 已提交
592
	unsigned long flags;
593
	bool page_stolen = false;
594
	int max_len = PAGE_SIZE << trans_pcie->rx_page_order;
595
	u32 offset = 0;
J
Johannes Berg 已提交
596 597 598 599

	if (WARN_ON(!rxb))
		return;

600 601 602 603 604 605 606 607 608 609
	dma_unmap_page(trans->dev, rxb->page_dma, max_len, DMA_FROM_DEVICE);

	while (offset + sizeof(u32) + sizeof(struct iwl_cmd_header) < max_len) {
		struct iwl_rx_packet *pkt;
		struct iwl_device_cmd *cmd;
		u16 sequence;
		bool reclaim;
		int index, cmd_index, err, len;
		struct iwl_rx_cmd_buffer rxcb = {
			._offset = offset,
610
			._rx_page_order = trans_pcie->rx_page_order,
611 612
			._page = rxb->page,
			._page_stolen = false,
613
			.truesize = max_len,
614 615 616 617 618 619 620 621
		};

		pkt = rxb_addr(&rxcb);

		if (pkt->len_n_flags == cpu_to_le32(FH_RSCSR_FRAME_INVALID))
			break;

		IWL_DEBUG_RX(trans, "cmd at offset %d: %s (0x%.2x)\n",
622
			rxcb._offset, get_cmd_string(trans_pcie, pkt->hdr.cmd),
J
Johannes Berg 已提交
623
			pkt->hdr.cmd);
624 625 626

		len = le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK;
		len += sizeof(u32); /* account for status word */
627 628
		trace_iwlwifi_dev_rx(trans->dev, trans, pkt, len);
		trace_iwlwifi_dev_rx_data(trans->dev, trans, pkt, len);
629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645

		/* Reclaim a command buffer only if this packet is a response
		 *   to a (driver-originated) command.
		 * If the packet (e.g. Rx frame) originated from uCode,
		 *   there is no command buffer to reclaim.
		 * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
		 *   but apparently a few don't get set; catch them here. */
		reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME);
		if (reclaim) {
			int i;

			for (i = 0; i < trans_pcie->n_no_reclaim_cmds; i++) {
				if (trans_pcie->no_reclaim_cmds[i] ==
							pkt->hdr.cmd) {
					reclaim = false;
					break;
				}
646 647
			}
		}
J
Johannes Berg 已提交
648

649 650 651 652
		sequence = le16_to_cpu(pkt->hdr.sequence);
		index = SEQ_TO_INDEX(sequence);
		cmd_index = get_cmd_index(&txq->q, index);

653 654 655
		if (reclaim)
			cmd = txq->entries[cmd_index].cmd;
		else
656 657 658 659
			cmd = NULL;

		err = iwl_op_mode_rx(trans->op_mode, &rxcb, cmd);

660
		if (reclaim) {
661 662
			kfree(txq->entries[cmd_index].free_buf);
			txq->entries[cmd_index].free_buf = NULL;
663 664
		}

665 666 667 668 669 670 671 672 673 674 675
		/*
		 * After here, we should always check rxcb._page_stolen,
		 * if it is true then one of the handlers took the page.
		 */

		if (reclaim) {
			/* Invoke any callbacks, transfer the buffer to caller,
			 * and fire off the (possibly) blocking
			 * iwl_trans_send_cmd()
			 * as we reclaim the driver command queue */
			if (!rxcb._page_stolen)
676
				iwl_pcie_hcmd_complete(trans, &rxcb, err);
677 678 679 680 681 682
			else
				IWL_WARN(trans, "Claim null rxb?\n");
		}

		page_stolen |= rxcb._page_stolen;
		offset += ALIGN(len, FH_RSCSR_FRAME_ALIGN);
J
Johannes Berg 已提交
683 684
	}

685 686
	/* page was stolen from us -- free our reference */
	if (page_stolen) {
687
		__free_pages(rxb->page, trans_pcie->rx_page_order);
J
Johannes Berg 已提交
688
		rxb->page = NULL;
689
	}
J
Johannes Berg 已提交
690 691 692 693 694 695 696 697

	/* Reuse the page if possible. For notification packets and
	 * SKBs that fail to Rx correctly, add them back into the
	 * rx_free list for reuse later. */
	spin_lock_irqsave(&rxq->lock, flags);
	if (rxb->page != NULL) {
		rxb->page_dma =
			dma_map_page(trans->dev, rxb->page, 0,
698 699
				     PAGE_SIZE << trans_pcie->rx_page_order,
				     DMA_FROM_DEVICE);
700 701 702 703 704 705 706 707 708 709 710 711 712
		if (dma_mapping_error(trans->dev, rxb->page_dma)) {
			/*
			 * free the page(s) as well to not break
			 * the invariant that the items on the used
			 * list have no page(s)
			 */
			__free_pages(rxb->page, trans_pcie->rx_page_order);
			rxb->page = NULL;
			list_add_tail(&rxb->list, &rxq->rx_used);
		} else {
			list_add_tail(&rxb->list, &rxq->rx_free);
			rxq->free_count++;
		}
J
Johannes Berg 已提交
713 714 715 716 717
	} else
		list_add_tail(&rxb->list, &rxq->rx_used);
	spin_unlock_irqrestore(&rxq->lock, flags);
}

718 719
/*
 * iwl_pcie_rx_handle - Main entry function for receiving responses from fw
720
 */
721
static void iwl_pcie_rx_handle(struct iwl_trans *trans)
722
{
J
Johannes Berg 已提交
723
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
724
	struct iwl_rxq *rxq = &trans_pcie->rxq;
725 726 727 728 729 730 731
	u32 r, i;
	u8 fill_rx = 0;
	u32 count = 8;
	int total_empty;

	/* uCode's read index (stored in shared DRAM) indicates the last Rx
	 * buffer that the driver may process (last buffer filled by ucode). */
732
	r = le16_to_cpu(ACCESS_ONCE(rxq->rb_stts->closed_rb_num)) & 0x0FFF;
733 734 735 736
	i = rxq->read;

	/* Rx interrupt, but nothing sent from uCode */
	if (i == r)
737
		IWL_DEBUG_RX(trans, "HW = SW = %d\n", r);
738 739 740 741 742 743 744 745 746 747

	/* calculate total frames need to be restock after handling RX */
	total_empty = r - rxq->write_actual;
	if (total_empty < 0)
		total_empty += RX_QUEUE_SIZE;

	if (total_empty > (RX_QUEUE_SIZE / 2))
		fill_rx = 1;

	while (i != r) {
748
		struct iwl_rx_mem_buffer *rxb;
749 750 751 752

		rxb = rxq->queue[i];
		rxq->queue[i] = NULL;

753 754
		IWL_DEBUG_RX(trans, "rxbuf: HW = %d, SW = %d (%p)\n",
			     r, i, rxb);
755
		iwl_pcie_rx_handle_rb(trans, rxb);
756 757 758 759 760 761 762 763

		i = (i + 1) & RX_QUEUE_MASK;
		/* If there are a lot of unused frames,
		 * restock the Rx queue so ucode wont assert. */
		if (fill_rx) {
			count++;
			if (count >= 8) {
				rxq->read = i;
764
				iwl_pcie_rx_replenish_now(trans);
765 766 767 768 769 770 771 772
				count = 0;
			}
		}
	}

	/* Backtrack one entry */
	rxq->read = i;
	if (fill_rx)
773
		iwl_pcie_rx_replenish_now(trans);
774
	else
775
		iwl_pcie_rxq_restock(trans);
776 777
}

778 779
/*
 * iwl_pcie_irq_handle_error - called for HW or SW error interrupt from card
780
 */
781
static void iwl_pcie_irq_handle_error(struct iwl_trans *trans)
782
{
783 784
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);

785
	/* W/A for WiFi/WiMAX coex and WiMAX own the RF */
786
	if (trans->cfg->internal_wimax_coex &&
787
	    (!(iwl_read_prph(trans, APMG_CLK_CTRL_REG) &
788
			     APMS_CLK_VAL_MRB_FUNC_MODE) ||
789
	     (iwl_read_prph(trans, APMG_PS_CTRL_REG) &
790
			    APMG_PS_CTRL_VAL_RESET_REQ))) {
791
		clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
792
		iwl_op_mode_wimax_active(trans->op_mode);
793
		wake_up(&trans_pcie->wait_command_queue);
794 795 796
		return;
	}

797
	iwl_pcie_dump_csr(trans);
798
	iwl_dump_fh(trans, NULL);
799

800
	local_bh_disable();
801 802 803
	/* The STATUS_FW_ERROR bit is set in this function. This must happen
	 * before we wake up the command caller, to ensure a proper cleanup. */
	iwl_trans_fw_error(trans);
804
	local_bh_enable();
805 806 807

	clear_bit(STATUS_SYNC_HCMD_ACTIVE, &trans->status);
	wake_up(&trans_pcie->wait_command_queue);
808 809
}

810
irqreturn_t iwl_pcie_irq_handler(int irq, void *dev_id)
811
{
812
	struct iwl_trans *trans = dev_id;
813 814
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
	struct isr_statistics *isr_stats = &trans_pcie->isr_stats;
815 816 817 818 819
	u32 inta = 0;
	u32 handled = 0;
	unsigned long flags;
	u32 i;

820 821
	lock_map_acquire(&trans->sync_cmd_lockdep_map);

J
Johannes Berg 已提交
822
	spin_lock_irqsave(&trans_pcie->irq_lock, flags);
823 824 825 826 827 828 829 830 831 832 833 834

	/* Ack/clear/reset pending uCode interrupts.
	 * Note:  Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
	 */
	/* There is a hardware bug in the interrupt mask function that some
	 * interrupts (i.e. CSR_INT_BIT_SCD) can still be generated even if
	 * they are disabled in the CSR_INT_MASK register. Furthermore the
	 * ICT interrupt handling mechanism has another bug that might cause
	 * these unmasked interrupts fail to be detected. We workaround the
	 * hardware bugs here by ACKing all the possible interrupts so that
	 * interrupt coalescing can still be achieved.
	 */
835
	iwl_write32(trans, CSR_INT,
836
		    trans_pcie->inta | ~trans_pcie->inta_mask);
837

838
	inta = trans_pcie->inta;
839

840
	if (iwl_have_debug_level(IWL_DL_ISR))
841
		IWL_DEBUG_ISR(trans, "inta 0x%08x, enabled 0x%08x\n",
842
			      inta, iwl_read32(trans, CSR_INT_MASK));
843

844 845
	/* saved interrupt in inta variable now we can reset trans_pcie->inta */
	trans_pcie->inta = 0;
846

J
Johannes Berg 已提交
847
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
848

849 850
	/* Now service all interrupt bits discovered above. */
	if (inta & CSR_INT_BIT_HW_ERR) {
851
		IWL_ERR(trans, "Hardware error detected.  Restarting.\n");
852 853

		/* Tell the device to stop sending interrupts */
854
		iwl_disable_interrupts(trans);
855

856
		isr_stats->hw++;
857
		iwl_pcie_irq_handle_error(trans);
858 859 860

		handled |= CSR_INT_BIT_HW_ERR;

861
		goto out;
862 863
	}

864
	if (iwl_have_debug_level(IWL_DL_ISR)) {
865 866
		/* NIC fires this, but we don't use it, redundant with WAKEUP */
		if (inta & CSR_INT_BIT_SCD) {
867 868
			IWL_DEBUG_ISR(trans,
				      "Scheduler finished to transmit the frame/frames.\n");
869
			isr_stats->sch++;
870 871 872 873
		}

		/* Alive notification via Rx interrupt will do the real work */
		if (inta & CSR_INT_BIT_ALIVE) {
874
			IWL_DEBUG_ISR(trans, "Alive interrupt\n");
875
			isr_stats->alive++;
876 877
		}
	}
878

879 880 881 882 883
	/* Safely ignore these bits for debug checks below */
	inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);

	/* HW RF KILL switch toggled */
	if (inta & CSR_INT_BIT_RF_KILL) {
884
		bool hw_rfkill;
885

886
		hw_rfkill = iwl_is_rfkill_set(trans);
887
		IWL_WARN(trans, "RF_KILL bit toggled to %s.\n",
888
			 hw_rfkill ? "disable radio" : "enable radio");
889

890
		isr_stats->rfkill++;
891

892
		iwl_op_mode_hw_rf_kill(trans->op_mode, hw_rfkill);
893
		if (hw_rfkill) {
894 895 896
			set_bit(STATUS_RFKILL, &trans->status);
			if (test_and_clear_bit(STATUS_SYNC_HCMD_ACTIVE,
					       &trans->status))
897 898 899 900
				IWL_DEBUG_RF_KILL(trans,
						  "Rfkill while SYNC HCMD in flight\n");
			wake_up(&trans_pcie->wait_command_queue);
		} else {
901
			clear_bit(STATUS_RFKILL, &trans->status);
902
		}
903 904 905 906 907 908

		handled |= CSR_INT_BIT_RF_KILL;
	}

	/* Chip got too hot and stopped itself */
	if (inta & CSR_INT_BIT_CT_KILL) {
909
		IWL_ERR(trans, "Microcode CT kill error detected.\n");
910
		isr_stats->ctkill++;
911 912 913 914 915
		handled |= CSR_INT_BIT_CT_KILL;
	}

	/* Error detected by uCode */
	if (inta & CSR_INT_BIT_SW_ERR) {
916
		IWL_ERR(trans, "Microcode SW error detected. "
917
			" Restarting 0x%X.\n", inta);
918
		isr_stats->sw++;
919
		iwl_pcie_irq_handle_error(trans);
920 921 922 923 924
		handled |= CSR_INT_BIT_SW_ERR;
	}

	/* uCode wakes up after power-down sleep */
	if (inta & CSR_INT_BIT_WAKEUP) {
925
		IWL_DEBUG_ISR(trans, "Wakeup interrupt\n");
926
		iwl_pcie_rxq_inc_wr_ptr(trans, &trans_pcie->rxq);
927
		for (i = 0; i < trans->cfg->base_params->num_of_queues; i++)
928
			iwl_pcie_txq_inc_wr_ptr(trans, &trans_pcie->txq[i]);
929

930
		isr_stats->wakeup++;
931 932 933 934 935 936 937 938

		handled |= CSR_INT_BIT_WAKEUP;
	}

	/* All uCode command responses, including Tx command responses,
	 * Rx "responses" (frame-received notification), and other
	 * notifications from uCode come through here*/
	if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
939
		    CSR_INT_BIT_RX_PERIODIC)) {
940
		IWL_DEBUG_ISR(trans, "Rx interrupt\n");
941 942
		if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
			handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
943
			iwl_write32(trans, CSR_FH_INT_STATUS,
944 945 946 947
					CSR_FH_INT_RX_MASK);
		}
		if (inta & CSR_INT_BIT_RX_PERIODIC) {
			handled |= CSR_INT_BIT_RX_PERIODIC;
948
			iwl_write32(trans,
949
				CSR_INT, CSR_INT_BIT_RX_PERIODIC);
950 951 952 953 954 955 956 957 958 959 960 961 962
		}
		/* Sending RX interrupt require many steps to be done in the
		 * the device:
		 * 1- write interrupt to current index in ICT table.
		 * 2- dma RX frame.
		 * 3- update RX shared data to indicate last write index.
		 * 4- send interrupt.
		 * This could lead to RX race, driver could receive RX interrupt
		 * but the shared data changes does not reflect this;
		 * periodic interrupt will detect any dangling Rx activity.
		 */

		/* Disable periodic interrupt; we use it as just a one-shot. */
963
		iwl_write8(trans, CSR_INT_PERIODIC_REG,
964
			    CSR_INT_PERIODIC_DIS);
965

966
		iwl_pcie_rx_handle(trans);
967

968 969 970 971 972 973 974 975
		/*
		 * Enable periodic interrupt in 8 msec only if we received
		 * real RX interrupt (instead of just periodic int), to catch
		 * any dangling Rx interrupt.  If it was just the periodic
		 * interrupt, there was no dangling Rx activity, and no need
		 * to extend the periodic interrupt; one-shot is enough.
		 */
		if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
976
			iwl_write8(trans, CSR_INT_PERIODIC_REG,
977
				   CSR_INT_PERIODIC_ENA);
978

979
		isr_stats->rx++;
980 981 982 983
	}

	/* This "Tx" DMA channel is used only for loading uCode */
	if (inta & CSR_INT_BIT_FH_TX) {
984
		iwl_write32(trans, CSR_FH_INT_STATUS, CSR_FH_INT_TX_MASK);
985
		IWL_DEBUG_ISR(trans, "uCode load interrupt\n");
986
		isr_stats->tx++;
987 988
		handled |= CSR_INT_BIT_FH_TX;
		/* Wake up uCode load routine, now that load is complete */
989 990
		trans_pcie->ucode_write_complete = true;
		wake_up(&trans_pcie->ucode_write_waitq);
991 992 993
	}

	if (inta & ~handled) {
994
		IWL_ERR(trans, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
995
		isr_stats->unhandled++;
996 997
	}

998 999 1000
	if (inta & ~(trans_pcie->inta_mask)) {
		IWL_WARN(trans, "Disabled INTA bits 0x%08x were pending\n",
			 inta & ~trans_pcie->inta_mask);
1001 1002 1003 1004
	}

	/* Re-enable all interrupts */
	/* only Re-enable if disabled by irq */
1005
	if (test_bit(STATUS_INT_ENABLED, &trans->status))
1006
		iwl_enable_interrupts(trans);
1007
	/* Re-enable RF_KILL if it occurred */
1008 1009
	else if (handled & CSR_INT_BIT_RF_KILL)
		iwl_enable_rfkill_int(trans);
1010 1011 1012 1013

out:
	lock_map_release(&trans->sync_cmd_lockdep_map);
	return IRQ_HANDLED;
1014 1015
}

1016 1017 1018 1019 1020
/******************************************************************************
 *
 * ICT functions
 *
 ******************************************************************************/
1021 1022 1023 1024 1025

/* a device (PCI-E) page is 4096 bytes long */
#define ICT_SHIFT	12
#define ICT_SIZE	(1 << ICT_SHIFT)
#define ICT_COUNT	(ICT_SIZE / sizeof(u32))
1026 1027

/* Free dram table */
1028
void iwl_pcie_free_ict(struct iwl_trans *trans)
1029
{
1030
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1031

1032
	if (trans_pcie->ict_tbl) {
1033
		dma_free_coherent(trans->dev, ICT_SIZE,
1034
				  trans_pcie->ict_tbl,
1035
				  trans_pcie->ict_tbl_dma);
1036 1037
		trans_pcie->ict_tbl = NULL;
		trans_pcie->ict_tbl_dma = 0;
1038 1039 1040
	}
}

1041 1042 1043
/*
 * allocate dram shared table, it is an aligned memory
 * block of ICT_SIZE.
1044 1045
 * also reset all data related to ICT table interrupt.
 */
1046
int iwl_pcie_alloc_ict(struct iwl_trans *trans)
1047
{
1048
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1049

1050
	trans_pcie->ict_tbl =
1051
		dma_zalloc_coherent(trans->dev, ICT_SIZE,
1052 1053 1054
				   &trans_pcie->ict_tbl_dma,
				   GFP_KERNEL);
	if (!trans_pcie->ict_tbl)
1055 1056
		return -ENOMEM;

1057 1058
	/* just an API sanity check ... it is guaranteed to be aligned */
	if (WARN_ON(trans_pcie->ict_tbl_dma & (ICT_SIZE - 1))) {
1059
		iwl_pcie_free_ict(trans);
1060 1061
		return -EINVAL;
	}
1062

1063 1064 1065
	IWL_DEBUG_ISR(trans, "ict dma addr %Lx ict vir addr %p\n",
		      (unsigned long long)trans_pcie->ict_tbl_dma,
		      trans_pcie->ict_tbl);
1066 1067 1068 1069 1070 1071 1072

	return 0;
}

/* Device is going up inform it about using ICT interrupt table,
 * also we need to tell the driver to start using ICT interrupt.
 */
1073
void iwl_pcie_reset_ict(struct iwl_trans *trans)
1074
{
1075
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1076 1077 1078
	u32 val;
	unsigned long flags;

1079
	if (!trans_pcie->ict_tbl)
1080
		return;
1081

J
Johannes Berg 已提交
1082
	spin_lock_irqsave(&trans_pcie->irq_lock, flags);
1083
	iwl_disable_interrupts(trans);
1084

1085
	memset(trans_pcie->ict_tbl, 0, ICT_SIZE);
1086

1087
	val = trans_pcie->ict_tbl_dma >> ICT_SHIFT;
1088 1089 1090 1091

	val |= CSR_DRAM_INT_TBL_ENABLE;
	val |= CSR_DRAM_INIT_TBL_WRAP_CHECK;

1092
	IWL_DEBUG_ISR(trans, "CSR_DRAM_INT_TBL_REG =0x%x\n", val);
1093

1094
	iwl_write32(trans, CSR_DRAM_INT_TBL_REG, val);
1095 1096
	trans_pcie->use_ict = true;
	trans_pcie->ict_index = 0;
1097
	iwl_write32(trans, CSR_INT, trans_pcie->inta_mask);
1098
	iwl_enable_interrupts(trans);
J
Johannes Berg 已提交
1099
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
1100 1101 1102
}

/* Device is going down disable ict interrupt usage */
1103
void iwl_pcie_disable_ict(struct iwl_trans *trans)
1104
{
1105
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1106 1107
	unsigned long flags;

J
Johannes Berg 已提交
1108
	spin_lock_irqsave(&trans_pcie->irq_lock, flags);
1109
	trans_pcie->use_ict = false;
J
Johannes Berg 已提交
1110
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
1111 1112
}

1113
/* legacy (non-ICT) ISR. Assumes that trans_pcie->irq_lock is held */
1114
static irqreturn_t iwl_pcie_isr(int irq, void *data)
1115
{
1116
	struct iwl_trans *trans = data;
1117
	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
1118
	u32 inta;
1119 1120 1121

	lockdep_assert_held(&trans_pcie->irq_lock);

1122
	trace_iwlwifi_dev_irq(trans->dev);
J
Johannes Berg 已提交
1123

1124 1125
	/* Disable (but don't clear!) interrupts here to avoid
	 *    back-to-back ISRs and sporadic interrupts from our NIC.
1126
	 * If we have something to service, the irq thread will re-enable ints.
1127
	 * If we *don't* have something, we'll re-enable before leaving here. */
1128
	iwl_write32(trans, CSR_INT_MASK, 0x00000000);
1129 1130

	/* Discover which interrupts are active/pending */
1131
	inta = iwl_read32(trans, CSR_INT);
1132

1133
	if (inta & (~trans_pcie->inta_mask)) {
1134 1135
		IWL_DEBUG_ISR(trans,
			      "We got a masked interrupt (0x%08x)...Ack and ignore\n",
1136 1137 1138
			      inta & (~trans_pcie->inta_mask));
		iwl_write32(trans, CSR_INT, inta & (~trans_pcie->inta_mask));
		inta &= trans_pcie->inta_mask;
1139 1140
	}

1141 1142 1143 1144
	/* Ignore interrupt if there's nothing in NIC to service.
	 * This may be due to IRQ shared with another device,
	 * or due to sporadic interrupts thrown from our NIC. */
	if (!inta) {
1145
		IWL_DEBUG_ISR(trans, "Ignore interrupt, inta == 0\n");
1146 1147 1148 1149 1150 1151
		/*
		 * Re-enable interrupts here since we don't have anything to
		 * service, but only in case the handler won't run. Note that
		 * the handler can be scheduled because of a previous
		 * interrupt.
		 */
1152
		if (test_bit(STATUS_INT_ENABLED, &trans->status) &&
1153 1154 1155
		    !trans_pcie->inta)
			iwl_enable_interrupts(trans);
		return IRQ_NONE;
1156 1157 1158 1159 1160
	}

	if ((inta == 0xFFFFFFFF) || ((inta & 0xFFFFFFF0) == 0xa5a5a5a0)) {
		/* Hardware disappeared. It might have already raised
		 * an interrupt */
1161
		IWL_WARN(trans, "HARDWARE GONE?? INTA == 0x%08x\n", inta);
1162
		return IRQ_HANDLED;
1163 1164
	}

1165 1166 1167
	if (iwl_have_debug_level(IWL_DL_ISR))
		IWL_DEBUG_ISR(trans,
			      "ISR inta 0x%08x, enabled 0x%08x, fh 0x%08x\n",
1168
			      inta, trans_pcie->inta_mask,
1169
			      iwl_read32(trans, CSR_FH_INT_STATUS));
1170

1171
	trans_pcie->inta |= inta;
1172
	/* the thread will service interrupts and re-enable them */
1173
	return IRQ_WAKE_THREAD;
1174 1175 1176 1177 1178 1179 1180 1181 1182 1183
}

/* interrupt handler using ict table, with this interrupt driver will
 * stop using INTA register to get device's interrupt, reading this register
 * is expensive, device will write interrupts in ICT dram table, increment
 * index then will fire interrupt to driver, driver will OR all ICT table
 * entries from current index up to table entry with 0 value. the result is
 * the interrupt we need to service, driver will set the entries back to 0 and
 * set index.
 */
1184
irqreturn_t iwl_pcie_isr_ict(int irq, void *data)
1185
{
1186 1187
	struct iwl_trans *trans = data;
	struct iwl_trans_pcie *trans_pcie;
1188
	u32 inta;
1189
	u32 val = 0;
J
Johannes Berg 已提交
1190
	u32 read;
1191
	unsigned long flags;
1192
	irqreturn_t ret = IRQ_NONE;
1193

1194
	if (!trans)
1195 1196
		return IRQ_NONE;

1197 1198
	trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);

1199 1200
	spin_lock_irqsave(&trans_pcie->irq_lock, flags);

1201 1202 1203
	/* dram interrupt table not set yet,
	 * use legacy interrupt.
	 */
1204
	if (unlikely(!trans_pcie->use_ict)) {
1205
		ret = iwl_pcie_isr(irq, data);
1206 1207 1208
		spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
		return ret;
	}
1209

1210
	trace_iwlwifi_dev_irq(trans->dev);
J
Johannes Berg 已提交
1211

1212 1213 1214 1215 1216
	/* Disable (but don't clear!) interrupts here to avoid
	 * back-to-back ISRs and sporadic interrupts from our NIC.
	 * If we have something to service, the tasklet will re-enable ints.
	 * If we *don't* have something, we'll re-enable before leaving here.
	 */
1217
	iwl_write32(trans, CSR_INT_MASK, 0x00000000);
1218 1219 1220 1221

	/* Ignore interrupt if there's nothing in NIC to service.
	 * This may be due to IRQ shared with another device,
	 * or due to sporadic interrupts thrown from our NIC. */
J
Johannes Berg 已提交
1222
	read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1223
	trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index, read);
J
Johannes Berg 已提交
1224
	if (!read) {
1225
		IWL_DEBUG_ISR(trans, "Ignore interrupt, inta == 0\n");
1226 1227 1228
		goto none;
	}

J
Johannes Berg 已提交
1229 1230 1231 1232 1233 1234
	/*
	 * Collect all entries up to the first 0, starting from ict_index;
	 * note we already read at ict_index.
	 */
	do {
		val |= read;
1235
		IWL_DEBUG_ISR(trans, "ICT index %d value 0x%08X\n",
J
Johannes Berg 已提交
1236
				trans_pcie->ict_index, read);
1237 1238 1239
		trans_pcie->ict_tbl[trans_pcie->ict_index] = 0;
		trans_pcie->ict_index =
			iwl_queue_inc_wrap(trans_pcie->ict_index, ICT_COUNT);
1240

J
Johannes Berg 已提交
1241
		read = le32_to_cpu(trans_pcie->ict_tbl[trans_pcie->ict_index]);
1242
		trace_iwlwifi_dev_ict_read(trans->dev, trans_pcie->ict_index,
J
Johannes Berg 已提交
1243 1244
					   read);
	} while (read);
1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260

	/* We should not get this value, just ignore it. */
	if (val == 0xffffffff)
		val = 0;

	/*
	 * this is a w/a for a h/w bug. the h/w bug may cause the Rx bit
	 * (bit 15 before shifting it to 31) to clear when using interrupt
	 * coalescing. fortunately, bits 18 and 19 stay set when this happens
	 * so we use them to decide on the real state of the Rx bit.
	 * In order words, bit 15 is set if bit 18 or bit 19 are set.
	 */
	if (val & 0xC0000)
		val |= 0x8000;

	inta = (0xff & val) | ((0xff00 & val) << 16);
1261 1262 1263 1264 1265
	IWL_DEBUG_ISR(trans, "ISR inta 0x%08x, enabled(sw) 0x%08x ict 0x%08x\n",
		      inta, trans_pcie->inta_mask, val);
	if (iwl_have_debug_level(IWL_DL_ISR))
		IWL_DEBUG_ISR(trans, "enabled(hw) 0x%08x\n",
			      iwl_read32(trans, CSR_INT_MASK));
1266

1267 1268
	inta &= trans_pcie->inta_mask;
	trans_pcie->inta |= inta;
1269

1270
	/* iwl_pcie_tasklet() will service interrupts and re-enable them */
1271 1272 1273
	if (likely(inta)) {
		spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
		return IRQ_WAKE_THREAD;
1274 1275
	}

1276
	ret = IRQ_HANDLED;
1277 1278 1279 1280 1281

 none:
	/* re-enable interrupts here since we don't have anything to service.
	 * only Re-enable if disabled by irq.
	 */
1282
	if (test_bit(STATUS_INT_ENABLED, &trans->status) &&
J
Johannes Berg 已提交
1283
	    !trans_pcie->inta)
1284
		iwl_enable_interrupts(trans);
1285

J
Johannes Berg 已提交
1286
	spin_unlock_irqrestore(&trans_pcie->irq_lock, flags);
1287
	return ret;
1288
}