189323f8cSGrygorii Strashko /* 289323f8cSGrygorii Strashko * Texas Instruments Keystone IRQ controller IP driver 389323f8cSGrygorii Strashko * 489323f8cSGrygorii Strashko * Copyright (C) 2014 Texas Instruments, Inc. 589323f8cSGrygorii Strashko * Author: Sajesh Kumar Saran <sajesh@ti.com> 689323f8cSGrygorii Strashko * Grygorii Strashko <grygorii.strashko@ti.com> 789323f8cSGrygorii Strashko * 889323f8cSGrygorii Strashko * This program is free software; you can redistribute it and/or 989323f8cSGrygorii Strashko * modify it under the terms of the GNU General Public License as 1089323f8cSGrygorii Strashko * published by the Free Software Foundation version 2. 1189323f8cSGrygorii Strashko * 1289323f8cSGrygorii Strashko * This program is distributed "as is" WITHOUT ANY WARRANTY of any 1389323f8cSGrygorii Strashko * kind, whether express or implied; without even the implied warranty 1489323f8cSGrygorii Strashko * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1589323f8cSGrygorii Strashko * GNU General Public License for more details. 1689323f8cSGrygorii Strashko */ 1789323f8cSGrygorii Strashko 1889323f8cSGrygorii Strashko #include <linux/irq.h> 1989323f8cSGrygorii Strashko #include <linux/bitops.h> 2089323f8cSGrygorii Strashko #include <linux/module.h> 2189323f8cSGrygorii Strashko #include <linux/moduleparam.h> 222f884e6eSStrashko, Grygorii #include <linux/interrupt.h> 2389323f8cSGrygorii Strashko #include <linux/irqdomain.h> 2441a83e06SJoel Porquet #include <linux/irqchip.h> 2589323f8cSGrygorii Strashko #include <linux/of.h> 2689323f8cSGrygorii Strashko #include <linux/of_platform.h> 2789323f8cSGrygorii Strashko #include <linux/mfd/syscon.h> 2889323f8cSGrygorii Strashko #include <linux/regmap.h> 2989323f8cSGrygorii Strashko 3089323f8cSGrygorii Strashko /* The source ID bits start from 4 to 31 (total 28 bits)*/ 3189323f8cSGrygorii Strashko #define BIT_OFS 4 3289323f8cSGrygorii Strashko #define KEYSTONE_N_IRQ (32 - BIT_OFS) 3389323f8cSGrygorii Strashko 3489323f8cSGrygorii Strashko struct keystone_irq_device { 3589323f8cSGrygorii Strashko struct device *dev; 3689323f8cSGrygorii Strashko struct irq_chip chip; 3789323f8cSGrygorii Strashko u32 mask; 388703ec19SGrygorii Strashko int irq; 3989323f8cSGrygorii Strashko struct irq_domain *irqd; 4089323f8cSGrygorii Strashko struct regmap *devctrl_regs; 4189323f8cSGrygorii Strashko u32 devctrl_offset; 422f884e6eSStrashko, Grygorii raw_spinlock_t wa_lock; 4389323f8cSGrygorii Strashko }; 4489323f8cSGrygorii Strashko 4589323f8cSGrygorii Strashko static inline u32 keystone_irq_readl(struct keystone_irq_device *kirq) 4689323f8cSGrygorii Strashko { 4789323f8cSGrygorii Strashko int ret; 4889323f8cSGrygorii Strashko u32 val = 0; 4989323f8cSGrygorii Strashko 5089323f8cSGrygorii Strashko ret = regmap_read(kirq->devctrl_regs, kirq->devctrl_offset, &val); 5189323f8cSGrygorii Strashko if (ret < 0) 5289323f8cSGrygorii Strashko dev_dbg(kirq->dev, "irq read failed ret(%d)\n", ret); 5389323f8cSGrygorii Strashko return val; 5489323f8cSGrygorii Strashko } 5589323f8cSGrygorii Strashko 5689323f8cSGrygorii Strashko static inline void 5789323f8cSGrygorii Strashko keystone_irq_writel(struct keystone_irq_device *kirq, u32 value) 5889323f8cSGrygorii Strashko { 5989323f8cSGrygorii Strashko int ret; 6089323f8cSGrygorii Strashko 6189323f8cSGrygorii Strashko ret = regmap_write(kirq->devctrl_regs, kirq->devctrl_offset, value); 6289323f8cSGrygorii Strashko if (ret < 0) 6389323f8cSGrygorii Strashko dev_dbg(kirq->dev, "irq write failed ret(%d)\n", ret); 6489323f8cSGrygorii Strashko } 6589323f8cSGrygorii Strashko 6689323f8cSGrygorii Strashko static void keystone_irq_setmask(struct irq_data *d) 6789323f8cSGrygorii Strashko { 6889323f8cSGrygorii Strashko struct keystone_irq_device *kirq = irq_data_get_irq_chip_data(d); 6989323f8cSGrygorii Strashko 7089323f8cSGrygorii Strashko kirq->mask |= BIT(d->hwirq); 7189323f8cSGrygorii Strashko dev_dbg(kirq->dev, "mask %lu [%x]\n", d->hwirq, kirq->mask); 7289323f8cSGrygorii Strashko } 7389323f8cSGrygorii Strashko 7489323f8cSGrygorii Strashko static void keystone_irq_unmask(struct irq_data *d) 7589323f8cSGrygorii Strashko { 7689323f8cSGrygorii Strashko struct keystone_irq_device *kirq = irq_data_get_irq_chip_data(d); 7789323f8cSGrygorii Strashko 7889323f8cSGrygorii Strashko kirq->mask &= ~BIT(d->hwirq); 7989323f8cSGrygorii Strashko dev_dbg(kirq->dev, "unmask %lu [%x]\n", d->hwirq, kirq->mask); 8089323f8cSGrygorii Strashko } 8189323f8cSGrygorii Strashko 8289323f8cSGrygorii Strashko static void keystone_irq_ack(struct irq_data *d) 8389323f8cSGrygorii Strashko { 8489323f8cSGrygorii Strashko /* nothing to do here */ 8589323f8cSGrygorii Strashko } 8689323f8cSGrygorii Strashko 872f884e6eSStrashko, Grygorii static irqreturn_t keystone_irq_handler(int irq, void *keystone_irq) 8889323f8cSGrygorii Strashko { 892f884e6eSStrashko, Grygorii struct keystone_irq_device *kirq = keystone_irq; 902f884e6eSStrashko, Grygorii unsigned long wa_lock_flags; 9189323f8cSGrygorii Strashko unsigned long pending; 92*046a6ee2SMarc Zyngier int src, err; 9389323f8cSGrygorii Strashko 9489323f8cSGrygorii Strashko dev_dbg(kirq->dev, "start irq %d\n", irq); 9589323f8cSGrygorii Strashko 9689323f8cSGrygorii Strashko pending = keystone_irq_readl(kirq); 9789323f8cSGrygorii Strashko keystone_irq_writel(kirq, pending); 9889323f8cSGrygorii Strashko 9989323f8cSGrygorii Strashko dev_dbg(kirq->dev, "pending 0x%lx, mask 0x%x\n", pending, kirq->mask); 10089323f8cSGrygorii Strashko 10189323f8cSGrygorii Strashko pending = (pending >> BIT_OFS) & ~kirq->mask; 10289323f8cSGrygorii Strashko 10389323f8cSGrygorii Strashko dev_dbg(kirq->dev, "pending after mask 0x%lx\n", pending); 10489323f8cSGrygorii Strashko 10589323f8cSGrygorii Strashko for (src = 0; src < KEYSTONE_N_IRQ; src++) { 10689323f8cSGrygorii Strashko if (BIT(src) & pending) { 1072f884e6eSStrashko, Grygorii raw_spin_lock_irqsave(&kirq->wa_lock, wa_lock_flags); 108*046a6ee2SMarc Zyngier err = generic_handle_domain_irq(kirq->irqd, src); 1092f884e6eSStrashko, Grygorii raw_spin_unlock_irqrestore(&kirq->wa_lock, 1102f884e6eSStrashko, Grygorii wa_lock_flags); 111*046a6ee2SMarc Zyngier 112*046a6ee2SMarc Zyngier if (err) 113*046a6ee2SMarc Zyngier dev_warn_ratelimited(kirq->dev, "spurious irq detected hwirq %d\n", 114*046a6ee2SMarc Zyngier src); 11589323f8cSGrygorii Strashko } 11689323f8cSGrygorii Strashko } 11789323f8cSGrygorii Strashko 11889323f8cSGrygorii Strashko dev_dbg(kirq->dev, "end irq %d\n", irq); 1192f884e6eSStrashko, Grygorii return IRQ_HANDLED; 12089323f8cSGrygorii Strashko } 12189323f8cSGrygorii Strashko 12289323f8cSGrygorii Strashko static int keystone_irq_map(struct irq_domain *h, unsigned int virq, 12389323f8cSGrygorii Strashko irq_hw_number_t hw) 12489323f8cSGrygorii Strashko { 12589323f8cSGrygorii Strashko struct keystone_irq_device *kirq = h->host_data; 12689323f8cSGrygorii Strashko 12789323f8cSGrygorii Strashko irq_set_chip_data(virq, kirq); 12889323f8cSGrygorii Strashko irq_set_chip_and_handler(virq, &kirq->chip, handle_level_irq); 129d17cab44SRob Herring irq_set_probe(virq); 13089323f8cSGrygorii Strashko return 0; 13189323f8cSGrygorii Strashko } 13289323f8cSGrygorii Strashko 13396009736SKrzysztof Kozlowski static const struct irq_domain_ops keystone_irq_ops = { 13489323f8cSGrygorii Strashko .map = keystone_irq_map, 13589323f8cSGrygorii Strashko .xlate = irq_domain_xlate_onecell, 13689323f8cSGrygorii Strashko }; 13789323f8cSGrygorii Strashko 13889323f8cSGrygorii Strashko static int keystone_irq_probe(struct platform_device *pdev) 13989323f8cSGrygorii Strashko { 14089323f8cSGrygorii Strashko struct device *dev = &pdev->dev; 14189323f8cSGrygorii Strashko struct device_node *np = dev->of_node; 14289323f8cSGrygorii Strashko struct keystone_irq_device *kirq; 14389323f8cSGrygorii Strashko int ret; 14489323f8cSGrygorii Strashko 14589323f8cSGrygorii Strashko if (np == NULL) 14689323f8cSGrygorii Strashko return -EINVAL; 14789323f8cSGrygorii Strashko 14889323f8cSGrygorii Strashko kirq = devm_kzalloc(dev, sizeof(*kirq), GFP_KERNEL); 14989323f8cSGrygorii Strashko if (!kirq) 15089323f8cSGrygorii Strashko return -ENOMEM; 15189323f8cSGrygorii Strashko 15289323f8cSGrygorii Strashko kirq->devctrl_regs = 15389323f8cSGrygorii Strashko syscon_regmap_lookup_by_phandle(np, "ti,syscon-dev"); 15489323f8cSGrygorii Strashko if (IS_ERR(kirq->devctrl_regs)) 15589323f8cSGrygorii Strashko return PTR_ERR(kirq->devctrl_regs); 15689323f8cSGrygorii Strashko 15789323f8cSGrygorii Strashko ret = of_property_read_u32_index(np, "ti,syscon-dev", 1, 15889323f8cSGrygorii Strashko &kirq->devctrl_offset); 15989323f8cSGrygorii Strashko if (ret) { 16089323f8cSGrygorii Strashko dev_err(dev, "couldn't read the devctrl_offset offset!\n"); 16189323f8cSGrygorii Strashko return ret; 16289323f8cSGrygorii Strashko } 16389323f8cSGrygorii Strashko 16489323f8cSGrygorii Strashko kirq->irq = platform_get_irq(pdev, 0); 1656c9050a7SStephen Boyd if (kirq->irq < 0) 16689323f8cSGrygorii Strashko return kirq->irq; 16789323f8cSGrygorii Strashko 16889323f8cSGrygorii Strashko kirq->dev = dev; 16989323f8cSGrygorii Strashko kirq->mask = ~0x0; 17089323f8cSGrygorii Strashko kirq->chip.name = "keystone-irq"; 17189323f8cSGrygorii Strashko kirq->chip.irq_ack = keystone_irq_ack; 17289323f8cSGrygorii Strashko kirq->chip.irq_mask = keystone_irq_setmask; 17389323f8cSGrygorii Strashko kirq->chip.irq_unmask = keystone_irq_unmask; 17489323f8cSGrygorii Strashko 17589323f8cSGrygorii Strashko kirq->irqd = irq_domain_add_linear(np, KEYSTONE_N_IRQ, 17689323f8cSGrygorii Strashko &keystone_irq_ops, kirq); 17789323f8cSGrygorii Strashko if (!kirq->irqd) { 17889323f8cSGrygorii Strashko dev_err(dev, "IRQ domain registration failed\n"); 17989323f8cSGrygorii Strashko return -ENODEV; 18089323f8cSGrygorii Strashko } 18189323f8cSGrygorii Strashko 1822f884e6eSStrashko, Grygorii raw_spin_lock_init(&kirq->wa_lock); 1832f884e6eSStrashko, Grygorii 18489323f8cSGrygorii Strashko platform_set_drvdata(pdev, kirq); 18589323f8cSGrygorii Strashko 1862f884e6eSStrashko, Grygorii ret = request_irq(kirq->irq, keystone_irq_handler, 1872f884e6eSStrashko, Grygorii 0, dev_name(dev), kirq); 1882f884e6eSStrashko, Grygorii if (ret) { 1892f884e6eSStrashko, Grygorii irq_domain_remove(kirq->irqd); 1902f884e6eSStrashko, Grygorii return ret; 1912f884e6eSStrashko, Grygorii } 19289323f8cSGrygorii Strashko 19389323f8cSGrygorii Strashko /* clear all source bits */ 19489323f8cSGrygorii Strashko keystone_irq_writel(kirq, ~0x0); 19589323f8cSGrygorii Strashko 19689323f8cSGrygorii Strashko dev_info(dev, "irqchip registered, nr_irqs %u\n", KEYSTONE_N_IRQ); 19789323f8cSGrygorii Strashko 19889323f8cSGrygorii Strashko return 0; 19989323f8cSGrygorii Strashko } 20089323f8cSGrygorii Strashko 20189323f8cSGrygorii Strashko static int keystone_irq_remove(struct platform_device *pdev) 20289323f8cSGrygorii Strashko { 20389323f8cSGrygorii Strashko struct keystone_irq_device *kirq = platform_get_drvdata(pdev); 20489323f8cSGrygorii Strashko int hwirq; 20589323f8cSGrygorii Strashko 2062f884e6eSStrashko, Grygorii free_irq(kirq->irq, kirq); 2072f884e6eSStrashko, Grygorii 20889323f8cSGrygorii Strashko for (hwirq = 0; hwirq < KEYSTONE_N_IRQ; hwirq++) 20989323f8cSGrygorii Strashko irq_dispose_mapping(irq_find_mapping(kirq->irqd, hwirq)); 21089323f8cSGrygorii Strashko 21189323f8cSGrygorii Strashko irq_domain_remove(kirq->irqd); 21289323f8cSGrygorii Strashko return 0; 21389323f8cSGrygorii Strashko } 21489323f8cSGrygorii Strashko 21589323f8cSGrygorii Strashko static const struct of_device_id keystone_irq_dt_ids[] = { 21689323f8cSGrygorii Strashko { .compatible = "ti,keystone-irq", }, 21789323f8cSGrygorii Strashko {}, 21889323f8cSGrygorii Strashko }; 21989323f8cSGrygorii Strashko MODULE_DEVICE_TABLE(of, keystone_irq_dt_ids); 22089323f8cSGrygorii Strashko 22189323f8cSGrygorii Strashko static struct platform_driver keystone_irq_device_driver = { 22289323f8cSGrygorii Strashko .probe = keystone_irq_probe, 22389323f8cSGrygorii Strashko .remove = keystone_irq_remove, 22489323f8cSGrygorii Strashko .driver = { 22589323f8cSGrygorii Strashko .name = "keystone_irq", 22689323f8cSGrygorii Strashko .of_match_table = of_match_ptr(keystone_irq_dt_ids), 22789323f8cSGrygorii Strashko } 22889323f8cSGrygorii Strashko }; 22989323f8cSGrygorii Strashko 23089323f8cSGrygorii Strashko module_platform_driver(keystone_irq_device_driver); 23189323f8cSGrygorii Strashko 23289323f8cSGrygorii Strashko MODULE_AUTHOR("Texas Instruments"); 23389323f8cSGrygorii Strashko MODULE_AUTHOR("Sajesh Kumar Saran"); 23489323f8cSGrygorii Strashko MODULE_AUTHOR("Grygorii Strashko"); 23589323f8cSGrygorii Strashko MODULE_DESCRIPTION("Keystone IRQ chip"); 23689323f8cSGrygorii Strashko MODULE_LICENSE("GPL v2"); 237