Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright 2006-2007, Michael Ellerman, IBM Corporation.
4 */
5
6#include <linux/irq.h>
7#include <linux/irqdomain.h>
8#include <linux/of_irq.h>
9#include <linux/bitmap.h>
10#include <linux/msi.h>
11#include <asm/mpic.h>
12#include <asm/hw_irq.h>
13#include <asm/ppc-pci.h>
14#include <asm/msi_bitmap.h>
15
16#include <sysdev/mpic.h>
17
18void mpic_msi_reserve_hwirq(struct mpic *mpic, irq_hw_number_t hwirq)
19{
20 /* The mpic calls this even when there is no allocator setup */
21 if (!mpic->msi_bitmap.bitmap)
22 return;
23
24 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, hwirq);
25}
26
27#ifdef CONFIG_MPIC_U3_HT_IRQS
28static int __init mpic_msi_reserve_u3_hwirqs(struct mpic *mpic)
29{
30 irq_hw_number_t hwirq;
31 const struct irq_domain_ops *ops = mpic->irqhost->ops;
32 struct device_node *np;
33 int flags, index, i;
34 struct of_phandle_args oirq;
35
36 pr_debug("mpic: found U3, guessing msi allocator setup\n");
37
38 /* Reserve source numbers we know are reserved in the HW.
39 *
40 * This is a bit of a mix of U3 and U4 reserves but that's going
41 * to work fine, we have plenty enough numbers left so let's just
42 * mark anything we don't like reserved.
43 */
44 for (i = 0; i < 8; i++)
45 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
46
47 for (i = 42; i < 46; i++)
48 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
49
50 for (i = 100; i < 105; i++)
51 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
52
53 for (i = 124; i < mpic->num_sources; i++)
54 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
55
56
57 np = NULL;
58 while ((np = of_find_all_nodes(np))) {
59 pr_debug("mpic: mapping hwirqs for %pOF\n", np);
60
61 index = 0;
62 while (of_irq_parse_one(np, index++, &oirq) == 0) {
63 ops->xlate(mpic->irqhost, NULL, oirq.args,
64 oirq.args_count, &hwirq, &flags);
65 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, hwirq);
66 }
67 }
68
69 return 0;
70}
71#else
72static int __init mpic_msi_reserve_u3_hwirqs(struct mpic *mpic)
73{
74 return -1;
75}
76#endif
77
78int __init mpic_msi_init_allocator(struct mpic *mpic)
79{
80 int rc;
81
82 rc = msi_bitmap_alloc(&mpic->msi_bitmap, mpic->num_sources,
83 irq_domain_get_of_node(mpic->irqhost));
84 if (rc)
85 return rc;
86
87 rc = msi_bitmap_reserve_dt_hwirqs(&mpic->msi_bitmap);
88 if (rc > 0) {
89 if (mpic->flags & MPIC_U3_HT_IRQS)
90 rc = mpic_msi_reserve_u3_hwirqs(mpic);
91
92 if (rc) {
93 msi_bitmap_free(&mpic->msi_bitmap);
94 return rc;
95 }
96 }
97
98 return 0;
99}
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright 2006-2007, Michael Ellerman, IBM Corporation.
4 */
5
6#include <linux/irq.h>
7#include <linux/bitmap.h>
8#include <linux/msi.h>
9#include <asm/mpic.h>
10#include <asm/prom.h>
11#include <asm/hw_irq.h>
12#include <asm/ppc-pci.h>
13#include <asm/msi_bitmap.h>
14
15#include <sysdev/mpic.h>
16
17void mpic_msi_reserve_hwirq(struct mpic *mpic, irq_hw_number_t hwirq)
18{
19 /* The mpic calls this even when there is no allocator setup */
20 if (!mpic->msi_bitmap.bitmap)
21 return;
22
23 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, hwirq);
24}
25
26#ifdef CONFIG_MPIC_U3_HT_IRQS
27static int mpic_msi_reserve_u3_hwirqs(struct mpic *mpic)
28{
29 irq_hw_number_t hwirq;
30 const struct irq_domain_ops *ops = mpic->irqhost->ops;
31 struct device_node *np;
32 int flags, index, i;
33 struct of_phandle_args oirq;
34
35 pr_debug("mpic: found U3, guessing msi allocator setup\n");
36
37 /* Reserve source numbers we know are reserved in the HW.
38 *
39 * This is a bit of a mix of U3 and U4 reserves but that's going
40 * to work fine, we have plenty enugh numbers left so let's just
41 * mark anything we don't like reserved.
42 */
43 for (i = 0; i < 8; i++)
44 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
45
46 for (i = 42; i < 46; i++)
47 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
48
49 for (i = 100; i < 105; i++)
50 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
51
52 for (i = 124; i < mpic->num_sources; i++)
53 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, i);
54
55
56 np = NULL;
57 while ((np = of_find_all_nodes(np))) {
58 pr_debug("mpic: mapping hwirqs for %pOF\n", np);
59
60 index = 0;
61 while (of_irq_parse_one(np, index++, &oirq) == 0) {
62 ops->xlate(mpic->irqhost, NULL, oirq.args,
63 oirq.args_count, &hwirq, &flags);
64 msi_bitmap_reserve_hwirq(&mpic->msi_bitmap, hwirq);
65 }
66 }
67
68 return 0;
69}
70#else
71static int mpic_msi_reserve_u3_hwirqs(struct mpic *mpic)
72{
73 return -1;
74}
75#endif
76
77int mpic_msi_init_allocator(struct mpic *mpic)
78{
79 int rc;
80
81 rc = msi_bitmap_alloc(&mpic->msi_bitmap, mpic->num_sources,
82 irq_domain_get_of_node(mpic->irqhost));
83 if (rc)
84 return rc;
85
86 rc = msi_bitmap_reserve_dt_hwirqs(&mpic->msi_bitmap);
87 if (rc > 0) {
88 if (mpic->flags & MPIC_U3_HT_IRQS)
89 rc = mpic_msi_reserve_u3_hwirqs(mpic);
90
91 if (rc) {
92 msi_bitmap_free(&mpic->msi_bitmap);
93 return rc;
94 }
95 }
96
97 return 0;
98}