Blame view
drivers/irqchip/irq-vf610-mscm-ir.c
6.24 KB
d2912cb15 treewide: Replace... |
1 |
// SPDX-License-Identifier: GPL-2.0-only |
0494e11aa irqchip: vf610-ms... |
2 3 4 5 |
/* * Copyright (C) 2014-2015 Toradex AG * Author: Stefan Agner <stefan@agner.ch> * |
0494e11aa irqchip: vf610-ms... |
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 |
* IRQ chip driver for MSCM interrupt router available on Vybrid SoC's. * The interrupt router is between the CPU's interrupt controller and the * peripheral. The router allows to route the peripheral interrupts to * one of the two available CPU's on Vybrid VF6xx SoC's (Cortex-A5 or * Cortex-M4). The router will be configured transparently on a IRQ * request. * * o All peripheral interrupts of the Vybrid SoC can be routed to * CPU 0, CPU 1 or both. The routing is useful for dual-core * variants of Vybrid SoC such as VF6xx. This driver routes the * requested interrupt to the CPU currently running on. * * o It is required to setup the interrupt router even on single-core * variants of Vybrid. */ #include <linux/cpu_pm.h> #include <linux/io.h> #include <linux/irq.h> |
41a83e06e irqchip: Prepare ... |
25 |
#include <linux/irqchip.h> |
0494e11aa irqchip: vf610-ms... |
26 27 28 29 30 31 32 |
#include <linux/irqdomain.h> #include <linux/mfd/syscon.h> #include <dt-bindings/interrupt-controller/arm-gic.h> #include <linux/of.h> #include <linux/of_address.h> #include <linux/slab.h> #include <linux/regmap.h> |
0494e11aa irqchip: vf610-ms... |
33 34 35 36 37 38 39 40 41 42 43 |
#define MSCM_CPxNUM 0x4 #define MSCM_IRSPRC(n) (0x80 + 2 * (n)) #define MSCM_IRSPRC_CPEN_MASK 0x3 #define MSCM_IRSPRC_NUM 112 struct vf610_mscm_ir_chip_data { void __iomem *mscm_ir_base; u16 cpu_mask; u16 saved_irsprc[MSCM_IRSPRC_NUM]; |
b5cc5cbc1 irqchip: vf610-ms... |
44 |
bool is_nvic; |
0494e11aa irqchip: vf610-ms... |
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 |
}; static struct vf610_mscm_ir_chip_data *mscm_ir_data; static inline void vf610_mscm_ir_save(struct vf610_mscm_ir_chip_data *data) { int i; for (i = 0; i < MSCM_IRSPRC_NUM; i++) data->saved_irsprc[i] = readw_relaxed(data->mscm_ir_base + MSCM_IRSPRC(i)); } static inline void vf610_mscm_ir_restore(struct vf610_mscm_ir_chip_data *data) { int i; for (i = 0; i < MSCM_IRSPRC_NUM; i++) writew_relaxed(data->saved_irsprc[i], data->mscm_ir_base + MSCM_IRSPRC(i)); } static int vf610_mscm_ir_notifier(struct notifier_block *self, unsigned long cmd, void *v) { switch (cmd) { case CPU_CLUSTER_PM_ENTER: vf610_mscm_ir_save(mscm_ir_data); break; case CPU_CLUSTER_PM_ENTER_FAILED: case CPU_CLUSTER_PM_EXIT: vf610_mscm_ir_restore(mscm_ir_data); break; } return NOTIFY_OK; } static struct notifier_block mscm_ir_notifier_block = { .notifier_call = vf610_mscm_ir_notifier, }; static void vf610_mscm_ir_enable(struct irq_data *data) { irq_hw_number_t hwirq = data->hwirq; struct vf610_mscm_ir_chip_data *chip_data = data->chip_data; u16 irsprc; irsprc = readw_relaxed(chip_data->mscm_ir_base + MSCM_IRSPRC(hwirq)); irsprc &= MSCM_IRSPRC_CPEN_MASK; WARN_ON(irsprc & ~chip_data->cpu_mask); writew_relaxed(chip_data->cpu_mask, chip_data->mscm_ir_base + MSCM_IRSPRC(hwirq)); |
b5cc5cbc1 irqchip: vf610-ms... |
98 |
irq_chip_enable_parent(data); |
0494e11aa irqchip: vf610-ms... |
99 100 101 102 103 104 105 106 |
} static void vf610_mscm_ir_disable(struct irq_data *data) { irq_hw_number_t hwirq = data->hwirq; struct vf610_mscm_ir_chip_data *chip_data = data->chip_data; writew_relaxed(0x0, chip_data->mscm_ir_base + MSCM_IRSPRC(hwirq)); |
b5cc5cbc1 irqchip: vf610-ms... |
107 |
irq_chip_disable_parent(data); |
0494e11aa irqchip: vf610-ms... |
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 |
} static struct irq_chip vf610_mscm_ir_irq_chip = { .name = "mscm-ir", .irq_mask = irq_chip_mask_parent, .irq_unmask = irq_chip_unmask_parent, .irq_eoi = irq_chip_eoi_parent, .irq_enable = vf610_mscm_ir_enable, .irq_disable = vf610_mscm_ir_disable, .irq_retrigger = irq_chip_retrigger_hierarchy, .irq_set_affinity = irq_chip_set_affinity_parent, }; static int vf610_mscm_ir_domain_alloc(struct irq_domain *domain, unsigned int virq, unsigned int nr_irqs, void *arg) { int i; irq_hw_number_t hwirq; |
f833f57ff irqchip: Convert ... |
126 127 |
struct irq_fwspec *fwspec = arg; struct irq_fwspec parent_fwspec; |
0494e11aa irqchip: vf610-ms... |
128 |
|
f833f57ff irqchip: Convert ... |
129 |
if (!irq_domain_get_of_node(domain->parent)) |
0494e11aa irqchip: vf610-ms... |
130 |
return -EINVAL; |
f833f57ff irqchip: Convert ... |
131 132 133 134 |
if (fwspec->param_count != 2) return -EINVAL; hwirq = fwspec->param[0]; |
0494e11aa irqchip: vf610-ms... |
135 136 137 138 |
for (i = 0; i < nr_irqs; i++) irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i, &vf610_mscm_ir_irq_chip, domain->host_data); |
f833f57ff irqchip: Convert ... |
139 |
parent_fwspec.fwnode = domain->parent->fwnode; |
b5cc5cbc1 irqchip: vf610-ms... |
140 141 |
if (mscm_ir_data->is_nvic) { |
f833f57ff irqchip: Convert ... |
142 143 |
parent_fwspec.param_count = 1; parent_fwspec.param[0] = fwspec->param[0]; |
b5cc5cbc1 irqchip: vf610-ms... |
144 |
} else { |
f833f57ff irqchip: Convert ... |
145 146 147 148 |
parent_fwspec.param_count = 3; parent_fwspec.param[0] = GIC_SPI; parent_fwspec.param[1] = fwspec->param[0]; parent_fwspec.param[2] = fwspec->param[1]; |
b5cc5cbc1 irqchip: vf610-ms... |
149 |
} |
f833f57ff irqchip: Convert ... |
150 151 152 153 154 155 156 157 158 159 160 161 162 163 |
return irq_domain_alloc_irqs_parent(domain, virq, nr_irqs, &parent_fwspec); } static int vf610_mscm_ir_domain_translate(struct irq_domain *d, struct irq_fwspec *fwspec, unsigned long *hwirq, unsigned int *type) { if (WARN_ON(fwspec->param_count < 2)) return -EINVAL; *hwirq = fwspec->param[0]; *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK; return 0; |
0494e11aa irqchip: vf610-ms... |
164 165 166 |
} static const struct irq_domain_ops mscm_irq_domain_ops = { |
f833f57ff irqchip: Convert ... |
167 |
.translate = vf610_mscm_ir_domain_translate, |
0494e11aa irqchip: vf610-ms... |
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 |
.alloc = vf610_mscm_ir_domain_alloc, .free = irq_domain_free_irqs_common, }; static int __init vf610_mscm_ir_of_init(struct device_node *node, struct device_node *parent) { struct irq_domain *domain, *domain_parent; struct regmap *mscm_cp_regmap; int ret, cpuid; domain_parent = irq_find_host(parent); if (!domain_parent) { pr_err("vf610_mscm_ir: interrupt-parent not found "); return -EINVAL; } mscm_ir_data = kzalloc(sizeof(*mscm_ir_data), GFP_KERNEL); if (!mscm_ir_data) return -ENOMEM; mscm_ir_data->mscm_ir_base = of_io_request_and_map(node, 0, "mscm-ir"); |
dbf07cf0c irqchip: vf610: F... |
191 |
if (IS_ERR(mscm_ir_data->mscm_ir_base)) { |
0494e11aa irqchip: vf610-ms... |
192 193 |
pr_err("vf610_mscm_ir: unable to map mscm register "); |
dbf07cf0c irqchip: vf610: F... |
194 |
ret = PTR_ERR(mscm_ir_data->mscm_ir_base); |
0494e11aa irqchip: vf610-ms... |
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 |
goto out_free; } mscm_cp_regmap = syscon_regmap_lookup_by_phandle(node, "fsl,cpucfg"); if (IS_ERR(mscm_cp_regmap)) { ret = PTR_ERR(mscm_cp_regmap); pr_err("vf610_mscm_ir: regmap lookup for cpucfg failed "); goto out_unmap; } regmap_read(mscm_cp_regmap, MSCM_CPxNUM, &cpuid); mscm_ir_data->cpu_mask = 0x1 << cpuid; domain = irq_domain_add_hierarchy(domain_parent, 0, MSCM_IRSPRC_NUM, node, &mscm_irq_domain_ops, mscm_ir_data); if (!domain) { ret = -ENOMEM; goto out_unmap; } |
5d4c9bc77 irqdomain: Use ir... |
216 217 |
if (of_device_is_compatible(irq_domain_get_of_node(domain->parent), "arm,armv7m-nvic")) |
b5cc5cbc1 irqchip: vf610-ms... |
218 |
mscm_ir_data->is_nvic = true; |
0494e11aa irqchip: vf610-ms... |
219 220 221 222 223 224 225 226 227 228 229 |
cpu_pm_register_notifier(&mscm_ir_notifier_block); return 0; out_unmap: iounmap(mscm_ir_data->mscm_ir_base); out_free: kfree(mscm_ir_data); return ret; } IRQCHIP_DECLARE(vf610_mscm_ir, "fsl,vf610-mscm-ir", vf610_mscm_ir_of_init); |