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