2 * Freescale Management Complex (MC) bus driver MSI support
4 * Copyright (C) 2015-2016 Freescale Semiconductor, Inc.
5 * Author: German Rivera <German.Rivera@freescale.com>
7 * This file is licensed under the terms of the GNU General Public
8 * License version 2. This program is licensed "as is" without any
9 * warranty of any kind, whether express or implied.
12 #include <linux/of_device.h>
13 #include <linux/of_address.h>
14 #include <linux/irqchip/arm-gic-v3.h>
15 #include <linux/of_irq.h>
16 #include <linux/irq.h>
17 #include <linux/irqdomain.h>
18 #include <linux/msi.h>
19 #include "fsl-mc-private.h"
22 * Generate a unique ID identifying the interrupt (only used within the MSI
23 * irqdomain. Combine the icid with the interrupt index.
25 static irq_hw_number_t
fsl_mc_domain_calc_hwirq(struct fsl_mc_device
*dev
,
26 struct msi_desc
*desc
)
29 * Make the base hwirq value for ICID*10000 so it is readable
30 * as a decimal value in /proc/interrupts.
32 return (irq_hw_number_t
)(desc
->fsl_mc
.msi_index
+ (dev
->icid
* 10000));
35 static void fsl_mc_msi_set_desc(msi_alloc_info_t
*arg
,
36 struct msi_desc
*desc
)
39 arg
->hwirq
= fsl_mc_domain_calc_hwirq(to_fsl_mc_device(desc
->dev
),
43 static void fsl_mc_msi_update_dom_ops(struct msi_domain_info
*info
)
45 struct msi_domain_ops
*ops
= info
->ops
;
51 * set_desc should not be set by the caller
54 ops
->set_desc
= fsl_mc_msi_set_desc
;
57 static void __fsl_mc_msi_write_msg(struct fsl_mc_device
*mc_bus_dev
,
58 struct fsl_mc_device_irq
*mc_dev_irq
)
61 struct fsl_mc_device
*owner_mc_dev
= mc_dev_irq
->mc_dev
;
62 struct msi_desc
*msi_desc
= mc_dev_irq
->msi_desc
;
63 struct dprc_irq_cfg irq_cfg
;
66 * msi_desc->msg.address is 0x0 when this function is invoked in
67 * the free_irq() code path. In this case, for the MC, we don't
68 * really need to "unprogram" the MSI, so we just return.
70 if (msi_desc
->msg
.address_lo
== 0x0 && msi_desc
->msg
.address_hi
== 0x0)
73 if (WARN_ON(!owner_mc_dev
))
76 irq_cfg
.paddr
= ((u64
)msi_desc
->msg
.address_hi
<< 32) |
77 msi_desc
->msg
.address_lo
;
78 irq_cfg
.val
= msi_desc
->msg
.data
;
79 irq_cfg
.irq_num
= msi_desc
->irq
;
81 if (owner_mc_dev
== mc_bus_dev
) {
83 * IRQ is for the mc_bus_dev's DPRC itself
85 error
= dprc_set_irq(mc_bus_dev
->mc_io
,
86 MC_CMD_FLAG_INTR_DIS
| MC_CMD_FLAG_PRI
,
87 mc_bus_dev
->mc_handle
,
88 mc_dev_irq
->dev_irq_index
,
91 dev_err(&owner_mc_dev
->dev
,
92 "dprc_set_irq() failed: %d\n", error
);
96 * IRQ is for for a child device of mc_bus_dev
98 error
= dprc_set_obj_irq(mc_bus_dev
->mc_io
,
99 MC_CMD_FLAG_INTR_DIS
| MC_CMD_FLAG_PRI
,
100 mc_bus_dev
->mc_handle
,
101 owner_mc_dev
->obj_desc
.type
,
102 owner_mc_dev
->obj_desc
.id
,
103 mc_dev_irq
->dev_irq_index
,
106 dev_err(&owner_mc_dev
->dev
,
107 "dprc_obj_set_irq() failed: %d\n", error
);
113 * NOTE: This function is invoked with interrupts disabled
115 static void fsl_mc_msi_write_msg(struct irq_data
*irq_data
,
118 struct msi_desc
*msi_desc
= irq_data_get_msi_desc(irq_data
);
119 struct fsl_mc_device
*mc_bus_dev
= to_fsl_mc_device(msi_desc
->dev
);
120 struct fsl_mc_bus
*mc_bus
= to_fsl_mc_bus(mc_bus_dev
);
121 struct fsl_mc_device_irq
*mc_dev_irq
=
122 &mc_bus
->irq_resources
[msi_desc
->fsl_mc
.msi_index
];
124 WARN_ON(mc_dev_irq
->msi_desc
!= msi_desc
);
125 msi_desc
->msg
= *msg
;
128 * Program the MSI (paddr, value) pair in the device:
130 __fsl_mc_msi_write_msg(mc_bus_dev
, mc_dev_irq
);
133 static void fsl_mc_msi_update_chip_ops(struct msi_domain_info
*info
)
135 struct irq_chip
*chip
= info
->chip
;
137 if (WARN_ON((!chip
)))
141 * irq_write_msi_msg should not be set by the caller
143 if (!chip
->irq_write_msi_msg
)
144 chip
->irq_write_msi_msg
= fsl_mc_msi_write_msg
;
148 * fsl_mc_msi_create_irq_domain - Create a fsl-mc MSI interrupt domain
149 * @np: Optional device-tree node of the interrupt controller
150 * @info: MSI domain info
151 * @parent: Parent irq domain
153 * Updates the domain and chip ops and creates a fsl-mc MSI
157 * A domain pointer or NULL in case of failure.
159 struct irq_domain
*fsl_mc_msi_create_irq_domain(struct fwnode_handle
*fwnode
,
160 struct msi_domain_info
*info
,
161 struct irq_domain
*parent
)
163 struct irq_domain
*domain
;
165 if (info
->flags
& MSI_FLAG_USE_DEF_DOM_OPS
)
166 fsl_mc_msi_update_dom_ops(info
);
167 if (info
->flags
& MSI_FLAG_USE_DEF_CHIP_OPS
)
168 fsl_mc_msi_update_chip_ops(info
);
170 domain
= msi_create_irq_domain(fwnode
, info
, parent
);
172 domain
->bus_token
= DOMAIN_BUS_FSL_MC_MSI
;
177 int fsl_mc_find_msi_domain(struct device
*mc_platform_dev
,
178 struct irq_domain
**mc_msi_domain
)
180 struct irq_domain
*msi_domain
;
181 struct device_node
*mc_of_node
= mc_platform_dev
->of_node
;
183 msi_domain
= of_msi_get_domain(mc_platform_dev
, mc_of_node
,
184 DOMAIN_BUS_FSL_MC_MSI
);
186 pr_err("Unable to find fsl-mc MSI domain for %s\n",
187 mc_of_node
->full_name
);
192 *mc_msi_domain
= msi_domain
;
196 static void fsl_mc_msi_free_descs(struct device
*dev
)
198 struct msi_desc
*desc
, *tmp
;
200 list_for_each_entry_safe(desc
, tmp
, dev_to_msi_list(dev
), list
) {
201 list_del(&desc
->list
);
202 free_msi_entry(desc
);
206 static int fsl_mc_msi_alloc_descs(struct device
*dev
, unsigned int irq_count
)
211 struct msi_desc
*msi_desc
;
213 for (i
= 0; i
< irq_count
; i
++) {
214 msi_desc
= alloc_msi_entry(dev
, 1, NULL
);
216 dev_err(dev
, "Failed to allocate msi entry\n");
218 goto cleanup_msi_descs
;
221 msi_desc
->fsl_mc
.msi_index
= i
;
222 INIT_LIST_HEAD(&msi_desc
->list
);
223 list_add_tail(&msi_desc
->list
, dev_to_msi_list(dev
));
229 fsl_mc_msi_free_descs(dev
);
233 int fsl_mc_msi_domain_alloc_irqs(struct device
*dev
,
234 unsigned int irq_count
)
236 struct irq_domain
*msi_domain
;
239 if (WARN_ON(!list_empty(dev_to_msi_list(dev
))))
242 error
= fsl_mc_msi_alloc_descs(dev
, irq_count
);
246 msi_domain
= dev_get_msi_domain(dev
);
247 if (WARN_ON(!msi_domain
)) {
249 goto cleanup_msi_descs
;
253 * NOTE: Calling this function will trigger the invocation of the
254 * its_fsl_mc_msi_prepare() callback
256 error
= msi_domain_alloc_irqs(msi_domain
, dev
, irq_count
);
259 dev_err(dev
, "Failed to allocate IRQs\n");
260 goto cleanup_msi_descs
;
266 fsl_mc_msi_free_descs(dev
);
270 void fsl_mc_msi_domain_free_irqs(struct device
*dev
)
272 struct irq_domain
*msi_domain
;
274 msi_domain
= dev_get_msi_domain(dev
);
275 if (WARN_ON(!msi_domain
))
278 msi_domain_free_irqs(msi_domain
, dev
);
280 if (WARN_ON(list_empty(dev_to_msi_list(dev
))))
283 fsl_mc_msi_free_descs(dev
);