2 * Copyright (C) 2013-2015 ARM Limited, All Rights Reserved.
3 * Author: Marc Zyngier <marc.zyngier@arm.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 #include <linux/acpi_iort.h>
19 #include <linux/device.h>
20 #include <linux/msi.h>
22 #include <linux/of_irq.h>
24 static struct irq_chip its_pmsi_irq_chip
= {
28 static int of_pmsi_get_dev_id(struct irq_domain
*domain
, struct device
*dev
,
33 /* Suck the DeviceID out of the msi-parent property */
35 struct of_phandle_args args
;
37 ret
= of_parse_phandle_with_args(dev
->of_node
,
38 "msi-parent", "#msi-cells",
40 if (args
.np
== irq_domain_get_of_node(domain
)) {
41 if (WARN_ON(args
.args_count
!= 1))
43 *dev_id
= args
.args
[0];
51 static int its_pmsi_prepare(struct irq_domain
*domain
, struct device
*dev
,
52 int nvec
, msi_alloc_info_t
*info
)
54 struct msi_domain_info
*msi_info
;
58 msi_info
= msi_get_domain_info(domain
->parent
);
60 ret
= dev
->of_node
? of_pmsi_get_dev_id(domain
, dev
, &dev_id
) :
61 iort_pmsi_get_dev_id(dev
, &dev_id
);
65 /* ITS specific DeviceID, as the core ITS ignores dev. */
66 info
->scratchpad
[0].ul
= dev_id
;
68 return msi_info
->ops
->msi_prepare(domain
->parent
,
72 static struct msi_domain_ops its_pmsi_ops
= {
73 .msi_prepare
= its_pmsi_prepare
,
76 static struct msi_domain_info its_pmsi_domain_info
= {
77 .flags
= (MSI_FLAG_USE_DEF_DOM_OPS
| MSI_FLAG_USE_DEF_CHIP_OPS
),
79 .chip
= &its_pmsi_irq_chip
,
82 static struct of_device_id its_device_id
[] = {
83 { .compatible
= "arm,gic-v3-its", },
87 static int __init
its_pmsi_init_one(struct fwnode_handle
*fwnode
,
90 struct irq_domain
*parent
;
92 parent
= irq_find_matching_fwnode(fwnode
, DOMAIN_BUS_NEXUS
);
93 if (!parent
|| !msi_get_domain_info(parent
)) {
94 pr_err("%s: unable to locate ITS domain\n", name
);
98 if (!platform_msi_create_irq_domain(fwnode
, &its_pmsi_domain_info
,
100 pr_err("%s: unable to create platform domain\n", name
);
104 pr_info("Platform MSI: %s domain created\n", name
);
110 its_pmsi_parse_madt(struct acpi_subtable_header
*header
,
111 const unsigned long end
)
113 struct acpi_madt_generic_translator
*its_entry
;
114 struct fwnode_handle
*domain_handle
;
115 const char *node_name
;
118 its_entry
= (struct acpi_madt_generic_translator
*)header
;
119 node_name
= kasprintf(GFP_KERNEL
, "ITS@0x%lx",
120 (long)its_entry
->base_address
);
121 domain_handle
= iort_find_domain_token(its_entry
->translation_id
);
122 if (!domain_handle
) {
123 pr_err("%s: Unable to locate ITS domain handle\n", node_name
);
127 err
= its_pmsi_init_one(domain_handle
, node_name
);
134 static void __init
its_pmsi_acpi_init(void)
136 acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR
,
137 its_pmsi_parse_madt
, 0);
140 static inline void its_pmsi_acpi_init(void) { }
143 static void __init
its_pmsi_of_init(void)
145 struct device_node
*np
;
147 for (np
= of_find_matching_node(NULL
, its_device_id
); np
;
148 np
= of_find_matching_node(np
, its_device_id
)) {
149 if (!of_property_read_bool(np
, "msi-controller"))
152 its_pmsi_init_one(of_node_to_fwnode(np
), np
->full_name
);
156 static int __init
its_pmsi_init(void)
159 its_pmsi_acpi_init();
162 early_initcall(its_pmsi_init
);