3 * Purpose: PCI Message Signaled Interrupt (MSI)
5 * Copyright (C) 2003-2004 Intel
6 * Copyright (C) Tom Long Nguyen (tom.l.nguyen@intel.com)
7 * Copyright (C) 2016 Christoph Hellwig.
10 #include <linux/err.h>
12 #include <linux/irq.h>
13 #include <linux/interrupt.h>
14 #include <linux/export.h>
15 #include <linux/ioport.h>
16 #include <linux/pci.h>
17 #include <linux/proc_fs.h>
18 #include <linux/msi.h>
19 #include <linux/smp.h>
20 #include <linux/errno.h>
22 #include <linux/acpi_iort.h>
23 #include <linux/slab.h>
24 #include <linux/irqdomain.h>
25 #include <linux/of_irq.h>
29 static int pci_msi_enable
= 1;
30 int pci_msi_ignore_mask
;
32 #define msix_table_size(flags) ((flags & PCI_MSIX_FLAGS_QSIZE) + 1)
34 #ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
35 static int pci_msi_setup_msi_irqs(struct pci_dev
*dev
, int nvec
, int type
)
37 struct irq_domain
*domain
;
39 domain
= dev_get_msi_domain(&dev
->dev
);
40 if (domain
&& irq_domain_is_hierarchy(domain
))
41 return msi_domain_alloc_irqs(domain
, &dev
->dev
, nvec
);
43 return arch_setup_msi_irqs(dev
, nvec
, type
);
46 static void pci_msi_teardown_msi_irqs(struct pci_dev
*dev
)
48 struct irq_domain
*domain
;
50 domain
= dev_get_msi_domain(&dev
->dev
);
51 if (domain
&& irq_domain_is_hierarchy(domain
))
52 msi_domain_free_irqs(domain
, &dev
->dev
);
54 arch_teardown_msi_irqs(dev
);
57 #define pci_msi_setup_msi_irqs arch_setup_msi_irqs
58 #define pci_msi_teardown_msi_irqs arch_teardown_msi_irqs
63 int __weak
arch_setup_msi_irq(struct pci_dev
*dev
, struct msi_desc
*desc
)
65 struct msi_controller
*chip
= dev
->bus
->msi
;
68 if (!chip
|| !chip
->setup_irq
)
71 err
= chip
->setup_irq(chip
, dev
, desc
);
75 irq_set_chip_data(desc
->irq
, chip
);
80 void __weak
arch_teardown_msi_irq(unsigned int irq
)
82 struct msi_controller
*chip
= irq_get_chip_data(irq
);
84 if (!chip
|| !chip
->teardown_irq
)
87 chip
->teardown_irq(chip
, irq
);
90 int __weak
arch_setup_msi_irqs(struct pci_dev
*dev
, int nvec
, int type
)
92 struct msi_controller
*chip
= dev
->bus
->msi
;
93 struct msi_desc
*entry
;
96 if (chip
&& chip
->setup_irqs
)
97 return chip
->setup_irqs(chip
, dev
, nvec
, type
);
99 * If an architecture wants to support multiple MSI, it needs to
100 * override arch_setup_msi_irqs()
102 if (type
== PCI_CAP_ID_MSI
&& nvec
> 1)
105 for_each_pci_msi_entry(entry
, dev
) {
106 ret
= arch_setup_msi_irq(dev
, entry
);
117 * We have a default implementation available as a separate non-weak
118 * function, as it is used by the Xen x86 PCI code
120 void default_teardown_msi_irqs(struct pci_dev
*dev
)
123 struct msi_desc
*entry
;
125 for_each_pci_msi_entry(entry
, dev
)
127 for (i
= 0; i
< entry
->nvec_used
; i
++)
128 arch_teardown_msi_irq(entry
->irq
+ i
);
131 void __weak
arch_teardown_msi_irqs(struct pci_dev
*dev
)
133 return default_teardown_msi_irqs(dev
);
136 static void default_restore_msi_irq(struct pci_dev
*dev
, int irq
)
138 struct msi_desc
*entry
;
141 if (dev
->msix_enabled
) {
142 for_each_pci_msi_entry(entry
, dev
) {
143 if (irq
== entry
->irq
)
146 } else if (dev
->msi_enabled
) {
147 entry
= irq_get_msi_desc(irq
);
151 __pci_write_msi_msg(entry
, &entry
->msg
);
154 void __weak
arch_restore_msi_irqs(struct pci_dev
*dev
)
156 return default_restore_msi_irqs(dev
);
159 static inline __attribute_const__ u32
msi_mask(unsigned x
)
161 /* Don't shift by >= width of type */
164 return (1 << (1 << x
)) - 1;
168 * PCI 2.3 does not specify mask bits for each MSI interrupt. Attempting to
169 * mask all MSI interrupts by clearing the MSI enable bit does not work
170 * reliably as devices without an INTx disable bit will then generate a
171 * level IRQ which will never be cleared.
173 u32
__pci_msi_desc_mask_irq(struct msi_desc
*desc
, u32 mask
, u32 flag
)
175 u32 mask_bits
= desc
->masked
;
177 if (pci_msi_ignore_mask
|| !desc
->msi_attrib
.maskbit
)
182 pci_write_config_dword(msi_desc_to_pci_dev(desc
), desc
->mask_pos
,
188 static void msi_mask_irq(struct msi_desc
*desc
, u32 mask
, u32 flag
)
190 desc
->masked
= __pci_msi_desc_mask_irq(desc
, mask
, flag
);
193 static void __iomem
*pci_msix_desc_addr(struct msi_desc
*desc
)
195 return desc
->mask_base
+
196 desc
->msi_attrib
.entry_nr
* PCI_MSIX_ENTRY_SIZE
;
200 * This internal function does not flush PCI writes to the device.
201 * All users must ensure that they read from the device before either
202 * assuming that the device state is up to date, or returning out of this
203 * file. This saves a few milliseconds when initialising devices with lots
204 * of MSI-X interrupts.
206 u32
__pci_msix_desc_mask_irq(struct msi_desc
*desc
, u32 flag
)
208 u32 mask_bits
= desc
->masked
;
210 if (pci_msi_ignore_mask
)
213 mask_bits
&= ~PCI_MSIX_ENTRY_CTRL_MASKBIT
;
215 mask_bits
|= PCI_MSIX_ENTRY_CTRL_MASKBIT
;
216 writel(mask_bits
, pci_msix_desc_addr(desc
) + PCI_MSIX_ENTRY_VECTOR_CTRL
);
221 static void msix_mask_irq(struct msi_desc
*desc
, u32 flag
)
223 desc
->masked
= __pci_msix_desc_mask_irq(desc
, flag
);
226 static void msi_set_mask_bit(struct irq_data
*data
, u32 flag
)
228 struct msi_desc
*desc
= irq_data_get_msi_desc(data
);
230 if (desc
->msi_attrib
.is_msix
) {
231 msix_mask_irq(desc
, flag
);
232 readl(desc
->mask_base
); /* Flush write to device */
234 unsigned offset
= data
->irq
- desc
->irq
;
235 msi_mask_irq(desc
, 1 << offset
, flag
<< offset
);
240 * pci_msi_mask_irq - Generic irq chip callback to mask PCI/MSI interrupts
241 * @data: pointer to irqdata associated to that interrupt
243 void pci_msi_mask_irq(struct irq_data
*data
)
245 msi_set_mask_bit(data
, 1);
247 EXPORT_SYMBOL_GPL(pci_msi_mask_irq
);
250 * pci_msi_unmask_irq - Generic irq chip callback to unmask PCI/MSI interrupts
251 * @data: pointer to irqdata associated to that interrupt
253 void pci_msi_unmask_irq(struct irq_data
*data
)
255 msi_set_mask_bit(data
, 0);
257 EXPORT_SYMBOL_GPL(pci_msi_unmask_irq
);
259 void default_restore_msi_irqs(struct pci_dev
*dev
)
261 struct msi_desc
*entry
;
263 for_each_pci_msi_entry(entry
, dev
)
264 default_restore_msi_irq(dev
, entry
->irq
);
267 void __pci_read_msi_msg(struct msi_desc
*entry
, struct msi_msg
*msg
)
269 struct pci_dev
*dev
= msi_desc_to_pci_dev(entry
);
271 BUG_ON(dev
->current_state
!= PCI_D0
);
273 if (entry
->msi_attrib
.is_msix
) {
274 void __iomem
*base
= pci_msix_desc_addr(entry
);
276 msg
->address_lo
= readl(base
+ PCI_MSIX_ENTRY_LOWER_ADDR
);
277 msg
->address_hi
= readl(base
+ PCI_MSIX_ENTRY_UPPER_ADDR
);
278 msg
->data
= readl(base
+ PCI_MSIX_ENTRY_DATA
);
280 int pos
= dev
->msi_cap
;
283 pci_read_config_dword(dev
, pos
+ PCI_MSI_ADDRESS_LO
,
285 if (entry
->msi_attrib
.is_64
) {
286 pci_read_config_dword(dev
, pos
+ PCI_MSI_ADDRESS_HI
,
288 pci_read_config_word(dev
, pos
+ PCI_MSI_DATA_64
, &data
);
291 pci_read_config_word(dev
, pos
+ PCI_MSI_DATA_32
, &data
);
297 void __pci_write_msi_msg(struct msi_desc
*entry
, struct msi_msg
*msg
)
299 struct pci_dev
*dev
= msi_desc_to_pci_dev(entry
);
301 if (dev
->current_state
!= PCI_D0
) {
302 /* Don't touch the hardware now */
303 } else if (entry
->msi_attrib
.is_msix
) {
304 void __iomem
*base
= pci_msix_desc_addr(entry
);
306 writel(msg
->address_lo
, base
+ PCI_MSIX_ENTRY_LOWER_ADDR
);
307 writel(msg
->address_hi
, base
+ PCI_MSIX_ENTRY_UPPER_ADDR
);
308 writel(msg
->data
, base
+ PCI_MSIX_ENTRY_DATA
);
310 int pos
= dev
->msi_cap
;
313 pci_read_config_word(dev
, pos
+ PCI_MSI_FLAGS
, &msgctl
);
314 msgctl
&= ~PCI_MSI_FLAGS_QSIZE
;
315 msgctl
|= entry
->msi_attrib
.multiple
<< 4;
316 pci_write_config_word(dev
, pos
+ PCI_MSI_FLAGS
, msgctl
);
318 pci_write_config_dword(dev
, pos
+ PCI_MSI_ADDRESS_LO
,
320 if (entry
->msi_attrib
.is_64
) {
321 pci_write_config_dword(dev
, pos
+ PCI_MSI_ADDRESS_HI
,
323 pci_write_config_word(dev
, pos
+ PCI_MSI_DATA_64
,
326 pci_write_config_word(dev
, pos
+ PCI_MSI_DATA_32
,
333 void pci_write_msi_msg(unsigned int irq
, struct msi_msg
*msg
)
335 struct msi_desc
*entry
= irq_get_msi_desc(irq
);
337 __pci_write_msi_msg(entry
, msg
);
339 EXPORT_SYMBOL_GPL(pci_write_msi_msg
);
341 static void free_msi_irqs(struct pci_dev
*dev
)
343 struct list_head
*msi_list
= dev_to_msi_list(&dev
->dev
);
344 struct msi_desc
*entry
, *tmp
;
345 struct attribute
**msi_attrs
;
346 struct device_attribute
*dev_attr
;
349 for_each_pci_msi_entry(entry
, dev
)
351 for (i
= 0; i
< entry
->nvec_used
; i
++)
352 BUG_ON(irq_has_action(entry
->irq
+ i
));
354 pci_msi_teardown_msi_irqs(dev
);
356 list_for_each_entry_safe(entry
, tmp
, msi_list
, list
) {
357 if (entry
->msi_attrib
.is_msix
) {
358 if (list_is_last(&entry
->list
, msi_list
))
359 iounmap(entry
->mask_base
);
362 list_del(&entry
->list
);
363 free_msi_entry(entry
);
366 if (dev
->msi_irq_groups
) {
367 sysfs_remove_groups(&dev
->dev
.kobj
, dev
->msi_irq_groups
);
368 msi_attrs
= dev
->msi_irq_groups
[0]->attrs
;
369 while (msi_attrs
[count
]) {
370 dev_attr
= container_of(msi_attrs
[count
],
371 struct device_attribute
, attr
);
372 kfree(dev_attr
->attr
.name
);
377 kfree(dev
->msi_irq_groups
[0]);
378 kfree(dev
->msi_irq_groups
);
379 dev
->msi_irq_groups
= NULL
;
383 static void pci_intx_for_msi(struct pci_dev
*dev
, int enable
)
385 if (!(dev
->dev_flags
& PCI_DEV_FLAGS_MSI_INTX_DISABLE_BUG
))
386 pci_intx(dev
, enable
);
389 static void __pci_restore_msi_state(struct pci_dev
*dev
)
392 struct msi_desc
*entry
;
394 if (!dev
->msi_enabled
)
397 entry
= irq_get_msi_desc(dev
->irq
);
399 pci_intx_for_msi(dev
, 0);
400 pci_msi_set_enable(dev
, 0);
401 arch_restore_msi_irqs(dev
);
403 pci_read_config_word(dev
, dev
->msi_cap
+ PCI_MSI_FLAGS
, &control
);
404 msi_mask_irq(entry
, msi_mask(entry
->msi_attrib
.multi_cap
),
406 control
&= ~PCI_MSI_FLAGS_QSIZE
;
407 control
|= (entry
->msi_attrib
.multiple
<< 4) | PCI_MSI_FLAGS_ENABLE
;
408 pci_write_config_word(dev
, dev
->msi_cap
+ PCI_MSI_FLAGS
, control
);
411 static void __pci_restore_msix_state(struct pci_dev
*dev
)
413 struct msi_desc
*entry
;
415 if (!dev
->msix_enabled
)
417 BUG_ON(list_empty(dev_to_msi_list(&dev
->dev
)));
419 /* route the table */
420 pci_intx_for_msi(dev
, 0);
421 pci_msix_clear_and_set_ctrl(dev
, 0,
422 PCI_MSIX_FLAGS_ENABLE
| PCI_MSIX_FLAGS_MASKALL
);
424 arch_restore_msi_irqs(dev
);
425 for_each_pci_msi_entry(entry
, dev
)
426 msix_mask_irq(entry
, entry
->masked
);
428 pci_msix_clear_and_set_ctrl(dev
, PCI_MSIX_FLAGS_MASKALL
, 0);
431 void pci_restore_msi_state(struct pci_dev
*dev
)
433 __pci_restore_msi_state(dev
);
434 __pci_restore_msix_state(dev
);
436 EXPORT_SYMBOL_GPL(pci_restore_msi_state
);
438 static ssize_t
msi_mode_show(struct device
*dev
, struct device_attribute
*attr
,
441 struct msi_desc
*entry
;
445 retval
= kstrtoul(attr
->attr
.name
, 10, &irq
);
449 entry
= irq_get_msi_desc(irq
);
451 return sprintf(buf
, "%s\n",
452 entry
->msi_attrib
.is_msix
? "msix" : "msi");
457 static int populate_msi_sysfs(struct pci_dev
*pdev
)
459 struct attribute
**msi_attrs
;
460 struct attribute
*msi_attr
;
461 struct device_attribute
*msi_dev_attr
;
462 struct attribute_group
*msi_irq_group
;
463 const struct attribute_group
**msi_irq_groups
;
464 struct msi_desc
*entry
;
470 /* Determine how many msi entries we have */
471 for_each_pci_msi_entry(entry
, pdev
)
472 num_msi
+= entry
->nvec_used
;
476 /* Dynamically create the MSI attributes for the PCI device */
477 msi_attrs
= kzalloc(sizeof(void *) * (num_msi
+ 1), GFP_KERNEL
);
480 for_each_pci_msi_entry(entry
, pdev
) {
481 for (i
= 0; i
< entry
->nvec_used
; i
++) {
482 msi_dev_attr
= kzalloc(sizeof(*msi_dev_attr
), GFP_KERNEL
);
485 msi_attrs
[count
] = &msi_dev_attr
->attr
;
487 sysfs_attr_init(&msi_dev_attr
->attr
);
488 msi_dev_attr
->attr
.name
= kasprintf(GFP_KERNEL
, "%d",
490 if (!msi_dev_attr
->attr
.name
)
492 msi_dev_attr
->attr
.mode
= S_IRUGO
;
493 msi_dev_attr
->show
= msi_mode_show
;
498 msi_irq_group
= kzalloc(sizeof(*msi_irq_group
), GFP_KERNEL
);
501 msi_irq_group
->name
= "msi_irqs";
502 msi_irq_group
->attrs
= msi_attrs
;
504 msi_irq_groups
= kzalloc(sizeof(void *) * 2, GFP_KERNEL
);
506 goto error_irq_group
;
507 msi_irq_groups
[0] = msi_irq_group
;
509 ret
= sysfs_create_groups(&pdev
->dev
.kobj
, msi_irq_groups
);
511 goto error_irq_groups
;
512 pdev
->msi_irq_groups
= msi_irq_groups
;
517 kfree(msi_irq_groups
);
519 kfree(msi_irq_group
);
522 msi_attr
= msi_attrs
[count
];
524 msi_dev_attr
= container_of(msi_attr
, struct device_attribute
, attr
);
525 kfree(msi_attr
->name
);
528 msi_attr
= msi_attrs
[count
];
534 static struct msi_desc
*
535 msi_setup_entry(struct pci_dev
*dev
, int nvec
, const struct irq_affinity
*affd
)
537 struct cpumask
*masks
= NULL
;
538 struct msi_desc
*entry
;
542 masks
= irq_create_affinity_masks(nvec
, affd
);
544 pr_err("Unable to allocate affinity masks, ignoring\n");
547 /* MSI Entry Initialization */
548 entry
= alloc_msi_entry(&dev
->dev
, nvec
, masks
);
552 pci_read_config_word(dev
, dev
->msi_cap
+ PCI_MSI_FLAGS
, &control
);
554 entry
->msi_attrib
.is_msix
= 0;
555 entry
->msi_attrib
.is_64
= !!(control
& PCI_MSI_FLAGS_64BIT
);
556 entry
->msi_attrib
.entry_nr
= 0;
557 entry
->msi_attrib
.maskbit
= !!(control
& PCI_MSI_FLAGS_MASKBIT
);
558 entry
->msi_attrib
.default_irq
= dev
->irq
; /* Save IOAPIC IRQ */
559 entry
->msi_attrib
.multi_cap
= (control
& PCI_MSI_FLAGS_QMASK
) >> 1;
560 entry
->msi_attrib
.multiple
= ilog2(__roundup_pow_of_two(nvec
));
562 if (control
& PCI_MSI_FLAGS_64BIT
)
563 entry
->mask_pos
= dev
->msi_cap
+ PCI_MSI_MASK_64
;
565 entry
->mask_pos
= dev
->msi_cap
+ PCI_MSI_MASK_32
;
567 /* Save the initial mask status */
568 if (entry
->msi_attrib
.maskbit
)
569 pci_read_config_dword(dev
, entry
->mask_pos
, &entry
->masked
);
576 static int msi_verify_entries(struct pci_dev
*dev
)
578 struct msi_desc
*entry
;
580 for_each_pci_msi_entry(entry
, dev
) {
581 if (!dev
->no_64bit_msi
|| !entry
->msg
.address_hi
)
583 dev_err(&dev
->dev
, "Device has broken 64-bit MSI but arch"
584 " tried to assign one above 4G\n");
591 * msi_capability_init - configure device's MSI capability structure
592 * @dev: pointer to the pci_dev data structure of MSI device function
593 * @nvec: number of interrupts to allocate
594 * @affd: description of automatic irq affinity assignments (may be %NULL)
596 * Setup the MSI capability structure of the device with the requested
597 * number of interrupts. A return value of zero indicates the successful
598 * setup of an entry with the new MSI irq. A negative return value indicates
599 * an error, and a positive return value indicates the number of interrupts
600 * which could have been allocated.
602 static int msi_capability_init(struct pci_dev
*dev
, int nvec
,
603 const struct irq_affinity
*affd
)
605 struct msi_desc
*entry
;
609 pci_msi_set_enable(dev
, 0); /* Disable MSI during set up */
611 entry
= msi_setup_entry(dev
, nvec
, affd
);
615 /* All MSIs are unmasked by default, Mask them all */
616 mask
= msi_mask(entry
->msi_attrib
.multi_cap
);
617 msi_mask_irq(entry
, mask
, mask
);
619 list_add_tail(&entry
->list
, dev_to_msi_list(&dev
->dev
));
621 /* Configure MSI capability structure */
622 ret
= pci_msi_setup_msi_irqs(dev
, nvec
, PCI_CAP_ID_MSI
);
624 msi_mask_irq(entry
, mask
, ~mask
);
629 ret
= msi_verify_entries(dev
);
631 msi_mask_irq(entry
, mask
, ~mask
);
636 ret
= populate_msi_sysfs(dev
);
638 msi_mask_irq(entry
, mask
, ~mask
);
643 /* Set MSI enabled bits */
644 pci_intx_for_msi(dev
, 0);
645 pci_msi_set_enable(dev
, 1);
646 dev
->msi_enabled
= 1;
648 pcibios_free_irq(dev
);
649 dev
->irq
= entry
->irq
;
653 static void __iomem
*msix_map_region(struct pci_dev
*dev
, unsigned nr_entries
)
655 resource_size_t phys_addr
;
660 pci_read_config_dword(dev
, dev
->msix_cap
+ PCI_MSIX_TABLE
,
662 bir
= (u8
)(table_offset
& PCI_MSIX_TABLE_BIR
);
663 flags
= pci_resource_flags(dev
, bir
);
664 if (!flags
|| (flags
& IORESOURCE_UNSET
))
667 table_offset
&= PCI_MSIX_TABLE_OFFSET
;
668 phys_addr
= pci_resource_start(dev
, bir
) + table_offset
;
670 return ioremap_nocache(phys_addr
, nr_entries
* PCI_MSIX_ENTRY_SIZE
);
673 static int msix_setup_entries(struct pci_dev
*dev
, void __iomem
*base
,
674 struct msix_entry
*entries
, int nvec
,
675 const struct irq_affinity
*affd
)
677 struct cpumask
*curmsk
, *masks
= NULL
;
678 struct msi_desc
*entry
;
682 masks
= irq_create_affinity_masks(nvec
, affd
);
684 pr_err("Unable to allocate affinity masks, ignoring\n");
687 for (i
= 0, curmsk
= masks
; i
< nvec
; i
++) {
688 entry
= alloc_msi_entry(&dev
->dev
, 1, curmsk
);
694 /* No enough memory. Don't try again */
699 entry
->msi_attrib
.is_msix
= 1;
700 entry
->msi_attrib
.is_64
= 1;
702 entry
->msi_attrib
.entry_nr
= entries
[i
].entry
;
704 entry
->msi_attrib
.entry_nr
= i
;
705 entry
->msi_attrib
.default_irq
= dev
->irq
;
706 entry
->mask_base
= base
;
708 list_add_tail(&entry
->list
, dev_to_msi_list(&dev
->dev
));
718 static void msix_program_entries(struct pci_dev
*dev
,
719 struct msix_entry
*entries
)
721 struct msi_desc
*entry
;
724 for_each_pci_msi_entry(entry
, dev
) {
726 entries
[i
++].vector
= entry
->irq
;
727 entry
->masked
= readl(pci_msix_desc_addr(entry
) +
728 PCI_MSIX_ENTRY_VECTOR_CTRL
);
729 msix_mask_irq(entry
, 1);
734 * msix_capability_init - configure device's MSI-X capability
735 * @dev: pointer to the pci_dev data structure of MSI-X device function
736 * @entries: pointer to an array of struct msix_entry entries
737 * @nvec: number of @entries
738 * @affd: Optional pointer to enable automatic affinity assignement
740 * Setup the MSI-X capability structure of device function with a
741 * single MSI-X irq. A return of zero indicates the successful setup of
742 * requested MSI-X entries with allocated irqs or non-zero for otherwise.
744 static int msix_capability_init(struct pci_dev
*dev
, struct msix_entry
*entries
,
745 int nvec
, const struct irq_affinity
*affd
)
751 /* Ensure MSI-X is disabled while it is set up */
752 pci_msix_clear_and_set_ctrl(dev
, PCI_MSIX_FLAGS_ENABLE
, 0);
754 pci_read_config_word(dev
, dev
->msix_cap
+ PCI_MSIX_FLAGS
, &control
);
755 /* Request & Map MSI-X table region */
756 base
= msix_map_region(dev
, msix_table_size(control
));
760 ret
= msix_setup_entries(dev
, base
, entries
, nvec
, affd
);
764 ret
= pci_msi_setup_msi_irqs(dev
, nvec
, PCI_CAP_ID_MSIX
);
768 /* Check if all MSI entries honor device restrictions */
769 ret
= msi_verify_entries(dev
);
774 * Some devices require MSI-X to be enabled before we can touch the
775 * MSI-X registers. We need to mask all the vectors to prevent
776 * interrupts coming in before they're fully set up.
778 pci_msix_clear_and_set_ctrl(dev
, 0,
779 PCI_MSIX_FLAGS_MASKALL
| PCI_MSIX_FLAGS_ENABLE
);
781 msix_program_entries(dev
, entries
);
783 ret
= populate_msi_sysfs(dev
);
787 /* Set MSI-X enabled bits and unmask the function */
788 pci_intx_for_msi(dev
, 0);
789 dev
->msix_enabled
= 1;
790 pci_msix_clear_and_set_ctrl(dev
, PCI_MSIX_FLAGS_MASKALL
, 0);
792 pcibios_free_irq(dev
);
798 * If we had some success, report the number of irqs
799 * we succeeded in setting up.
801 struct msi_desc
*entry
;
804 for_each_pci_msi_entry(entry
, dev
) {
819 * pci_msi_supported - check whether MSI may be enabled on a device
820 * @dev: pointer to the pci_dev data structure of MSI device function
821 * @nvec: how many MSIs have been requested ?
823 * Look at global flags, the device itself, and its parent buses
824 * to determine if MSI/-X are supported for the device. If MSI/-X is
825 * supported return 1, else return 0.
827 static int pci_msi_supported(struct pci_dev
*dev
, int nvec
)
831 /* MSI must be globally enabled and supported by the device */
835 if (!dev
|| dev
->no_msi
|| dev
->current_state
!= PCI_D0
)
839 * You can't ask to have 0 or less MSIs configured.
841 * b) the list manipulation code assumes nvec >= 1.
847 * Any bridge which does NOT route MSI transactions from its
848 * secondary bus to its primary bus must set NO_MSI flag on
849 * the secondary pci_bus.
850 * We expect only arch-specific PCI host bus controller driver
851 * or quirks for specific PCI bridges to be setting NO_MSI.
853 for (bus
= dev
->bus
; bus
; bus
= bus
->parent
)
854 if (bus
->bus_flags
& PCI_BUS_FLAGS_NO_MSI
)
861 * pci_msi_vec_count - Return the number of MSI vectors a device can send
862 * @dev: device to report about
864 * This function returns the number of MSI vectors a device requested via
865 * Multiple Message Capable register. It returns a negative errno if the
866 * device is not capable sending MSI interrupts. Otherwise, the call succeeds
867 * and returns a power of two, up to a maximum of 2^5 (32), according to the
870 int pci_msi_vec_count(struct pci_dev
*dev
)
878 pci_read_config_word(dev
, dev
->msi_cap
+ PCI_MSI_FLAGS
, &msgctl
);
879 ret
= 1 << ((msgctl
& PCI_MSI_FLAGS_QMASK
) >> 1);
883 EXPORT_SYMBOL(pci_msi_vec_count
);
885 void pci_msi_shutdown(struct pci_dev
*dev
)
887 struct msi_desc
*desc
;
890 if (!pci_msi_enable
|| !dev
|| !dev
->msi_enabled
)
893 BUG_ON(list_empty(dev_to_msi_list(&dev
->dev
)));
894 desc
= first_pci_msi_entry(dev
);
896 pci_msi_set_enable(dev
, 0);
897 pci_intx_for_msi(dev
, 1);
898 dev
->msi_enabled
= 0;
900 /* Return the device with MSI unmasked as initial states */
901 mask
= msi_mask(desc
->msi_attrib
.multi_cap
);
902 /* Keep cached state to be restored */
903 __pci_msi_desc_mask_irq(desc
, mask
, ~mask
);
905 /* Restore dev->irq to its default pin-assertion irq */
906 dev
->irq
= desc
->msi_attrib
.default_irq
;
907 pcibios_alloc_irq(dev
);
910 void pci_disable_msi(struct pci_dev
*dev
)
912 if (!pci_msi_enable
|| !dev
|| !dev
->msi_enabled
)
915 pci_msi_shutdown(dev
);
918 EXPORT_SYMBOL(pci_disable_msi
);
921 * pci_msix_vec_count - return the number of device's MSI-X table entries
922 * @dev: pointer to the pci_dev data structure of MSI-X device function
923 * This function returns the number of device's MSI-X table entries and
924 * therefore the number of MSI-X vectors device is capable of sending.
925 * It returns a negative errno if the device is not capable of sending MSI-X
928 int pci_msix_vec_count(struct pci_dev
*dev
)
935 pci_read_config_word(dev
, dev
->msix_cap
+ PCI_MSIX_FLAGS
, &control
);
936 return msix_table_size(control
);
938 EXPORT_SYMBOL(pci_msix_vec_count
);
940 static int __pci_enable_msix(struct pci_dev
*dev
, struct msix_entry
*entries
,
941 int nvec
, const struct irq_affinity
*affd
)
946 if (!pci_msi_supported(dev
, nvec
))
949 nr_entries
= pci_msix_vec_count(dev
);
952 if (nvec
> nr_entries
)
956 /* Check for any invalid entries */
957 for (i
= 0; i
< nvec
; i
++) {
958 if (entries
[i
].entry
>= nr_entries
)
959 return -EINVAL
; /* invalid entry */
960 for (j
= i
+ 1; j
< nvec
; j
++) {
961 if (entries
[i
].entry
== entries
[j
].entry
)
962 return -EINVAL
; /* duplicate entry */
966 WARN_ON(!!dev
->msix_enabled
);
968 /* Check whether driver already requested for MSI irq */
969 if (dev
->msi_enabled
) {
970 dev_info(&dev
->dev
, "can't enable MSI-X (MSI IRQ already assigned)\n");
973 return msix_capability_init(dev
, entries
, nvec
, affd
);
977 * pci_enable_msix - configure device's MSI-X capability structure
978 * @dev: pointer to the pci_dev data structure of MSI-X device function
979 * @entries: pointer to an array of MSI-X entries (optional)
980 * @nvec: number of MSI-X irqs requested for allocation by device driver
982 * Setup the MSI-X capability structure of device function with the number
983 * of requested irqs upon its software driver call to request for
984 * MSI-X mode enabled on its hardware device function. A return of zero
985 * indicates the successful configuration of MSI-X capability structure
986 * with new allocated MSI-X irqs. A return of < 0 indicates a failure.
987 * Or a return of > 0 indicates that driver request is exceeding the number
988 * of irqs or MSI-X vectors available. Driver should use the returned value to
989 * re-send its request.
991 int pci_enable_msix(struct pci_dev
*dev
, struct msix_entry
*entries
, int nvec
)
993 return __pci_enable_msix(dev
, entries
, nvec
, NULL
);
995 EXPORT_SYMBOL(pci_enable_msix
);
997 void pci_msix_shutdown(struct pci_dev
*dev
)
999 struct msi_desc
*entry
;
1001 if (!pci_msi_enable
|| !dev
|| !dev
->msix_enabled
)
1004 /* Return the device with MSI-X masked as initial states */
1005 for_each_pci_msi_entry(entry
, dev
) {
1006 /* Keep cached states to be restored */
1007 __pci_msix_desc_mask_irq(entry
, 1);
1010 pci_msix_clear_and_set_ctrl(dev
, PCI_MSIX_FLAGS_ENABLE
, 0);
1011 pci_intx_for_msi(dev
, 1);
1012 dev
->msix_enabled
= 0;
1013 pcibios_alloc_irq(dev
);
1016 void pci_disable_msix(struct pci_dev
*dev
)
1018 if (!pci_msi_enable
|| !dev
|| !dev
->msix_enabled
)
1021 pci_msix_shutdown(dev
);
1024 EXPORT_SYMBOL(pci_disable_msix
);
1026 void pci_no_msi(void)
1032 * pci_msi_enabled - is MSI enabled?
1034 * Returns true if MSI has not been disabled by the command-line option
1037 int pci_msi_enabled(void)
1039 return pci_msi_enable
;
1041 EXPORT_SYMBOL(pci_msi_enabled
);
1043 static int __pci_enable_msi_range(struct pci_dev
*dev
, int minvec
, int maxvec
,
1044 const struct irq_affinity
*affd
)
1049 if (!pci_msi_supported(dev
, minvec
))
1052 WARN_ON(!!dev
->msi_enabled
);
1054 /* Check whether driver already requested MSI-X irqs */
1055 if (dev
->msix_enabled
) {
1057 "can't enable MSI (MSI-X already enabled)\n");
1061 if (maxvec
< minvec
)
1064 nvec
= pci_msi_vec_count(dev
);
1075 nvec
= irq_calc_affinity_vectors(nvec
, affd
);
1080 rc
= msi_capability_init(dev
, nvec
, affd
);
1093 /* deprecated, don't use */
1094 int pci_enable_msi(struct pci_dev
*dev
)
1096 int rc
= __pci_enable_msi_range(dev
, 1, 1, NULL
);
1101 EXPORT_SYMBOL(pci_enable_msi
);
1103 static int __pci_enable_msix_range(struct pci_dev
*dev
,
1104 struct msix_entry
*entries
, int minvec
,
1105 int maxvec
, const struct irq_affinity
*affd
)
1107 int rc
, nvec
= maxvec
;
1109 if (maxvec
< minvec
)
1114 nvec
= irq_calc_affinity_vectors(nvec
, affd
);
1119 rc
= __pci_enable_msix(dev
, entries
, nvec
, affd
);
1133 * pci_enable_msix_range - configure device's MSI-X capability structure
1134 * @dev: pointer to the pci_dev data structure of MSI-X device function
1135 * @entries: pointer to an array of MSI-X entries
1136 * @minvec: minimum number of MSI-X irqs requested
1137 * @maxvec: maximum number of MSI-X irqs requested
1139 * Setup the MSI-X capability structure of device function with a maximum
1140 * possible number of interrupts in the range between @minvec and @maxvec
1141 * upon its software driver call to request for MSI-X mode enabled on its
1142 * hardware device function. It returns a negative errno if an error occurs.
1143 * If it succeeds, it returns the actual number of interrupts allocated and
1144 * indicates the successful configuration of MSI-X capability structure
1145 * with new allocated MSI-X interrupts.
1147 int pci_enable_msix_range(struct pci_dev
*dev
, struct msix_entry
*entries
,
1148 int minvec
, int maxvec
)
1150 return __pci_enable_msix_range(dev
, entries
, minvec
, maxvec
, NULL
);
1152 EXPORT_SYMBOL(pci_enable_msix_range
);
1155 * pci_alloc_irq_vectors_affinity - allocate multiple IRQs for a device
1156 * @dev: PCI device to operate on
1157 * @min_vecs: minimum number of vectors required (must be >= 1)
1158 * @max_vecs: maximum (desired) number of vectors
1159 * @flags: flags or quirks for the allocation
1160 * @affd: optional description of the affinity requirements
1162 * Allocate up to @max_vecs interrupt vectors for @dev, using MSI-X or MSI
1163 * vectors if available, and fall back to a single legacy vector
1164 * if neither is available. Return the number of vectors allocated,
1165 * (which might be smaller than @max_vecs) if successful, or a negative
1166 * error code on error. If less than @min_vecs interrupt vectors are
1167 * available for @dev the function will fail with -ENOSPC.
1169 * To get the Linux IRQ number used for a vector that can be passed to
1170 * request_irq() use the pci_irq_vector() helper.
1172 int pci_alloc_irq_vectors_affinity(struct pci_dev
*dev
, unsigned int min_vecs
,
1173 unsigned int max_vecs
, unsigned int flags
,
1174 const struct irq_affinity
*affd
)
1176 static const struct irq_affinity msi_default_affd
;
1179 if (flags
& PCI_IRQ_AFFINITY
) {
1181 affd
= &msi_default_affd
;
1183 if (affd
->pre_vectors
+ affd
->post_vectors
> min_vecs
)
1187 * If there aren't any vectors left after applying the pre/post
1188 * vectors don't bother with assigning affinity.
1190 if (affd
->pre_vectors
+ affd
->post_vectors
== min_vecs
)
1197 if (flags
& PCI_IRQ_MSIX
) {
1198 vecs
= __pci_enable_msix_range(dev
, NULL
, min_vecs
, max_vecs
,
1204 if (flags
& PCI_IRQ_MSI
) {
1205 vecs
= __pci_enable_msi_range(dev
, min_vecs
, max_vecs
, affd
);
1210 /* use legacy irq if allowed */
1211 if (flags
& PCI_IRQ_LEGACY
) {
1212 if (min_vecs
== 1 && dev
->irq
) {
1220 EXPORT_SYMBOL(pci_alloc_irq_vectors_affinity
);
1223 * pci_free_irq_vectors - free previously allocated IRQs for a device
1224 * @dev: PCI device to operate on
1226 * Undoes the allocations and enabling in pci_alloc_irq_vectors().
1228 void pci_free_irq_vectors(struct pci_dev
*dev
)
1230 pci_disable_msix(dev
);
1231 pci_disable_msi(dev
);
1233 EXPORT_SYMBOL(pci_free_irq_vectors
);
1236 * pci_irq_vector - return Linux IRQ number of a device vector
1237 * @dev: PCI device to operate on
1238 * @nr: device-relative interrupt vector index (0-based).
1240 int pci_irq_vector(struct pci_dev
*dev
, unsigned int nr
)
1242 if (dev
->msix_enabled
) {
1243 struct msi_desc
*entry
;
1246 for_each_pci_msi_entry(entry
, dev
) {
1255 if (dev
->msi_enabled
) {
1256 struct msi_desc
*entry
= first_pci_msi_entry(dev
);
1258 if (WARN_ON_ONCE(nr
>= entry
->nvec_used
))
1261 if (WARN_ON_ONCE(nr
> 0))
1265 return dev
->irq
+ nr
;
1267 EXPORT_SYMBOL(pci_irq_vector
);
1270 * pci_irq_get_affinity - return the affinity of a particular msi vector
1271 * @dev: PCI device to operate on
1272 * @nr: device-relative interrupt vector index (0-based).
1274 const struct cpumask
*pci_irq_get_affinity(struct pci_dev
*dev
, int nr
)
1276 if (dev
->msix_enabled
) {
1277 struct msi_desc
*entry
;
1280 for_each_pci_msi_entry(entry
, dev
) {
1282 return entry
->affinity
;
1287 } else if (dev
->msi_enabled
) {
1288 struct msi_desc
*entry
= first_pci_msi_entry(dev
);
1290 if (WARN_ON_ONCE(!entry
|| !entry
->affinity
||
1291 nr
>= entry
->nvec_used
))
1294 return &entry
->affinity
[nr
];
1296 return cpu_possible_mask
;
1299 EXPORT_SYMBOL(pci_irq_get_affinity
);
1302 * pci_irq_get_node - return the numa node of a particular msi vector
1303 * @pdev: PCI device to operate on
1304 * @vec: device-relative interrupt vector index (0-based).
1306 int pci_irq_get_node(struct pci_dev
*pdev
, int vec
)
1308 const struct cpumask
*mask
;
1310 mask
= pci_irq_get_affinity(pdev
, vec
);
1312 return local_memory_node(cpu_to_node(cpumask_first(mask
)));
1313 return dev_to_node(&pdev
->dev
);
1315 EXPORT_SYMBOL(pci_irq_get_node
);
1317 struct pci_dev
*msi_desc_to_pci_dev(struct msi_desc
*desc
)
1319 return to_pci_dev(desc
->dev
);
1321 EXPORT_SYMBOL(msi_desc_to_pci_dev
);
1323 void *msi_desc_to_pci_sysdata(struct msi_desc
*desc
)
1325 struct pci_dev
*dev
= msi_desc_to_pci_dev(desc
);
1327 return dev
->bus
->sysdata
;
1329 EXPORT_SYMBOL_GPL(msi_desc_to_pci_sysdata
);
1331 #ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
1333 * pci_msi_domain_write_msg - Helper to write MSI message to PCI config space
1334 * @irq_data: Pointer to interrupt data of the MSI interrupt
1335 * @msg: Pointer to the message
1337 void pci_msi_domain_write_msg(struct irq_data
*irq_data
, struct msi_msg
*msg
)
1339 struct msi_desc
*desc
= irq_data_get_msi_desc(irq_data
);
1342 * For MSI-X desc->irq is always equal to irq_data->irq. For
1343 * MSI only the first interrupt of MULTI MSI passes the test.
1345 if (desc
->irq
== irq_data
->irq
)
1346 __pci_write_msi_msg(desc
, msg
);
1350 * pci_msi_domain_calc_hwirq - Generate a unique ID for an MSI source
1351 * @dev: Pointer to the PCI device
1352 * @desc: Pointer to the msi descriptor
1354 * The ID number is only used within the irqdomain.
1356 irq_hw_number_t
pci_msi_domain_calc_hwirq(struct pci_dev
*dev
,
1357 struct msi_desc
*desc
)
1359 return (irq_hw_number_t
)desc
->msi_attrib
.entry_nr
|
1360 PCI_DEVID(dev
->bus
->number
, dev
->devfn
) << 11 |
1361 (pci_domain_nr(dev
->bus
) & 0xFFFFFFFF) << 27;
1364 static inline bool pci_msi_desc_is_multi_msi(struct msi_desc
*desc
)
1366 return !desc
->msi_attrib
.is_msix
&& desc
->nvec_used
> 1;
1370 * pci_msi_domain_check_cap - Verify that @domain supports the capabilities for @dev
1371 * @domain: The interrupt domain to check
1372 * @info: The domain info for verification
1373 * @dev: The device to check
1376 * 0 if the functionality is supported
1377 * 1 if Multi MSI is requested, but the domain does not support it
1378 * -ENOTSUPP otherwise
1380 int pci_msi_domain_check_cap(struct irq_domain
*domain
,
1381 struct msi_domain_info
*info
, struct device
*dev
)
1383 struct msi_desc
*desc
= first_pci_msi_entry(to_pci_dev(dev
));
1385 /* Special handling to support __pci_enable_msi_range() */
1386 if (pci_msi_desc_is_multi_msi(desc
) &&
1387 !(info
->flags
& MSI_FLAG_MULTI_PCI_MSI
))
1389 else if (desc
->msi_attrib
.is_msix
&& !(info
->flags
& MSI_FLAG_PCI_MSIX
))
1395 static int pci_msi_domain_handle_error(struct irq_domain
*domain
,
1396 struct msi_desc
*desc
, int error
)
1398 /* Special handling to support __pci_enable_msi_range() */
1399 if (pci_msi_desc_is_multi_msi(desc
) && error
== -ENOSPC
)
1405 #ifdef GENERIC_MSI_DOMAIN_OPS
1406 static void pci_msi_domain_set_desc(msi_alloc_info_t
*arg
,
1407 struct msi_desc
*desc
)
1410 arg
->hwirq
= pci_msi_domain_calc_hwirq(msi_desc_to_pci_dev(desc
),
1414 #define pci_msi_domain_set_desc NULL
1417 static struct msi_domain_ops pci_msi_domain_ops_default
= {
1418 .set_desc
= pci_msi_domain_set_desc
,
1419 .msi_check
= pci_msi_domain_check_cap
,
1420 .handle_error
= pci_msi_domain_handle_error
,
1423 static void pci_msi_domain_update_dom_ops(struct msi_domain_info
*info
)
1425 struct msi_domain_ops
*ops
= info
->ops
;
1428 info
->ops
= &pci_msi_domain_ops_default
;
1430 if (ops
->set_desc
== NULL
)
1431 ops
->set_desc
= pci_msi_domain_set_desc
;
1432 if (ops
->msi_check
== NULL
)
1433 ops
->msi_check
= pci_msi_domain_check_cap
;
1434 if (ops
->handle_error
== NULL
)
1435 ops
->handle_error
= pci_msi_domain_handle_error
;
1439 static void pci_msi_domain_update_chip_ops(struct msi_domain_info
*info
)
1441 struct irq_chip
*chip
= info
->chip
;
1444 if (!chip
->irq_write_msi_msg
)
1445 chip
->irq_write_msi_msg
= pci_msi_domain_write_msg
;
1446 if (!chip
->irq_mask
)
1447 chip
->irq_mask
= pci_msi_mask_irq
;
1448 if (!chip
->irq_unmask
)
1449 chip
->irq_unmask
= pci_msi_unmask_irq
;
1453 * pci_msi_create_irq_domain - Create a MSI interrupt domain
1454 * @fwnode: Optional fwnode of the interrupt controller
1455 * @info: MSI domain info
1456 * @parent: Parent irq domain
1458 * Updates the domain and chip ops and creates a MSI interrupt domain.
1461 * A domain pointer or NULL in case of failure.
1463 struct irq_domain
*pci_msi_create_irq_domain(struct fwnode_handle
*fwnode
,
1464 struct msi_domain_info
*info
,
1465 struct irq_domain
*parent
)
1467 struct irq_domain
*domain
;
1469 if (info
->flags
& MSI_FLAG_USE_DEF_DOM_OPS
)
1470 pci_msi_domain_update_dom_ops(info
);
1471 if (info
->flags
& MSI_FLAG_USE_DEF_CHIP_OPS
)
1472 pci_msi_domain_update_chip_ops(info
);
1474 info
->flags
|= MSI_FLAG_ACTIVATE_EARLY
;
1476 domain
= msi_create_irq_domain(fwnode
, info
, parent
);
1480 domain
->bus_token
= DOMAIN_BUS_PCI_MSI
;
1483 EXPORT_SYMBOL_GPL(pci_msi_create_irq_domain
);
1485 static int get_msi_id_cb(struct pci_dev
*pdev
, u16 alias
, void *data
)
1493 * pci_msi_domain_get_msi_rid - Get the MSI requester id (RID)
1494 * @domain: The interrupt domain
1495 * @pdev: The PCI device.
1497 * The RID for a device is formed from the alias, with a firmware
1498 * supplied mapping applied
1502 u32
pci_msi_domain_get_msi_rid(struct irq_domain
*domain
, struct pci_dev
*pdev
)
1504 struct device_node
*of_node
;
1507 pci_for_each_dma_alias(pdev
, get_msi_id_cb
, &rid
);
1509 of_node
= irq_domain_get_of_node(domain
);
1510 rid
= of_node
? of_msi_map_rid(&pdev
->dev
, of_node
, rid
) :
1511 iort_msi_map_rid(&pdev
->dev
, rid
);
1517 * pci_msi_get_device_domain - Get the MSI domain for a given PCI device
1518 * @pdev: The PCI device
1520 * Use the firmware data to find a device-specific MSI domain
1521 * (i.e. not one that is ste as a default).
1523 * Returns: The coresponding MSI domain or NULL if none has been found.
1525 struct irq_domain
*pci_msi_get_device_domain(struct pci_dev
*pdev
)
1527 struct irq_domain
*dom
;
1530 pci_for_each_dma_alias(pdev
, get_msi_id_cb
, &rid
);
1531 dom
= of_msi_map_get_device_domain(&pdev
->dev
, rid
);
1533 dom
= iort_get_device_domain(&pdev
->dev
, rid
);
1536 #endif /* CONFIG_PCI_MSI_IRQ_DOMAIN */