11802d0beSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
25ed34d3aSMasahiro Yamada /*
35ed34d3aSMasahiro Yamada * Driver for UniPhier AIDET (ARM Interrupt Detector)
45ed34d3aSMasahiro Yamada *
55ed34d3aSMasahiro Yamada * Copyright (C) 2017 Socionext Inc.
65ed34d3aSMasahiro Yamada * Author: Masahiro Yamada <yamada.masahiro@socionext.com>
75ed34d3aSMasahiro Yamada */
85ed34d3aSMasahiro Yamada
95ed34d3aSMasahiro Yamada #include <linux/bitops.h>
105ed34d3aSMasahiro Yamada #include <linux/init.h>
115ed34d3aSMasahiro Yamada #include <linux/irq.h>
125ed34d3aSMasahiro Yamada #include <linux/irqdomain.h>
135ed34d3aSMasahiro Yamada #include <linux/kernel.h>
145ed34d3aSMasahiro Yamada #include <linux/of.h>
155ed34d3aSMasahiro Yamada #include <linux/of_irq.h>
165ed34d3aSMasahiro Yamada #include <linux/platform_device.h>
175ed34d3aSMasahiro Yamada #include <linux/spinlock.h>
185ed34d3aSMasahiro Yamada
195ed34d3aSMasahiro Yamada #define UNIPHIER_AIDET_NR_IRQS 256
205ed34d3aSMasahiro Yamada
215ed34d3aSMasahiro Yamada #define UNIPHIER_AIDET_DETCONF 0x04 /* inverter register base */
225ed34d3aSMasahiro Yamada
235ed34d3aSMasahiro Yamada struct uniphier_aidet_priv {
245ed34d3aSMasahiro Yamada struct irq_domain *domain;
255ed34d3aSMasahiro Yamada void __iomem *reg_base;
265ed34d3aSMasahiro Yamada spinlock_t lock;
275ed34d3aSMasahiro Yamada u32 saved_vals[UNIPHIER_AIDET_NR_IRQS / 32];
285ed34d3aSMasahiro Yamada };
295ed34d3aSMasahiro Yamada
uniphier_aidet_reg_update(struct uniphier_aidet_priv * priv,unsigned int reg,u32 mask,u32 val)305ed34d3aSMasahiro Yamada static void uniphier_aidet_reg_update(struct uniphier_aidet_priv *priv,
315ed34d3aSMasahiro Yamada unsigned int reg, u32 mask, u32 val)
325ed34d3aSMasahiro Yamada {
335ed34d3aSMasahiro Yamada unsigned long flags;
345ed34d3aSMasahiro Yamada u32 tmp;
355ed34d3aSMasahiro Yamada
365ed34d3aSMasahiro Yamada spin_lock_irqsave(&priv->lock, flags);
375ed34d3aSMasahiro Yamada tmp = readl_relaxed(priv->reg_base + reg);
385ed34d3aSMasahiro Yamada tmp &= ~mask;
395ed34d3aSMasahiro Yamada tmp |= mask & val;
405ed34d3aSMasahiro Yamada writel_relaxed(tmp, priv->reg_base + reg);
415ed34d3aSMasahiro Yamada spin_unlock_irqrestore(&priv->lock, flags);
425ed34d3aSMasahiro Yamada }
435ed34d3aSMasahiro Yamada
uniphier_aidet_detconf_update(struct uniphier_aidet_priv * priv,unsigned long index,unsigned int val)445ed34d3aSMasahiro Yamada static void uniphier_aidet_detconf_update(struct uniphier_aidet_priv *priv,
455ed34d3aSMasahiro Yamada unsigned long index, unsigned int val)
465ed34d3aSMasahiro Yamada {
475ed34d3aSMasahiro Yamada unsigned int reg;
485ed34d3aSMasahiro Yamada u32 mask;
495ed34d3aSMasahiro Yamada
505ed34d3aSMasahiro Yamada reg = UNIPHIER_AIDET_DETCONF + index / 32 * 4;
515ed34d3aSMasahiro Yamada mask = BIT(index % 32);
525ed34d3aSMasahiro Yamada
535ed34d3aSMasahiro Yamada uniphier_aidet_reg_update(priv, reg, mask, val ? mask : 0);
545ed34d3aSMasahiro Yamada }
555ed34d3aSMasahiro Yamada
uniphier_aidet_irq_set_type(struct irq_data * data,unsigned int type)565ed34d3aSMasahiro Yamada static int uniphier_aidet_irq_set_type(struct irq_data *data, unsigned int type)
575ed34d3aSMasahiro Yamada {
585ed34d3aSMasahiro Yamada struct uniphier_aidet_priv *priv = data->chip_data;
595ed34d3aSMasahiro Yamada unsigned int val;
605ed34d3aSMasahiro Yamada
615ed34d3aSMasahiro Yamada /* enable inverter for active low triggers */
625ed34d3aSMasahiro Yamada switch (type) {
635ed34d3aSMasahiro Yamada case IRQ_TYPE_EDGE_RISING:
645ed34d3aSMasahiro Yamada case IRQ_TYPE_LEVEL_HIGH:
655ed34d3aSMasahiro Yamada val = 0;
665ed34d3aSMasahiro Yamada break;
675ed34d3aSMasahiro Yamada case IRQ_TYPE_EDGE_FALLING:
685ed34d3aSMasahiro Yamada val = 1;
695ed34d3aSMasahiro Yamada type = IRQ_TYPE_EDGE_RISING;
705ed34d3aSMasahiro Yamada break;
715ed34d3aSMasahiro Yamada case IRQ_TYPE_LEVEL_LOW:
725ed34d3aSMasahiro Yamada val = 1;
735ed34d3aSMasahiro Yamada type = IRQ_TYPE_LEVEL_HIGH;
745ed34d3aSMasahiro Yamada break;
755ed34d3aSMasahiro Yamada default:
765ed34d3aSMasahiro Yamada return -EINVAL;
775ed34d3aSMasahiro Yamada }
785ed34d3aSMasahiro Yamada
795ed34d3aSMasahiro Yamada uniphier_aidet_detconf_update(priv, data->hwirq, val);
805ed34d3aSMasahiro Yamada
815ed34d3aSMasahiro Yamada return irq_chip_set_type_parent(data, type);
825ed34d3aSMasahiro Yamada }
835ed34d3aSMasahiro Yamada
845ed34d3aSMasahiro Yamada static struct irq_chip uniphier_aidet_irq_chip = {
855ed34d3aSMasahiro Yamada .name = "AIDET",
865ed34d3aSMasahiro Yamada .irq_mask = irq_chip_mask_parent,
875ed34d3aSMasahiro Yamada .irq_unmask = irq_chip_unmask_parent,
885ed34d3aSMasahiro Yamada .irq_eoi = irq_chip_eoi_parent,
895ed34d3aSMasahiro Yamada .irq_set_affinity = irq_chip_set_affinity_parent,
905ed34d3aSMasahiro Yamada .irq_set_type = uniphier_aidet_irq_set_type,
915ed34d3aSMasahiro Yamada };
925ed34d3aSMasahiro Yamada
uniphier_aidet_domain_translate(struct irq_domain * domain,struct irq_fwspec * fwspec,unsigned long * out_hwirq,unsigned int * out_type)935ed34d3aSMasahiro Yamada static int uniphier_aidet_domain_translate(struct irq_domain *domain,
945ed34d3aSMasahiro Yamada struct irq_fwspec *fwspec,
955ed34d3aSMasahiro Yamada unsigned long *out_hwirq,
965ed34d3aSMasahiro Yamada unsigned int *out_type)
975ed34d3aSMasahiro Yamada {
985ed34d3aSMasahiro Yamada if (WARN_ON(fwspec->param_count < 2))
995ed34d3aSMasahiro Yamada return -EINVAL;
1005ed34d3aSMasahiro Yamada
1015ed34d3aSMasahiro Yamada *out_hwirq = fwspec->param[0];
1025ed34d3aSMasahiro Yamada *out_type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK;
1035ed34d3aSMasahiro Yamada
1045ed34d3aSMasahiro Yamada return 0;
1055ed34d3aSMasahiro Yamada }
1065ed34d3aSMasahiro Yamada
uniphier_aidet_domain_alloc(struct irq_domain * domain,unsigned int virq,unsigned int nr_irqs,void * arg)1075ed34d3aSMasahiro Yamada static int uniphier_aidet_domain_alloc(struct irq_domain *domain,
1085ed34d3aSMasahiro Yamada unsigned int virq, unsigned int nr_irqs,
1095ed34d3aSMasahiro Yamada void *arg)
1105ed34d3aSMasahiro Yamada {
1115ed34d3aSMasahiro Yamada struct irq_fwspec parent_fwspec;
1125ed34d3aSMasahiro Yamada irq_hw_number_t hwirq;
1135ed34d3aSMasahiro Yamada unsigned int type;
1145ed34d3aSMasahiro Yamada int ret;
1155ed34d3aSMasahiro Yamada
1165ed34d3aSMasahiro Yamada if (nr_irqs != 1)
1175ed34d3aSMasahiro Yamada return -EINVAL;
1185ed34d3aSMasahiro Yamada
1195ed34d3aSMasahiro Yamada ret = uniphier_aidet_domain_translate(domain, arg, &hwirq, &type);
1205ed34d3aSMasahiro Yamada if (ret)
1215ed34d3aSMasahiro Yamada return ret;
1225ed34d3aSMasahiro Yamada
1235ed34d3aSMasahiro Yamada switch (type) {
1245ed34d3aSMasahiro Yamada case IRQ_TYPE_EDGE_RISING:
1255ed34d3aSMasahiro Yamada case IRQ_TYPE_LEVEL_HIGH:
1265ed34d3aSMasahiro Yamada break;
1275ed34d3aSMasahiro Yamada case IRQ_TYPE_EDGE_FALLING:
1285ed34d3aSMasahiro Yamada type = IRQ_TYPE_EDGE_RISING;
1295ed34d3aSMasahiro Yamada break;
1305ed34d3aSMasahiro Yamada case IRQ_TYPE_LEVEL_LOW:
1315ed34d3aSMasahiro Yamada type = IRQ_TYPE_LEVEL_HIGH;
1325ed34d3aSMasahiro Yamada break;
1335ed34d3aSMasahiro Yamada default:
1345ed34d3aSMasahiro Yamada return -EINVAL;
1355ed34d3aSMasahiro Yamada }
1365ed34d3aSMasahiro Yamada
1375ed34d3aSMasahiro Yamada if (hwirq >= UNIPHIER_AIDET_NR_IRQS)
1385ed34d3aSMasahiro Yamada return -ENXIO;
1395ed34d3aSMasahiro Yamada
1405ed34d3aSMasahiro Yamada ret = irq_domain_set_hwirq_and_chip(domain, virq, hwirq,
1415ed34d3aSMasahiro Yamada &uniphier_aidet_irq_chip,
1425ed34d3aSMasahiro Yamada domain->host_data);
1435ed34d3aSMasahiro Yamada if (ret)
1445ed34d3aSMasahiro Yamada return ret;
1455ed34d3aSMasahiro Yamada
1465ed34d3aSMasahiro Yamada /* parent is GIC */
1475ed34d3aSMasahiro Yamada parent_fwspec.fwnode = domain->parent->fwnode;
1485ed34d3aSMasahiro Yamada parent_fwspec.param_count = 3;
1495ed34d3aSMasahiro Yamada parent_fwspec.param[0] = 0; /* SPI */
1505ed34d3aSMasahiro Yamada parent_fwspec.param[1] = hwirq;
1515ed34d3aSMasahiro Yamada parent_fwspec.param[2] = type;
1525ed34d3aSMasahiro Yamada
1535ed34d3aSMasahiro Yamada return irq_domain_alloc_irqs_parent(domain, virq, 1, &parent_fwspec);
1545ed34d3aSMasahiro Yamada }
1555ed34d3aSMasahiro Yamada
1565ed34d3aSMasahiro Yamada static const struct irq_domain_ops uniphier_aidet_domain_ops = {
1575ed34d3aSMasahiro Yamada .alloc = uniphier_aidet_domain_alloc,
1585ed34d3aSMasahiro Yamada .free = irq_domain_free_irqs_common,
1595ed34d3aSMasahiro Yamada .translate = uniphier_aidet_domain_translate,
1605ed34d3aSMasahiro Yamada };
1615ed34d3aSMasahiro Yamada
uniphier_aidet_probe(struct platform_device * pdev)1625ed34d3aSMasahiro Yamada static int uniphier_aidet_probe(struct platform_device *pdev)
1635ed34d3aSMasahiro Yamada {
1645ed34d3aSMasahiro Yamada struct device *dev = &pdev->dev;
1655ed34d3aSMasahiro Yamada struct device_node *parent_np;
1665ed34d3aSMasahiro Yamada struct irq_domain *parent_domain;
1675ed34d3aSMasahiro Yamada struct uniphier_aidet_priv *priv;
1685ed34d3aSMasahiro Yamada
1695ed34d3aSMasahiro Yamada parent_np = of_irq_find_parent(dev->of_node);
1705ed34d3aSMasahiro Yamada if (!parent_np)
1715ed34d3aSMasahiro Yamada return -ENXIO;
1725ed34d3aSMasahiro Yamada
1735ed34d3aSMasahiro Yamada parent_domain = irq_find_host(parent_np);
1745ed34d3aSMasahiro Yamada of_node_put(parent_np);
1755ed34d3aSMasahiro Yamada if (!parent_domain)
1765ed34d3aSMasahiro Yamada return -EPROBE_DEFER;
1775ed34d3aSMasahiro Yamada
1785ed34d3aSMasahiro Yamada priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1795ed34d3aSMasahiro Yamada if (!priv)
1805ed34d3aSMasahiro Yamada return -ENOMEM;
1815ed34d3aSMasahiro Yamada
182e89327f6SMasahiro Yamada priv->reg_base = devm_platform_ioremap_resource(pdev, 0);
1835ed34d3aSMasahiro Yamada if (IS_ERR(priv->reg_base))
1845ed34d3aSMasahiro Yamada return PTR_ERR(priv->reg_base);
1855ed34d3aSMasahiro Yamada
1865ed34d3aSMasahiro Yamada spin_lock_init(&priv->lock);
1875ed34d3aSMasahiro Yamada
1885ed34d3aSMasahiro Yamada priv->domain = irq_domain_create_hierarchy(
1895ed34d3aSMasahiro Yamada parent_domain, 0,
1905ed34d3aSMasahiro Yamada UNIPHIER_AIDET_NR_IRQS,
1915ed34d3aSMasahiro Yamada of_node_to_fwnode(dev->of_node),
1925ed34d3aSMasahiro Yamada &uniphier_aidet_domain_ops, priv);
1935ed34d3aSMasahiro Yamada if (!priv->domain)
1945ed34d3aSMasahiro Yamada return -ENOMEM;
1955ed34d3aSMasahiro Yamada
1965ed34d3aSMasahiro Yamada platform_set_drvdata(pdev, priv);
1975ed34d3aSMasahiro Yamada
1985ed34d3aSMasahiro Yamada return 0;
1995ed34d3aSMasahiro Yamada }
2005ed34d3aSMasahiro Yamada
uniphier_aidet_suspend(struct device * dev)2015ed34d3aSMasahiro Yamada static int __maybe_unused uniphier_aidet_suspend(struct device *dev)
2025ed34d3aSMasahiro Yamada {
2035ed34d3aSMasahiro Yamada struct uniphier_aidet_priv *priv = dev_get_drvdata(dev);
2045ed34d3aSMasahiro Yamada int i;
2055ed34d3aSMasahiro Yamada
2065ed34d3aSMasahiro Yamada for (i = 0; i < ARRAY_SIZE(priv->saved_vals); i++)
2075ed34d3aSMasahiro Yamada priv->saved_vals[i] = readl_relaxed(
2085ed34d3aSMasahiro Yamada priv->reg_base + UNIPHIER_AIDET_DETCONF + i * 4);
2095ed34d3aSMasahiro Yamada
2105ed34d3aSMasahiro Yamada return 0;
2115ed34d3aSMasahiro Yamada }
2125ed34d3aSMasahiro Yamada
uniphier_aidet_resume(struct device * dev)2135ed34d3aSMasahiro Yamada static int __maybe_unused uniphier_aidet_resume(struct device *dev)
2145ed34d3aSMasahiro Yamada {
2155ed34d3aSMasahiro Yamada struct uniphier_aidet_priv *priv = dev_get_drvdata(dev);
2165ed34d3aSMasahiro Yamada int i;
2175ed34d3aSMasahiro Yamada
2185ed34d3aSMasahiro Yamada for (i = 0; i < ARRAY_SIZE(priv->saved_vals); i++)
2195ed34d3aSMasahiro Yamada writel_relaxed(priv->saved_vals[i],
2205ed34d3aSMasahiro Yamada priv->reg_base + UNIPHIER_AIDET_DETCONF + i * 4);
2215ed34d3aSMasahiro Yamada
2225ed34d3aSMasahiro Yamada return 0;
2235ed34d3aSMasahiro Yamada }
2245ed34d3aSMasahiro Yamada
2255ed34d3aSMasahiro Yamada static const struct dev_pm_ops uniphier_aidet_pm_ops = {
2265ed34d3aSMasahiro Yamada SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(uniphier_aidet_suspend,
2275ed34d3aSMasahiro Yamada uniphier_aidet_resume)
2285ed34d3aSMasahiro Yamada };
2295ed34d3aSMasahiro Yamada
2305ed34d3aSMasahiro Yamada static const struct of_device_id uniphier_aidet_match[] = {
2315ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-ld4-aidet" },
2325ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-pro4-aidet" },
2335ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-sld8-aidet" },
2345ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-pro5-aidet" },
2355ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-pxs2-aidet" },
2365ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-ld11-aidet" },
2375ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-ld20-aidet" },
2385ed34d3aSMasahiro Yamada { .compatible = "socionext,uniphier-pxs3-aidet" },
239*e3f056a7SKunihiko Hayashi { .compatible = "socionext,uniphier-nx1-aidet" },
2405ed34d3aSMasahiro Yamada { /* sentinel */ }
2415ed34d3aSMasahiro Yamada };
2425ed34d3aSMasahiro Yamada
2435ed34d3aSMasahiro Yamada static struct platform_driver uniphier_aidet_driver = {
2445ed34d3aSMasahiro Yamada .probe = uniphier_aidet_probe,
2455ed34d3aSMasahiro Yamada .driver = {
2465ed34d3aSMasahiro Yamada .name = "uniphier-aidet",
2475ed34d3aSMasahiro Yamada .of_match_table = uniphier_aidet_match,
2485ed34d3aSMasahiro Yamada .pm = &uniphier_aidet_pm_ops,
2495ed34d3aSMasahiro Yamada },
2505ed34d3aSMasahiro Yamada };
2515ed34d3aSMasahiro Yamada builtin_platform_driver(uniphier_aidet_driver);
252