Loading...
1/*
2 * IMG PowerDown Controller (PDC)
3 *
4 * Copyright 2010-2013 Imagination Technologies Ltd.
5 *
6 * Exposes the syswake and PDC peripheral wake interrupts to the system.
7 *
8 */
9
10#include <linux/bitops.h>
11#include <linux/interrupt.h>
12#include <linux/irqdomain.h>
13#include <linux/io.h>
14#include <linux/kernel.h>
15#include <linux/of.h>
16#include <linux/platform_device.h>
17#include <linux/spinlock.h>
18
19/* PDC interrupt register numbers */
20
21#define PDC_IRQ_STATUS 0x310
22#define PDC_IRQ_ENABLE 0x314
23#define PDC_IRQ_CLEAR 0x318
24#define PDC_IRQ_ROUTE 0x31c
25#define PDC_SYS_WAKE_BASE 0x330
26#define PDC_SYS_WAKE_STRIDE 0x8
27#define PDC_SYS_WAKE_CONFIG_BASE 0x334
28#define PDC_SYS_WAKE_CONFIG_STRIDE 0x8
29
30/* PDC interrupt register field masks */
31
32#define PDC_IRQ_SYS3 0x08
33#define PDC_IRQ_SYS2 0x04
34#define PDC_IRQ_SYS1 0x02
35#define PDC_IRQ_SYS0 0x01
36#define PDC_IRQ_ROUTE_WU_EN_SYS3 0x08000000
37#define PDC_IRQ_ROUTE_WU_EN_SYS2 0x04000000
38#define PDC_IRQ_ROUTE_WU_EN_SYS1 0x02000000
39#define PDC_IRQ_ROUTE_WU_EN_SYS0 0x01000000
40#define PDC_IRQ_ROUTE_WU_EN_WD 0x00040000
41#define PDC_IRQ_ROUTE_WU_EN_IR 0x00020000
42#define PDC_IRQ_ROUTE_WU_EN_RTC 0x00010000
43#define PDC_IRQ_ROUTE_EXT_EN_SYS3 0x00000800
44#define PDC_IRQ_ROUTE_EXT_EN_SYS2 0x00000400
45#define PDC_IRQ_ROUTE_EXT_EN_SYS1 0x00000200
46#define PDC_IRQ_ROUTE_EXT_EN_SYS0 0x00000100
47#define PDC_IRQ_ROUTE_EXT_EN_WD 0x00000004
48#define PDC_IRQ_ROUTE_EXT_EN_IR 0x00000002
49#define PDC_IRQ_ROUTE_EXT_EN_RTC 0x00000001
50#define PDC_SYS_WAKE_RESET 0x00000010
51#define PDC_SYS_WAKE_INT_MODE 0x0000000e
52#define PDC_SYS_WAKE_INT_MODE_SHIFT 1
53#define PDC_SYS_WAKE_PIN_VAL 0x00000001
54
55/* PDC interrupt constants */
56
57#define PDC_SYS_WAKE_INT_LOW 0x0
58#define PDC_SYS_WAKE_INT_HIGH 0x1
59#define PDC_SYS_WAKE_INT_DOWN 0x2
60#define PDC_SYS_WAKE_INT_UP 0x3
61#define PDC_SYS_WAKE_INT_CHANGE 0x6
62#define PDC_SYS_WAKE_INT_NONE 0x4
63
64/**
65 * struct pdc_intc_priv - private pdc interrupt data.
66 * @nr_perips: Number of peripheral interrupt signals.
67 * @nr_syswakes: Number of syswake signals.
68 * @perip_irqs: List of peripheral IRQ numbers handled.
69 * @syswake_irq: Shared PDC syswake IRQ number.
70 * @domain: IRQ domain for PDC peripheral and syswake IRQs.
71 * @pdc_base: Base of PDC registers.
72 * @irq_route: Cached version of PDC_IRQ_ROUTE register.
73 * @lock: Lock to protect the PDC syswake registers and the cached
74 * values of those registers in this struct.
75 */
76struct pdc_intc_priv {
77 unsigned int nr_perips;
78 unsigned int nr_syswakes;
79 unsigned int *perip_irqs;
80 unsigned int syswake_irq;
81 struct irq_domain *domain;
82 void __iomem *pdc_base;
83
84 u32 irq_route;
85 raw_spinlock_t lock;
86};
87
88static void pdc_write(struct pdc_intc_priv *priv, unsigned int reg_offs,
89 unsigned int data)
90{
91 iowrite32(data, priv->pdc_base + reg_offs);
92}
93
94static unsigned int pdc_read(struct pdc_intc_priv *priv,
95 unsigned int reg_offs)
96{
97 return ioread32(priv->pdc_base + reg_offs);
98}
99
100/* Generic IRQ callbacks */
101
102#define SYS0_HWIRQ 8
103
104static unsigned int hwirq_is_syswake(irq_hw_number_t hw)
105{
106 return hw >= SYS0_HWIRQ;
107}
108
109static unsigned int hwirq_to_syswake(irq_hw_number_t hw)
110{
111 return hw - SYS0_HWIRQ;
112}
113
114static irq_hw_number_t syswake_to_hwirq(unsigned int syswake)
115{
116 return SYS0_HWIRQ + syswake;
117}
118
119static struct pdc_intc_priv *irqd_to_priv(struct irq_data *data)
120{
121 return (struct pdc_intc_priv *)data->domain->host_data;
122}
123
124/*
125 * perip_irq_mask() and perip_irq_unmask() use IRQ_ROUTE which also contains
126 * wake bits, therefore we cannot use the generic irqchip mask callbacks as they
127 * cache the mask.
128 */
129
130static void perip_irq_mask(struct irq_data *data)
131{
132 struct pdc_intc_priv *priv = irqd_to_priv(data);
133
134 raw_spin_lock(&priv->lock);
135 priv->irq_route &= ~data->mask;
136 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
137 raw_spin_unlock(&priv->lock);
138}
139
140static void perip_irq_unmask(struct irq_data *data)
141{
142 struct pdc_intc_priv *priv = irqd_to_priv(data);
143
144 raw_spin_lock(&priv->lock);
145 priv->irq_route |= data->mask;
146 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
147 raw_spin_unlock(&priv->lock);
148}
149
150static int syswake_irq_set_type(struct irq_data *data, unsigned int flow_type)
151{
152 struct pdc_intc_priv *priv = irqd_to_priv(data);
153 unsigned int syswake = hwirq_to_syswake(data->hwirq);
154 unsigned int irq_mode;
155 unsigned int soc_sys_wake_regoff, soc_sys_wake;
156
157 /* translate to syswake IRQ mode */
158 switch (flow_type) {
159 case IRQ_TYPE_EDGE_BOTH:
160 irq_mode = PDC_SYS_WAKE_INT_CHANGE;
161 break;
162 case IRQ_TYPE_EDGE_RISING:
163 irq_mode = PDC_SYS_WAKE_INT_UP;
164 break;
165 case IRQ_TYPE_EDGE_FALLING:
166 irq_mode = PDC_SYS_WAKE_INT_DOWN;
167 break;
168 case IRQ_TYPE_LEVEL_HIGH:
169 irq_mode = PDC_SYS_WAKE_INT_HIGH;
170 break;
171 case IRQ_TYPE_LEVEL_LOW:
172 irq_mode = PDC_SYS_WAKE_INT_LOW;
173 break;
174 default:
175 return -EINVAL;
176 }
177
178 raw_spin_lock(&priv->lock);
179
180 /* set the IRQ mode */
181 soc_sys_wake_regoff = PDC_SYS_WAKE_BASE + syswake*PDC_SYS_WAKE_STRIDE;
182 soc_sys_wake = pdc_read(priv, soc_sys_wake_regoff);
183 soc_sys_wake &= ~PDC_SYS_WAKE_INT_MODE;
184 soc_sys_wake |= irq_mode << PDC_SYS_WAKE_INT_MODE_SHIFT;
185 pdc_write(priv, soc_sys_wake_regoff, soc_sys_wake);
186
187 /* and update the handler */
188 irq_setup_alt_chip(data, flow_type);
189
190 raw_spin_unlock(&priv->lock);
191
192 return 0;
193}
194
195/* applies to both peripheral and syswake interrupts */
196static int pdc_irq_set_wake(struct irq_data *data, unsigned int on)
197{
198 struct pdc_intc_priv *priv = irqd_to_priv(data);
199 irq_hw_number_t hw = data->hwirq;
200 unsigned int mask = (1 << 16) << hw;
201 unsigned int dst_irq;
202
203 raw_spin_lock(&priv->lock);
204 if (on)
205 priv->irq_route |= mask;
206 else
207 priv->irq_route &= ~mask;
208 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
209 raw_spin_unlock(&priv->lock);
210
211 /* control the destination IRQ wakeup too for standby mode */
212 if (hwirq_is_syswake(hw))
213 dst_irq = priv->syswake_irq;
214 else
215 dst_irq = priv->perip_irqs[hw];
216 irq_set_irq_wake(dst_irq, on);
217
218 return 0;
219}
220
221static void pdc_intc_perip_isr(unsigned int irq, struct irq_desc *desc)
222{
223 struct pdc_intc_priv *priv;
224 unsigned int i, irq_no;
225
226 priv = (struct pdc_intc_priv *)irq_desc_get_handler_data(desc);
227
228 /* find the peripheral number */
229 for (i = 0; i < priv->nr_perips; ++i)
230 if (irq == priv->perip_irqs[i])
231 goto found;
232
233 /* should never get here */
234 return;
235found:
236
237 /* pass on the interrupt */
238 irq_no = irq_linear_revmap(priv->domain, i);
239 generic_handle_irq(irq_no);
240}
241
242static void pdc_intc_syswake_isr(unsigned int irq, struct irq_desc *desc)
243{
244 struct pdc_intc_priv *priv;
245 unsigned int syswake, irq_no;
246 unsigned int status;
247
248 priv = (struct pdc_intc_priv *)irq_desc_get_handler_data(desc);
249
250 status = pdc_read(priv, PDC_IRQ_STATUS) &
251 pdc_read(priv, PDC_IRQ_ENABLE);
252 status &= (1 << priv->nr_syswakes) - 1;
253
254 for (syswake = 0; status; status >>= 1, ++syswake) {
255 /* Has this sys_wake triggered? */
256 if (!(status & 1))
257 continue;
258
259 irq_no = irq_linear_revmap(priv->domain,
260 syswake_to_hwirq(syswake));
261 generic_handle_irq(irq_no);
262 }
263}
264
265static void pdc_intc_setup(struct pdc_intc_priv *priv)
266{
267 int i;
268 unsigned int soc_sys_wake_regoff;
269 unsigned int soc_sys_wake;
270
271 /*
272 * Mask all syswake interrupts before routing, or we could receive an
273 * interrupt before we're ready to handle it.
274 */
275 pdc_write(priv, PDC_IRQ_ENABLE, 0);
276
277 /*
278 * Enable routing of all syswakes
279 * Disable all wake sources
280 */
281 priv->irq_route = ((PDC_IRQ_ROUTE_EXT_EN_SYS0 << priv->nr_syswakes) -
282 PDC_IRQ_ROUTE_EXT_EN_SYS0);
283 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
284
285 /* Initialise syswake IRQ */
286 for (i = 0; i < priv->nr_syswakes; ++i) {
287 /* set the IRQ mode to none */
288 soc_sys_wake_regoff = PDC_SYS_WAKE_BASE + i*PDC_SYS_WAKE_STRIDE;
289 soc_sys_wake = PDC_SYS_WAKE_INT_NONE
290 << PDC_SYS_WAKE_INT_MODE_SHIFT;
291 pdc_write(priv, soc_sys_wake_regoff, soc_sys_wake);
292 }
293}
294
295static int pdc_intc_probe(struct platform_device *pdev)
296{
297 struct pdc_intc_priv *priv;
298 struct device_node *node = pdev->dev.of_node;
299 struct resource *res_regs;
300 struct irq_chip_generic *gc;
301 unsigned int i;
302 int irq, ret;
303 u32 val;
304
305 if (!node)
306 return -ENOENT;
307
308 /* Get registers */
309 res_regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
310 if (res_regs == NULL) {
311 dev_err(&pdev->dev, "cannot find registers resource\n");
312 return -ENOENT;
313 }
314
315 /* Allocate driver data */
316 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
317 if (!priv) {
318 dev_err(&pdev->dev, "cannot allocate device data\n");
319 return -ENOMEM;
320 }
321 raw_spin_lock_init(&priv->lock);
322 platform_set_drvdata(pdev, priv);
323
324 /* Ioremap the registers */
325 priv->pdc_base = devm_ioremap(&pdev->dev, res_regs->start,
326 res_regs->end - res_regs->start);
327 if (!priv->pdc_base)
328 return -EIO;
329
330 /* Get number of peripherals */
331 ret = of_property_read_u32(node, "num-perips", &val);
332 if (ret) {
333 dev_err(&pdev->dev, "No num-perips node property found\n");
334 return -EINVAL;
335 }
336 if (val > SYS0_HWIRQ) {
337 dev_err(&pdev->dev, "num-perips (%u) out of range\n", val);
338 return -EINVAL;
339 }
340 priv->nr_perips = val;
341
342 /* Get number of syswakes */
343 ret = of_property_read_u32(node, "num-syswakes", &val);
344 if (ret) {
345 dev_err(&pdev->dev, "No num-syswakes node property found\n");
346 return -EINVAL;
347 }
348 if (val > SYS0_HWIRQ) {
349 dev_err(&pdev->dev, "num-syswakes (%u) out of range\n", val);
350 return -EINVAL;
351 }
352 priv->nr_syswakes = val;
353
354 /* Get peripheral IRQ numbers */
355 priv->perip_irqs = devm_kzalloc(&pdev->dev, 4 * priv->nr_perips,
356 GFP_KERNEL);
357 if (!priv->perip_irqs) {
358 dev_err(&pdev->dev, "cannot allocate perip IRQ list\n");
359 return -ENOMEM;
360 }
361 for (i = 0; i < priv->nr_perips; ++i) {
362 irq = platform_get_irq(pdev, 1 + i);
363 if (irq < 0) {
364 dev_err(&pdev->dev, "cannot find perip IRQ #%u\n", i);
365 return irq;
366 }
367 priv->perip_irqs[i] = irq;
368 }
369 /* check if too many were provided */
370 if (platform_get_irq(pdev, 1 + i) >= 0) {
371 dev_err(&pdev->dev, "surplus perip IRQs detected\n");
372 return -EINVAL;
373 }
374
375 /* Get syswake IRQ number */
376 irq = platform_get_irq(pdev, 0);
377 if (irq < 0) {
378 dev_err(&pdev->dev, "cannot find syswake IRQ\n");
379 return irq;
380 }
381 priv->syswake_irq = irq;
382
383 /* Set up an IRQ domain */
384 priv->domain = irq_domain_add_linear(node, 16, &irq_generic_chip_ops,
385 priv);
386 if (unlikely(!priv->domain)) {
387 dev_err(&pdev->dev, "cannot add IRQ domain\n");
388 return -ENOMEM;
389 }
390
391 /*
392 * Set up 2 generic irq chips with 2 chip types.
393 * The first one for peripheral irqs (only 1 chip type used)
394 * The second one for syswake irqs (edge and level chip types)
395 */
396 ret = irq_alloc_domain_generic_chips(priv->domain, 8, 2, "pdc",
397 handle_level_irq, 0, 0,
398 IRQ_GC_INIT_NESTED_LOCK);
399 if (ret)
400 goto err_generic;
401
402 /* peripheral interrupt chip */
403
404 gc = irq_get_domain_generic_chip(priv->domain, 0);
405 gc->unused = ~(BIT(priv->nr_perips) - 1);
406 gc->reg_base = priv->pdc_base;
407 /*
408 * IRQ_ROUTE contains wake bits, so we can't use the generic versions as
409 * they cache the mask
410 */
411 gc->chip_types[0].regs.mask = PDC_IRQ_ROUTE;
412 gc->chip_types[0].chip.irq_mask = perip_irq_mask;
413 gc->chip_types[0].chip.irq_unmask = perip_irq_unmask;
414 gc->chip_types[0].chip.irq_set_wake = pdc_irq_set_wake;
415
416 /* syswake interrupt chip */
417
418 gc = irq_get_domain_generic_chip(priv->domain, 8);
419 gc->unused = ~(BIT(priv->nr_syswakes) - 1);
420 gc->reg_base = priv->pdc_base;
421
422 /* edge interrupts */
423 gc->chip_types[0].type = IRQ_TYPE_EDGE_BOTH;
424 gc->chip_types[0].handler = handle_edge_irq;
425 gc->chip_types[0].regs.ack = PDC_IRQ_CLEAR;
426 gc->chip_types[0].regs.mask = PDC_IRQ_ENABLE;
427 gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
428 gc->chip_types[0].chip.irq_mask = irq_gc_mask_clr_bit;
429 gc->chip_types[0].chip.irq_unmask = irq_gc_mask_set_bit;
430 gc->chip_types[0].chip.irq_set_type = syswake_irq_set_type;
431 gc->chip_types[0].chip.irq_set_wake = pdc_irq_set_wake;
432 /* for standby we pass on to the shared syswake IRQ */
433 gc->chip_types[0].chip.flags = IRQCHIP_MASK_ON_SUSPEND;
434
435 /* level interrupts */
436 gc->chip_types[1].type = IRQ_TYPE_LEVEL_MASK;
437 gc->chip_types[1].handler = handle_level_irq;
438 gc->chip_types[1].regs.ack = PDC_IRQ_CLEAR;
439 gc->chip_types[1].regs.mask = PDC_IRQ_ENABLE;
440 gc->chip_types[1].chip.irq_ack = irq_gc_ack_set_bit;
441 gc->chip_types[1].chip.irq_mask = irq_gc_mask_clr_bit;
442 gc->chip_types[1].chip.irq_unmask = irq_gc_mask_set_bit;
443 gc->chip_types[1].chip.irq_set_type = syswake_irq_set_type;
444 gc->chip_types[1].chip.irq_set_wake = pdc_irq_set_wake;
445 /* for standby we pass on to the shared syswake IRQ */
446 gc->chip_types[1].chip.flags = IRQCHIP_MASK_ON_SUSPEND;
447
448 /* Set up the hardware to enable interrupt routing */
449 pdc_intc_setup(priv);
450
451 /* Setup chained handlers for the peripheral IRQs */
452 for (i = 0; i < priv->nr_perips; ++i) {
453 irq = priv->perip_irqs[i];
454 irq_set_handler_data(irq, priv);
455 irq_set_chained_handler(irq, pdc_intc_perip_isr);
456 }
457
458 /* Setup chained handler for the syswake IRQ */
459 irq_set_handler_data(priv->syswake_irq, priv);
460 irq_set_chained_handler(priv->syswake_irq, pdc_intc_syswake_isr);
461
462 dev_info(&pdev->dev,
463 "PDC IRQ controller initialised (%u perip IRQs, %u syswake IRQs)\n",
464 priv->nr_perips,
465 priv->nr_syswakes);
466
467 return 0;
468err_generic:
469 irq_domain_remove(priv->domain);
470 return ret;
471}
472
473static int pdc_intc_remove(struct platform_device *pdev)
474{
475 struct pdc_intc_priv *priv = platform_get_drvdata(pdev);
476
477 irq_domain_remove(priv->domain);
478 return 0;
479}
480
481static const struct of_device_id pdc_intc_match[] = {
482 { .compatible = "img,pdc-intc" },
483 {}
484};
485
486static struct platform_driver pdc_intc_driver = {
487 .driver = {
488 .name = "pdc-intc",
489 .of_match_table = pdc_intc_match,
490 },
491 .probe = pdc_intc_probe,
492 .remove = pdc_intc_remove,
493};
494
495static int __init pdc_intc_init(void)
496{
497 return platform_driver_register(&pdc_intc_driver);
498}
499core_initcall(pdc_intc_init);
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * IMG PowerDown Controller (PDC)
4 *
5 * Copyright 2010-2013 Imagination Technologies Ltd.
6 *
7 * Exposes the syswake and PDC peripheral wake interrupts to the system.
8 *
9 */
10
11#include <linux/bitops.h>
12#include <linux/interrupt.h>
13#include <linux/irqdomain.h>
14#include <linux/io.h>
15#include <linux/kernel.h>
16#include <linux/of.h>
17#include <linux/platform_device.h>
18#include <linux/spinlock.h>
19
20/* PDC interrupt register numbers */
21
22#define PDC_IRQ_STATUS 0x310
23#define PDC_IRQ_ENABLE 0x314
24#define PDC_IRQ_CLEAR 0x318
25#define PDC_IRQ_ROUTE 0x31c
26#define PDC_SYS_WAKE_BASE 0x330
27#define PDC_SYS_WAKE_STRIDE 0x8
28#define PDC_SYS_WAKE_CONFIG_BASE 0x334
29#define PDC_SYS_WAKE_CONFIG_STRIDE 0x8
30
31/* PDC interrupt register field masks */
32
33#define PDC_IRQ_SYS3 0x08
34#define PDC_IRQ_SYS2 0x04
35#define PDC_IRQ_SYS1 0x02
36#define PDC_IRQ_SYS0 0x01
37#define PDC_IRQ_ROUTE_WU_EN_SYS3 0x08000000
38#define PDC_IRQ_ROUTE_WU_EN_SYS2 0x04000000
39#define PDC_IRQ_ROUTE_WU_EN_SYS1 0x02000000
40#define PDC_IRQ_ROUTE_WU_EN_SYS0 0x01000000
41#define PDC_IRQ_ROUTE_WU_EN_WD 0x00040000
42#define PDC_IRQ_ROUTE_WU_EN_IR 0x00020000
43#define PDC_IRQ_ROUTE_WU_EN_RTC 0x00010000
44#define PDC_IRQ_ROUTE_EXT_EN_SYS3 0x00000800
45#define PDC_IRQ_ROUTE_EXT_EN_SYS2 0x00000400
46#define PDC_IRQ_ROUTE_EXT_EN_SYS1 0x00000200
47#define PDC_IRQ_ROUTE_EXT_EN_SYS0 0x00000100
48#define PDC_IRQ_ROUTE_EXT_EN_WD 0x00000004
49#define PDC_IRQ_ROUTE_EXT_EN_IR 0x00000002
50#define PDC_IRQ_ROUTE_EXT_EN_RTC 0x00000001
51#define PDC_SYS_WAKE_RESET 0x00000010
52#define PDC_SYS_WAKE_INT_MODE 0x0000000e
53#define PDC_SYS_WAKE_INT_MODE_SHIFT 1
54#define PDC_SYS_WAKE_PIN_VAL 0x00000001
55
56/* PDC interrupt constants */
57
58#define PDC_SYS_WAKE_INT_LOW 0x0
59#define PDC_SYS_WAKE_INT_HIGH 0x1
60#define PDC_SYS_WAKE_INT_DOWN 0x2
61#define PDC_SYS_WAKE_INT_UP 0x3
62#define PDC_SYS_WAKE_INT_CHANGE 0x6
63#define PDC_SYS_WAKE_INT_NONE 0x4
64
65/**
66 * struct pdc_intc_priv - private pdc interrupt data.
67 * @nr_perips: Number of peripheral interrupt signals.
68 * @nr_syswakes: Number of syswake signals.
69 * @perip_irqs: List of peripheral IRQ numbers handled.
70 * @syswake_irq: Shared PDC syswake IRQ number.
71 * @domain: IRQ domain for PDC peripheral and syswake IRQs.
72 * @pdc_base: Base of PDC registers.
73 * @irq_route: Cached version of PDC_IRQ_ROUTE register.
74 * @lock: Lock to protect the PDC syswake registers and the cached
75 * values of those registers in this struct.
76 */
77struct pdc_intc_priv {
78 unsigned int nr_perips;
79 unsigned int nr_syswakes;
80 unsigned int *perip_irqs;
81 unsigned int syswake_irq;
82 struct irq_domain *domain;
83 void __iomem *pdc_base;
84
85 u32 irq_route;
86 raw_spinlock_t lock;
87};
88
89static void pdc_write(struct pdc_intc_priv *priv, unsigned int reg_offs,
90 unsigned int data)
91{
92 iowrite32(data, priv->pdc_base + reg_offs);
93}
94
95static unsigned int pdc_read(struct pdc_intc_priv *priv,
96 unsigned int reg_offs)
97{
98 return ioread32(priv->pdc_base + reg_offs);
99}
100
101/* Generic IRQ callbacks */
102
103#define SYS0_HWIRQ 8
104
105static unsigned int hwirq_is_syswake(irq_hw_number_t hw)
106{
107 return hw >= SYS0_HWIRQ;
108}
109
110static unsigned int hwirq_to_syswake(irq_hw_number_t hw)
111{
112 return hw - SYS0_HWIRQ;
113}
114
115static irq_hw_number_t syswake_to_hwirq(unsigned int syswake)
116{
117 return SYS0_HWIRQ + syswake;
118}
119
120static struct pdc_intc_priv *irqd_to_priv(struct irq_data *data)
121{
122 return (struct pdc_intc_priv *)data->domain->host_data;
123}
124
125/*
126 * perip_irq_mask() and perip_irq_unmask() use IRQ_ROUTE which also contains
127 * wake bits, therefore we cannot use the generic irqchip mask callbacks as they
128 * cache the mask.
129 */
130
131static void perip_irq_mask(struct irq_data *data)
132{
133 struct pdc_intc_priv *priv = irqd_to_priv(data);
134
135 raw_spin_lock(&priv->lock);
136 priv->irq_route &= ~data->mask;
137 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
138 raw_spin_unlock(&priv->lock);
139}
140
141static void perip_irq_unmask(struct irq_data *data)
142{
143 struct pdc_intc_priv *priv = irqd_to_priv(data);
144
145 raw_spin_lock(&priv->lock);
146 priv->irq_route |= data->mask;
147 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
148 raw_spin_unlock(&priv->lock);
149}
150
151static int syswake_irq_set_type(struct irq_data *data, unsigned int flow_type)
152{
153 struct pdc_intc_priv *priv = irqd_to_priv(data);
154 unsigned int syswake = hwirq_to_syswake(data->hwirq);
155 unsigned int irq_mode;
156 unsigned int soc_sys_wake_regoff, soc_sys_wake;
157
158 /* translate to syswake IRQ mode */
159 switch (flow_type) {
160 case IRQ_TYPE_EDGE_BOTH:
161 irq_mode = PDC_SYS_WAKE_INT_CHANGE;
162 break;
163 case IRQ_TYPE_EDGE_RISING:
164 irq_mode = PDC_SYS_WAKE_INT_UP;
165 break;
166 case IRQ_TYPE_EDGE_FALLING:
167 irq_mode = PDC_SYS_WAKE_INT_DOWN;
168 break;
169 case IRQ_TYPE_LEVEL_HIGH:
170 irq_mode = PDC_SYS_WAKE_INT_HIGH;
171 break;
172 case IRQ_TYPE_LEVEL_LOW:
173 irq_mode = PDC_SYS_WAKE_INT_LOW;
174 break;
175 default:
176 return -EINVAL;
177 }
178
179 raw_spin_lock(&priv->lock);
180
181 /* set the IRQ mode */
182 soc_sys_wake_regoff = PDC_SYS_WAKE_BASE + syswake*PDC_SYS_WAKE_STRIDE;
183 soc_sys_wake = pdc_read(priv, soc_sys_wake_regoff);
184 soc_sys_wake &= ~PDC_SYS_WAKE_INT_MODE;
185 soc_sys_wake |= irq_mode << PDC_SYS_WAKE_INT_MODE_SHIFT;
186 pdc_write(priv, soc_sys_wake_regoff, soc_sys_wake);
187
188 /* and update the handler */
189 irq_setup_alt_chip(data, flow_type);
190
191 raw_spin_unlock(&priv->lock);
192
193 return 0;
194}
195
196/* applies to both peripheral and syswake interrupts */
197static int pdc_irq_set_wake(struct irq_data *data, unsigned int on)
198{
199 struct pdc_intc_priv *priv = irqd_to_priv(data);
200 irq_hw_number_t hw = data->hwirq;
201 unsigned int mask = (1 << 16) << hw;
202 unsigned int dst_irq;
203
204 raw_spin_lock(&priv->lock);
205 if (on)
206 priv->irq_route |= mask;
207 else
208 priv->irq_route &= ~mask;
209 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
210 raw_spin_unlock(&priv->lock);
211
212 /* control the destination IRQ wakeup too for standby mode */
213 if (hwirq_is_syswake(hw))
214 dst_irq = priv->syswake_irq;
215 else
216 dst_irq = priv->perip_irqs[hw];
217 irq_set_irq_wake(dst_irq, on);
218
219 return 0;
220}
221
222static void pdc_intc_perip_isr(struct irq_desc *desc)
223{
224 unsigned int irq = irq_desc_get_irq(desc);
225 struct pdc_intc_priv *priv;
226 unsigned int i;
227
228 priv = (struct pdc_intc_priv *)irq_desc_get_handler_data(desc);
229
230 /* find the peripheral number */
231 for (i = 0; i < priv->nr_perips; ++i)
232 if (irq == priv->perip_irqs[i])
233 goto found;
234
235 /* should never get here */
236 return;
237found:
238
239 /* pass on the interrupt */
240 generic_handle_domain_irq(priv->domain, i);
241}
242
243static void pdc_intc_syswake_isr(struct irq_desc *desc)
244{
245 struct pdc_intc_priv *priv;
246 unsigned int syswake;
247 unsigned int status;
248
249 priv = (struct pdc_intc_priv *)irq_desc_get_handler_data(desc);
250
251 status = pdc_read(priv, PDC_IRQ_STATUS) &
252 pdc_read(priv, PDC_IRQ_ENABLE);
253 status &= (1 << priv->nr_syswakes) - 1;
254
255 for (syswake = 0; status; status >>= 1, ++syswake) {
256 /* Has this sys_wake triggered? */
257 if (!(status & 1))
258 continue;
259
260 generic_handle_domain_irq(priv->domain, syswake_to_hwirq(syswake));
261 }
262}
263
264static void pdc_intc_setup(struct pdc_intc_priv *priv)
265{
266 int i;
267 unsigned int soc_sys_wake_regoff;
268 unsigned int soc_sys_wake;
269
270 /*
271 * Mask all syswake interrupts before routing, or we could receive an
272 * interrupt before we're ready to handle it.
273 */
274 pdc_write(priv, PDC_IRQ_ENABLE, 0);
275
276 /*
277 * Enable routing of all syswakes
278 * Disable all wake sources
279 */
280 priv->irq_route = ((PDC_IRQ_ROUTE_EXT_EN_SYS0 << priv->nr_syswakes) -
281 PDC_IRQ_ROUTE_EXT_EN_SYS0);
282 pdc_write(priv, PDC_IRQ_ROUTE, priv->irq_route);
283
284 /* Initialise syswake IRQ */
285 for (i = 0; i < priv->nr_syswakes; ++i) {
286 /* set the IRQ mode to none */
287 soc_sys_wake_regoff = PDC_SYS_WAKE_BASE + i*PDC_SYS_WAKE_STRIDE;
288 soc_sys_wake = PDC_SYS_WAKE_INT_NONE
289 << PDC_SYS_WAKE_INT_MODE_SHIFT;
290 pdc_write(priv, soc_sys_wake_regoff, soc_sys_wake);
291 }
292}
293
294static int pdc_intc_probe(struct platform_device *pdev)
295{
296 struct pdc_intc_priv *priv;
297 struct device_node *node = pdev->dev.of_node;
298 struct resource *res_regs;
299 struct irq_chip_generic *gc;
300 unsigned int i;
301 int irq, ret;
302 u32 val;
303
304 if (!node)
305 return -ENOENT;
306
307 /* Get registers */
308 res_regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
309 if (res_regs == NULL) {
310 dev_err(&pdev->dev, "cannot find registers resource\n");
311 return -ENOENT;
312 }
313
314 /* Allocate driver data */
315 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
316 if (!priv)
317 return -ENOMEM;
318 raw_spin_lock_init(&priv->lock);
319 platform_set_drvdata(pdev, priv);
320
321 /* Ioremap the registers */
322 priv->pdc_base = devm_ioremap(&pdev->dev, res_regs->start,
323 resource_size(res_regs));
324 if (!priv->pdc_base)
325 return -EIO;
326
327 /* Get number of peripherals */
328 ret = of_property_read_u32(node, "num-perips", &val);
329 if (ret) {
330 dev_err(&pdev->dev, "No num-perips node property found\n");
331 return -EINVAL;
332 }
333 if (val > SYS0_HWIRQ) {
334 dev_err(&pdev->dev, "num-perips (%u) out of range\n", val);
335 return -EINVAL;
336 }
337 priv->nr_perips = val;
338
339 /* Get number of syswakes */
340 ret = of_property_read_u32(node, "num-syswakes", &val);
341 if (ret) {
342 dev_err(&pdev->dev, "No num-syswakes node property found\n");
343 return -EINVAL;
344 }
345 if (val > SYS0_HWIRQ) {
346 dev_err(&pdev->dev, "num-syswakes (%u) out of range\n", val);
347 return -EINVAL;
348 }
349 priv->nr_syswakes = val;
350
351 /* Get peripheral IRQ numbers */
352 priv->perip_irqs = devm_kcalloc(&pdev->dev, 4, priv->nr_perips,
353 GFP_KERNEL);
354 if (!priv->perip_irqs)
355 return -ENOMEM;
356 for (i = 0; i < priv->nr_perips; ++i) {
357 irq = platform_get_irq(pdev, 1 + i);
358 if (irq < 0)
359 return irq;
360 priv->perip_irqs[i] = irq;
361 }
362 /* check if too many were provided */
363 if (platform_get_irq(pdev, 1 + i) >= 0) {
364 dev_err(&pdev->dev, "surplus perip IRQs detected\n");
365 return -EINVAL;
366 }
367
368 /* Get syswake IRQ number */
369 irq = platform_get_irq(pdev, 0);
370 if (irq < 0)
371 return irq;
372 priv->syswake_irq = irq;
373
374 /* Set up an IRQ domain */
375 priv->domain = irq_domain_add_linear(node, 16, &irq_generic_chip_ops,
376 priv);
377 if (unlikely(!priv->domain)) {
378 dev_err(&pdev->dev, "cannot add IRQ domain\n");
379 return -ENOMEM;
380 }
381
382 /*
383 * Set up 2 generic irq chips with 2 chip types.
384 * The first one for peripheral irqs (only 1 chip type used)
385 * The second one for syswake irqs (edge and level chip types)
386 */
387 ret = irq_alloc_domain_generic_chips(priv->domain, 8, 2, "pdc",
388 handle_level_irq, 0, 0,
389 IRQ_GC_INIT_NESTED_LOCK);
390 if (ret)
391 goto err_generic;
392
393 /* peripheral interrupt chip */
394
395 gc = irq_get_domain_generic_chip(priv->domain, 0);
396 gc->unused = ~(BIT(priv->nr_perips) - 1);
397 gc->reg_base = priv->pdc_base;
398 /*
399 * IRQ_ROUTE contains wake bits, so we can't use the generic versions as
400 * they cache the mask
401 */
402 gc->chip_types[0].regs.mask = PDC_IRQ_ROUTE;
403 gc->chip_types[0].chip.irq_mask = perip_irq_mask;
404 gc->chip_types[0].chip.irq_unmask = perip_irq_unmask;
405 gc->chip_types[0].chip.irq_set_wake = pdc_irq_set_wake;
406
407 /* syswake interrupt chip */
408
409 gc = irq_get_domain_generic_chip(priv->domain, 8);
410 gc->unused = ~(BIT(priv->nr_syswakes) - 1);
411 gc->reg_base = priv->pdc_base;
412
413 /* edge interrupts */
414 gc->chip_types[0].type = IRQ_TYPE_EDGE_BOTH;
415 gc->chip_types[0].handler = handle_edge_irq;
416 gc->chip_types[0].regs.ack = PDC_IRQ_CLEAR;
417 gc->chip_types[0].regs.mask = PDC_IRQ_ENABLE;
418 gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
419 gc->chip_types[0].chip.irq_mask = irq_gc_mask_clr_bit;
420 gc->chip_types[0].chip.irq_unmask = irq_gc_mask_set_bit;
421 gc->chip_types[0].chip.irq_set_type = syswake_irq_set_type;
422 gc->chip_types[0].chip.irq_set_wake = pdc_irq_set_wake;
423 /* for standby we pass on to the shared syswake IRQ */
424 gc->chip_types[0].chip.flags = IRQCHIP_MASK_ON_SUSPEND;
425
426 /* level interrupts */
427 gc->chip_types[1].type = IRQ_TYPE_LEVEL_MASK;
428 gc->chip_types[1].handler = handle_level_irq;
429 gc->chip_types[1].regs.ack = PDC_IRQ_CLEAR;
430 gc->chip_types[1].regs.mask = PDC_IRQ_ENABLE;
431 gc->chip_types[1].chip.irq_ack = irq_gc_ack_set_bit;
432 gc->chip_types[1].chip.irq_mask = irq_gc_mask_clr_bit;
433 gc->chip_types[1].chip.irq_unmask = irq_gc_mask_set_bit;
434 gc->chip_types[1].chip.irq_set_type = syswake_irq_set_type;
435 gc->chip_types[1].chip.irq_set_wake = pdc_irq_set_wake;
436 /* for standby we pass on to the shared syswake IRQ */
437 gc->chip_types[1].chip.flags = IRQCHIP_MASK_ON_SUSPEND;
438
439 /* Set up the hardware to enable interrupt routing */
440 pdc_intc_setup(priv);
441
442 /* Setup chained handlers for the peripheral IRQs */
443 for (i = 0; i < priv->nr_perips; ++i) {
444 irq = priv->perip_irqs[i];
445 irq_set_chained_handler_and_data(irq, pdc_intc_perip_isr,
446 priv);
447 }
448
449 /* Setup chained handler for the syswake IRQ */
450 irq_set_chained_handler_and_data(priv->syswake_irq,
451 pdc_intc_syswake_isr, priv);
452
453 dev_info(&pdev->dev,
454 "PDC IRQ controller initialised (%u perip IRQs, %u syswake IRQs)\n",
455 priv->nr_perips,
456 priv->nr_syswakes);
457
458 return 0;
459err_generic:
460 irq_domain_remove(priv->domain);
461 return ret;
462}
463
464static int pdc_intc_remove(struct platform_device *pdev)
465{
466 struct pdc_intc_priv *priv = platform_get_drvdata(pdev);
467
468 irq_domain_remove(priv->domain);
469 return 0;
470}
471
472static const struct of_device_id pdc_intc_match[] = {
473 { .compatible = "img,pdc-intc" },
474 {}
475};
476
477static struct platform_driver pdc_intc_driver = {
478 .driver = {
479 .name = "pdc-intc",
480 .of_match_table = pdc_intc_match,
481 },
482 .probe = pdc_intc_probe,
483 .remove = pdc_intc_remove,
484};
485
486static int __init pdc_intc_init(void)
487{
488 return platform_driver_register(&pdc_intc_driver);
489}
490core_initcall(pdc_intc_init);