dma.c 45.0 KB
Newer Older
1
/*
2
 * Intel I/OAT DMA Linux driver
3
 * Copyright(c) 2004 - 2009 Intel Corporation.
4 5
 *
 * This program is free software; you can redistribute it and/or modify it
6 7
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
8 9 10 11 12 13 14
 *
 * 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
15 16 17 18 19
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * The full GNU General Public License is included in this distribution in
 * the file called "COPYING".
20 21 22 23 24 25 26 27 28 29 30 31 32 33
 *
 */

/*
 * This driver supports an Intel I/OAT DMA engine, which does asynchronous
 * copy operations.
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/interrupt.h>
#include <linux/dmaengine.h>
#include <linux/delay.h>
34
#include <linux/dma-mapping.h>
35
#include <linux/workqueue.h>
36
#include <linux/i7300_idle.h>
D
Dan Williams 已提交
37 38 39
#include "dma.h"
#include "registers.h"
#include "hw.h"
40

41 42 43 44 45
static int ioat_pending_level = 4;
module_param(ioat_pending_level, int, 0644);
MODULE_PARM_DESC(ioat_pending_level,
		 "high-water mark for pushing ioat descriptors (default: 4)");

46 47 48
static void ioat_dma_chan_reset_part2(struct work_struct *work);
static void ioat_dma_chan_watchdog(struct work_struct *work);

49
/* internal functions */
50 51
static void ioat_dma_start_null_desc(struct ioat_dma_chan *ioat);
static void ioat_dma_memcpy_cleanup(struct ioat_dma_chan *ioat);
52 53

static struct ioat_desc_sw *
54
ioat1_dma_get_next_descriptor(struct ioat_dma_chan *ioat);
55
static struct ioat_desc_sw *
56
ioat2_dma_get_next_descriptor(struct ioat_dma_chan *ioat);
57

58
static inline struct ioat_chan_common *
59
ioat_chan_by_index(struct ioatdma_device *device, int index)
60 61 62 63 64 65 66 67 68 69 70 71
{
	return device->idx[index];
}

/**
 * ioat_dma_do_interrupt - handler used for single vector interrupt mode
 * @irq: interrupt id
 * @data: interrupt data
 */
static irqreturn_t ioat_dma_do_interrupt(int irq, void *data)
{
	struct ioatdma_device *instance = data;
72
	struct ioat_chan_common *chan;
73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
	unsigned long attnstatus;
	int bit;
	u8 intrctrl;

	intrctrl = readb(instance->reg_base + IOAT_INTRCTRL_OFFSET);

	if (!(intrctrl & IOAT_INTRCTRL_MASTER_INT_EN))
		return IRQ_NONE;

	if (!(intrctrl & IOAT_INTRCTRL_INT_STATUS)) {
		writeb(intrctrl, instance->reg_base + IOAT_INTRCTRL_OFFSET);
		return IRQ_NONE;
	}

	attnstatus = readl(instance->reg_base + IOAT_ATTNSTATUS_OFFSET);
	for_each_bit(bit, &attnstatus, BITS_PER_LONG) {
89 90
		chan = ioat_chan_by_index(instance, bit);
		tasklet_schedule(&chan->cleanup_task);
91 92 93 94 95 96 97 98 99 100 101 102 103
	}

	writeb(intrctrl, instance->reg_base + IOAT_INTRCTRL_OFFSET);
	return IRQ_HANDLED;
}

/**
 * ioat_dma_do_interrupt_msix - handler used for vector-per-channel interrupt mode
 * @irq: interrupt id
 * @data: interrupt data
 */
static irqreturn_t ioat_dma_do_interrupt_msix(int irq, void *data)
{
104
	struct ioat_chan_common *chan = data;
105

106
	tasklet_schedule(&chan->cleanup_task);
107 108 109 110 111 112 113 114 115 116

	return IRQ_HANDLED;
}

static void ioat_dma_cleanup_tasklet(unsigned long data);

/**
 * ioat_dma_enumerate_channels - find and initialize the device's channels
 * @device: the device to be enumerated
 */
117
static int ioat_dma_enumerate_channels(struct ioatdma_device *device)
118 119 120 121
{
	u8 xfercap_scale;
	u32 xfercap;
	int i;
122 123
	struct ioat_chan_common *chan;
	struct ioat_dma_chan *ioat;
124
	struct device *dev = &device->pdev->dev;
125
	struct dma_device *dma = &device->common;
126

127 128
	INIT_LIST_HEAD(&dma->channels);
	dma->chancnt = readb(device->reg_base + IOAT_CHANCNT_OFFSET);
129
	xfercap_scale = readb(device->reg_base + IOAT_XFERCAP_OFFSET);
130 131
	xfercap = (xfercap_scale == 0 ? -1 : (1UL << xfercap_scale));

132
#ifdef  CONFIG_I7300_IDLE_IOAT_CHANNEL
133 134
	if (i7300_idle_platform_probe(NULL, NULL, 1) == 0)
		dma->chancnt--;
A
Andy Henroid 已提交
135
#endif
136
	for (i = 0; i < dma->chancnt; i++) {
137 138
		ioat = devm_kzalloc(dev, sizeof(*ioat), GFP_KERNEL);
		if (!ioat) {
139
			dma->chancnt = i;
140 141 142
			break;
		}

143 144 145 146 147 148 149 150 151 152
		chan = &ioat->base;
		chan->device = device;
		chan->reg_base = device->reg_base + (0x80 * (i + 1));
		ioat->xfercap = xfercap;
		ioat->desccount = 0;
		INIT_DELAYED_WORK(&chan->work, ioat_dma_chan_reset_part2);
		spin_lock_init(&chan->cleanup_lock);
		spin_lock_init(&ioat->desc_lock);
		INIT_LIST_HEAD(&ioat->free_desc);
		INIT_LIST_HEAD(&ioat->used_desc);
153
		/* This should be made common somewhere in dmaengine.c */
154 155 156 157
		chan->common.device = &device->common;
		list_add_tail(&chan->common.device_node, &dma->channels);
		device->idx[i] = chan;
		tasklet_init(&chan->cleanup_task,
158
			     ioat_dma_cleanup_tasklet,
159 160
			     (unsigned long) ioat);
		tasklet_disable(&chan->cleanup_task);
161
	}
162
	return dma->chancnt;
163 164
}

S
Shannon Nelson 已提交
165 166 167 168 169
/**
 * ioat_dma_memcpy_issue_pending - push potentially unrecognized appended
 *                                 descriptors to hw
 * @chan: DMA channel handle
 */
170
static inline void
171
__ioat1_dma_memcpy_issue_pending(struct ioat_dma_chan *ioat)
S
Shannon Nelson 已提交
172
{
173 174 175 176
	void __iomem *reg_base = ioat->base.reg_base;

	ioat->pending = 0;
	writeb(IOAT_CHANCMD_APPEND, reg_base + IOAT1_CHANCMD_OFFSET);
S
Shannon Nelson 已提交
177 178 179 180
}

static void ioat1_dma_memcpy_issue_pending(struct dma_chan *chan)
{
181
	struct ioat_dma_chan *ioat = to_ioat_chan(chan);
S
Shannon Nelson 已提交
182

183 184 185 186
	if (ioat->pending > 0) {
		spin_lock_bh(&ioat->desc_lock);
		__ioat1_dma_memcpy_issue_pending(ioat);
		spin_unlock_bh(&ioat->desc_lock);
S
Shannon Nelson 已提交
187 188 189
	}
}

190
static inline void
191
__ioat2_dma_memcpy_issue_pending(struct ioat_dma_chan *ioat)
S
Shannon Nelson 已提交
192
{
193 194 195 196
	void __iomem *reg_base = ioat->base.reg_base;

	ioat->pending = 0;
	writew(ioat->dmacount, reg_base + IOAT_CHAN_DMACOUNT_OFFSET);
S
Shannon Nelson 已提交
197 198 199 200
}

static void ioat2_dma_memcpy_issue_pending(struct dma_chan *chan)
{
201
	struct ioat_dma_chan *ioat = to_ioat_chan(chan);
S
Shannon Nelson 已提交
202

203 204 205 206
	if (ioat->pending > 0) {
		spin_lock_bh(&ioat->desc_lock);
		__ioat2_dma_memcpy_issue_pending(ioat);
		spin_unlock_bh(&ioat->desc_lock);
S
Shannon Nelson 已提交
207 208
	}
}
209

210 211 212 213 214 215

/**
 * ioat_dma_chan_reset_part2 - reinit the channel after a reset
 */
static void ioat_dma_chan_reset_part2(struct work_struct *work)
{
216 217
	struct ioat_chan_common *chan;
	struct ioat_dma_chan *ioat;
218 219
	struct ioat_desc_sw *desc;

220 221 222 223
	chan = container_of(work, struct ioat_chan_common, work.work);
	ioat = container_of(chan, struct ioat_dma_chan, base);
	spin_lock_bh(&chan->cleanup_lock);
	spin_lock_bh(&ioat->desc_lock);
224

225 226 227
	chan->completion_virt->low = 0;
	chan->completion_virt->high = 0;
	ioat->pending = 0;
228 229 230 231 232

	/*
	 * count the descriptors waiting, and be sure to do it
	 * right for both the CB1 line and the CB2 ring
	 */
233 234 235
	ioat->dmacount = 0;
	if (ioat->used_desc.prev) {
		desc = to_ioat_desc(ioat->used_desc.prev);
236
		do {
237
			ioat->dmacount++;
238
			desc = to_ioat_desc(desc->node.next);
239
		} while (&desc->node != ioat->used_desc.next);
240 241 242 243 244 245
	}

	/*
	 * write the new starting descriptor address
	 * this puts channel engine into ARMED state
	 */
246 247
	desc = to_ioat_desc(ioat->used_desc.prev);
	switch (chan->device->version) {
248
	case IOAT_VER_1_2:
249
		writel(((u64) desc->txd.phys) & 0x00000000FFFFFFFF,
250
		       chan->reg_base + IOAT1_CHAINADDR_OFFSET_LOW);
251
		writel(((u64) desc->txd.phys) >> 32,
252
		       chan->reg_base + IOAT1_CHAINADDR_OFFSET_HIGH);
253

254 255
		writeb(IOAT_CHANCMD_START, chan->reg_base
			+ IOAT_CHANCMD_OFFSET(chan->device->version));
256 257
		break;
	case IOAT_VER_2_0:
258
		writel(((u64) desc->txd.phys) & 0x00000000FFFFFFFF,
259
		       chan->reg_base + IOAT2_CHAINADDR_OFFSET_LOW);
260
		writel(((u64) desc->txd.phys) >> 32,
261
		       chan->reg_base + IOAT2_CHAINADDR_OFFSET_HIGH);
262 263

		/* tell the engine to go with what's left to be done */
264 265
		writew(ioat->dmacount,
		       chan->reg_base + IOAT_CHAN_DMACOUNT_OFFSET);
266 267 268

		break;
	}
269
	dev_err(to_dev(chan),
270
		"chan%d reset - %d descs waiting, %d total desc\n",
271
		chan_num(chan), ioat->dmacount, ioat->desccount);
272

273 274
	spin_unlock_bh(&ioat->desc_lock);
	spin_unlock_bh(&chan->cleanup_lock);
275 276 277 278
}

/**
 * ioat_dma_reset_channel - restart a channel
279
 * @ioat: IOAT DMA channel handle
280
 */
281
static void ioat_dma_reset_channel(struct ioat_dma_chan *ioat)
282
{
283 284
	struct ioat_chan_common *chan = &ioat->base;
	void __iomem *reg_base = chan->reg_base;
285 286
	u32 chansts, chanerr;

287
	if (!ioat->used_desc.prev)
288 289
		return;

290 291
	chanerr = readl(reg_base + IOAT_CHANERR_OFFSET);
	chansts = (chan->completion_virt->low
292 293
					& IOAT_CHANSTS_DMA_TRANSFER_STATUS);
	if (chanerr) {
294
		dev_err(to_dev(chan),
295
			"chan%d, CHANSTS = 0x%08x CHANERR = 0x%04x, clearing\n",
296 297
			chan_num(chan), chansts, chanerr);
		writel(chanerr, reg_base + IOAT_CHANERR_OFFSET);
298 299 300 301 302 303 304 305 306 307
	}

	/*
	 * whack it upside the head with a reset
	 * and wait for things to settle out.
	 * force the pending count to a really big negative
	 * to make sure no one forces an issue_pending
	 * while we're waiting.
	 */

308 309
	spin_lock_bh(&ioat->desc_lock);
	ioat->pending = INT_MIN;
310
	writeb(IOAT_CHANCMD_RESET,
311 312
	       reg_base + IOAT_CHANCMD_OFFSET(chan->device->version));
	spin_unlock_bh(&ioat->desc_lock);
313 314

	/* schedule the 2nd half instead of sleeping a long time */
315
	schedule_delayed_work(&chan->work, RESET_DELAY);
316 317 318 319 320 321 322 323 324
}

/**
 * ioat_dma_chan_watchdog - watch for stuck channels
 */
static void ioat_dma_chan_watchdog(struct work_struct *work)
{
	struct ioatdma_device *device =
		container_of(work, struct ioatdma_device, work.work);
325 326
	struct ioat_dma_chan *ioat;
	struct ioat_chan_common *chan;
327 328 329 330 331 332 333 334 335 336 337 338
	int i;

	union {
		u64 full;
		struct {
			u32 low;
			u32 high;
		};
	} completion_hw;
	unsigned long compl_desc_addr_hw;

	for (i = 0; i < device->common.chancnt; i++) {
339 340
		chan = ioat_chan_by_index(device, i);
		ioat = container_of(chan, struct ioat_dma_chan, base);
341

342
		if (chan->device->version == IOAT_VER_1_2
343
			/* have we started processing anything yet */
344
		    && chan->last_completion
345
			/* have we completed any since last watchdog cycle? */
346
		    && (chan->last_completion == chan->watchdog_completion)
347
			/* has TCP stuck on one cookie since last watchdog? */
348 349
		    && (chan->watchdog_tcp_cookie == chan->watchdog_last_tcp_cookie)
		    && (chan->watchdog_tcp_cookie != chan->completed_cookie)
350 351
			/* is there something in the chain to be processed? */
			/* CB1 chain always has at least the last one processed */
352 353
		    && (ioat->used_desc.prev != ioat->used_desc.next)
		    && ioat->pending == 0) {
354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369

			/*
			 * check CHANSTS register for completed
			 * descriptor address.
			 * if it is different than completion writeback,
			 * it is not zero
			 * and it has changed since the last watchdog
			 *     we can assume that channel
			 *     is still working correctly
			 *     and the problem is in completion writeback.
			 *     update completion writeback
			 *     with actual CHANSTS value
			 * else
			 *     try resetting the channel
			 */

370 371 372 373
			completion_hw.low = readl(chan->reg_base +
				IOAT_CHANSTS_OFFSET_LOW(chan->device->version));
			completion_hw.high = readl(chan->reg_base +
				IOAT_CHANSTS_OFFSET_HIGH(chan->device->version));
374 375 376 377 378 379 380 381 382 383
#if (BITS_PER_LONG == 64)
			compl_desc_addr_hw =
				completion_hw.full
				& IOAT_CHANSTS_COMPLETED_DESCRIPTOR_ADDR;
#else
			compl_desc_addr_hw =
				completion_hw.low & IOAT_LOW_COMPLETION_MASK;
#endif

			if ((compl_desc_addr_hw != 0)
384 385 386 387 388
			   && (compl_desc_addr_hw != chan->watchdog_completion)
			   && (compl_desc_addr_hw != chan->last_compl_desc_addr_hw)) {
				chan->last_compl_desc_addr_hw = compl_desc_addr_hw;
				chan->completion_virt->low = completion_hw.low;
				chan->completion_virt->high = completion_hw.high;
389
			} else {
390 391 392
				ioat_dma_reset_channel(ioat);
				chan->watchdog_completion = 0;
				chan->last_compl_desc_addr_hw = 0;
393 394 395 396 397 398 399 400 401 402
			}

		/*
		 * for version 2.0 if there are descriptors yet to be processed
		 * and the last completed hasn't changed since the last watchdog
		 *      if they haven't hit the pending level
		 *          issue the pending to push them through
		 *      else
		 *          try resetting the channel
		 */
403 404 405 406
		} else if (chan->device->version == IOAT_VER_2_0
		    && ioat->used_desc.prev
		    && chan->last_completion
		    && chan->last_completion == chan->watchdog_completion) {
407

408 409
			if (ioat->pending < ioat_pending_level)
				ioat2_dma_memcpy_issue_pending(&chan->common);
410
			else {
411 412
				ioat_dma_reset_channel(ioat);
				chan->watchdog_completion = 0;
413 414
			}
		} else {
415 416
			chan->last_compl_desc_addr_hw = 0;
			chan->watchdog_completion = chan->last_completion;
417
		}
418
		chan->watchdog_last_tcp_cookie = chan->watchdog_tcp_cookie;
419 420 421 422 423
	}

	schedule_delayed_work(&device->work, WATCHDOG_DELAY);
}

424
static dma_cookie_t ioat1_tx_submit(struct dma_async_tx_descriptor *tx)
425
{
426 427
	struct dma_chan *c = tx->chan;
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
428 429 430
	struct ioat_desc_sw *desc = tx_to_ioat_desc(tx);
	struct ioat_desc_sw *first;
	struct ioat_desc_sw *chain_tail;
431 432
	dma_cookie_t cookie;

433
	spin_lock_bh(&ioat->desc_lock);
434
	/* cookie incr and addition to used_list must be atomic */
435
	cookie = c->cookie;
436 437 438
	cookie++;
	if (cookie < 0)
		cookie = 1;
439 440
	c->cookie = cookie;
	tx->cookie = cookie;
441 442

	/* write address into NextDescriptor field of last desc in chain */
443
	first = to_ioat_desc(tx->tx_list.next);
444
	chain_tail = to_ioat_desc(ioat->used_desc.prev);
445 446 447
	/* make descriptor updates globally visible before chaining */
	wmb();
	chain_tail->hw->next = first->txd.phys;
448
	list_splice_tail_init(&tx->tx_list, &ioat->used_desc);
449

450 451 452 453 454
	ioat->dmacount += desc->tx_cnt;
	ioat->pending += desc->tx_cnt;
	if (ioat->pending >= ioat_pending_level)
		__ioat1_dma_memcpy_issue_pending(ioat);
	spin_unlock_bh(&ioat->desc_lock);
455

456 457 458 459 460
	return cookie;
}

static dma_cookie_t ioat2_tx_submit(struct dma_async_tx_descriptor *tx)
{
461
	struct ioat_dma_chan *ioat = to_ioat_chan(tx->chan);
462 463 464 465 466 467 468
	struct ioat_desc_sw *first = tx_to_ioat_desc(tx);
	struct ioat_desc_sw *new;
	struct ioat_dma_descriptor *hw;
	dma_cookie_t cookie;
	u32 copy;
	size_t len;
	dma_addr_t src, dst;
469
	unsigned long orig_flags;
470 471 472 473 474 475
	unsigned int desc_count = 0;

	/* src and dest and len are stored in the initial descriptor */
	len = first->len;
	src = first->src;
	dst = first->dst;
476
	orig_flags = first->txd.flags;
477 478
	new = first;

S
Shannon Nelson 已提交
479
	/*
480
	 * ioat->desc_lock is still in force in version 2 path
S
Shannon Nelson 已提交
481 482
	 * it gets unlocked at end of this function
	 */
483
	do {
484
		copy = min_t(size_t, len, ioat->xfercap);
485

486
		async_tx_ack(&new->txd);
487 488 489 490 491 492 493 494 495 496 497

		hw = new->hw;
		hw->size = copy;
		hw->ctl = 0;
		hw->src_addr = src;
		hw->dst_addr = dst;

		len -= copy;
		dst += copy;
		src += copy;
		desc_count++;
498
	} while (len && (new = ioat2_dma_get_next_descriptor(ioat)));
499

500
	if (!new) {
501 502
		dev_err(to_dev(&ioat->base), "tx submit failed\n");
		spin_unlock_bh(&ioat->desc_lock);
503 504 505
		return -ENOMEM;
	}

506
	hw->ctl_f.compl_write = 1;
507
	if (first->txd.callback) {
508
		hw->ctl_f.int_en = 1;
509 510
		if (first != new) {
			/* move callback into to last desc */
511 512 513 514 515
			new->txd.callback = first->txd.callback;
			new->txd.callback_param
					= first->txd.callback_param;
			first->txd.callback = NULL;
			first->txd.callback_param = NULL;
516 517 518 519
		}
	}

	new->tx_cnt = desc_count;
520
	new->txd.flags = orig_flags; /* client is in control of this ack */
521 522 523 524 525 526 527 528 529

	/* store the original values for use in later cleanup */
	if (new != first) {
		new->src = first->src;
		new->dst = first->dst;
		new->len = first->len;
	}

	/* cookie incr and addition to used_list must be atomic */
530
	cookie = ioat->base.common.cookie;
531 532 533
	cookie++;
	if (cookie < 0)
		cookie = 1;
534
	ioat->base.common.cookie = new->txd.cookie = cookie;
535

536 537 538 539 540
	ioat->dmacount += desc_count;
	ioat->pending += desc_count;
	if (ioat->pending >= ioat_pending_level)
		__ioat2_dma_memcpy_issue_pending(ioat);
	spin_unlock_bh(&ioat->desc_lock);
S
Shannon Nelson 已提交
541

542 543 544
	return cookie;
}

545 546
/**
 * ioat_dma_alloc_descriptor - allocate and return a sw and hw descriptor pair
547
 * @ioat: the channel supplying the memory pool for the descriptors
548 549
 * @flags: allocation flags
 */
550
static struct ioat_desc_sw *
551
ioat_dma_alloc_descriptor(struct ioat_dma_chan *ioat, gfp_t flags)
552 553 554
{
	struct ioat_dma_descriptor *desc;
	struct ioat_desc_sw *desc_sw;
555
	struct ioatdma_device *ioatdma_device;
556 557
	dma_addr_t phys;

558
	ioatdma_device = ioat->base.device;
559
	desc = pci_pool_alloc(ioatdma_device->dma_pool, flags, &phys);
560 561 562 563 564
	if (unlikely(!desc))
		return NULL;

	desc_sw = kzalloc(sizeof(*desc_sw), flags);
	if (unlikely(!desc_sw)) {
565
		pci_pool_free(ioatdma_device->dma_pool, desc, phys);
566 567 568 569
		return NULL;
	}

	memset(desc, 0, sizeof(*desc));
570 571
	dma_async_tx_descriptor_init(&desc_sw->txd, &ioat->base.common);
	switch (ioatdma_device->version) {
572
	case IOAT_VER_1_2:
573
		desc_sw->txd.tx_submit = ioat1_tx_submit;
574 575
		break;
	case IOAT_VER_2_0:
576
	case IOAT_VER_3_0:
577
		desc_sw->txd.tx_submit = ioat2_tx_submit;
578 579 580
		break;
	}

581
	desc_sw->hw = desc;
582
	desc_sw->txd.phys = phys;
583 584 585 586

	return desc_sw;
}

587 588 589 590 591 592 593
static int ioat_initial_desc_count = 256;
module_param(ioat_initial_desc_count, int, 0644);
MODULE_PARM_DESC(ioat_initial_desc_count,
		 "initial descriptors per channel (default: 256)");

/**
 * ioat2_dma_massage_chan_desc - link the descriptors into a circle
594
 * @ioat: the channel to be massaged
595
 */
596
static void ioat2_dma_massage_chan_desc(struct ioat_dma_chan *ioat)
597 598 599 600
{
	struct ioat_desc_sw *desc, *_desc;

	/* setup used_desc */
601 602
	ioat->used_desc.next = ioat->free_desc.next;
	ioat->used_desc.prev = NULL;
603 604 605 606

	/* pull free_desc out of the circle so that every node is a hw
	 * descriptor, but leave it pointing to the list
	 */
607 608
	ioat->free_desc.prev->next = ioat->free_desc.next;
	ioat->free_desc.next->prev = ioat->free_desc.prev;
609 610

	/* circle link the hw descriptors */
611
	desc = to_ioat_desc(ioat->free_desc.next);
612
	desc->hw->next = to_ioat_desc(desc->node.next)->txd.phys;
613
	list_for_each_entry_safe(desc, _desc, ioat->free_desc.next, node) {
614
		desc->hw->next = to_ioat_desc(desc->node.next)->txd.phys;
615 616 617 618 619 620 621
	}
}

/**
 * ioat_dma_alloc_chan_resources - returns the number of allocated descriptors
 * @chan: the channel to be filled out
 */
622
static int ioat_dma_alloc_chan_resources(struct dma_chan *c)
623
{
624 625
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
	struct ioat_chan_common *chan = &ioat->base;
S
Shannon Nelson 已提交
626
	struct ioat_desc_sw *desc;
627 628 629 630 631
	u16 chanctrl;
	u32 chanerr;
	int i;
	LIST_HEAD(tmp_list);

632
	/* have we already been set up? */
633 634
	if (!list_empty(&ioat->free_desc))
		return ioat->desccount;
635

636
	/* Setup register to interrupt and write completion status on error */
637
	chanctrl = IOAT_CHANCTRL_ERR_INT_EN |
638 639
		IOAT_CHANCTRL_ANY_ERR_ABORT_EN |
		IOAT_CHANCTRL_ERR_COMPLETION_EN;
640
	writew(chanctrl, chan->reg_base + IOAT_CHANCTRL_OFFSET);
641

642
	chanerr = readl(chan->reg_base + IOAT_CHANERR_OFFSET);
643
	if (chanerr) {
644 645
		dev_err(to_dev(chan), "CHANERR = %x, clearing\n", chanerr);
		writel(chanerr, chan->reg_base + IOAT_CHANERR_OFFSET);
646 647 648
	}

	/* Allocate descriptors */
649
	for (i = 0; i < ioat_initial_desc_count; i++) {
650
		desc = ioat_dma_alloc_descriptor(ioat, GFP_KERNEL);
651
		if (!desc) {
652
			dev_err(to_dev(chan), "Only %d initial descriptors\n", i);
653 654 655 656
			break;
		}
		list_add_tail(&desc->node, &tmp_list);
	}
657 658 659 660 661 662
	spin_lock_bh(&ioat->desc_lock);
	ioat->desccount = i;
	list_splice(&tmp_list, &ioat->free_desc);
	if (chan->device->version != IOAT_VER_1_2)
		ioat2_dma_massage_chan_desc(ioat);
	spin_unlock_bh(&ioat->desc_lock);
663 664 665

	/* allocate a completion writeback area */
	/* doing 2 32bit writes to mmio since 1 64b write doesn't work */
666 667 668 669 670 671 672 673 674 675 676 677 678
	chan->completion_virt = pci_pool_alloc(chan->device->completion_pool,
					       GFP_KERNEL,
					       &chan->completion_addr);
	memset(chan->completion_virt, 0,
	       sizeof(*chan->completion_virt));
	writel(((u64) chan->completion_addr) & 0x00000000FFFFFFFF,
	       chan->reg_base + IOAT_CHANCMP_OFFSET_LOW);
	writel(((u64) chan->completion_addr) >> 32,
	       chan->reg_base + IOAT_CHANCMP_OFFSET_HIGH);

	tasklet_enable(&chan->cleanup_task);
	ioat_dma_start_null_desc(ioat);  /* give chain to dma device */
	return ioat->desccount;
679 680
}

681 682 683 684
/**
 * ioat_dma_free_chan_resources - release all the descriptors
 * @chan: the channel to be cleaned
 */
685
static void ioat_dma_free_chan_resources(struct dma_chan *c)
686
{
687 688 689
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
	struct ioat_chan_common *chan = &ioat->base;
	struct ioatdma_device *ioatdma_device = chan->device;
690 691 692
	struct ioat_desc_sw *desc, *_desc;
	int in_use_descs = 0;

693 694 695
	/* Before freeing channel resources first check
	 * if they have been previously allocated for this channel.
	 */
696
	if (ioat->desccount == 0)
697 698
		return;

699 700
	tasklet_disable(&chan->cleanup_task);
	ioat_dma_memcpy_cleanup(ioat);
701

702 703 704
	/* Delay 100ms after reset to allow internal DMA logic to quiesce
	 * before removing DMA descriptor resources.
	 */
705
	writeb(IOAT_CHANCMD_RESET,
706
	       chan->reg_base + IOAT_CHANCMD_OFFSET(chan->device->version));
707
	mdelay(100);
708

709 710
	spin_lock_bh(&ioat->desc_lock);
	switch (chan->device->version) {
711 712
	case IOAT_VER_1_2:
		list_for_each_entry_safe(desc, _desc,
713
					 &ioat->used_desc, node) {
714 715 716
			in_use_descs++;
			list_del(&desc->node);
			pci_pool_free(ioatdma_device->dma_pool, desc->hw,
717
				      desc->txd.phys);
718 719 720
			kfree(desc);
		}
		list_for_each_entry_safe(desc, _desc,
721
					 &ioat->free_desc, node) {
722 723
			list_del(&desc->node);
			pci_pool_free(ioatdma_device->dma_pool, desc->hw,
724
				      desc->txd.phys);
725 726 727 728
			kfree(desc);
		}
		break;
	case IOAT_VER_2_0:
729
	case IOAT_VER_3_0:
730
		list_for_each_entry_safe(desc, _desc,
731
					 ioat->free_desc.next, node) {
732 733
			list_del(&desc->node);
			pci_pool_free(ioatdma_device->dma_pool, desc->hw,
734
				      desc->txd.phys);
735 736
			kfree(desc);
		}
737
		desc = to_ioat_desc(ioat->free_desc.next);
738
		pci_pool_free(ioatdma_device->dma_pool, desc->hw,
739
			      desc->txd.phys);
740
		kfree(desc);
741 742
		INIT_LIST_HEAD(&ioat->free_desc);
		INIT_LIST_HEAD(&ioat->used_desc);
743
		break;
744
	}
745
	spin_unlock_bh(&ioat->desc_lock);
746

747
	pci_pool_free(ioatdma_device->completion_pool,
748 749
		      chan->completion_virt,
		      chan->completion_addr);
750 751 752

	/* one is ok since we left it on there on purpose */
	if (in_use_descs > 1)
753
		dev_err(to_dev(chan), "Freeing %d in use descriptors!\n",
754 755
			in_use_descs - 1);

756 757 758 759 760 761 762
	chan->last_completion = chan->completion_addr = 0;
	chan->watchdog_completion = 0;
	chan->last_compl_desc_addr_hw = 0;
	chan->watchdog_tcp_cookie = chan->watchdog_last_tcp_cookie = 0;
	ioat->pending = 0;
	ioat->dmacount = 0;
	ioat->desccount = 0;
763
}
764

765
/**
766 767
 * ioat1_dma_get_next_descriptor - return the next available descriptor
 * @ioat: IOAT DMA channel handle
768 769 770 771 772
 *
 * Gets the next descriptor from the chain, and must be called with the
 * channel's desc_lock held.  Allocates more descriptors if the channel
 * has run out.
 */
773
static struct ioat_desc_sw *
774
ioat1_dma_get_next_descriptor(struct ioat_dma_chan *ioat)
775
{
S
Shannon Nelson 已提交
776
	struct ioat_desc_sw *new;
777

778 779
	if (!list_empty(&ioat->free_desc)) {
		new = to_ioat_desc(ioat->free_desc.next);
780 781 782
		list_del(&new->node);
	} else {
		/* try to get another desc */
783
		new = ioat_dma_alloc_descriptor(ioat, GFP_ATOMIC);
S
Shannon Nelson 已提交
784
		if (!new) {
785
			dev_err(to_dev(&ioat->base), "alloc failed\n");
S
Shannon Nelson 已提交
786 787
			return NULL;
		}
788 789 790 791
	}

	prefetch(new->hw);
	return new;
792 793
}

794
static struct ioat_desc_sw *
795
ioat2_dma_get_next_descriptor(struct ioat_dma_chan *ioat)
796
{
S
Shannon Nelson 已提交
797
	struct ioat_desc_sw *new;
798 799 800 801 802 803 804 805 806 807

	/*
	 * used.prev points to where to start processing
	 * used.next points to next free descriptor
	 * if used.prev == NULL, there are none waiting to be processed
	 * if used.next == used.prev.prev, there is only one free descriptor,
	 *      and we need to use it to as a noop descriptor before
	 *      linking in a new set of descriptors, since the device
	 *      has probably already read the pointer to it
	 */
808 809
	if (ioat->used_desc.prev &&
	    ioat->used_desc.next == ioat->used_desc.prev->prev) {
810

S
Shannon Nelson 已提交
811 812
		struct ioat_desc_sw *desc;
		struct ioat_desc_sw *noop_desc;
813 814 815
		int i;

		/* set up the noop descriptor */
816
		noop_desc = to_ioat_desc(ioat->used_desc.next);
817 818
		/* set size to non-zero value (channel returns error when size is 0) */
		noop_desc->hw->size = NULL_DESC_BUFFER_SIZE;
819 820
		noop_desc->hw->ctl = 0;
		noop_desc->hw->ctl_f.null = 1;
821 822 823
		noop_desc->hw->src_addr = 0;
		noop_desc->hw->dst_addr = 0;

824 825 826
		ioat->used_desc.next = ioat->used_desc.next->next;
		ioat->pending++;
		ioat->dmacount++;
827

S
Shannon Nelson 已提交
828
		/* try to get a few more descriptors */
829
		for (i = 16; i; i--) {
830
			desc = ioat_dma_alloc_descriptor(ioat, GFP_ATOMIC);
S
Shannon Nelson 已提交
831
			if (!desc) {
832 833
				dev_err(to_dev(&ioat->base),
					"alloc failed\n");
S
Shannon Nelson 已提交
834 835
				break;
			}
836
			list_add_tail(&desc->node, ioat->used_desc.next);
837 838

			desc->hw->next
839
				= to_ioat_desc(desc->node.next)->txd.phys;
840
			to_ioat_desc(desc->node.prev)->hw->next
841
				= desc->txd.phys;
842
			ioat->desccount++;
843 844
		}

845
		ioat->used_desc.next = noop_desc->node.next;
846
	}
847
	new = to_ioat_desc(ioat->used_desc.next);
848
	prefetch(new);
849
	ioat->used_desc.next = new->node.next;
850

851 852
	if (ioat->used_desc.prev == NULL)
		ioat->used_desc.prev = &new->node;
853 854 855 856 857

	prefetch(new->hw);
	return new;
}

858
static struct ioat_desc_sw *
859
ioat_dma_get_next_descriptor(struct ioat_dma_chan *ioat)
860
{
861
	if (!ioat)
862 863
		return NULL;

864
	switch (ioat->base.device->version) {
865
	case IOAT_VER_1_2:
866
		return ioat1_dma_get_next_descriptor(ioat);
867
	case IOAT_VER_2_0:
868
	case IOAT_VER_3_0:
869
		return ioat2_dma_get_next_descriptor(ioat);
870 871 872 873
	}
	return NULL;
}

874
static struct dma_async_tx_descriptor *
875
ioat1_dma_prep_memcpy(struct dma_chan *c, dma_addr_t dma_dest,
876
		      dma_addr_t dma_src, size_t len, unsigned long flags)
877
{
878
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
879 880 881 882 883 884 885 886
	struct ioat_desc_sw *desc;
	size_t copy;
	LIST_HEAD(chain);
	dma_addr_t src = dma_src;
	dma_addr_t dest = dma_dest;
	size_t total_len = len;
	struct ioat_dma_descriptor *hw = NULL;
	int tx_cnt = 0;
887

888 889
	spin_lock_bh(&ioat->desc_lock);
	desc = ioat_dma_get_next_descriptor(ioat);
890 891 892
	do {
		if (!desc)
			break;
893

894
		tx_cnt++;
895
		copy = min_t(size_t, len, ioat->xfercap);
896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911

		hw = desc->hw;
		hw->size = copy;
		hw->ctl = 0;
		hw->src_addr = src;
		hw->dst_addr = dest;

		list_add_tail(&desc->node, &chain);

		len -= copy;
		dest += copy;
		src += copy;
		if (len) {
			struct ioat_desc_sw *next;

			async_tx_ack(&desc->txd);
912
			next = ioat_dma_get_next_descriptor(ioat);
913 914 915 916 917 918 919
			hw->next = next ? next->txd.phys : 0;
			desc = next;
		} else
			hw->next = 0;
	} while (len);

	if (!desc) {
920 921 922
		struct ioat_chan_common *chan = &ioat->base;

		dev_err(to_dev(chan),
923
			"chan%d - get_next_desc failed: %d descs waiting, %d total desc\n",
924 925 926
			chan_num(chan), ioat->dmacount, ioat->desccount);
		list_splice(&chain, &ioat->free_desc);
		spin_unlock_bh(&ioat->desc_lock);
S
Shannon Nelson 已提交
927
		return NULL;
928
	}
929
	spin_unlock_bh(&ioat->desc_lock);
930 931 932 933 934 935 936 937 938 939 940

	desc->txd.flags = flags;
	desc->tx_cnt = tx_cnt;
	desc->src = dma_src;
	desc->dst = dma_dest;
	desc->len = total_len;
	list_splice(&chain, &desc->txd.tx_list);
	hw->ctl_f.int_en = !!(flags & DMA_PREP_INTERRUPT);
	hw->ctl_f.compl_write = 1;

	return &desc->txd;
941 942
}

943
static struct dma_async_tx_descriptor *
944
ioat2_dma_prep_memcpy(struct dma_chan *c, dma_addr_t dma_dest,
945
		      dma_addr_t dma_src, size_t len, unsigned long flags)
946
{
947
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
948 949
	struct ioat_desc_sw *new;

950 951
	spin_lock_bh(&ioat->desc_lock);
	new = ioat2_dma_get_next_descriptor(ioat);
952

S
Shannon Nelson 已提交
953
	/*
954
	 * leave ioat->desc_lock set in ioat 2 path
S
Shannon Nelson 已提交
955 956
	 * it will get unlocked at end of tx_submit
	 */
957

S
Shannon Nelson 已提交
958 959
	if (new) {
		new->len = len;
960 961
		new->dst = dma_dest;
		new->src = dma_src;
962 963
		new->txd.flags = flags;
		return &new->txd;
964
	} else {
965 966 967 968
		struct ioat_chan_common *chan = &ioat->base;

		spin_unlock_bh(&ioat->desc_lock);
		dev_err(to_dev(chan),
969
			"chan%d - get_next_desc failed: %d descs waiting, %d total desc\n",
970
			chan_num(chan), ioat->dmacount, ioat->desccount);
S
Shannon Nelson 已提交
971
		return NULL;
972
	}
973 974
}

975 976 977 978 979
static void ioat_dma_cleanup_tasklet(unsigned long data)
{
	struct ioat_dma_chan *chan = (void *)data;
	ioat_dma_memcpy_cleanup(chan);
	writew(IOAT_CHANCTRL_INT_DISABLE,
980
	       chan->base.reg_base + IOAT_CHANCTRL_OFFSET);
981 982
}

983
static void
984
ioat_dma_unmap(struct ioat_chan_common *chan, struct ioat_desc_sw *desc)
985
{
986 987
	if (!(desc->txd.flags & DMA_COMPL_SKIP_DEST_UNMAP)) {
		if (desc->txd.flags & DMA_COMPL_DEST_UNMAP_SINGLE)
988
			pci_unmap_single(chan->device->pdev,
989 990 991 992
					 pci_unmap_addr(desc, dst),
					 pci_unmap_len(desc, len),
					 PCI_DMA_FROMDEVICE);
		else
993
			pci_unmap_page(chan->device->pdev,
994 995 996 997 998
				       pci_unmap_addr(desc, dst),
				       pci_unmap_len(desc, len),
				       PCI_DMA_FROMDEVICE);
	}

999 1000
	if (!(desc->txd.flags & DMA_COMPL_SKIP_SRC_UNMAP)) {
		if (desc->txd.flags & DMA_COMPL_SRC_UNMAP_SINGLE)
1001
			pci_unmap_single(chan->device->pdev,
1002 1003 1004 1005
					 pci_unmap_addr(desc, src),
					 pci_unmap_len(desc, len),
					 PCI_DMA_TODEVICE);
		else
1006
			pci_unmap_page(chan->device->pdev,
1007 1008 1009 1010
				       pci_unmap_addr(desc, src),
				       pci_unmap_len(desc, len),
				       PCI_DMA_TODEVICE);
	}
1011 1012
}

1013 1014 1015 1016
/**
 * ioat_dma_memcpy_cleanup - cleanup up finished descriptors
 * @chan: ioat channel to be cleaned up
 */
1017
static void ioat_dma_memcpy_cleanup(struct ioat_dma_chan *ioat)
1018
{
1019
	struct ioat_chan_common *chan = &ioat->base;
1020 1021 1022
	unsigned long phys_complete;
	struct ioat_desc_sw *desc, *_desc;
	dma_cookie_t cookie = 0;
1023 1024
	unsigned long desc_phys;
	struct ioat_desc_sw *latest_desc;
1025
	struct dma_async_tx_descriptor *tx;
1026

1027
	prefetch(chan->completion_virt);
1028

1029
	if (!spin_trylock_bh(&chan->cleanup_lock))
1030 1031 1032 1033 1034 1035 1036 1037 1038
		return;

	/* The completion writeback can happen at any time,
	   so reads by the driver need to be atomic operations
	   The descriptor physical addresses are limited to 32-bits
	   when the CPU can only do a 32-bit mov */

#if (BITS_PER_LONG == 64)
	phys_complete =
1039
		chan->completion_virt->full
1040
		& IOAT_CHANSTS_COMPLETED_DESCRIPTOR_ADDR;
1041
#else
1042
	phys_complete = chan->completion_virt->low & IOAT_LOW_COMPLETION_MASK;
1043 1044
#endif

1045
	if ((chan->completion_virt->full
1046
		& IOAT_CHANSTS_DMA_TRANSFER_STATUS) ==
1047
				IOAT_CHANSTS_DMA_TRANSFER_STATUS_HALTED) {
1048 1049
		dev_err(to_dev(chan), "Channel halted, chanerr = %x\n",
			readl(chan->reg_base + IOAT_CHANERR_OFFSET));
1050 1051 1052 1053

		/* TODO do something to salvage the situation */
	}

1054 1055
	if (phys_complete == chan->last_completion) {
		spin_unlock_bh(&chan->cleanup_lock);
1056 1057 1058 1059
		/*
		 * perhaps we're stuck so hard that the watchdog can't go off?
		 * try to catch it after 2 seconds
		 */
1060
		if (chan->device->version != IOAT_VER_3_0) {
1061
			if (time_after(jiffies,
1062 1063 1064
				       chan->last_completion_time + HZ*WATCHDOG_DELAY)) {
				ioat_dma_chan_watchdog(&(chan->device->work.work));
				chan->last_completion_time = jiffies;
1065
			}
1066
		}
1067 1068
		return;
	}
1069
	chan->last_completion_time = jiffies;
1070

1071
	cookie = 0;
1072 1073
	if (!spin_trylock_bh(&ioat->desc_lock)) {
		spin_unlock_bh(&chan->cleanup_lock);
1074 1075 1076
		return;
	}

1077
	switch (chan->device->version) {
1078
	case IOAT_VER_1_2:
1079
		list_for_each_entry_safe(desc, _desc, &ioat->used_desc, node) {
1080
			tx = &desc->txd;
1081
			/*
1082 1083 1084
			 * Incoming DMA requests may use multiple descriptors,
			 * due to exceeding xfercap, perhaps. If so, only the
			 * last one will have a cookie, and require unmapping.
1085
			 */
1086 1087
			if (tx->cookie) {
				cookie = tx->cookie;
1088
				ioat_dma_unmap(chan, desc);
1089 1090 1091
				if (tx->callback) {
					tx->callback(tx->callback_param);
					tx->callback = NULL;
1092
				}
1093
			}
1094

1095
			if (tx->phys != phys_complete) {
1096 1097 1098 1099
				/*
				 * a completed entry, but not the last, so clean
				 * up if the client is done with the descriptor
				 */
1100
				if (async_tx_test_ack(tx)) {
E
Eric Sesterhenn 已提交
1101
					list_move_tail(&desc->node,
1102
						       &ioat->free_desc);
1103
				} else
1104
					tx->cookie = 0;
1105 1106 1107 1108 1109 1110
			} else {
				/*
				 * last used desc. Do not remove, so we can
				 * append from it, but don't look at it next
				 * time, either
				 */
1111
				tx->cookie = 0;
1112

1113 1114 1115 1116 1117 1118
				/* TODO check status bits? */
				break;
			}
		}
		break;
	case IOAT_VER_2_0:
1119
	case IOAT_VER_3_0:
1120
		/* has some other thread has already cleaned up? */
1121
		if (ioat->used_desc.prev == NULL)
1122
			break;
1123 1124

		/* work backwards to find latest finished desc */
1125
		desc = to_ioat_desc(ioat->used_desc.next);
1126
		tx = &desc->txd;
1127 1128 1129
		latest_desc = NULL;
		do {
			desc = to_ioat_desc(desc->node.prev);
1130
			desc_phys = (unsigned long)tx->phys
1131 1132 1133 1134 1135
				       & IOAT_CHANSTS_COMPLETED_DESCRIPTOR_ADDR;
			if (desc_phys == phys_complete) {
				latest_desc = desc;
				break;
			}
1136
		} while (&desc->node != ioat->used_desc.prev);
1137 1138 1139

		if (latest_desc != NULL) {
			/* work forwards to clear finished descriptors */
1140
			for (desc = to_ioat_desc(ioat->used_desc.prev);
1141
			     &desc->node != latest_desc->node.next &&
1142
			     &desc->node != ioat->used_desc.next;
1143
			     desc = to_ioat_desc(desc->node.next)) {
1144 1145 1146
				if (tx->cookie) {
					cookie = tx->cookie;
					tx->cookie = 0;
1147
					ioat_dma_unmap(chan, desc);
1148 1149 1150
					if (tx->callback) {
						tx->callback(tx->callback_param);
						tx->callback = NULL;
1151 1152 1153 1154 1155
					}
				}
			}

			/* move used.prev up beyond those that are finished */
1156 1157
			if (&desc->node == ioat->used_desc.next)
				ioat->used_desc.prev = NULL;
1158
			else
1159
				ioat->used_desc.prev = &desc->node;
1160
		}
1161
		break;
1162 1163
	}

1164
	spin_unlock_bh(&ioat->desc_lock);
1165

1166
	chan->last_completion = phys_complete;
1167
	if (cookie != 0)
1168
		chan->completed_cookie = cookie;
1169

1170
	spin_unlock_bh(&chan->cleanup_lock);
1171 1172 1173 1174 1175 1176
}

/**
 * ioat_dma_is_complete - poll the status of a IOAT DMA transaction
 * @chan: IOAT DMA channel handle
 * @cookie: DMA transaction identifier
1177 1178
 * @done: if not %NULL, updated with last completed transaction
 * @used: if not %NULL, updated with last used transaction
1179
 */
1180
static enum dma_status
1181
ioat_dma_is_complete(struct dma_chan *c, dma_cookie_t cookie,
1182
		     dma_cookie_t *done, dma_cookie_t *used)
1183
{
1184 1185
	struct ioat_dma_chan *ioat = to_ioat_chan(c);
	struct ioat_chan_common *chan = &ioat->base;
1186 1187 1188 1189
	dma_cookie_t last_used;
	dma_cookie_t last_complete;
	enum dma_status ret;

1190 1191 1192
	last_used = c->cookie;
	last_complete = chan->completed_cookie;
	chan->watchdog_tcp_cookie = cookie;
1193 1194

	if (done)
1195
		*done = last_complete;
1196 1197 1198 1199 1200 1201 1202
	if (used)
		*used = last_used;

	ret = dma_async_is_complete(cookie, last_complete, last_used);
	if (ret == DMA_SUCCESS)
		return ret;

1203
	ioat_dma_memcpy_cleanup(ioat);
1204

1205 1206
	last_used = c->cookie;
	last_complete = chan->completed_cookie;
1207 1208

	if (done)
1209
		*done = last_complete;
1210 1211 1212 1213 1214 1215
	if (used)
		*used = last_used;

	return dma_async_is_complete(cookie, last_complete, last_used);
}

1216
static void ioat_dma_start_null_desc(struct ioat_dma_chan *ioat)
1217
{
1218
	struct ioat_chan_common *chan = &ioat->base;
1219
	struct ioat_desc_sw *desc;
1220
	struct ioat_dma_descriptor *hw;
1221

1222
	spin_lock_bh(&ioat->desc_lock);
1223

1224
	desc = ioat_dma_get_next_descriptor(ioat);
1225 1226

	if (!desc) {
1227
		dev_err(to_dev(chan),
1228
			"Unable to start null desc - get next desc failed\n");
1229
		spin_unlock_bh(&ioat->desc_lock);
1230 1231 1232
		return;
	}

1233 1234 1235 1236 1237
	hw = desc->hw;
	hw->ctl = 0;
	hw->ctl_f.null = 1;
	hw->ctl_f.int_en = 1;
	hw->ctl_f.compl_write = 1;
1238
	/* set size to non-zero value (channel returns error when size is 0) */
1239 1240 1241
	hw->size = NULL_DESC_BUFFER_SIZE;
	hw->src_addr = 0;
	hw->dst_addr = 0;
1242
	async_tx_ack(&desc->txd);
1243
	switch (chan->device->version) {
1244
	case IOAT_VER_1_2:
1245
		hw->next = 0;
1246
		list_add_tail(&desc->node, &ioat->used_desc);
1247

1248
		writel(((u64) desc->txd.phys) & 0x00000000FFFFFFFF,
1249
		       chan->reg_base + IOAT1_CHAINADDR_OFFSET_LOW);
1250
		writel(((u64) desc->txd.phys) >> 32,
1251
		       chan->reg_base + IOAT1_CHAINADDR_OFFSET_HIGH);
1252

1253 1254
		writeb(IOAT_CHANCMD_START, chan->reg_base
			+ IOAT_CHANCMD_OFFSET(chan->device->version));
1255 1256
		break;
	case IOAT_VER_2_0:
1257
	case IOAT_VER_3_0:
1258
		writel(((u64) desc->txd.phys) & 0x00000000FFFFFFFF,
1259
		       chan->reg_base + IOAT2_CHAINADDR_OFFSET_LOW);
1260
		writel(((u64) desc->txd.phys) >> 32,
1261
		       chan->reg_base + IOAT2_CHAINADDR_OFFSET_HIGH);
1262

1263 1264
		ioat->dmacount++;
		__ioat2_dma_memcpy_issue_pending(ioat);
1265 1266
		break;
	}
1267
	spin_unlock_bh(&ioat->desc_lock);
1268 1269 1270 1271 1272 1273 1274
}

/*
 * Perform a IOAT transaction to verify the HW works.
 */
#define IOAT_TEST_SIZE 2000

1275 1276
static void ioat_dma_test_callback(void *dma_async_param)
{
1277 1278 1279
	struct completion *cmp = dma_async_param;

	complete(cmp);
1280 1281
}

1282 1283 1284 1285 1286
/**
 * ioat_dma_self_test - Perform a IOAT transaction to verify the HW works.
 * @device: device to be tested
 */
static int ioat_dma_self_test(struct ioatdma_device *device)
1287 1288 1289 1290
{
	int i;
	u8 *src;
	u8 *dest;
1291 1292
	struct dma_device *dma = &device->common;
	struct device *dev = &device->pdev->dev;
1293
	struct dma_chan *dma_chan;
S
Shannon Nelson 已提交
1294
	struct dma_async_tx_descriptor *tx;
1295
	dma_addr_t dma_dest, dma_src;
1296 1297
	dma_cookie_t cookie;
	int err = 0;
1298
	struct completion cmp;
1299
	unsigned long tmo;
1300
	unsigned long flags;
1301

1302
	src = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL);
1303 1304
	if (!src)
		return -ENOMEM;
1305
	dest = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL);
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315
	if (!dest) {
		kfree(src);
		return -ENOMEM;
	}

	/* Fill in src buffer */
	for (i = 0; i < IOAT_TEST_SIZE; i++)
		src[i] = (u8)i;

	/* Start copy, using first DMA channel */
1316
	dma_chan = container_of(dma->channels.next, struct dma_chan,
1317
				device_node);
1318 1319
	if (dma->device_alloc_chan_resources(dma_chan) < 1) {
		dev_err(dev, "selftest cannot allocate chan resource\n");
1320 1321 1322 1323
		err = -ENODEV;
		goto out;
	}

1324 1325
	dma_src = dma_map_single(dev, src, IOAT_TEST_SIZE, DMA_TO_DEVICE);
	dma_dest = dma_map_single(dev, dest, IOAT_TEST_SIZE, DMA_FROM_DEVICE);
D
Dan Williams 已提交
1326 1327
	flags = DMA_COMPL_SRC_UNMAP_SINGLE | DMA_COMPL_DEST_UNMAP_SINGLE |
		DMA_PREP_INTERRUPT;
1328
	tx = device->common.device_prep_dma_memcpy(dma_chan, dma_dest, dma_src,
1329
						   IOAT_TEST_SIZE, flags);
1330
	if (!tx) {
1331
		dev_err(dev, "Self-test prep failed, disabling\n");
1332 1333 1334 1335
		err = -ENODEV;
		goto free_resources;
	}

1336
	async_tx_ack(tx);
1337
	init_completion(&cmp);
1338
	tx->callback = ioat_dma_test_callback;
1339
	tx->callback_param = &cmp;
1340
	cookie = tx->tx_submit(tx);
1341
	if (cookie < 0) {
1342
		dev_err(dev, "Self-test setup failed, disabling\n");
1343 1344 1345
		err = -ENODEV;
		goto free_resources;
	}
1346
	dma->device_issue_pending(dma_chan);
D
Dan Williams 已提交
1347

1348
	tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000));
1349

1350
	if (tmo == 0 ||
1351
	    dma->device_is_tx_complete(dma_chan, cookie, NULL, NULL)
1352
					!= DMA_SUCCESS) {
1353
		dev_err(dev, "Self-test copy timed out, disabling\n");
1354 1355 1356 1357
		err = -ENODEV;
		goto free_resources;
	}
	if (memcmp(src, dest, IOAT_TEST_SIZE)) {
1358
		dev_err(dev, "Self-test copy failed compare, disabling\n");
1359 1360 1361 1362 1363
		err = -ENODEV;
		goto free_resources;
	}

free_resources:
1364
	dma->device_free_chan_resources(dma_chan);
1365 1366 1367 1368 1369 1370
out:
	kfree(src);
	kfree(dest);
	return err;
}

1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383
static char ioat_interrupt_style[32] = "msix";
module_param_string(ioat_interrupt_style, ioat_interrupt_style,
		    sizeof(ioat_interrupt_style), 0644);
MODULE_PARM_DESC(ioat_interrupt_style,
		 "set ioat interrupt style: msix (default), "
		 "msix-single-vector, msi, intx)");

/**
 * ioat_dma_setup_interrupts - setup interrupt handler
 * @device: ioat device
 */
static int ioat_dma_setup_interrupts(struct ioatdma_device *device)
{
1384
	struct ioat_chan_common *chan;
1385 1386 1387 1388 1389
	struct pci_dev *pdev = device->pdev;
	struct device *dev = &pdev->dev;
	struct msix_entry *msix;
	int i, j, msixcnt;
	int err = -EINVAL;
1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
	u8 intrctrl = 0;

	if (!strcmp(ioat_interrupt_style, "msix"))
		goto msix;
	if (!strcmp(ioat_interrupt_style, "msix-single-vector"))
		goto msix_single_vector;
	if (!strcmp(ioat_interrupt_style, "msi"))
		goto msi;
	if (!strcmp(ioat_interrupt_style, "intx"))
		goto intx;
1400
	dev_err(dev, "invalid ioat_interrupt_style %s\n", ioat_interrupt_style);
1401
	goto err_no_irq;
1402 1403 1404 1405 1406 1407 1408

msix:
	/* The number of MSI-X vectors should equal the number of channels */
	msixcnt = device->common.chancnt;
	for (i = 0; i < msixcnt; i++)
		device->msix_entries[i].entry = i;

1409
	err = pci_enable_msix(pdev, device->msix_entries, msixcnt);
1410 1411 1412 1413 1414 1415
	if (err < 0)
		goto msi;
	if (err > 0)
		goto msix_single_vector;

	for (i = 0; i < msixcnt; i++) {
1416
		msix = &device->msix_entries[i];
1417
		chan = ioat_chan_by_index(device, i);
1418 1419
		err = devm_request_irq(dev, msix->vector,
				       ioat_dma_do_interrupt_msix, 0,
1420
				       "ioat-msix", chan);
1421 1422
		if (err) {
			for (j = 0; j < i; j++) {
1423
				msix = &device->msix_entries[j];
1424 1425
				chan = ioat_chan_by_index(device, j);
				devm_free_irq(dev, msix->vector, chan);
1426 1427 1428 1429 1430 1431 1432 1433
			}
			goto msix_single_vector;
		}
	}
	intrctrl |= IOAT_INTRCTRL_MSIX_VECTOR_CONTROL;
	goto done;

msix_single_vector:
1434 1435 1436
	msix = &device->msix_entries[0];
	msix->entry = 0;
	err = pci_enable_msix(pdev, device->msix_entries, 1);
1437 1438 1439
	if (err)
		goto msi;

1440 1441
	err = devm_request_irq(dev, msix->vector, ioat_dma_do_interrupt, 0,
			       "ioat-msix", device);
1442
	if (err) {
1443
		pci_disable_msix(pdev);
1444 1445 1446 1447 1448
		goto msi;
	}
	goto done;

msi:
1449
	err = pci_enable_msi(pdev);
1450 1451 1452
	if (err)
		goto intx;

1453 1454
	err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt, 0,
			       "ioat-msi", device);
1455
	if (err) {
1456
		pci_disable_msi(pdev);
1457 1458 1459 1460 1461
		goto intx;
	}
	goto done;

intx:
1462 1463
	err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt,
			       IRQF_SHARED, "ioat-intx", device);
1464 1465 1466 1467
	if (err)
		goto err_no_irq;

done:
1468 1469
	if (device->intr_quirk)
		device->intr_quirk(device);
1470 1471 1472 1473 1474 1475 1476
	intrctrl |= IOAT_INTRCTRL_MASTER_INT_EN;
	writeb(intrctrl, device->reg_base + IOAT_INTRCTRL_OFFSET);
	return 0;

err_no_irq:
	/* Disable all interrupt generation */
	writeb(0, device->reg_base + IOAT_INTRCTRL_OFFSET);
1477 1478
	dev_err(dev, "no usable interrupts\n");
	return err;
1479 1480
}

1481
static void ioat_disable_interrupts(struct ioatdma_device *device)
1482 1483 1484 1485 1486
{
	/* Disable all interrupt generation */
	writeb(0, device->reg_base + IOAT_INTRCTRL_OFFSET);
}

1487
static int ioat_probe(struct ioatdma_device *device)
1488
{
1489 1490 1491
	int err = -ENODEV;
	struct dma_device *dma = &device->common;
	struct pci_dev *pdev = device->pdev;
1492
	struct device *dev = &pdev->dev;
1493 1494 1495

	/* DMA coherent memory pool for DMA descriptor allocations */
	device->dma_pool = pci_pool_create("dma_desc_pool", pdev,
1496 1497
					   sizeof(struct ioat_dma_descriptor),
					   64, 0);
1498 1499 1500 1501 1502
	if (!device->dma_pool) {
		err = -ENOMEM;
		goto err_dma_pool;
	}

1503 1504 1505
	device->completion_pool = pci_pool_create("completion_pool", pdev,
						  sizeof(u64), SMP_CACHE_BYTES,
						  SMP_CACHE_BYTES);
1506 1507 1508 1509 1510
	if (!device->completion_pool) {
		err = -ENOMEM;
		goto err_completion_pool;
	}

1511
	ioat_dma_enumerate_channels(device);
1512

1513
	dma_cap_set(DMA_MEMCPY, dma->cap_mask);
1514 1515 1516
	dma->device_alloc_chan_resources = ioat_dma_alloc_chan_resources;
	dma->device_free_chan_resources = ioat_dma_free_chan_resources;
	dma->device_is_tx_complete = ioat_dma_is_complete;
1517
	dma->dev = &pdev->dev;
1518

1519
	dev_err(dev, "Intel(R) I/OAT DMA Engine found,"
1520
		" %d channels, device version 0x%02x, driver version %s\n",
1521
		dma->chancnt, device->version, IOAT_DMA_VERSION);
1522

1523
	if (!dma->chancnt) {
1524
		dev_err(dev, "Intel(R) I/OAT DMA Engine problem found: "
1525 1526 1527 1528
			"zero channels detected\n");
		goto err_setup_interrupts;
	}

1529
	err = ioat_dma_setup_interrupts(device);
1530
	if (err)
1531
		goto err_setup_interrupts;
1532

1533
	err = ioat_dma_self_test(device);
1534 1535 1536
	if (err)
		goto err_self_test;

1537
	return 0;
1538 1539

err_self_test:
1540
	ioat_disable_interrupts(device);
1541
err_setup_interrupts:
1542 1543 1544 1545
	pci_pool_destroy(device->completion_pool);
err_completion_pool:
	pci_pool_destroy(device->dma_pool);
err_dma_pool:
1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
	return err;
}

static int ioat_register(struct ioatdma_device *device)
{
	int err = dma_async_device_register(&device->common);

	if (err) {
		ioat_disable_interrupts(device);
		pci_pool_destroy(device->completion_pool);
		pci_pool_destroy(device->dma_pool);
	}

	return err;
}

/* ioat1_intr_quirk - fix up dma ctrl register to enable / disable msi */
static void ioat1_intr_quirk(struct ioatdma_device *device)
{
	struct pci_dev *pdev = device->pdev;
	u32 dmactrl;

	pci_read_config_dword(pdev, IOAT_PCI_DMACTRL_OFFSET, &dmactrl);
	if (pdev->msi_enabled)
		dmactrl |= IOAT_PCI_DMACTRL_MSI_EN;
	else
		dmactrl &= ~IOAT_PCI_DMACTRL_MSI_EN;
	pci_write_config_dword(pdev, IOAT_PCI_DMACTRL_OFFSET, dmactrl);
}

int ioat1_dma_probe(struct ioatdma_device *device, int dca)
{
	struct pci_dev *pdev = device->pdev;
	struct dma_device *dma;
	int err;

	device->intr_quirk = ioat1_intr_quirk;
	dma = &device->common;
	dma->device_prep_dma_memcpy = ioat1_dma_prep_memcpy;
	dma->device_issue_pending = ioat1_dma_memcpy_issue_pending;

	err = ioat_probe(device);
	if (err)
		return err;
	ioat_set_tcp_copy_break(4096);
	err = ioat_register(device);
	if (err)
		return err;
	if (dca)
		device->dca = ioat_dca_init(pdev, device->reg_base);

	INIT_DELAYED_WORK(&device->work, ioat_dma_chan_watchdog);
	schedule_delayed_work(&device->work, WATCHDOG_DELAY);

	return err;
}

int ioat2_dma_probe(struct ioatdma_device *device, int dca)
{
	struct pci_dev *pdev = device->pdev;
	struct dma_device *dma;
1607 1608
	struct dma_chan *c;
	struct ioat_chan_common *chan;
1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619
	int err;

	dma = &device->common;
	dma->device_prep_dma_memcpy = ioat2_dma_prep_memcpy;
	dma->device_issue_pending = ioat2_dma_memcpy_issue_pending;

	err = ioat_probe(device);
	if (err)
		return err;
	ioat_set_tcp_copy_break(2048);

1620 1621
	list_for_each_entry(c, &dma->channels, device_node) {
		chan = to_chan_common(c);
1622
		writel(IOAT_DCACTRL_CMPL_WRITE_ENABLE | IOAT_DMA_DCA_ANY_CPU,
1623
		       chan->reg_base + IOAT_DCACTRL_OFFSET);
1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641
	}

	err = ioat_register(device);
	if (err)
		return err;
	if (dca)
		device->dca = ioat2_dca_init(pdev, device->reg_base);

	INIT_DELAYED_WORK(&device->work, ioat_dma_chan_watchdog);
	schedule_delayed_work(&device->work, WATCHDOG_DELAY);

	return err;
}

int ioat3_dma_probe(struct ioatdma_device *device, int dca)
{
	struct pci_dev *pdev = device->pdev;
	struct dma_device *dma;
1642 1643
	struct dma_chan *c;
	struct ioat_chan_common *chan;
1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668
	int err;
	u16 dev_id;

	dma = &device->common;
	dma->device_prep_dma_memcpy = ioat2_dma_prep_memcpy;
	dma->device_issue_pending = ioat2_dma_memcpy_issue_pending;

	/* -= IOAT ver.3 workarounds =- */
	/* Write CHANERRMSK_INT with 3E07h to mask out the errors
	 * that can cause stability issues for IOAT ver.3
	 */
	pci_write_config_dword(pdev, IOAT_PCI_CHANERRMASK_INT_OFFSET, 0x3e07);

	/* Clear DMAUNCERRSTS Cfg-Reg Parity Error status bit
	 * (workaround for spurious config parity error after restart)
	 */
	pci_read_config_word(pdev, IOAT_PCI_DEVICE_ID_OFFSET, &dev_id);
	if (dev_id == PCI_DEVICE_ID_INTEL_IOAT_TBG0)
		pci_write_config_dword(pdev, IOAT_PCI_DMAUNCERRSTS_OFFSET, 0x10);

	err = ioat_probe(device);
	if (err)
		return err;
	ioat_set_tcp_copy_break(262144);

1669 1670
	list_for_each_entry(c, &dma->channels, device_node) {
		chan = to_chan_common(c);
1671
		writel(IOAT_DMA_DCA_ANY_CPU,
1672
		       chan->reg_base + IOAT_DCACTRL_OFFSET);
1673 1674 1675 1676 1677 1678 1679 1680 1681
	}

	err = ioat_register(device);
	if (err)
		return err;
	if (dca)
		device->dca = ioat3_dca_init(pdev, device->reg_base);

	return err;
D
Dan Aloni 已提交
1682 1683
}

1684
void ioat_dma_remove(struct ioatdma_device *device)
1685
{
1686
	struct dma_device *dma = &device->common;
1687

1688 1689 1690
	if (device->version != IOAT_VER_3_0)
		cancel_delayed_work(&device->work);

1691
	ioat_disable_interrupts(device);
1692

1693
	dma_async_device_unregister(dma);
1694

1695 1696
	pci_pool_destroy(device->dma_pool);
	pci_pool_destroy(device->completion_pool);
1697

1698
	INIT_LIST_HEAD(&dma->channels);
1699 1700
}