1fcaf2036SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
28cb17b5eSVladimir Zapolskiy /*
38cb17b5eSVladimir Zapolskiy * Copyright 2015-2016 Vladimir Zapolskiy <vz@mleia.com>
48cb17b5eSVladimir Zapolskiy */
58cb17b5eSVladimir Zapolskiy
68cb17b5eSVladimir Zapolskiy #define pr_fmt(fmt) "%s: " fmt, __func__
78cb17b5eSVladimir Zapolskiy
88cb17b5eSVladimir Zapolskiy #include <linux/io.h>
98cb17b5eSVladimir Zapolskiy #include <linux/irqchip.h>
108cb17b5eSVladimir Zapolskiy #include <linux/irqchip/chained_irq.h>
118cb17b5eSVladimir Zapolskiy #include <linux/of_address.h>
128cb17b5eSVladimir Zapolskiy #include <linux/of_irq.h>
138cb17b5eSVladimir Zapolskiy #include <linux/of_platform.h>
14*36555023SMarc Zyngier #include <linux/seq_file.h>
158cb17b5eSVladimir Zapolskiy #include <linux/slab.h>
168cb17b5eSVladimir Zapolskiy #include <asm/exception.h>
178cb17b5eSVladimir Zapolskiy
188cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_MASK 0x00
198cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_RAW 0x04
208cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_STAT 0x08
218cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_POL 0x0C
228cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_TYPE 0x10
238cb17b5eSVladimir Zapolskiy #define LPC32XX_INTC_FIQ 0x14
248cb17b5eSVladimir Zapolskiy
258cb17b5eSVladimir Zapolskiy #define NR_LPC32XX_IC_IRQS 32
268cb17b5eSVladimir Zapolskiy
278cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip {
288cb17b5eSVladimir Zapolskiy void __iomem *base;
29*36555023SMarc Zyngier phys_addr_t addr;
308cb17b5eSVladimir Zapolskiy struct irq_domain *domain;
318cb17b5eSVladimir Zapolskiy };
328cb17b5eSVladimir Zapolskiy
338cb17b5eSVladimir Zapolskiy static struct lpc32xx_irq_chip *lpc32xx_mic_irqc;
348cb17b5eSVladimir Zapolskiy
lpc32xx_ic_read(struct lpc32xx_irq_chip * ic,u32 reg)358cb17b5eSVladimir Zapolskiy static inline u32 lpc32xx_ic_read(struct lpc32xx_irq_chip *ic, u32 reg)
368cb17b5eSVladimir Zapolskiy {
378cb17b5eSVladimir Zapolskiy return readl_relaxed(ic->base + reg);
388cb17b5eSVladimir Zapolskiy }
398cb17b5eSVladimir Zapolskiy
lpc32xx_ic_write(struct lpc32xx_irq_chip * ic,u32 reg,u32 val)408cb17b5eSVladimir Zapolskiy static inline void lpc32xx_ic_write(struct lpc32xx_irq_chip *ic,
418cb17b5eSVladimir Zapolskiy u32 reg, u32 val)
428cb17b5eSVladimir Zapolskiy {
438cb17b5eSVladimir Zapolskiy writel_relaxed(val, ic->base + reg);
448cb17b5eSVladimir Zapolskiy }
458cb17b5eSVladimir Zapolskiy
lpc32xx_irq_mask(struct irq_data * d)468cb17b5eSVladimir Zapolskiy static void lpc32xx_irq_mask(struct irq_data *d)
478cb17b5eSVladimir Zapolskiy {
488cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);
498cb17b5eSVladimir Zapolskiy u32 val, mask = BIT(d->hwirq);
508cb17b5eSVladimir Zapolskiy
518cb17b5eSVladimir Zapolskiy val = lpc32xx_ic_read(ic, LPC32XX_INTC_MASK) & ~mask;
528cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(ic, LPC32XX_INTC_MASK, val);
538cb17b5eSVladimir Zapolskiy }
548cb17b5eSVladimir Zapolskiy
lpc32xx_irq_unmask(struct irq_data * d)558cb17b5eSVladimir Zapolskiy static void lpc32xx_irq_unmask(struct irq_data *d)
568cb17b5eSVladimir Zapolskiy {
578cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);
588cb17b5eSVladimir Zapolskiy u32 val, mask = BIT(d->hwirq);
598cb17b5eSVladimir Zapolskiy
608cb17b5eSVladimir Zapolskiy val = lpc32xx_ic_read(ic, LPC32XX_INTC_MASK) | mask;
618cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(ic, LPC32XX_INTC_MASK, val);
628cb17b5eSVladimir Zapolskiy }
638cb17b5eSVladimir Zapolskiy
lpc32xx_irq_ack(struct irq_data * d)648cb17b5eSVladimir Zapolskiy static void lpc32xx_irq_ack(struct irq_data *d)
658cb17b5eSVladimir Zapolskiy {
668cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);
678cb17b5eSVladimir Zapolskiy u32 mask = BIT(d->hwirq);
688cb17b5eSVladimir Zapolskiy
698cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(ic, LPC32XX_INTC_RAW, mask);
708cb17b5eSVladimir Zapolskiy }
718cb17b5eSVladimir Zapolskiy
lpc32xx_irq_set_type(struct irq_data * d,unsigned int type)728cb17b5eSVladimir Zapolskiy static int lpc32xx_irq_set_type(struct irq_data *d, unsigned int type)
738cb17b5eSVladimir Zapolskiy {
748cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);
758cb17b5eSVladimir Zapolskiy u32 val, mask = BIT(d->hwirq);
768cb17b5eSVladimir Zapolskiy bool high, edge;
778cb17b5eSVladimir Zapolskiy
788cb17b5eSVladimir Zapolskiy switch (type) {
798cb17b5eSVladimir Zapolskiy case IRQ_TYPE_EDGE_RISING:
808cb17b5eSVladimir Zapolskiy edge = true;
818cb17b5eSVladimir Zapolskiy high = true;
828cb17b5eSVladimir Zapolskiy break;
838cb17b5eSVladimir Zapolskiy case IRQ_TYPE_EDGE_FALLING:
848cb17b5eSVladimir Zapolskiy edge = true;
858cb17b5eSVladimir Zapolskiy high = false;
868cb17b5eSVladimir Zapolskiy break;
878cb17b5eSVladimir Zapolskiy case IRQ_TYPE_LEVEL_HIGH:
888cb17b5eSVladimir Zapolskiy edge = false;
898cb17b5eSVladimir Zapolskiy high = true;
908cb17b5eSVladimir Zapolskiy break;
918cb17b5eSVladimir Zapolskiy case IRQ_TYPE_LEVEL_LOW:
928cb17b5eSVladimir Zapolskiy edge = false;
938cb17b5eSVladimir Zapolskiy high = false;
948cb17b5eSVladimir Zapolskiy break;
958cb17b5eSVladimir Zapolskiy default:
968cb17b5eSVladimir Zapolskiy pr_info("unsupported irq type %d\n", type);
978cb17b5eSVladimir Zapolskiy return -EINVAL;
988cb17b5eSVladimir Zapolskiy }
998cb17b5eSVladimir Zapolskiy
1008cb17b5eSVladimir Zapolskiy irqd_set_trigger_type(d, type);
1018cb17b5eSVladimir Zapolskiy
1028cb17b5eSVladimir Zapolskiy val = lpc32xx_ic_read(ic, LPC32XX_INTC_POL);
1038cb17b5eSVladimir Zapolskiy if (high)
1048cb17b5eSVladimir Zapolskiy val |= mask;
1058cb17b5eSVladimir Zapolskiy else
1068cb17b5eSVladimir Zapolskiy val &= ~mask;
1078cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(ic, LPC32XX_INTC_POL, val);
1088cb17b5eSVladimir Zapolskiy
1098cb17b5eSVladimir Zapolskiy val = lpc32xx_ic_read(ic, LPC32XX_INTC_TYPE);
1108cb17b5eSVladimir Zapolskiy if (edge) {
1118cb17b5eSVladimir Zapolskiy val |= mask;
1128cb17b5eSVladimir Zapolskiy irq_set_handler_locked(d, handle_edge_irq);
1138cb17b5eSVladimir Zapolskiy } else {
1148cb17b5eSVladimir Zapolskiy val &= ~mask;
1158cb17b5eSVladimir Zapolskiy irq_set_handler_locked(d, handle_level_irq);
1168cb17b5eSVladimir Zapolskiy }
1178cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(ic, LPC32XX_INTC_TYPE, val);
1188cb17b5eSVladimir Zapolskiy
1198cb17b5eSVladimir Zapolskiy return 0;
1208cb17b5eSVladimir Zapolskiy }
1218cb17b5eSVladimir Zapolskiy
lpc32xx_irq_print_chip(struct irq_data * d,struct seq_file * p)122*36555023SMarc Zyngier static void lpc32xx_irq_print_chip(struct irq_data *d, struct seq_file *p)
123*36555023SMarc Zyngier {
124*36555023SMarc Zyngier struct lpc32xx_irq_chip *ic = irq_data_get_irq_chip_data(d);
125*36555023SMarc Zyngier
126*36555023SMarc Zyngier if (ic == lpc32xx_mic_irqc)
127*36555023SMarc Zyngier seq_printf(p, "%08x.mic", ic->addr);
128*36555023SMarc Zyngier else
129*36555023SMarc Zyngier seq_printf(p, "%08x.sic", ic->addr);
130*36555023SMarc Zyngier }
131*36555023SMarc Zyngier
132*36555023SMarc Zyngier static const struct irq_chip lpc32xx_chip = {
133*36555023SMarc Zyngier .irq_ack = lpc32xx_irq_ack,
134*36555023SMarc Zyngier .irq_mask = lpc32xx_irq_mask,
135*36555023SMarc Zyngier .irq_unmask = lpc32xx_irq_unmask,
136*36555023SMarc Zyngier .irq_set_type = lpc32xx_irq_set_type,
137*36555023SMarc Zyngier .irq_print_chip = lpc32xx_irq_print_chip,
138*36555023SMarc Zyngier };
139*36555023SMarc Zyngier
lpc32xx_handle_irq(struct pt_regs * regs)1408cb17b5eSVladimir Zapolskiy static void __exception_irq_entry lpc32xx_handle_irq(struct pt_regs *regs)
1418cb17b5eSVladimir Zapolskiy {
1428cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = lpc32xx_mic_irqc;
1438cb17b5eSVladimir Zapolskiy u32 hwirq = lpc32xx_ic_read(ic, LPC32XX_INTC_STAT), irq;
1448cb17b5eSVladimir Zapolskiy
1458cb17b5eSVladimir Zapolskiy while (hwirq) {
1468cb17b5eSVladimir Zapolskiy irq = __ffs(hwirq);
1478cb17b5eSVladimir Zapolskiy hwirq &= ~BIT(irq);
1480953fb26SMark Rutland generic_handle_domain_irq(lpc32xx_mic_irqc->domain, irq);
1498cb17b5eSVladimir Zapolskiy }
1508cb17b5eSVladimir Zapolskiy }
1518cb17b5eSVladimir Zapolskiy
lpc32xx_sic_handler(struct irq_desc * desc)1528cb17b5eSVladimir Zapolskiy static void lpc32xx_sic_handler(struct irq_desc *desc)
1538cb17b5eSVladimir Zapolskiy {
1548cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = irq_desc_get_handler_data(desc);
1558cb17b5eSVladimir Zapolskiy struct irq_chip *chip = irq_desc_get_chip(desc);
1568cb17b5eSVladimir Zapolskiy u32 hwirq = lpc32xx_ic_read(ic, LPC32XX_INTC_STAT), irq;
1578cb17b5eSVladimir Zapolskiy
1588cb17b5eSVladimir Zapolskiy chained_irq_enter(chip, desc);
1598cb17b5eSVladimir Zapolskiy
1608cb17b5eSVladimir Zapolskiy while (hwirq) {
1618cb17b5eSVladimir Zapolskiy irq = __ffs(hwirq);
1628cb17b5eSVladimir Zapolskiy hwirq &= ~BIT(irq);
163046a6ee2SMarc Zyngier generic_handle_domain_irq(ic->domain, irq);
1648cb17b5eSVladimir Zapolskiy }
1658cb17b5eSVladimir Zapolskiy
1668cb17b5eSVladimir Zapolskiy chained_irq_exit(chip, desc);
1678cb17b5eSVladimir Zapolskiy }
1688cb17b5eSVladimir Zapolskiy
lpc32xx_irq_domain_map(struct irq_domain * id,unsigned int virq,irq_hw_number_t hw)1698cb17b5eSVladimir Zapolskiy static int lpc32xx_irq_domain_map(struct irq_domain *id, unsigned int virq,
1708cb17b5eSVladimir Zapolskiy irq_hw_number_t hw)
1718cb17b5eSVladimir Zapolskiy {
1728cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *ic = id->host_data;
1738cb17b5eSVladimir Zapolskiy
1748cb17b5eSVladimir Zapolskiy irq_set_chip_data(virq, ic);
175*36555023SMarc Zyngier irq_set_chip_and_handler(virq, &lpc32xx_chip, handle_level_irq);
1768cb17b5eSVladimir Zapolskiy irq_set_status_flags(virq, IRQ_LEVEL);
1778cb17b5eSVladimir Zapolskiy irq_set_noprobe(virq);
1788cb17b5eSVladimir Zapolskiy
1798cb17b5eSVladimir Zapolskiy return 0;
1808cb17b5eSVladimir Zapolskiy }
1818cb17b5eSVladimir Zapolskiy
lpc32xx_irq_domain_unmap(struct irq_domain * id,unsigned int virq)1828cb17b5eSVladimir Zapolskiy static void lpc32xx_irq_domain_unmap(struct irq_domain *id, unsigned int virq)
1838cb17b5eSVladimir Zapolskiy {
1848cb17b5eSVladimir Zapolskiy irq_set_chip_and_handler(virq, NULL, NULL);
1858cb17b5eSVladimir Zapolskiy }
1868cb17b5eSVladimir Zapolskiy
1878cb17b5eSVladimir Zapolskiy static const struct irq_domain_ops lpc32xx_irq_domain_ops = {
1888cb17b5eSVladimir Zapolskiy .map = lpc32xx_irq_domain_map,
1898cb17b5eSVladimir Zapolskiy .unmap = lpc32xx_irq_domain_unmap,
1908cb17b5eSVladimir Zapolskiy .xlate = irq_domain_xlate_twocell,
1918cb17b5eSVladimir Zapolskiy };
1928cb17b5eSVladimir Zapolskiy
lpc32xx_of_ic_init(struct device_node * node,struct device_node * parent)1938cb17b5eSVladimir Zapolskiy static int __init lpc32xx_of_ic_init(struct device_node *node,
1948cb17b5eSVladimir Zapolskiy struct device_node *parent)
1958cb17b5eSVladimir Zapolskiy {
1968cb17b5eSVladimir Zapolskiy struct lpc32xx_irq_chip *irqc;
1978cb17b5eSVladimir Zapolskiy bool is_mic = of_device_is_compatible(node, "nxp,lpc3220-mic");
1988cb17b5eSVladimir Zapolskiy const __be32 *reg = of_get_property(node, "reg", NULL);
1998cb17b5eSVladimir Zapolskiy u32 parent_irq, i, addr = reg ? be32_to_cpu(*reg) : 0;
2008cb17b5eSVladimir Zapolskiy
2018cb17b5eSVladimir Zapolskiy irqc = kzalloc(sizeof(*irqc), GFP_KERNEL);
2028cb17b5eSVladimir Zapolskiy if (!irqc)
2038cb17b5eSVladimir Zapolskiy return -ENOMEM;
2048cb17b5eSVladimir Zapolskiy
205*36555023SMarc Zyngier irqc->addr = addr;
2068cb17b5eSVladimir Zapolskiy irqc->base = of_iomap(node, 0);
2078cb17b5eSVladimir Zapolskiy if (!irqc->base) {
208e81f54c6SRob Herring pr_err("%pOF: unable to map registers\n", node);
2098cb17b5eSVladimir Zapolskiy kfree(irqc);
2108cb17b5eSVladimir Zapolskiy return -EINVAL;
2118cb17b5eSVladimir Zapolskiy }
2128cb17b5eSVladimir Zapolskiy
2138cb17b5eSVladimir Zapolskiy irqc->domain = irq_domain_add_linear(node, NR_LPC32XX_IC_IRQS,
2148cb17b5eSVladimir Zapolskiy &lpc32xx_irq_domain_ops, irqc);
2158cb17b5eSVladimir Zapolskiy if (!irqc->domain) {
2168cb17b5eSVladimir Zapolskiy pr_err("unable to add irq domain\n");
2178cb17b5eSVladimir Zapolskiy iounmap(irqc->base);
2188cb17b5eSVladimir Zapolskiy kfree(irqc);
2198cb17b5eSVladimir Zapolskiy return -ENODEV;
2208cb17b5eSVladimir Zapolskiy }
2218cb17b5eSVladimir Zapolskiy
2228cb17b5eSVladimir Zapolskiy if (is_mic) {
2238cb17b5eSVladimir Zapolskiy lpc32xx_mic_irqc = irqc;
2248cb17b5eSVladimir Zapolskiy set_handle_irq(lpc32xx_handle_irq);
2258cb17b5eSVladimir Zapolskiy } else {
2268cb17b5eSVladimir Zapolskiy for (i = 0; i < of_irq_count(node); i++) {
2278cb17b5eSVladimir Zapolskiy parent_irq = irq_of_parse_and_map(node, i);
2288cb17b5eSVladimir Zapolskiy if (parent_irq)
2298cb17b5eSVladimir Zapolskiy irq_set_chained_handler_and_data(parent_irq,
2308cb17b5eSVladimir Zapolskiy lpc32xx_sic_handler, irqc);
2318cb17b5eSVladimir Zapolskiy }
2328cb17b5eSVladimir Zapolskiy }
2338cb17b5eSVladimir Zapolskiy
2348cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(irqc, LPC32XX_INTC_MASK, 0x00);
2358cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(irqc, LPC32XX_INTC_POL, 0x00);
2368cb17b5eSVladimir Zapolskiy lpc32xx_ic_write(irqc, LPC32XX_INTC_TYPE, 0x00);
2378cb17b5eSVladimir Zapolskiy
2388cb17b5eSVladimir Zapolskiy return 0;
2398cb17b5eSVladimir Zapolskiy }
2408cb17b5eSVladimir Zapolskiy
2418cb17b5eSVladimir Zapolskiy IRQCHIP_DECLARE(nxp_lpc32xx_mic, "nxp,lpc3220-mic", lpc32xx_of_ic_init);
2428cb17b5eSVladimir Zapolskiy IRQCHIP_DECLARE(nxp_lpc32xx_sic, "nxp,lpc3220-sic", lpc32xx_of_ic_init);
243