msi.c 22.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8
/*
 * File:	msi.c
 * Purpose:	PCI Message Signaled Interrupt (MSI)
 *
 * Copyright (C) 2003-2004 Intel
 * Copyright (C) Tom Long Nguyen (tom.l.nguyen@intel.com)
 */

9
#include <linux/err.h>
L
Linus Torvalds 已提交
10 11 12 13 14 15 16
#include <linux/mm.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/init.h>
#include <linux/ioport.h>
#include <linux/pci.h>
#include <linux/proc_fs.h>
17
#include <linux/msi.h>
D
Dan Williams 已提交
18
#include <linux/smp.h>
H
Hidetoshi Seto 已提交
19 20
#include <linux/errno.h>
#include <linux/io.h>
21
#include <linux/slab.h>
L
Linus Torvalds 已提交
22 23 24 25 26 27

#include "pci.h"
#include "msi.h"

static int pci_msi_enable = 1;

28 29
/* Arch hooks */

30 31
#ifndef arch_msi_check_device
int arch_msi_check_device(struct pci_dev *dev, int nvec, int type)
32 33 34
{
	return 0;
}
35
#endif
36

37 38
#ifndef arch_setup_msi_irqs
int arch_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
39 40 41 42
{
	struct msi_desc *entry;
	int ret;

43 44 45 46 47 48 49
	/*
	 * If an architecture wants to support multiple MSI, it needs to
	 * override arch_setup_msi_irqs()
	 */
	if (type == PCI_CAP_ID_MSI && nvec > 1)
		return 1;

50 51
	list_for_each_entry(entry, &dev->msi_list, list) {
		ret = arch_setup_msi_irq(dev, entry);
52
		if (ret < 0)
53
			return ret;
54 55
		if (ret > 0)
			return -ENOSPC;
56 57 58 59
	}

	return 0;
}
60
#endif
61

62 63
#ifndef arch_teardown_msi_irqs
void arch_teardown_msi_irqs(struct pci_dev *dev)
64 65 66 67
{
	struct msi_desc *entry;

	list_for_each_entry(entry, &dev->msi_list, list) {
68 69 70 71 72 73
		int i, nvec;
		if (entry->irq == 0)
			continue;
		nvec = 1 << entry->msi_attrib.multiple;
		for (i = 0; i < nvec; i++)
			arch_teardown_msi_irq(entry->irq + i);
74 75
	}
}
76
#endif
77

78
static void msi_set_enable(struct pci_dev *dev, int pos, int enable)
79 80 81
{
	u16 control;

82
	BUG_ON(!pos);
83

84 85 86 87 88
	pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
	control &= ~PCI_MSI_FLAGS_ENABLE;
	if (enable)
		control |= PCI_MSI_FLAGS_ENABLE;
	pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
89 90
}

91 92 93 94 95 96 97 98 99 100 101 102 103 104 105
static void msix_set_enable(struct pci_dev *dev, int enable)
{
	int pos;
	u16 control;

	pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
	if (pos) {
		pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
		control &= ~PCI_MSIX_FLAGS_ENABLE;
		if (enable)
			control |= PCI_MSIX_FLAGS_ENABLE;
		pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
	}
}

106 107
static inline __attribute_const__ u32 msi_mask(unsigned x)
{
108 109 110 111
	/* Don't shift by >= width of type */
	if (x >= 5)
		return 0xffffffff;
	return (1 << (1 << x)) - 1;
112 113
}

114
static inline __attribute_const__ u32 msi_capable_mask(u16 control)
M
Mitch Williams 已提交
115
{
116 117
	return msi_mask((control >> 1) & 7);
}
M
Mitch Williams 已提交
118

119 120 121
static inline __attribute_const__ u32 msi_enabled_mask(u16 control)
{
	return msi_mask((control >> 4) & 7);
M
Mitch Williams 已提交
122 123
}

124 125 126 127 128 129
/*
 * PCI 2.3 does not specify mask bits for each MSI interrupt.  Attempting to
 * mask all MSI interrupts by clearing the MSI enable bit does not work
 * reliably as devices without an INTx disable bit will then generate a
 * level IRQ which will never be cleared.
 */
130
static u32 __msi_mask_irq(struct msi_desc *desc, u32 mask, u32 flag)
L
Linus Torvalds 已提交
131
{
132
	u32 mask_bits = desc->masked;
L
Linus Torvalds 已提交
133

134
	if (!desc->msi_attrib.maskbit)
135
		return 0;
136 137 138 139

	mask_bits &= ~mask;
	mask_bits |= flag;
	pci_write_config_dword(desc->dev, desc->mask_pos, mask_bits);
140 141 142 143 144 145 146

	return mask_bits;
}

static void msi_mask_irq(struct msi_desc *desc, u32 mask, u32 flag)
{
	desc->masked = __msi_mask_irq(desc, mask, flag);
147 148 149 150 151 152 153 154 155
}

/*
 * This internal function does not flush PCI writes to the device.
 * All users must ensure that they read from the device before either
 * assuming that the device state is up to date, or returning out of this
 * file.  This saves a few milliseconds when initialising devices with lots
 * of MSI-X interrupts.
 */
156
static u32 __msix_mask_irq(struct msi_desc *desc, u32 flag)
157 158 159
{
	u32 mask_bits = desc->masked;
	unsigned offset = desc->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE +
160
						PCI_MSIX_ENTRY_VECTOR_CTRL;
161 162 163
	mask_bits &= ~1;
	mask_bits |= flag;
	writel(mask_bits, desc->mask_base + offset);
164 165 166 167 168 169 170

	return mask_bits;
}

static void msix_mask_irq(struct msi_desc *desc, u32 flag)
{
	desc->masked = __msix_mask_irq(desc, flag);
171
}
172

173 174 175
static void msi_set_mask_bit(unsigned irq, u32 flag)
{
	struct msi_desc *desc = get_irq_msi(irq);
176

177 178 179 180
	if (desc->msi_attrib.is_msix) {
		msix_mask_irq(desc, flag);
		readl(desc->mask_base);		/* Flush write to device */
	} else {
181 182
		unsigned offset = irq - desc->dev->irq;
		msi_mask_irq(desc, 1 << offset, flag << offset);
L
Linus Torvalds 已提交
183
	}
184 185 186 187 188 189 190 191 192 193
}

void mask_msi_irq(unsigned int irq)
{
	msi_set_mask_bit(irq, 1);
}

void unmask_msi_irq(unsigned int irq)
{
	msi_set_mask_bit(irq, 0);
L
Linus Torvalds 已提交
194 195
}

Y
Yinghai Lu 已提交
196
void read_msi_msg_desc(struct irq_desc *desc, struct msi_msg *msg)
L
Linus Torvalds 已提交
197
{
Y
Yinghai Lu 已提交
198
	struct msi_desc *entry = get_irq_desc_msi(desc);
199

200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
	BUG_ON(entry->dev->current_state != PCI_D0);

	if (entry->msi_attrib.is_msix) {
		void __iomem *base = entry->mask_base +
			entry->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE;

		msg->address_lo = readl(base + PCI_MSIX_ENTRY_LOWER_ADDR);
		msg->address_hi = readl(base + PCI_MSIX_ENTRY_UPPER_ADDR);
		msg->data = readl(base + PCI_MSIX_ENTRY_DATA);
	} else {
		struct pci_dev *dev = entry->dev;
		int pos = entry->msi_attrib.pos;
		u16 data;

		pci_read_config_dword(dev, msi_lower_address_reg(pos),
					&msg->address_lo);
		if (entry->msi_attrib.is_64) {
			pci_read_config_dword(dev, msi_upper_address_reg(pos),
						&msg->address_hi);
			pci_read_config_word(dev, msi_data_reg(pos, 1), &data);
		} else {
			msg->address_hi = 0;
			pci_read_config_word(dev, msi_data_reg(pos, 0), &data);
		}
		msg->data = data;
	}
}

void read_msi_msg(unsigned int irq, struct msi_msg *msg)
{
	struct irq_desc *desc = irq_to_desc(irq);

	read_msi_msg_desc(desc, msg);
}

void get_cached_msi_msg_desc(struct irq_desc *desc, struct msi_msg *msg)
{
	struct msi_desc *entry = get_irq_desc_msi(desc);

	/* Assert that the cache is valid, assuming that
240 241 242
	 * valid messages are not all-zeroes. */
	BUG_ON(!(entry->msg.address_hi | entry->msg.address_lo |
		 entry->msg.data));
243

244
	*msg = entry->msg;
245
}
L
Linus Torvalds 已提交
246

247
void get_cached_msi_msg(unsigned int irq, struct msi_msg *msg)
248
{
Y
Yinghai Lu 已提交
249 250
	struct irq_desc *desc = irq_to_desc(irq);

251
	get_cached_msi_msg_desc(desc, msg);
Y
Yinghai Lu 已提交
252 253 254 255 256
}

void write_msi_msg_desc(struct irq_desc *desc, struct msi_msg *msg)
{
	struct msi_desc *entry = get_irq_desc_msi(desc);
257 258 259 260

	if (entry->dev->current_state != PCI_D0) {
		/* Don't touch the hardware now */
	} else if (entry->msi_attrib.is_msix) {
261 262 263 264
		void __iomem *base;
		base = entry->mask_base +
			entry->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE;

265 266 267
		writel(msg->address_lo, base + PCI_MSIX_ENTRY_LOWER_ADDR);
		writel(msg->address_hi, base + PCI_MSIX_ENTRY_UPPER_ADDR);
		writel(msg->data, base + PCI_MSIX_ENTRY_DATA);
268
	} else {
269 270
		struct pci_dev *dev = entry->dev;
		int pos = entry->msi_attrib.pos;
271 272 273 274 275 276
		u16 msgctl;

		pci_read_config_word(dev, msi_control_reg(pos), &msgctl);
		msgctl &= ~PCI_MSI_FLAGS_QSIZE;
		msgctl |= entry->msi_attrib.multiple << 4;
		pci_write_config_word(dev, msi_control_reg(pos), msgctl);
277 278 279 280 281 282 283 284 285 286 287 288

		pci_write_config_dword(dev, msi_lower_address_reg(pos),
					msg->address_lo);
		if (entry->msi_attrib.is_64) {
			pci_write_config_dword(dev, msi_upper_address_reg(pos),
						msg->address_hi);
			pci_write_config_word(dev, msi_data_reg(pos, 1),
						msg->data);
		} else {
			pci_write_config_word(dev, msi_data_reg(pos, 0),
						msg->data);
		}
L
Linus Torvalds 已提交
289
	}
290
	entry->msg = *msg;
L
Linus Torvalds 已提交
291
}
292

Y
Yinghai Lu 已提交
293 294 295 296 297 298 299
void write_msi_msg(unsigned int irq, struct msi_msg *msg)
{
	struct irq_desc *desc = irq_to_desc(irq);

	write_msi_msg_desc(desc, msg);
}

300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323
static void free_msi_irqs(struct pci_dev *dev)
{
	struct msi_desc *entry, *tmp;

	list_for_each_entry(entry, &dev->msi_list, list) {
		int i, nvec;
		if (!entry->irq)
			continue;
		nvec = 1 << entry->msi_attrib.multiple;
		for (i = 0; i < nvec; i++)
			BUG_ON(irq_has_action(entry->irq + i));
	}

	arch_teardown_msi_irqs(dev);

	list_for_each_entry_safe(entry, tmp, &dev->msi_list, list) {
		if (entry->msi_attrib.is_msix) {
			if (list_is_last(&entry->list, &dev->msi_list))
				iounmap(entry->mask_base);
		}
		list_del(&entry->list);
		kfree(entry);
	}
}
S
Satoru Takeuchi 已提交
324

325
static struct msi_desc *alloc_msi_entry(struct pci_dev *dev)
L
Linus Torvalds 已提交
326
{
327 328
	struct msi_desc *desc = kzalloc(sizeof(*desc), GFP_KERNEL);
	if (!desc)
L
Linus Torvalds 已提交
329 330
		return NULL;

331 332
	INIT_LIST_HEAD(&desc->list);
	desc->dev = dev;
L
Linus Torvalds 已提交
333

334
	return desc;
L
Linus Torvalds 已提交
335 336
}

337 338 339 340 341 342
static void pci_intx_for_msi(struct pci_dev *dev, int enable)
{
	if (!(dev->dev_flags & PCI_DEV_FLAGS_MSI_INTX_DISABLE_BUG))
		pci_intx(dev, enable);
}

343
static void __pci_restore_msi_state(struct pci_dev *dev)
344
{
345
	int pos;
346
	u16 control;
347
	struct msi_desc *entry;
348

349 350 351
	if (!dev->msi_enabled)
		return;

352 353
	entry = get_irq_msi(dev->irq);
	pos = entry->msi_attrib.pos;
354

355
	pci_intx_for_msi(dev, 0);
356
	msi_set_enable(dev, pos, 0);
357 358 359
	write_msi_msg(dev->irq, &entry->msg);

	pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
360
	msi_mask_irq(entry, msi_capable_mask(control), entry->masked);
361
	control &= ~PCI_MSI_FLAGS_QSIZE;
362
	control |= (entry->msi_attrib.multiple << 4) | PCI_MSI_FLAGS_ENABLE;
363
	pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
364 365 366
}

static void __pci_restore_msix_state(struct pci_dev *dev)
367 368 369
{
	int pos;
	struct msi_desc *entry;
370
	u16 control;
371

E
Eric W. Biederman 已提交
372 373
	if (!dev->msix_enabled)
		return;
374
	BUG_ON(list_empty(&dev->msi_list));
H
Hidetoshi Seto 已提交
375
	entry = list_first_entry(&dev->msi_list, struct msi_desc, list);
376 377
	pos = entry->msi_attrib.pos;
	pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
E
Eric W. Biederman 已提交
378

379
	/* route the table */
380
	pci_intx_for_msi(dev, 0);
381 382
	control |= PCI_MSIX_FLAGS_ENABLE | PCI_MSIX_FLAGS_MASKALL;
	pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
383

384 385
	list_for_each_entry(entry, &dev->msi_list, list) {
		write_msi_msg(entry->irq, &entry->msg);
386
		msix_mask_irq(entry, entry->masked);
387 388
	}

389 390
	control &= ~PCI_MSIX_FLAGS_MASKALL;
	pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
391
}
392 393 394 395 396 397

void pci_restore_msi_state(struct pci_dev *dev)
{
	__pci_restore_msi_state(dev);
	__pci_restore_msix_state(dev);
}
398
EXPORT_SYMBOL_GPL(pci_restore_msi_state);
399

L
Linus Torvalds 已提交
400 401 402
/**
 * msi_capability_init - configure device's MSI capability structure
 * @dev: pointer to the pci_dev data structure of MSI device function
403
 * @nvec: number of interrupts to allocate
L
Linus Torvalds 已提交
404
 *
405 406 407 408 409 410 411
 * Setup the MSI capability structure of the device with the requested
 * number of interrupts.  A return value of zero indicates the successful
 * setup of an entry with the new MSI irq.  A negative return value indicates
 * an error, and a positive return value indicates the number of interrupts
 * which could have been allocated.
 */
static int msi_capability_init(struct pci_dev *dev, int nvec)
L
Linus Torvalds 已提交
412 413
{
	struct msi_desc *entry;
414
	int pos, ret;
L
Linus Torvalds 已提交
415
	u16 control;
416
	unsigned mask;
L
Linus Torvalds 已提交
417

H
Hidetoshi Seto 已提交
418
	pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
419 420
	msi_set_enable(dev, pos, 0);	/* Disable MSI during set up */

L
Linus Torvalds 已提交
421 422
	pci_read_config_word(dev, msi_control_reg(pos), &control);
	/* MSI Entry Initialization */
423
	entry = alloc_msi_entry(dev);
424 425
	if (!entry)
		return -ENOMEM;
426

H
Hidetoshi Seto 已提交
427 428 429 430 431 432
	entry->msi_attrib.is_msix	= 0;
	entry->msi_attrib.is_64		= is_64bit_address(control);
	entry->msi_attrib.entry_nr	= 0;
	entry->msi_attrib.maskbit	= is_mask_bit_support(control);
	entry->msi_attrib.default_irq	= dev->irq;	/* Save IOAPIC IRQ */
	entry->msi_attrib.pos		= pos;
433

434
	entry->mask_pos = msi_mask_reg(pos, entry->msi_attrib.is_64);
435 436 437 438 439 440
	/* All MSIs are unmasked by default, Mask them all */
	if (entry->msi_attrib.maskbit)
		pci_read_config_dword(dev, entry->mask_pos, &entry->masked);
	mask = msi_capable_mask(control);
	msi_mask_irq(entry, mask, mask);

441
	list_add_tail(&entry->list, &dev->msi_list);
442

L
Linus Torvalds 已提交
443
	/* Configure MSI capability structure */
444
	ret = arch_setup_msi_irqs(dev, nvec, PCI_CAP_ID_MSI);
445
	if (ret) {
446
		msi_mask_irq(entry, mask, ~mask);
447
		free_msi_irqs(dev);
448
		return ret;
449
	}
450

L
Linus Torvalds 已提交
451
	/* Set MSI enabled bits	 */
452
	pci_intx_for_msi(dev, 0);
453
	msi_set_enable(dev, pos, 1);
454
	dev->msi_enabled = 1;
L
Linus Torvalds 已提交
455

456
	dev->irq = entry->irq;
L
Linus Torvalds 已提交
457 458 459
	return 0;
}

460 461 462
static void __iomem *msix_map_region(struct pci_dev *dev, unsigned pos,
							unsigned nr_entries)
{
463
	resource_size_t phys_addr;
464 465 466 467 468 469 470 471 472 473 474
	u32 table_offset;
	u8 bir;

	pci_read_config_dword(dev, msix_table_offset_reg(pos), &table_offset);
	bir = (u8)(table_offset & PCI_MSIX_FLAGS_BIRMASK);
	table_offset &= ~PCI_MSIX_FLAGS_BIRMASK;
	phys_addr = pci_resource_start(dev, bir) + table_offset;

	return ioremap_nocache(phys_addr, nr_entries * PCI_MSIX_ENTRY_SIZE);
}

475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505
static int msix_setup_entries(struct pci_dev *dev, unsigned pos,
				void __iomem *base, struct msix_entry *entries,
				int nvec)
{
	struct msi_desc *entry;
	int i;

	for (i = 0; i < nvec; i++) {
		entry = alloc_msi_entry(dev);
		if (!entry) {
			if (!i)
				iounmap(base);
			else
				free_msi_irqs(dev);
			/* No enough memory. Don't try again */
			return -ENOMEM;
		}

		entry->msi_attrib.is_msix	= 1;
		entry->msi_attrib.is_64		= 1;
		entry->msi_attrib.entry_nr	= entries[i].entry;
		entry->msi_attrib.default_irq	= dev->irq;
		entry->msi_attrib.pos		= pos;
		entry->mask_base		= base;

		list_add_tail(&entry->list, &dev->msi_list);
	}

	return 0;
}

506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523
static void msix_program_entries(struct pci_dev *dev,
					struct msix_entry *entries)
{
	struct msi_desc *entry;
	int i = 0;

	list_for_each_entry(entry, &dev->msi_list, list) {
		int offset = entries[i].entry * PCI_MSIX_ENTRY_SIZE +
						PCI_MSIX_ENTRY_VECTOR_CTRL;

		entries[i].vector = entry->irq;
		set_irq_msi(entry->irq, entry);
		entry->masked = readl(entry->mask_base + offset);
		msix_mask_irq(entry, 1);
		i++;
	}
}

L
Linus Torvalds 已提交
524 525 526
/**
 * msix_capability_init - configure device's MSI-X capability
 * @dev: pointer to the pci_dev data structure of MSI-X device function
R
Randy Dunlap 已提交
527 528
 * @entries: pointer to an array of struct msix_entry entries
 * @nvec: number of @entries
L
Linus Torvalds 已提交
529
 *
530
 * Setup the MSI-X capability structure of device function with a
531 532
 * single MSI-X irq. A return of zero indicates the successful setup of
 * requested MSI-X entries with allocated irqs or non-zero for otherwise.
L
Linus Torvalds 已提交
533 534 535 536
 **/
static int msix_capability_init(struct pci_dev *dev,
				struct msix_entry *entries, int nvec)
{
537
	int pos, ret;
538
	u16 control;
L
Linus Torvalds 已提交
539 540
	void __iomem *base;

H
Hidetoshi Seto 已提交
541
	pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
542 543 544 545 546 547
	pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);

	/* Ensure MSI-X is disabled while it is set up */
	control &= ~PCI_MSIX_FLAGS_ENABLE;
	pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);

L
Linus Torvalds 已提交
548
	/* Request & Map MSI-X table region */
549 550
	base = msix_map_region(dev, pos, multi_msix_capable(control));
	if (!base)
L
Linus Torvalds 已提交
551 552
		return -ENOMEM;

553 554 555
	ret = msix_setup_entries(dev, pos, base, entries, nvec);
	if (ret)
		return ret;
556 557

	ret = arch_setup_msi_irqs(dev, nvec, PCI_CAP_ID_MSIX);
558 559
	if (ret)
		goto error;
560

561 562 563 564 565 566 567 568
	/*
	 * Some devices require MSI-X to be enabled before we can touch the
	 * MSI-X registers.  We need to mask all the vectors to prevent
	 * interrupts coming in before they're fully set up.
	 */
	control |= PCI_MSIX_FLAGS_MASKALL | PCI_MSIX_FLAGS_ENABLE;
	pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);

569
	msix_program_entries(dev, entries);
570 571

	/* Set MSI-X enabled bits and unmask the function */
572
	pci_intx_for_msi(dev, 0);
573
	dev->msix_enabled = 1;
L
Linus Torvalds 已提交
574

575 576
	control &= ~PCI_MSIX_FLAGS_MASKALL;
	pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
577

L
Linus Torvalds 已提交
578
	return 0;
579 580 581 582 583 584 585

error:
	if (ret < 0) {
		/*
		 * If we had some success, report the number of irqs
		 * we succeeded in setting up.
		 */
586
		struct msi_desc *entry;
587 588 589 590 591 592 593 594 595 596 597 598 599
		int avail = 0;

		list_for_each_entry(entry, &dev->msi_list, list) {
			if (entry->irq != 0)
				avail++;
		}
		if (avail != 0)
			ret = avail;
	}

	free_msi_irqs(dev);

	return ret;
L
Linus Torvalds 已提交
600 601
}

602
/**
603
 * pci_msi_check_device - check whether MSI may be enabled on a device
604
 * @dev: pointer to the pci_dev data structure of MSI device function
605
 * @nvec: how many MSIs have been requested ?
606
 * @type: are we checking for MSI or MSI-X ?
607
 *
608
 * Look at global flags, the device itself, and its parent busses
609 610
 * to determine if MSI/-X are supported for the device. If MSI/-X is
 * supported return 0, else return an error code.
611
 **/
H
Hidetoshi Seto 已提交
612
static int pci_msi_check_device(struct pci_dev *dev, int nvec, int type)
613 614
{
	struct pci_bus *bus;
615
	int ret;
616

617
	/* MSI must be globally enabled and supported by the device */
618 619 620
	if (!pci_msi_enable || !dev || dev->no_msi)
		return -EINVAL;

621 622 623 624 625 626 627 628
	/*
	 * You can't ask to have 0 or less MSIs configured.
	 *  a) it's stupid ..
	 *  b) the list manipulation code assumes nvec >= 1.
	 */
	if (nvec < 1)
		return -ERANGE;

H
Hidetoshi Seto 已提交
629 630 631
	/*
	 * Any bridge which does NOT route MSI transactions from its
	 * secondary bus to its primary bus must set NO_MSI flag on
632 633 634 635
	 * the secondary pci_bus.
	 * We expect only arch-specific PCI host bus controller driver
	 * or quirks for specific PCI bridges to be setting NO_MSI.
	 */
636 637 638 639
	for (bus = dev->bus; bus; bus = bus->parent)
		if (bus->bus_flags & PCI_BUS_FLAGS_NO_MSI)
			return -EINVAL;

640 641 642 643
	ret = arch_msi_check_device(dev, nvec, type);
	if (ret)
		return ret;

644 645 646
	if (!pci_find_capability(dev, type))
		return -EINVAL;

647 648 649
	return 0;
}

L
Linus Torvalds 已提交
650
/**
651 652 653
 * pci_enable_msi_block - configure device's MSI capability structure
 * @dev: device to configure
 * @nvec: number of interrupts to configure
L
Linus Torvalds 已提交
654
 *
655 656 657 658 659 660 661 662 663
 * Allocate IRQs for a device with the MSI capability.
 * This function returns a negative errno if an error occurs.  If it
 * is unable to allocate the number of interrupts requested, it returns
 * the number of interrupts it might be able to allocate.  If it successfully
 * allocates at least the number of interrupts requested, it returns 0 and
 * updates the @dev's irq member to the lowest new interrupt number; the
 * other interrupt numbers allocated to this device are consecutive.
 */
int pci_enable_msi_block(struct pci_dev *dev, unsigned int nvec)
L
Linus Torvalds 已提交
664
{
665 666 667 668 669 670 671 672 673 674
	int status, pos, maxvec;
	u16 msgctl;

	pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
	if (!pos)
		return -EINVAL;
	pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &msgctl);
	maxvec = 1 << ((msgctl & PCI_MSI_FLAGS_QMASK) >> 1);
	if (nvec > maxvec)
		return maxvec;
L
Linus Torvalds 已提交
675

676
	status = pci_msi_check_device(dev, nvec, PCI_CAP_ID_MSI);
677 678
	if (status)
		return status;
L
Linus Torvalds 已提交
679

E
Eric W. Biederman 已提交
680
	WARN_ON(!!dev->msi_enabled);
L
Linus Torvalds 已提交
681

682
	/* Check whether driver already requested MSI-X irqs */
683
	if (dev->msix_enabled) {
684 685
		dev_info(&dev->dev, "can't enable MSI "
			 "(MSI-X already enabled)\n");
686
		return -EINVAL;
L
Linus Torvalds 已提交
687
	}
688 689

	status = msi_capability_init(dev, nvec);
L
Linus Torvalds 已提交
690 691
	return status;
}
692
EXPORT_SYMBOL(pci_enable_msi_block);
L
Linus Torvalds 已提交
693

694
void pci_msi_shutdown(struct pci_dev *dev)
L
Linus Torvalds 已提交
695
{
696 697 698
	struct msi_desc *desc;
	u32 mask;
	u16 ctrl;
699
	unsigned pos;
L
Linus Torvalds 已提交
700

701
	if (!pci_msi_enable || !dev || !dev->msi_enabled)
E
Eric W. Biederman 已提交
702 703
		return;

704 705 706 707 708
	BUG_ON(list_empty(&dev->msi_list));
	desc = list_first_entry(&dev->msi_list, struct msi_desc, list);
	pos = desc->msi_attrib.pos;

	msi_set_enable(dev, pos, 0);
709
	pci_intx_for_msi(dev, 1);
710
	dev->msi_enabled = 0;
711

712
	/* Return the device with MSI unmasked as initial states */
713
	pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &ctrl);
714
	mask = msi_capable_mask(ctrl);
715 716
	/* Keep cached state to be restored */
	__msi_mask_irq(desc, mask, ~mask);
717 718

	/* Restore dev->irq to its default pin-assertion irq */
719
	dev->irq = desc->msi_attrib.default_irq;
720
}
721

H
Hidetoshi Seto 已提交
722
void pci_disable_msi(struct pci_dev *dev)
723 724 725 726 727
{
	if (!pci_msi_enable || !dev || !dev->msi_enabled)
		return;

	pci_msi_shutdown(dev);
728
	free_msi_irqs(dev);
L
Linus Torvalds 已提交
729
}
730
EXPORT_SYMBOL(pci_disable_msi);
L
Linus Torvalds 已提交
731

732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748
/**
 * pci_msix_table_size - return the number of device's MSI-X table entries
 * @dev: pointer to the pci_dev data structure of MSI-X device function
 */
int pci_msix_table_size(struct pci_dev *dev)
{
	int pos;
	u16 control;

	pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
	if (!pos)
		return 0;

	pci_read_config_word(dev, msi_control_reg(pos), &control);
	return multi_msix_capable(control);
}

L
Linus Torvalds 已提交
749 750 751
/**
 * pci_enable_msix - configure device's MSI-X capability structure
 * @dev: pointer to the pci_dev data structure of MSI-X device function
752
 * @entries: pointer to an array of MSI-X entries
753
 * @nvec: number of MSI-X irqs requested for allocation by device driver
L
Linus Torvalds 已提交
754 755
 *
 * Setup the MSI-X capability structure of device function with the number
756
 * of requested irqs upon its software driver call to request for
L
Linus Torvalds 已提交
757 758
 * MSI-X mode enabled on its hardware device function. A return of zero
 * indicates the successful configuration of MSI-X capability structure
759
 * with new allocated MSI-X irqs. A return of < 0 indicates a failure.
L
Linus Torvalds 已提交
760
 * Or a return of > 0 indicates that driver request is exceeding the number
761 762
 * of irqs or MSI-X vectors available. Driver should use the returned value to
 * re-send its request.
L
Linus Torvalds 已提交
763
 **/
H
Hidetoshi Seto 已提交
764
int pci_enable_msix(struct pci_dev *dev, struct msix_entry *entries, int nvec)
L
Linus Torvalds 已提交
765
{
766
	int status, nr_entries;
E
Eric W. Biederman 已提交
767
	int i, j;
L
Linus Torvalds 已提交
768

769
	if (!entries)
H
Hidetoshi Seto 已提交
770
		return -EINVAL;
L
Linus Torvalds 已提交
771

772 773 774 775
	status = pci_msi_check_device(dev, nvec, PCI_CAP_ID_MSIX);
	if (status)
		return status;

776
	nr_entries = pci_msix_table_size(dev);
L
Linus Torvalds 已提交
777
	if (nvec > nr_entries)
778
		return nr_entries;
L
Linus Torvalds 已提交
779 780 781 782 783 784 785 786 787 788

	/* Check for any invalid entries */
	for (i = 0; i < nvec; i++) {
		if (entries[i].entry >= nr_entries)
			return -EINVAL;		/* invalid entry */
		for (j = i + 1; j < nvec; j++) {
			if (entries[i].entry == entries[j].entry)
				return -EINVAL;	/* duplicate entry */
		}
	}
E
Eric W. Biederman 已提交
789
	WARN_ON(!!dev->msix_enabled);
790

791
	/* Check whether driver already requested for MSI irq */
H
Hidetoshi Seto 已提交
792
	if (dev->msi_enabled) {
793 794
		dev_info(&dev->dev, "can't enable MSI-X "
		       "(MSI IRQ already assigned)\n");
L
Linus Torvalds 已提交
795 796 797 798 799
		return -EINVAL;
	}
	status = msix_capability_init(dev, entries, nvec);
	return status;
}
800
EXPORT_SYMBOL(pci_enable_msix);
L
Linus Torvalds 已提交
801

H
Hidetoshi Seto 已提交
802
void pci_msix_shutdown(struct pci_dev *dev)
803
{
804 805
	struct msi_desc *entry;

806
	if (!pci_msi_enable || !dev || !dev->msix_enabled)
E
Eric W. Biederman 已提交
807 808
		return;

809 810 811 812 813 814
	/* Return the device with MSI-X masked as initial states */
	list_for_each_entry(entry, &dev->msi_list, list) {
		/* Keep cached states to be restored */
		__msix_mask_irq(entry, 1);
	}

815
	msix_set_enable(dev, 0);
816
	pci_intx_for_msi(dev, 1);
817
	dev->msix_enabled = 0;
818
}
819

H
Hidetoshi Seto 已提交
820
void pci_disable_msix(struct pci_dev *dev)
821 822 823 824 825
{
	if (!pci_msi_enable || !dev || !dev->msix_enabled)
		return;

	pci_msix_shutdown(dev);
826
	free_msi_irqs(dev);
L
Linus Torvalds 已提交
827
}
828
EXPORT_SYMBOL(pci_disable_msix);
L
Linus Torvalds 已提交
829 830

/**
831
 * msi_remove_pci_irq_vectors - reclaim MSI(X) irqs to unused state
L
Linus Torvalds 已提交
832 833
 * @dev: pointer to the pci_dev data structure of MSI(X) device function
 *
834
 * Being called during hotplug remove, from which the device function
835
 * is hot-removed. All previous assigned MSI/MSI-X irqs, if
L
Linus Torvalds 已提交
836 837 838
 * allocated for this device function, are reclaimed to unused state,
 * which may be used later on.
 **/
H
Hidetoshi Seto 已提交
839
void msi_remove_pci_irq_vectors(struct pci_dev *dev)
L
Linus Torvalds 已提交
840 841
{
	if (!pci_msi_enable || !dev)
H
Hidetoshi Seto 已提交
842
		return;
L
Linus Torvalds 已提交
843

844 845
	if (dev->msi_enabled || dev->msix_enabled)
		free_msi_irqs(dev);
L
Linus Torvalds 已提交
846 847
}

848 849 850 851
void pci_no_msi(void)
{
	pci_msi_enable = 0;
}
852

853 854 855 856 857 858 859
/**
 * pci_msi_enabled - is MSI enabled?
 *
 * Returns true if MSI has not been disabled by the command-line option
 * pci=nomsi.
 **/
int pci_msi_enabled(void)
860
{
861
	return pci_msi_enable;
862
}
863
EXPORT_SYMBOL(pci_msi_enabled);
864

865
void pci_msi_init_pci_dev(struct pci_dev *dev)
866
{
867
	INIT_LIST_HEAD(&dev->msi_list);
868
}