2 * ARM GIC v2m MSI(-X) support
3 * Support for Message Signaled Interrupts for systems that
4 * implement ARM Generic Interrupt Controller: GICv2m.
6 * Copyright (C) 2014 Advanced Micro Devices, Inc.
7 * Authors: Suravee Suthikulpanit <suravee.suthikulpanit@amd.com>
8 * Harish Kasiviswanathan <harish.kasiviswanathan@amd.com>
9 * Brandon Anderson <brandon.anderson@amd.com>
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License version 2 as published
13 * by the Free Software Foundation.
16 #define pr_fmt(fmt) "GICv2m: " fmt
18 #include <linux/irq.h>
19 #include <linux/irqdomain.h>
20 #include <linux/kernel.h>
21 #include <linux/of_address.h>
22 #include <linux/of_pci.h>
23 #include <linux/slab.h>
24 #include <linux/spinlock.h>
29 * [25:16] lowest SPI assigned to MSI
31 * [9:0] Numer of SPIs assigned to MSI
33 #define V2M_MSI_TYPER 0x008
34 #define V2M_MSI_TYPER_BASE_SHIFT 16
35 #define V2M_MSI_TYPER_BASE_MASK 0x3FF
36 #define V2M_MSI_TYPER_NUM_MASK 0x3FF
37 #define V2M_MSI_SETSPI_NS 0x040
38 #define V2M_MIN_SPI 32
39 #define V2M_MAX_SPI 1019
41 #define V2M_MSI_TYPER_BASE_SPI(x) \
42 (((x) >> V2M_MSI_TYPER_BASE_SHIFT) & V2M_MSI_TYPER_BASE_MASK)
44 #define V2M_MSI_TYPER_NUM_SPI(x) ((x) & V2M_MSI_TYPER_NUM_MASK)
47 spinlock_t msi_cnt_lock
;
48 struct resource res
; /* GICv2m resource */
49 void __iomem
*base
; /* GICv2m virt address */
50 u32 spi_start
; /* The SPI number that MSIs start */
51 u32 nr_spis
; /* The number of SPIs for MSIs */
52 unsigned long *bm
; /* MSI vector bitmap */
55 static void gicv2m_mask_msi_irq(struct irq_data
*d
)
58 irq_chip_mask_parent(d
);
61 static void gicv2m_unmask_msi_irq(struct irq_data
*d
)
63 pci_msi_unmask_irq(d
);
64 irq_chip_unmask_parent(d
);
67 static struct irq_chip gicv2m_msi_irq_chip
= {
69 .irq_mask
= gicv2m_mask_msi_irq
,
70 .irq_unmask
= gicv2m_unmask_msi_irq
,
71 .irq_eoi
= irq_chip_eoi_parent
,
72 .irq_write_msi_msg
= pci_msi_domain_write_msg
,
75 static struct msi_domain_info gicv2m_msi_domain_info
= {
76 .flags
= (MSI_FLAG_USE_DEF_DOM_OPS
| MSI_FLAG_USE_DEF_CHIP_OPS
|
78 .chip
= &gicv2m_msi_irq_chip
,
81 static int gicv2m_set_affinity(struct irq_data
*irq_data
,
82 const struct cpumask
*mask
, bool force
)
86 ret
= irq_chip_set_affinity_parent(irq_data
, mask
, force
);
87 if (ret
== IRQ_SET_MASK_OK
)
88 ret
= IRQ_SET_MASK_OK_DONE
;
93 static void gicv2m_compose_msi_msg(struct irq_data
*data
, struct msi_msg
*msg
)
95 struct v2m_data
*v2m
= irq_data_get_irq_chip_data(data
);
96 phys_addr_t addr
= v2m
->res
.start
+ V2M_MSI_SETSPI_NS
;
98 msg
->address_hi
= upper_32_bits(addr
);
99 msg
->address_lo
= lower_32_bits(addr
);
100 msg
->data
= data
->hwirq
;
103 static struct irq_chip gicv2m_irq_chip
= {
105 .irq_mask
= irq_chip_mask_parent
,
106 .irq_unmask
= irq_chip_unmask_parent
,
107 .irq_eoi
= irq_chip_eoi_parent
,
108 .irq_set_affinity
= gicv2m_set_affinity
,
109 .irq_compose_msi_msg
= gicv2m_compose_msi_msg
,
112 static int gicv2m_irq_gic_domain_alloc(struct irq_domain
*domain
,
114 irq_hw_number_t hwirq
)
116 struct of_phandle_args args
;
120 args
.np
= domain
->parent
->of_node
;
123 args
.args
[1] = hwirq
- 32;
124 args
.args
[2] = IRQ_TYPE_EDGE_RISING
;
126 err
= irq_domain_alloc_irqs_parent(domain
, virq
, 1, &args
);
130 /* Configure the interrupt line to be edge */
131 d
= irq_domain_get_irq_data(domain
->parent
, virq
);
132 d
->chip
->irq_set_type(d
, IRQ_TYPE_EDGE_RISING
);
136 static void gicv2m_unalloc_msi(struct v2m_data
*v2m
, unsigned int hwirq
)
140 pos
= hwirq
- v2m
->spi_start
;
141 if (pos
< 0 || pos
>= v2m
->nr_spis
) {
142 pr_err("Failed to teardown msi. Invalid hwirq %d\n", hwirq
);
146 spin_lock(&v2m
->msi_cnt_lock
);
147 __clear_bit(pos
, v2m
->bm
);
148 spin_unlock(&v2m
->msi_cnt_lock
);
151 static int gicv2m_irq_domain_alloc(struct irq_domain
*domain
, unsigned int virq
,
152 unsigned int nr_irqs
, void *args
)
154 struct v2m_data
*v2m
= domain
->host_data
;
155 int hwirq
, offset
, err
= 0;
157 spin_lock(&v2m
->msi_cnt_lock
);
158 offset
= find_first_zero_bit(v2m
->bm
, v2m
->nr_spis
);
159 if (offset
< v2m
->nr_spis
)
160 __set_bit(offset
, v2m
->bm
);
163 spin_unlock(&v2m
->msi_cnt_lock
);
168 hwirq
= v2m
->spi_start
+ offset
;
170 err
= gicv2m_irq_gic_domain_alloc(domain
, virq
, hwirq
);
172 gicv2m_unalloc_msi(v2m
, hwirq
);
176 irq_domain_set_hwirq_and_chip(domain
, virq
, hwirq
,
177 &gicv2m_irq_chip
, v2m
);
182 static void gicv2m_irq_domain_free(struct irq_domain
*domain
,
183 unsigned int virq
, unsigned int nr_irqs
)
185 struct irq_data
*d
= irq_domain_get_irq_data(domain
, virq
);
186 struct v2m_data
*v2m
= irq_data_get_irq_chip_data(d
);
188 BUG_ON(nr_irqs
!= 1);
189 gicv2m_unalloc_msi(v2m
, d
->hwirq
);
190 irq_domain_free_irqs_parent(domain
, virq
, nr_irqs
);
193 static const struct irq_domain_ops gicv2m_domain_ops
= {
194 .alloc
= gicv2m_irq_domain_alloc
,
195 .free
= gicv2m_irq_domain_free
,
198 static bool is_msi_spi_valid(u32 base
, u32 num
)
200 if (base
< V2M_MIN_SPI
) {
201 pr_err("Invalid MSI base SPI (base:%u)\n", base
);
205 if ((num
== 0) || (base
+ num
> V2M_MAX_SPI
)) {
206 pr_err("Number of SPIs (%u) exceed maximum (%u)\n",
207 num
, V2M_MAX_SPI
- V2M_MIN_SPI
+ 1);
214 static struct irq_chip gicv2m_pmsi_irq_chip
= {
218 static struct msi_domain_ops gicv2m_pmsi_ops
= {
221 static struct msi_domain_info gicv2m_pmsi_domain_info
= {
222 .flags
= (MSI_FLAG_USE_DEF_DOM_OPS
| MSI_FLAG_USE_DEF_CHIP_OPS
),
223 .ops
= &gicv2m_pmsi_ops
,
224 .chip
= &gicv2m_pmsi_irq_chip
,
227 static int __init
gicv2m_init_one(struct device_node
*node
,
228 struct irq_domain
*parent
)
231 struct v2m_data
*v2m
;
232 struct irq_domain
*inner_domain
, *pci_domain
, *plat_domain
;
234 v2m
= kzalloc(sizeof(struct v2m_data
), GFP_KERNEL
);
236 pr_err("Failed to allocate struct v2m_data.\n");
240 ret
= of_address_to_resource(node
, 0, &v2m
->res
);
242 pr_err("Failed to allocate v2m resource.\n");
246 v2m
->base
= ioremap(v2m
->res
.start
, resource_size(&v2m
->res
));
248 pr_err("Failed to map GICv2m resource\n");
253 if (!of_property_read_u32(node
, "arm,msi-base-spi", &v2m
->spi_start
) &&
254 !of_property_read_u32(node
, "arm,msi-num-spis", &v2m
->nr_spis
)) {
255 pr_info("Overriding V2M MSI_TYPER (base:%u, num:%u)\n",
256 v2m
->spi_start
, v2m
->nr_spis
);
258 u32 typer
= readl_relaxed(v2m
->base
+ V2M_MSI_TYPER
);
260 v2m
->spi_start
= V2M_MSI_TYPER_BASE_SPI(typer
);
261 v2m
->nr_spis
= V2M_MSI_TYPER_NUM_SPI(typer
);
264 if (!is_msi_spi_valid(v2m
->spi_start
, v2m
->nr_spis
)) {
269 v2m
->bm
= kzalloc(sizeof(long) * BITS_TO_LONGS(v2m
->nr_spis
),
276 inner_domain
= irq_domain_add_tree(node
, &gicv2m_domain_ops
, v2m
);
278 pr_err("Failed to create GICv2m domain\n");
283 inner_domain
->bus_token
= DOMAIN_BUS_NEXUS
;
284 inner_domain
->parent
= parent
;
285 pci_domain
= pci_msi_create_irq_domain(node
, &gicv2m_msi_domain_info
,
287 plat_domain
= platform_msi_create_irq_domain(node
,
288 &gicv2m_pmsi_domain_info
,
290 if (!pci_domain
|| !plat_domain
) {
291 pr_err("Failed to create MSI domains\n");
293 goto err_free_domains
;
296 spin_lock_init(&v2m
->msi_cnt_lock
);
298 pr_info("Node %s: range[%#lx:%#lx], SPI[%d:%d]\n", node
->name
,
299 (unsigned long)v2m
->res
.start
, (unsigned long)v2m
->res
.end
,
300 v2m
->spi_start
, (v2m
->spi_start
+ v2m
->nr_spis
));
306 irq_domain_remove(plat_domain
);
308 irq_domain_remove(pci_domain
);
310 irq_domain_remove(inner_domain
);
320 static struct of_device_id gicv2m_device_id
[] = {
321 { .compatible
= "arm,gic-v2m-frame", },
325 int __init
gicv2m_of_init(struct device_node
*node
, struct irq_domain
*parent
)
328 struct device_node
*child
;
330 for (child
= of_find_matching_node(node
, gicv2m_device_id
); child
;
331 child
= of_find_matching_node(child
, gicv2m_device_id
)) {
332 if (!of_find_property(child
, "msi-controller", NULL
))
335 ret
= gicv2m_init_one(child
, parent
);