aboutsummaryrefslogtreecommitdiffstats
path: root/drivers
diff options
context:
space:
mode:
Diffstat (limited to 'drivers')
-rw-r--r--drivers/pci/msi.c31
1 files changed, 20 insertions, 11 deletions
diff --git a/drivers/pci/msi.c b/drivers/pci/msi.c
index 434c7182d926..7a44ba467481 100644
--- a/drivers/pci/msi.c
+++ b/drivers/pci/msi.c
@@ -269,7 +269,8 @@ static void __pci_restore_msix_state(struct pci_dev *dev)
269 msi_set_mask_bit(entry->irq, entry->msi_attrib.masked); 269 msi_set_mask_bit(entry->irq, entry->msi_attrib.masked);
270 } 270 }
271 271
272 entry = get_irq_msi(dev->first_msi_irq); 272 BUG_ON(list_empty(&dev->msi_list));
273 entry = list_entry(dev->msi_list.next, struct msi_desc, list);
273 pos = entry->msi_attrib.pos; 274 pos = entry->msi_attrib.pos;
274 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control); 275 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
275 control &= ~PCI_MSIX_FLAGS_MASKALL; 276 control &= ~PCI_MSIX_FLAGS_MASKALL;
@@ -341,7 +342,6 @@ static int msi_capability_init(struct pci_dev *dev)
341 } 342 }
342 entry->irq = irq; 343 entry->irq = irq;
343 list_add(&entry->list, &dev->msi_list); 344 list_add(&entry->list, &dev->msi_list);
344 dev->first_msi_irq = irq;
345 set_irq_msi(irq, entry); 345 set_irq_msi(irq, entry);
346 346
347 /* Set MSI enabled bits */ 347 /* Set MSI enabled bits */
@@ -433,7 +433,6 @@ static int msix_capability_init(struct pci_dev *dev,
433 avail = -EBUSY; 433 avail = -EBUSY;
434 return avail; 434 return avail;
435 } 435 }
436 dev->first_msi_irq = entries[0].vector;
437 /* Set MSI-X enabled bits */ 436 /* Set MSI-X enabled bits */
438 pci_intx(dev, 0); /* disable intx */ 437 pci_intx(dev, 0); /* disable intx */
439 msix_set_enable(dev, 1); 438 msix_set_enable(dev, 1);
@@ -461,6 +460,14 @@ static int pci_msi_check_device(struct pci_dev* dev, int nvec, int type)
461 if (!pci_msi_enable || !dev || dev->no_msi) 460 if (!pci_msi_enable || !dev || dev->no_msi)
462 return -EINVAL; 461 return -EINVAL;
463 462
463 /*
464 * You can't ask to have 0 or less MSIs configured.
465 * a) it's stupid ..
466 * b) the list manipulation code assumes nvec >= 1.
467 */
468 if (nvec < 1)
469 return -ERANGE;
470
464 /* Any bridge which does NOT route MSI transactions from it's 471 /* Any bridge which does NOT route MSI transactions from it's
465 * secondary bus to it's primary bus must set NO_MSI flag on 472 * secondary bus to it's primary bus must set NO_MSI flag on
466 * the secondary pci_bus. 473 * the secondary pci_bus.
@@ -525,18 +532,17 @@ void pci_disable_msi(struct pci_dev* dev)
525 pci_intx(dev, 1); /* enable intx */ 532 pci_intx(dev, 1); /* enable intx */
526 dev->msi_enabled = 0; 533 dev->msi_enabled = 0;
527 534
528 entry = get_irq_msi(dev->first_msi_irq); 535 BUG_ON(list_empty(&dev->msi_list));
529 if (!entry || !entry->dev || entry->msi_attrib.type != PCI_CAP_ID_MSI) { 536 entry = list_entry(dev->msi_list.next, struct msi_desc, list);
537 if (!entry->dev || entry->msi_attrib.type != PCI_CAP_ID_MSI) {
530 return; 538 return;
531 } 539 }
532 540
533 default_irq = entry->msi_attrib.default_irq; 541 default_irq = entry->msi_attrib.default_irq;
534 msi_free_irq(dev, dev->first_msi_irq); 542 msi_free_irq(dev, entry->irq);
535 543
536 /* Restore dev->irq to its default pin-assertion irq */ 544 /* Restore dev->irq to its default pin-assertion irq */
537 dev->irq = default_irq; 545 dev->irq = default_irq;
538
539 dev->first_msi_irq = 0;
540} 546}
541EXPORT_SYMBOL(pci_disable_msi); 547EXPORT_SYMBOL(pci_disable_msi);
542 548
@@ -634,7 +640,6 @@ static void msix_free_all_irqs(struct pci_dev *dev)
634 640
635 list_for_each_entry(entry, &dev->msi_list, list) 641 list_for_each_entry(entry, &dev->msi_list, list)
636 msi_free_irq(dev, entry->irq); 642 msi_free_irq(dev, entry->irq);
637 dev->first_msi_irq = 0;
638} 643}
639 644
640void pci_disable_msix(struct pci_dev* dev) 645void pci_disable_msix(struct pci_dev* dev)
@@ -664,8 +669,12 @@ void msi_remove_pci_irq_vectors(struct pci_dev* dev)
664 if (!pci_msi_enable || !dev) 669 if (!pci_msi_enable || !dev)
665 return; 670 return;
666 671
667 if (dev->msi_enabled) 672 if (dev->msi_enabled) {
668 msi_free_irq(dev, dev->first_msi_irq); 673 struct msi_desc *entry;
674 BUG_ON(list_empty(&dev->msi_list));
675 entry = list_entry(dev->msi_list.next, struct msi_desc, list);
676 msi_free_irq(dev, entry->irq);
677 }
669 678
670 if (dev->msix_enabled) 679 if (dev->msix_enabled)
671 msix_free_all_irqs(dev); 680 msix_free_all_irqs(dev);