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