1
2
3
4
5
6
7
8
9#include <linux/err.h>
10#include <linux/mm.h>
11#include <linux/irq.h>
12#include <linux/interrupt.h>
13#include <linux/export.h>
14#include <linux/ioport.h>
15#include <linux/pci.h>
16#include <linux/proc_fs.h>
17#include <linux/msi.h>
18#include <linux/smp.h>
19#include <linux/errno.h>
20#include <linux/io.h>
21#include <linux/slab.h>
22#include <linux/irqdomain.h>
23#include <linux/of_irq.h>
24
25#include "pci.h"
26
27static int pci_msi_enable = 1;
28int pci_msi_ignore_mask;
29
30#define msix_table_size(flags) ((flags & PCI_MSIX_FLAGS_QSIZE) + 1)
31
32#ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
33static struct irq_domain *pci_msi_default_domain;
34static DEFINE_MUTEX(pci_msi_domain_lock);
35
36struct irq_domain * __weak arch_get_pci_msi_domain(struct pci_dev *dev)
37{
38 return pci_msi_default_domain;
39}
40
41static struct irq_domain *pci_msi_get_domain(struct pci_dev *dev)
42{
43 struct irq_domain *domain;
44
45 domain = dev_get_msi_domain(&dev->dev);
46 if (domain)
47 return domain;
48
49 return arch_get_pci_msi_domain(dev);
50}
51
52static int pci_msi_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
53{
54 struct irq_domain *domain;
55
56 domain = pci_msi_get_domain(dev);
57 if (domain && irq_domain_is_hierarchy(domain))
58 return pci_msi_domain_alloc_irqs(domain, dev, nvec, type);
59
60 return arch_setup_msi_irqs(dev, nvec, type);
61}
62
63static void pci_msi_teardown_msi_irqs(struct pci_dev *dev)
64{
65 struct irq_domain *domain;
66
67 domain = pci_msi_get_domain(dev);
68 if (domain && irq_domain_is_hierarchy(domain))
69 pci_msi_domain_free_irqs(domain, dev);
70 else
71 arch_teardown_msi_irqs(dev);
72}
73#else
74#define pci_msi_setup_msi_irqs arch_setup_msi_irqs
75#define pci_msi_teardown_msi_irqs arch_teardown_msi_irqs
76#endif
77
78
79
80int __weak arch_setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc)
81{
82 struct msi_controller *chip = dev->bus->msi;
83 int err;
84
85 if (!chip || !chip->setup_irq)
86 return -EINVAL;
87
88 err = chip->setup_irq(chip, dev, desc);
89 if (err < 0)
90 return err;
91
92 irq_set_chip_data(desc->irq, chip);
93
94 return 0;
95}
96
97void __weak arch_teardown_msi_irq(unsigned int irq)
98{
99 struct msi_controller *chip = irq_get_chip_data(irq);
100
101 if (!chip || !chip->teardown_irq)
102 return;
103
104 chip->teardown_irq(chip, irq);
105}
106
107int __weak arch_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
108{
109 struct msi_controller *chip = dev->bus->msi;
110 struct msi_desc *entry;
111 int ret;
112
113 if (chip && chip->setup_irqs)
114 return chip->setup_irqs(chip, dev, nvec, type);
115
116
117
118
119 if (type == PCI_CAP_ID_MSI && nvec > 1)
120 return 1;
121
122 for_each_pci_msi_entry(entry, dev) {
123 ret = arch_setup_msi_irq(dev, entry);
124 if (ret < 0)
125 return ret;
126 if (ret > 0)
127 return -ENOSPC;
128 }
129
130 return 0;
131}
132
133
134
135
136
137void default_teardown_msi_irqs(struct pci_dev *dev)
138{
139 int i;
140 struct msi_desc *entry;
141
142 for_each_pci_msi_entry(entry, dev)
143 if (entry->irq)
144 for (i = 0; i < entry->nvec_used; i++)
145 arch_teardown_msi_irq(entry->irq + i);
146}
147
148void __weak arch_teardown_msi_irqs(struct pci_dev *dev)
149{
150 return default_teardown_msi_irqs(dev);
151}
152
153static void default_restore_msi_irq(struct pci_dev *dev, int irq)
154{
155 struct msi_desc *entry;
156
157 entry = NULL;
158 if (dev->msix_enabled) {
159 for_each_pci_msi_entry(entry, dev) {
160 if (irq == entry->irq)
161 break;
162 }
163 } else if (dev->msi_enabled) {
164 entry = irq_get_msi_desc(irq);
165 }
166
167 if (entry)
168 __pci_write_msi_msg(entry, &entry->msg);
169}
170
171void __weak arch_restore_msi_irqs(struct pci_dev *dev)
172{
173 return default_restore_msi_irqs(dev);
174}
175
176static inline __attribute_const__ u32 msi_mask(unsigned x)
177{
178
179 if (x >= 5)
180 return 0xffffffff;
181 return (1 << (1 << x)) - 1;
182}
183
184
185
186
187
188
189
190u32 __pci_msi_desc_mask_irq(struct msi_desc *desc, u32 mask, u32 flag)
191{
192 u32 mask_bits = desc->masked;
193
194 if (pci_msi_ignore_mask || !desc->msi_attrib.maskbit)
195 return 0;
196
197 mask_bits &= ~mask;
198 mask_bits |= flag;
199 pci_write_config_dword(msi_desc_to_pci_dev(desc), desc->mask_pos,
200 mask_bits);
201
202 return mask_bits;
203}
204
205static void msi_mask_irq(struct msi_desc *desc, u32 mask, u32 flag)
206{
207 desc->masked = __pci_msi_desc_mask_irq(desc, mask, flag);
208}
209
210
211
212
213
214
215
216
217u32 __pci_msix_desc_mask_irq(struct msi_desc *desc, u32 flag)
218{
219 u32 mask_bits = desc->masked;
220 unsigned offset = desc->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE +
221 PCI_MSIX_ENTRY_VECTOR_CTRL;
222
223 if (pci_msi_ignore_mask)
224 return 0;
225
226 mask_bits &= ~PCI_MSIX_ENTRY_CTRL_MASKBIT;
227 if (flag)
228 mask_bits |= PCI_MSIX_ENTRY_CTRL_MASKBIT;
229 writel(mask_bits, desc->mask_base + offset);
230
231 return mask_bits;
232}
233
234static void msix_mask_irq(struct msi_desc *desc, u32 flag)
235{
236 desc->masked = __pci_msix_desc_mask_irq(desc, flag);
237}
238
239static void msi_set_mask_bit(struct irq_data *data, u32 flag)
240{
241 struct msi_desc *desc = irq_data_get_msi_desc(data);
242
243 if (desc->msi_attrib.is_msix) {
244 msix_mask_irq(desc, flag);
245 readl(desc->mask_base);
246 } else {
247 unsigned offset = data->irq - desc->irq;
248 msi_mask_irq(desc, 1 << offset, flag << offset);
249 }
250}
251
252
253
254
255
256void pci_msi_mask_irq(struct irq_data *data)
257{
258 msi_set_mask_bit(data, 1);
259}
260EXPORT_SYMBOL_GPL(pci_msi_mask_irq);
261
262
263
264
265
266void pci_msi_unmask_irq(struct irq_data *data)
267{
268 msi_set_mask_bit(data, 0);
269}
270EXPORT_SYMBOL_GPL(pci_msi_unmask_irq);
271
272void default_restore_msi_irqs(struct pci_dev *dev)
273{
274 struct msi_desc *entry;
275
276 for_each_pci_msi_entry(entry, dev)
277 default_restore_msi_irq(dev, entry->irq);
278}
279
280void __pci_read_msi_msg(struct msi_desc *entry, struct msi_msg *msg)
281{
282 struct pci_dev *dev = msi_desc_to_pci_dev(entry);
283
284 BUG_ON(dev->current_state != PCI_D0);
285
286 if (entry->msi_attrib.is_msix) {
287 void __iomem *base = entry->mask_base +
288 entry->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE;
289
290 msg->address_lo = readl(base + PCI_MSIX_ENTRY_LOWER_ADDR);
291 msg->address_hi = readl(base + PCI_MSIX_ENTRY_UPPER_ADDR);
292 msg->data = readl(base + PCI_MSIX_ENTRY_DATA);
293 } else {
294 int pos = dev->msi_cap;
295 u16 data;
296
297 pci_read_config_dword(dev, pos + PCI_MSI_ADDRESS_LO,
298 &msg->address_lo);
299 if (entry->msi_attrib.is_64) {
300 pci_read_config_dword(dev, pos + PCI_MSI_ADDRESS_HI,
301 &msg->address_hi);
302 pci_read_config_word(dev, pos + PCI_MSI_DATA_64, &data);
303 } else {
304 msg->address_hi = 0;
305 pci_read_config_word(dev, pos + PCI_MSI_DATA_32, &data);
306 }
307 msg->data = data;
308 }
309}
310
311void __pci_write_msi_msg(struct msi_desc *entry, struct msi_msg *msg)
312{
313 struct pci_dev *dev = msi_desc_to_pci_dev(entry);
314
315 if (dev->current_state != PCI_D0) {
316
317 } else if (entry->msi_attrib.is_msix) {
318 void __iomem *base;
319 base = entry->mask_base +
320 entry->msi_attrib.entry_nr * PCI_MSIX_ENTRY_SIZE;
321
322 writel(msg->address_lo, base + PCI_MSIX_ENTRY_LOWER_ADDR);
323 writel(msg->address_hi, base + PCI_MSIX_ENTRY_UPPER_ADDR);
324 writel(msg->data, base + PCI_MSIX_ENTRY_DATA);
325 } else {
326 int pos = dev->msi_cap;
327 u16 msgctl;
328
329 pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &msgctl);
330 msgctl &= ~PCI_MSI_FLAGS_QSIZE;
331 msgctl |= entry->msi_attrib.multiple << 4;
332 pci_write_config_word(dev, pos + PCI_MSI_FLAGS, msgctl);
333
334 pci_write_config_dword(dev, pos + PCI_MSI_ADDRESS_LO,
335 msg->address_lo);
336 if (entry->msi_attrib.is_64) {
337 pci_write_config_dword(dev, pos + PCI_MSI_ADDRESS_HI,
338 msg->address_hi);
339 pci_write_config_word(dev, pos + PCI_MSI_DATA_64,
340 msg->data);
341 } else {
342 pci_write_config_word(dev, pos + PCI_MSI_DATA_32,
343 msg->data);
344 }
345 }
346 entry->msg = *msg;
347}
348
349void pci_write_msi_msg(unsigned int irq, struct msi_msg *msg)
350{
351 struct msi_desc *entry = irq_get_msi_desc(irq);
352
353 __pci_write_msi_msg(entry, msg);
354}
355EXPORT_SYMBOL_GPL(pci_write_msi_msg);
356
357static void free_msi_irqs(struct pci_dev *dev)
358{
359 struct list_head *msi_list = dev_to_msi_list(&dev->dev);
360 struct msi_desc *entry, *tmp;
361 struct attribute **msi_attrs;
362 struct device_attribute *dev_attr;
363 int i, count = 0;
364
365 for_each_pci_msi_entry(entry, dev)
366 if (entry->irq)
367 for (i = 0; i < entry->nvec_used; i++)
368 BUG_ON(irq_has_action(entry->irq + i));
369
370 pci_msi_teardown_msi_irqs(dev);
371
372 list_for_each_entry_safe(entry, tmp, msi_list, list) {
373 if (entry->msi_attrib.is_msix) {
374 if (list_is_last(&entry->list, msi_list))
375 iounmap(entry->mask_base);
376 }
377
378 list_del(&entry->list);
379 kfree(entry);
380 }
381
382 if (dev->msi_irq_groups) {
383 sysfs_remove_groups(&dev->dev.kobj, dev->msi_irq_groups);
384 msi_attrs = dev->msi_irq_groups[0]->attrs;
385 while (msi_attrs[count]) {
386 dev_attr = container_of(msi_attrs[count],
387 struct device_attribute, attr);
388 kfree(dev_attr->attr.name);
389 kfree(dev_attr);
390 ++count;
391 }
392 kfree(msi_attrs);
393 kfree(dev->msi_irq_groups[0]);
394 kfree(dev->msi_irq_groups);
395 dev->msi_irq_groups = NULL;
396 }
397}
398
399static void pci_intx_for_msi(struct pci_dev *dev, int enable)
400{
401 if (!(dev->dev_flags & PCI_DEV_FLAGS_MSI_INTX_DISABLE_BUG))
402 pci_intx(dev, enable);
403}
404
405static void __pci_restore_msi_state(struct pci_dev *dev)
406{
407 u16 control;
408 struct msi_desc *entry;
409
410 if (!dev->msi_enabled)
411 return;
412
413 entry = irq_get_msi_desc(dev->irq);
414
415 pci_intx_for_msi(dev, 0);
416 pci_msi_set_enable(dev, 0);
417 arch_restore_msi_irqs(dev);
418
419 pci_read_config_word(dev, dev->msi_cap + PCI_MSI_FLAGS, &control);
420 msi_mask_irq(entry, msi_mask(entry->msi_attrib.multi_cap),
421 entry->masked);
422 control &= ~PCI_MSI_FLAGS_QSIZE;
423 control |= (entry->msi_attrib.multiple << 4) | PCI_MSI_FLAGS_ENABLE;
424 pci_write_config_word(dev, dev->msi_cap + PCI_MSI_FLAGS, control);
425}
426
427static void __pci_restore_msix_state(struct pci_dev *dev)
428{
429 struct msi_desc *entry;
430
431 if (!dev->msix_enabled)
432 return;
433 BUG_ON(list_empty(dev_to_msi_list(&dev->dev)));
434
435
436 pci_intx_for_msi(dev, 0);
437 pci_msix_clear_and_set_ctrl(dev, 0,
438 PCI_MSIX_FLAGS_ENABLE | PCI_MSIX_FLAGS_MASKALL);
439
440 arch_restore_msi_irqs(dev);
441 for_each_pci_msi_entry(entry, dev)
442 msix_mask_irq(entry, entry->masked);
443
444 pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_MASKALL, 0);
445}
446
447void pci_restore_msi_state(struct pci_dev *dev)
448{
449 __pci_restore_msi_state(dev);
450 __pci_restore_msix_state(dev);
451}
452EXPORT_SYMBOL_GPL(pci_restore_msi_state);
453
454static ssize_t msi_mode_show(struct device *dev, struct device_attribute *attr,
455 char *buf)
456{
457 struct msi_desc *entry;
458 unsigned long irq;
459 int retval;
460
461 retval = kstrtoul(attr->attr.name, 10, &irq);
462 if (retval)
463 return retval;
464
465 entry = irq_get_msi_desc(irq);
466 if (entry)
467 return sprintf(buf, "%s\n",
468 entry->msi_attrib.is_msix ? "msix" : "msi");
469
470 return -ENODEV;
471}
472
473static int populate_msi_sysfs(struct pci_dev *pdev)
474{
475 struct attribute **msi_attrs;
476 struct attribute *msi_attr;
477 struct device_attribute *msi_dev_attr;
478 struct attribute_group *msi_irq_group;
479 const struct attribute_group **msi_irq_groups;
480 struct msi_desc *entry;
481 int ret = -ENOMEM;
482 int num_msi = 0;
483 int count = 0;
484 int i;
485
486
487 for_each_pci_msi_entry(entry, pdev)
488 num_msi += entry->nvec_used;
489 if (!num_msi)
490 return 0;
491
492
493 msi_attrs = kzalloc(sizeof(void *) * (num_msi + 1), GFP_KERNEL);
494 if (!msi_attrs)
495 return -ENOMEM;
496 for_each_pci_msi_entry(entry, pdev) {
497 for (i = 0; i < entry->nvec_used; i++) {
498 msi_dev_attr = kzalloc(sizeof(*msi_dev_attr), GFP_KERNEL);
499 if (!msi_dev_attr)
500 goto error_attrs;
501 msi_attrs[count] = &msi_dev_attr->attr;
502
503 sysfs_attr_init(&msi_dev_attr->attr);
504 msi_dev_attr->attr.name = kasprintf(GFP_KERNEL, "%d",
505 entry->irq + i);
506 if (!msi_dev_attr->attr.name)
507 goto error_attrs;
508 msi_dev_attr->attr.mode = S_IRUGO;
509 msi_dev_attr->show = msi_mode_show;
510 ++count;
511 }
512 }
513
514 msi_irq_group = kzalloc(sizeof(*msi_irq_group), GFP_KERNEL);
515 if (!msi_irq_group)
516 goto error_attrs;
517 msi_irq_group->name = "msi_irqs";
518 msi_irq_group->attrs = msi_attrs;
519
520 msi_irq_groups = kzalloc(sizeof(void *) * 2, GFP_KERNEL);
521 if (!msi_irq_groups)
522 goto error_irq_group;
523 msi_irq_groups[0] = msi_irq_group;
524
525 ret = sysfs_create_groups(&pdev->dev.kobj, msi_irq_groups);
526 if (ret)
527 goto error_irq_groups;
528 pdev->msi_irq_groups = msi_irq_groups;
529
530 return 0;
531
532error_irq_groups:
533 kfree(msi_irq_groups);
534error_irq_group:
535 kfree(msi_irq_group);
536error_attrs:
537 count = 0;
538 msi_attr = msi_attrs[count];
539 while (msi_attr) {
540 msi_dev_attr = container_of(msi_attr, struct device_attribute, attr);
541 kfree(msi_attr->name);
542 kfree(msi_dev_attr);
543 ++count;
544 msi_attr = msi_attrs[count];
545 }
546 kfree(msi_attrs);
547 return ret;
548}
549
550static struct msi_desc *msi_setup_entry(struct pci_dev *dev, int nvec)
551{
552 u16 control;
553 struct msi_desc *entry;
554
555
556 entry = alloc_msi_entry(&dev->dev);
557 if (!entry)
558 return NULL;
559
560 pci_read_config_word(dev, dev->msi_cap + PCI_MSI_FLAGS, &control);
561
562 entry->msi_attrib.is_msix = 0;
563 entry->msi_attrib.is_64 = !!(control & PCI_MSI_FLAGS_64BIT);
564 entry->msi_attrib.entry_nr = 0;
565 entry->msi_attrib.maskbit = !!(control & PCI_MSI_FLAGS_MASKBIT);
566 entry->msi_attrib.default_irq = dev->irq;
567 entry->msi_attrib.multi_cap = (control & PCI_MSI_FLAGS_QMASK) >> 1;
568 entry->msi_attrib.multiple = ilog2(__roundup_pow_of_two(nvec));
569 entry->nvec_used = nvec;
570
571 if (control & PCI_MSI_FLAGS_64BIT)
572 entry->mask_pos = dev->msi_cap + PCI_MSI_MASK_64;
573 else
574 entry->mask_pos = dev->msi_cap + PCI_MSI_MASK_32;
575
576
577 if (entry->msi_attrib.maskbit)
578 pci_read_config_dword(dev, entry->mask_pos, &entry->masked);
579
580 return entry;
581}
582
583static int msi_verify_entries(struct pci_dev *dev)
584{
585 struct msi_desc *entry;
586
587 for_each_pci_msi_entry(entry, dev) {
588 if (!dev->no_64bit_msi || !entry->msg.address_hi)
589 continue;
590 dev_err(&dev->dev, "Device has broken 64-bit MSI but arch"
591 " tried to assign one above 4G\n");
592 return -EIO;
593 }
594 return 0;
595}
596
597
598
599
600
601
602
603
604
605
606
607
608static int msi_capability_init(struct pci_dev *dev, int nvec)
609{
610 struct msi_desc *entry;
611 int ret;
612 unsigned mask;
613
614 pci_msi_set_enable(dev, 0);
615
616 entry = msi_setup_entry(dev, nvec);
617 if (!entry)
618 return -ENOMEM;
619
620
621 mask = msi_mask(entry->msi_attrib.multi_cap);
622 msi_mask_irq(entry, mask, mask);
623
624 list_add_tail(&entry->list, dev_to_msi_list(&dev->dev));
625
626
627 ret = pci_msi_setup_msi_irqs(dev, nvec, PCI_CAP_ID_MSI);
628 if (ret) {
629 msi_mask_irq(entry, mask, ~mask);
630 free_msi_irqs(dev);
631 return ret;
632 }
633
634 ret = msi_verify_entries(dev);
635 if (ret) {
636 msi_mask_irq(entry, mask, ~mask);
637 free_msi_irqs(dev);
638 return ret;
639 }
640
641 ret = populate_msi_sysfs(dev);
642 if (ret) {
643 msi_mask_irq(entry, mask, ~mask);
644 free_msi_irqs(dev);
645 return ret;
646 }
647
648
649 pci_intx_for_msi(dev, 0);
650 pci_msi_set_enable(dev, 1);
651 dev->msi_enabled = 1;
652
653 pcibios_free_irq(dev);
654 dev->irq = entry->irq;
655 return 0;
656}
657
658static void __iomem *msix_map_region(struct pci_dev *dev, unsigned nr_entries)
659{
660 resource_size_t phys_addr;
661 u32 table_offset;
662 unsigned long flags;
663 u8 bir;
664
665 pci_read_config_dword(dev, dev->msix_cap + PCI_MSIX_TABLE,
666 &table_offset);
667 bir = (u8)(table_offset & PCI_MSIX_TABLE_BIR);
668 flags = pci_resource_flags(dev, bir);
669 if (!flags || (flags & IORESOURCE_UNSET))
670 return NULL;
671
672 table_offset &= PCI_MSIX_TABLE_OFFSET;
673 phys_addr = pci_resource_start(dev, bir) + table_offset;
674
675 return ioremap_nocache(phys_addr, nr_entries * PCI_MSIX_ENTRY_SIZE);
676}
677
678static int msix_setup_entries(struct pci_dev *dev, void __iomem *base,
679 struct msix_entry *entries, int nvec)
680{
681 struct msi_desc *entry;
682 int i;
683
684 for (i = 0; i < nvec; i++) {
685 entry = alloc_msi_entry(&dev->dev);
686 if (!entry) {
687 if (!i)
688 iounmap(base);
689 else
690 free_msi_irqs(dev);
691
692 return -ENOMEM;
693 }
694
695 entry->msi_attrib.is_msix = 1;
696 entry->msi_attrib.is_64 = 1;
697 entry->msi_attrib.entry_nr = entries[i].entry;
698 entry->msi_attrib.default_irq = dev->irq;
699 entry->mask_base = base;
700 entry->nvec_used = 1;
701
702 list_add_tail(&entry->list, dev_to_msi_list(&dev->dev));
703 }
704
705 return 0;
706}
707
708static void msix_program_entries(struct pci_dev *dev,
709 struct msix_entry *entries)
710{
711 struct msi_desc *entry;
712 int i = 0;
713
714 for_each_pci_msi_entry(entry, dev) {
715 int offset = entries[i].entry * PCI_MSIX_ENTRY_SIZE +
716 PCI_MSIX_ENTRY_VECTOR_CTRL;
717
718 entries[i].vector = entry->irq;
719 entry->masked = readl(entry->mask_base + offset);
720 msix_mask_irq(entry, 1);
721 i++;
722 }
723}
724
725
726
727
728
729
730
731
732
733
734
735static int msix_capability_init(struct pci_dev *dev,
736 struct msix_entry *entries, int nvec)
737{
738 int ret;
739 u16 control;
740 void __iomem *base;
741
742
743 pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_ENABLE, 0);
744
745 pci_read_config_word(dev, dev->msix_cap + PCI_MSIX_FLAGS, &control);
746
747 base = msix_map_region(dev, msix_table_size(control));
748 if (!base)
749 return -ENOMEM;
750
751 ret = msix_setup_entries(dev, base, entries, nvec);
752 if (ret)
753 return ret;
754
755 ret = pci_msi_setup_msi_irqs(dev, nvec, PCI_CAP_ID_MSIX);
756 if (ret)
757 goto out_avail;
758
759
760 ret = msi_verify_entries(dev);
761 if (ret)
762 goto out_free;
763
764
765
766
767
768
769 pci_msix_clear_and_set_ctrl(dev, 0,
770 PCI_MSIX_FLAGS_MASKALL | PCI_MSIX_FLAGS_ENABLE);
771
772 msix_program_entries(dev, entries);
773
774 ret = populate_msi_sysfs(dev);
775 if (ret)
776 goto out_free;
777
778
779 pci_intx_for_msi(dev, 0);
780 dev->msix_enabled = 1;
781 pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_MASKALL, 0);
782
783 pcibios_free_irq(dev);
784 return 0;
785
786out_avail:
787 if (ret < 0) {
788
789
790
791
792 struct msi_desc *entry;
793 int avail = 0;
794
795 for_each_pci_msi_entry(entry, dev) {
796 if (entry->irq != 0)
797 avail++;
798 }
799 if (avail != 0)
800 ret = avail;
801 }
802
803out_free:
804 free_msi_irqs(dev);
805
806 return ret;
807}
808
809
810
811
812
813
814
815
816
817
818static int pci_msi_supported(struct pci_dev *dev, int nvec)
819{
820 struct pci_bus *bus;
821
822
823 if (!pci_msi_enable)
824 return 0;
825
826 if (!dev || dev->no_msi || dev->current_state != PCI_D0)
827 return 0;
828
829
830
831
832
833
834 if (nvec < 1)
835 return 0;
836
837
838
839
840
841
842
843
844 for (bus = dev->bus; bus; bus = bus->parent)
845 if (bus->bus_flags & PCI_BUS_FLAGS_NO_MSI)
846 return 0;
847
848 return 1;
849}
850
851
852
853
854
855
856
857
858
859
860
861int pci_msi_vec_count(struct pci_dev *dev)
862{
863 int ret;
864 u16 msgctl;
865
866 if (!dev->msi_cap)
867 return -EINVAL;
868
869 pci_read_config_word(dev, dev->msi_cap + PCI_MSI_FLAGS, &msgctl);
870 ret = 1 << ((msgctl & PCI_MSI_FLAGS_QMASK) >> 1);
871
872 return ret;
873}
874EXPORT_SYMBOL(pci_msi_vec_count);
875
876void pci_msi_shutdown(struct pci_dev *dev)
877{
878 struct msi_desc *desc;
879 u32 mask;
880
881 if (!pci_msi_enable || !dev || !dev->msi_enabled)
882 return;
883
884 BUG_ON(list_empty(dev_to_msi_list(&dev->dev)));
885 desc = first_pci_msi_entry(dev);
886
887 pci_msi_set_enable(dev, 0);
888 pci_intx_for_msi(dev, 1);
889 dev->msi_enabled = 0;
890
891
892 mask = msi_mask(desc->msi_attrib.multi_cap);
893
894 __pci_msi_desc_mask_irq(desc, mask, ~mask);
895
896
897 dev->irq = desc->msi_attrib.default_irq;
898 pcibios_alloc_irq(dev);
899}
900
901void pci_disable_msi(struct pci_dev *dev)
902{
903 if (!pci_msi_enable || !dev || !dev->msi_enabled)
904 return;
905
906 pci_msi_shutdown(dev);
907 free_msi_irqs(dev);
908}
909EXPORT_SYMBOL(pci_disable_msi);
910
911
912
913
914
915
916
917
918
919int pci_msix_vec_count(struct pci_dev *dev)
920{
921 u16 control;
922
923 if (!dev->msix_cap)
924 return -EINVAL;
925
926 pci_read_config_word(dev, dev->msix_cap + PCI_MSIX_FLAGS, &control);
927 return msix_table_size(control);
928}
929EXPORT_SYMBOL(pci_msix_vec_count);
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946int pci_enable_msix(struct pci_dev *dev, struct msix_entry *entries, int nvec)
947{
948 int nr_entries;
949 int i, j;
950
951 if (!pci_msi_supported(dev, nvec))
952 return -EINVAL;
953
954 if (!entries)
955 return -EINVAL;
956
957 nr_entries = pci_msix_vec_count(dev);
958 if (nr_entries < 0)
959 return nr_entries;
960 if (nvec > nr_entries)
961 return nr_entries;
962
963
964 for (i = 0; i < nvec; i++) {
965 if (entries[i].entry >= nr_entries)
966 return -EINVAL;
967 for (j = i + 1; j < nvec; j++) {
968 if (entries[i].entry == entries[j].entry)
969 return -EINVAL;
970 }
971 }
972 WARN_ON(!!dev->msix_enabled);
973
974
975 if (dev->msi_enabled) {
976 dev_info(&dev->dev, "can't enable MSI-X (MSI IRQ already assigned)\n");
977 return -EINVAL;
978 }
979 return msix_capability_init(dev, entries, nvec);
980}
981EXPORT_SYMBOL(pci_enable_msix);
982
983void pci_msix_shutdown(struct pci_dev *dev)
984{
985 struct msi_desc *entry;
986
987 if (!pci_msi_enable || !dev || !dev->msix_enabled)
988 return;
989
990
991 for_each_pci_msi_entry(entry, dev) {
992
993 __pci_msix_desc_mask_irq(entry, 1);
994 }
995
996 pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_ENABLE, 0);
997 pci_intx_for_msi(dev, 1);
998 dev->msix_enabled = 0;
999 pcibios_alloc_irq(dev);
1000}
1001
1002void pci_disable_msix(struct pci_dev *dev)
1003{
1004 if (!pci_msi_enable || !dev || !dev->msix_enabled)
1005 return;
1006
1007 pci_msix_shutdown(dev);
1008 free_msi_irqs(dev);
1009}
1010EXPORT_SYMBOL(pci_disable_msix);
1011
1012void pci_no_msi(void)
1013{
1014 pci_msi_enable = 0;
1015}
1016
1017
1018
1019
1020
1021
1022
1023int pci_msi_enabled(void)
1024{
1025 return pci_msi_enable;
1026}
1027EXPORT_SYMBOL(pci_msi_enabled);
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041int pci_enable_msi_range(struct pci_dev *dev, int minvec, int maxvec)
1042{
1043 int nvec;
1044 int rc;
1045
1046 if (!pci_msi_supported(dev, minvec))
1047 return -EINVAL;
1048
1049 WARN_ON(!!dev->msi_enabled);
1050
1051
1052 if (dev->msix_enabled) {
1053 dev_info(&dev->dev,
1054 "can't enable MSI (MSI-X already enabled)\n");
1055 return -EINVAL;
1056 }
1057
1058 if (maxvec < minvec)
1059 return -ERANGE;
1060
1061 nvec = pci_msi_vec_count(dev);
1062 if (nvec < 0)
1063 return nvec;
1064 else if (nvec < minvec)
1065 return -EINVAL;
1066 else if (nvec > maxvec)
1067 nvec = maxvec;
1068
1069 do {
1070 rc = msi_capability_init(dev, nvec);
1071 if (rc < 0) {
1072 return rc;
1073 } else if (rc > 0) {
1074 if (rc < minvec)
1075 return -ENOSPC;
1076 nvec = rc;
1077 }
1078 } while (rc);
1079
1080 return nvec;
1081}
1082EXPORT_SYMBOL(pci_enable_msi_range);
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099int pci_enable_msix_range(struct pci_dev *dev, struct msix_entry *entries,
1100 int minvec, int maxvec)
1101{
1102 int nvec = maxvec;
1103 int rc;
1104
1105 if (maxvec < minvec)
1106 return -ERANGE;
1107
1108 do {
1109 rc = pci_enable_msix(dev, entries, nvec);
1110 if (rc < 0) {
1111 return rc;
1112 } else if (rc > 0) {
1113 if (rc < minvec)
1114 return -ENOSPC;
1115 nvec = rc;
1116 }
1117 } while (rc);
1118
1119 return nvec;
1120}
1121EXPORT_SYMBOL(pci_enable_msix_range);
1122
1123struct pci_dev *msi_desc_to_pci_dev(struct msi_desc *desc)
1124{
1125 return to_pci_dev(desc->dev);
1126}
1127EXPORT_SYMBOL(msi_desc_to_pci_dev);
1128
1129void *msi_desc_to_pci_sysdata(struct msi_desc *desc)
1130{
1131 struct pci_dev *dev = msi_desc_to_pci_dev(desc);
1132
1133 return dev->bus->sysdata;
1134}
1135EXPORT_SYMBOL_GPL(msi_desc_to_pci_sysdata);
1136
1137#ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
1138
1139
1140
1141
1142
1143void pci_msi_domain_write_msg(struct irq_data *irq_data, struct msi_msg *msg)
1144{
1145 struct msi_desc *desc = irq_data_get_msi_desc(irq_data);
1146
1147
1148
1149
1150
1151 if (desc->irq == irq_data->irq)
1152 __pci_write_msi_msg(desc, msg);
1153}
1154
1155
1156
1157
1158
1159
1160
1161
1162irq_hw_number_t pci_msi_domain_calc_hwirq(struct pci_dev *dev,
1163 struct msi_desc *desc)
1164{
1165 return (irq_hw_number_t)desc->msi_attrib.entry_nr |
1166 PCI_DEVID(dev->bus->number, dev->devfn) << 11 |
1167 (pci_domain_nr(dev->bus) & 0xFFFFFFFF) << 27;
1168}
1169
1170static inline bool pci_msi_desc_is_multi_msi(struct msi_desc *desc)
1171{
1172 return !desc->msi_attrib.is_msix && desc->nvec_used > 1;
1173}
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186int pci_msi_domain_check_cap(struct irq_domain *domain,
1187 struct msi_domain_info *info, struct device *dev)
1188{
1189 struct msi_desc *desc = first_pci_msi_entry(to_pci_dev(dev));
1190
1191
1192 if (pci_msi_desc_is_multi_msi(desc) &&
1193 !(info->flags & MSI_FLAG_MULTI_PCI_MSI))
1194 return 1;
1195 else if (desc->msi_attrib.is_msix && !(info->flags & MSI_FLAG_PCI_MSIX))
1196 return -ENOTSUPP;
1197
1198 return 0;
1199}
1200
1201static int pci_msi_domain_handle_error(struct irq_domain *domain,
1202 struct msi_desc *desc, int error)
1203{
1204
1205 if (pci_msi_desc_is_multi_msi(desc) && error == -ENOSPC)
1206 return 1;
1207
1208 return error;
1209}
1210
1211#ifdef GENERIC_MSI_DOMAIN_OPS
1212static void pci_msi_domain_set_desc(msi_alloc_info_t *arg,
1213 struct msi_desc *desc)
1214{
1215 arg->desc = desc;
1216 arg->hwirq = pci_msi_domain_calc_hwirq(msi_desc_to_pci_dev(desc),
1217 desc);
1218}
1219#else
1220#define pci_msi_domain_set_desc NULL
1221#endif
1222
1223static struct msi_domain_ops pci_msi_domain_ops_default = {
1224 .set_desc = pci_msi_domain_set_desc,
1225 .msi_check = pci_msi_domain_check_cap,
1226 .handle_error = pci_msi_domain_handle_error,
1227};
1228
1229static void pci_msi_domain_update_dom_ops(struct msi_domain_info *info)
1230{
1231 struct msi_domain_ops *ops = info->ops;
1232
1233 if (ops == NULL) {
1234 info->ops = &pci_msi_domain_ops_default;
1235 } else {
1236 if (ops->set_desc == NULL)
1237 ops->set_desc = pci_msi_domain_set_desc;
1238 if (ops->msi_check == NULL)
1239 ops->msi_check = pci_msi_domain_check_cap;
1240 if (ops->handle_error == NULL)
1241 ops->handle_error = pci_msi_domain_handle_error;
1242 }
1243}
1244
1245static void pci_msi_domain_update_chip_ops(struct msi_domain_info *info)
1246{
1247 struct irq_chip *chip = info->chip;
1248
1249 BUG_ON(!chip);
1250 if (!chip->irq_write_msi_msg)
1251 chip->irq_write_msi_msg = pci_msi_domain_write_msg;
1252 if (!chip->irq_mask)
1253 chip->irq_mask = pci_msi_mask_irq;
1254 if (!chip->irq_unmask)
1255 chip->irq_unmask = pci_msi_unmask_irq;
1256}
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269struct irq_domain *pci_msi_create_irq_domain(struct fwnode_handle *fwnode,
1270 struct msi_domain_info *info,
1271 struct irq_domain *parent)
1272{
1273 struct irq_domain *domain;
1274
1275 if (info->flags & MSI_FLAG_USE_DEF_DOM_OPS)
1276 pci_msi_domain_update_dom_ops(info);
1277 if (info->flags & MSI_FLAG_USE_DEF_CHIP_OPS)
1278 pci_msi_domain_update_chip_ops(info);
1279
1280 domain = msi_create_irq_domain(fwnode, info, parent);
1281 if (!domain)
1282 return NULL;
1283
1284 domain->bus_token = DOMAIN_BUS_PCI_MSI;
1285 return domain;
1286}
1287EXPORT_SYMBOL_GPL(pci_msi_create_irq_domain);
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299int pci_msi_domain_alloc_irqs(struct irq_domain *domain, struct pci_dev *dev,
1300 int nvec, int type)
1301{
1302 return msi_domain_alloc_irqs(domain, &dev->dev, nvec);
1303}
1304
1305
1306
1307
1308
1309
1310void pci_msi_domain_free_irqs(struct irq_domain *domain, struct pci_dev *dev)
1311{
1312 msi_domain_free_irqs(domain, &dev->dev);
1313}
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324struct irq_domain *pci_msi_create_default_irq_domain(struct fwnode_handle *fwnode,
1325 struct msi_domain_info *info, struct irq_domain *parent)
1326{
1327 struct irq_domain *domain;
1328
1329 mutex_lock(&pci_msi_domain_lock);
1330 if (pci_msi_default_domain) {
1331 pr_err("PCI: default irq domain for PCI MSI has already been created.\n");
1332 domain = NULL;
1333 } else {
1334 domain = pci_msi_create_irq_domain(fwnode, info, parent);
1335 pci_msi_default_domain = domain;
1336 }
1337 mutex_unlock(&pci_msi_domain_lock);
1338
1339 return domain;
1340}
1341
1342static int get_msi_id_cb(struct pci_dev *pdev, u16 alias, void *data)
1343{
1344 u32 *pa = data;
1345
1346 *pa = alias;
1347 return 0;
1348}
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359u32 pci_msi_domain_get_msi_rid(struct irq_domain *domain, struct pci_dev *pdev)
1360{
1361 struct device_node *of_node;
1362 u32 rid = 0;
1363
1364 pci_for_each_dma_alias(pdev, get_msi_id_cb, &rid);
1365
1366 of_node = irq_domain_get_of_node(domain);
1367 if (of_node)
1368 rid = of_msi_map_rid(&pdev->dev, of_node, rid);
1369
1370 return rid;
1371}
1372
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382struct irq_domain *pci_msi_get_device_domain(struct pci_dev *pdev)
1383{
1384 u32 rid = 0;
1385
1386 pci_for_each_dma_alias(pdev, get_msi_id_cb, &rid);
1387 return of_msi_map_get_device_domain(&pdev->dev, rid);
1388}
1389#endif
1390