diff options
Diffstat (limited to 'drivers/irqchip/irq-ls1x.c')
| -rw-r--r-- | drivers/irqchip/irq-ls1x.c | 192 |
1 files changed, 192 insertions, 0 deletions
diff --git a/drivers/irqchip/irq-ls1x.c b/drivers/irqchip/irq-ls1x.c new file mode 100644 index 000000000000..86b72fbd3b45 --- /dev/null +++ b/drivers/irqchip/irq-ls1x.c | |||
| @@ -0,0 +1,192 @@ | |||
| 1 | // SPDX-License-Identifier: GPL-2.0 | ||
| 2 | /* | ||
| 3 | * Copyright (C) 2019, Jiaxun Yang <jiaxun.yang@flygoat.com> | ||
| 4 | * Loongson-1 platform IRQ support | ||
| 5 | */ | ||
| 6 | |||
| 7 | #include <linux/errno.h> | ||
| 8 | #include <linux/init.h> | ||
| 9 | #include <linux/types.h> | ||
| 10 | #include <linux/interrupt.h> | ||
| 11 | #include <linux/ioport.h> | ||
| 12 | #include <linux/irqchip.h> | ||
| 13 | #include <linux/of_address.h> | ||
| 14 | #include <linux/of_irq.h> | ||
| 15 | #include <linux/io.h> | ||
| 16 | #include <linux/irqchip/chained_irq.h> | ||
| 17 | |||
| 18 | #define LS_REG_INTC_STATUS 0x00 | ||
| 19 | #define LS_REG_INTC_EN 0x04 | ||
| 20 | #define LS_REG_INTC_SET 0x08 | ||
| 21 | #define LS_REG_INTC_CLR 0x0c | ||
| 22 | #define LS_REG_INTC_POL 0x10 | ||
| 23 | #define LS_REG_INTC_EDGE 0x14 | ||
| 24 | |||
| 25 | /** | ||
| 26 | * struct ls1x_intc_priv - private ls1x-intc data. | ||
| 27 | * @domain: IRQ domain. | ||
| 28 | * @intc_base: IO Base of intc registers. | ||
| 29 | */ | ||
| 30 | |||
| 31 | struct ls1x_intc_priv { | ||
| 32 | struct irq_domain *domain; | ||
| 33 | void __iomem *intc_base; | ||
| 34 | }; | ||
| 35 | |||
| 36 | |||
| 37 | static void ls1x_chained_handle_irq(struct irq_desc *desc) | ||
| 38 | { | ||
| 39 | struct ls1x_intc_priv *priv = irq_desc_get_handler_data(desc); | ||
| 40 | struct irq_chip *chip = irq_desc_get_chip(desc); | ||
| 41 | u32 pending; | ||
| 42 | |||
| 43 | chained_irq_enter(chip, desc); | ||
| 44 | pending = readl(priv->intc_base + LS_REG_INTC_STATUS) & | ||
| 45 | readl(priv->intc_base + LS_REG_INTC_EN); | ||
| 46 | |||
| 47 | if (!pending) | ||
| 48 | spurious_interrupt(); | ||
| 49 | |||
| 50 | while (pending) { | ||
| 51 | int bit = __ffs(pending); | ||
| 52 | |||
| 53 | generic_handle_irq(irq_find_mapping(priv->domain, bit)); | ||
| 54 | pending &= ~BIT(bit); | ||
| 55 | } | ||
| 56 | |||
| 57 | chained_irq_exit(chip, desc); | ||
| 58 | } | ||
| 59 | |||
| 60 | static void ls_intc_set_bit(struct irq_chip_generic *gc, | ||
| 61 | unsigned int offset, | ||
| 62 | u32 mask, bool set) | ||
| 63 | { | ||
| 64 | if (set) | ||
| 65 | writel(readl(gc->reg_base + offset) | mask, | ||
| 66 | gc->reg_base + offset); | ||
| 67 | else | ||
| 68 | writel(readl(gc->reg_base + offset) & ~mask, | ||
| 69 | gc->reg_base + offset); | ||
| 70 | } | ||
| 71 | |||
| 72 | static int ls_intc_set_type(struct irq_data *data, unsigned int type) | ||
| 73 | { | ||
| 74 | struct irq_chip_generic *gc = irq_data_get_irq_chip_data(data); | ||
| 75 | u32 mask = data->mask; | ||
| 76 | |||
| 77 | switch (type) { | ||
| 78 | case IRQ_TYPE_LEVEL_HIGH: | ||
| 79 | ls_intc_set_bit(gc, LS_REG_INTC_EDGE, mask, false); | ||
| 80 | ls_intc_set_bit(gc, LS_REG_INTC_POL, mask, true); | ||
| 81 | break; | ||
| 82 | case IRQ_TYPE_LEVEL_LOW: | ||
| 83 | ls_intc_set_bit(gc, LS_REG_INTC_EDGE, mask, false); | ||
| 84 | ls_intc_set_bit(gc, LS_REG_INTC_POL, mask, false); | ||
| 85 | break; | ||
| 86 | case IRQ_TYPE_EDGE_RISING: | ||
| 87 | ls_intc_set_bit(gc, LS_REG_INTC_EDGE, mask, true); | ||
| 88 | ls_intc_set_bit(gc, LS_REG_INTC_POL, mask, true); | ||
| 89 | break; | ||
| 90 | case IRQ_TYPE_EDGE_FALLING: | ||
| 91 | ls_intc_set_bit(gc, LS_REG_INTC_EDGE, mask, true); | ||
| 92 | ls_intc_set_bit(gc, LS_REG_INTC_POL, mask, false); | ||
| 93 | break; | ||
| 94 | default: | ||
| 95 | return -EINVAL; | ||
| 96 | } | ||
| 97 | |||
| 98 | irqd_set_trigger_type(data, type); | ||
| 99 | return irq_setup_alt_chip(data, type); | ||
| 100 | } | ||
| 101 | |||
| 102 | |||
| 103 | static int __init ls1x_intc_of_init(struct device_node *node, | ||
| 104 | struct device_node *parent) | ||
| 105 | { | ||
| 106 | struct irq_chip_generic *gc; | ||
| 107 | struct irq_chip_type *ct; | ||
| 108 | struct ls1x_intc_priv *priv; | ||
| 109 | int parent_irq, err = 0; | ||
| 110 | |||
| 111 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); | ||
| 112 | if (!priv) | ||
| 113 | return -ENOMEM; | ||
| 114 | |||
| 115 | priv->intc_base = of_iomap(node, 0); | ||
| 116 | if (!priv->intc_base) { | ||
| 117 | err = -ENODEV; | ||
| 118 | goto out_free_priv; | ||
| 119 | } | ||
| 120 | |||
| 121 | parent_irq = irq_of_parse_and_map(node, 0); | ||
| 122 | if (!parent_irq) { | ||
| 123 | pr_err("ls1x-irq: unable to get parent irq\n"); | ||
| 124 | err = -ENODEV; | ||
| 125 | goto out_iounmap; | ||
| 126 | } | ||
| 127 | |||
| 128 | /* Set up an IRQ domain */ | ||
| 129 | priv->domain = irq_domain_add_linear(node, 32, &irq_generic_chip_ops, | ||
| 130 | NULL); | ||
| 131 | if (!priv->domain) { | ||
| 132 | pr_err("ls1x-irq: cannot add IRQ domain\n"); | ||
| 133 | goto out_iounmap; | ||
| 134 | } | ||
| 135 | |||
| 136 | err = irq_alloc_domain_generic_chips(priv->domain, 32, 2, | ||
| 137 | node->full_name, handle_level_irq, | ||
| 138 | IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN, 0, | ||
| 139 | IRQ_GC_INIT_MASK_CACHE); | ||
| 140 | if (err) { | ||
| 141 | pr_err("ls1x-irq: unable to register IRQ domain\n"); | ||
| 142 | goto out_free_domain; | ||
| 143 | } | ||
| 144 | |||
| 145 | /* Mask all irqs */ | ||
| 146 | writel(0x0, priv->intc_base + LS_REG_INTC_EN); | ||
| 147 | |||
| 148 | /* Ack all irqs */ | ||
| 149 | writel(0xffffffff, priv->intc_base + LS_REG_INTC_CLR); | ||
| 150 | |||
| 151 | /* Set all irqs to high level triggered */ | ||
| 152 | writel(0xffffffff, priv->intc_base + LS_REG_INTC_POL); | ||
| 153 | |||
| 154 | gc = irq_get_domain_generic_chip(priv->domain, 0); | ||
| 155 | |||
| 156 | gc->reg_base = priv->intc_base; | ||
| 157 | |||
| 158 | ct = gc->chip_types; | ||
| 159 | ct[0].type = IRQ_TYPE_LEVEL_MASK; | ||
| 160 | ct[0].regs.mask = LS_REG_INTC_EN; | ||
| 161 | ct[0].regs.ack = LS_REG_INTC_CLR; | ||
| 162 | ct[0].chip.irq_unmask = irq_gc_mask_set_bit; | ||
| 163 | ct[0].chip.irq_mask = irq_gc_mask_clr_bit; | ||
| 164 | ct[0].chip.irq_ack = irq_gc_ack_set_bit; | ||
| 165 | ct[0].chip.irq_set_type = ls_intc_set_type; | ||
| 166 | ct[0].handler = handle_level_irq; | ||
| 167 | |||
| 168 | ct[1].type = IRQ_TYPE_EDGE_BOTH; | ||
| 169 | ct[1].regs.mask = LS_REG_INTC_EN; | ||
| 170 | ct[1].regs.ack = LS_REG_INTC_CLR; | ||
| 171 | ct[1].chip.irq_unmask = irq_gc_mask_set_bit; | ||
| 172 | ct[1].chip.irq_mask = irq_gc_mask_clr_bit; | ||
| 173 | ct[1].chip.irq_ack = irq_gc_ack_set_bit; | ||
| 174 | ct[1].chip.irq_set_type = ls_intc_set_type; | ||
| 175 | ct[1].handler = handle_edge_irq; | ||
| 176 | |||
| 177 | irq_set_chained_handler_and_data(parent_irq, | ||
| 178 | ls1x_chained_handle_irq, priv); | ||
| 179 | |||
| 180 | return 0; | ||
| 181 | |||
| 182 | out_free_domain: | ||
| 183 | irq_domain_remove(priv->domain); | ||
| 184 | out_iounmap: | ||
| 185 | iounmap(priv->intc_base); | ||
| 186 | out_free_priv: | ||
| 187 | kfree(priv); | ||
| 188 | |||
| 189 | return err; | ||
| 190 | } | ||
| 191 | |||
| 192 | IRQCHIP_DECLARE(ls1x_intc, "loongson,ls1x-intc", ls1x_intc_of_init); | ||
