1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * irqchip for the Faraday Technology FTINTC010 Copyright (C) 2017 Linus
4  * Walleij <linus.walleij@linaro.org>
5  *
6  * Based on arch/arm/mach-gemini/irq.c
7  * Copyright (C) 2001-2006 Storlink, Corp.
8  * Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@gmail.com>
9  */
10 #include <linux/bitops.h>
11 #include <linux/irq.h>
12 #include <linux/io.h>
13 #include <linux/irqchip.h>
14 #include <linux/irqdomain.h>
15 #include <linux/module.h>
16 #include <linux/of.h>
17 #include <linux/of_address.h>
18 #include <linux/of_irq.h>
19 #include <linux/cpu.h>
20 
21 #include <asm/exception.h>
22 #include <asm/mach/irq.h>
23 
24 #define FT010_NUM_IRQS 32
25 
26 #define FT010_IRQ_SOURCE(base_addr)	(base_addr + 0x00)
27 #define FT010_IRQ_MASK(base_addr)	(base_addr + 0x04)
28 #define FT010_IRQ_CLEAR(base_addr)	(base_addr + 0x08)
29 /* Selects level- or edge-triggered */
30 #define FT010_IRQ_MODE(base_addr)	(base_addr + 0x0C)
31 /* Selects active low/high or falling/rising edge */
32 #define FT010_IRQ_POLARITY(base_addr)	(base_addr + 0x10)
33 #define FT010_IRQ_STATUS(base_addr)	(base_addr + 0x14)
34 #define FT010_FIQ_SOURCE(base_addr)	(base_addr + 0x20)
35 #define FT010_FIQ_MASK(base_addr)	(base_addr + 0x24)
36 #define FT010_FIQ_CLEAR(base_addr)	(base_addr + 0x28)
37 #define FT010_FIQ_MODE(base_addr)	(base_addr + 0x2C)
38 #define FT010_FIQ_POLARITY(base_addr)	(base_addr + 0x30)
39 #define FT010_FIQ_STATUS(base_addr)	(base_addr + 0x34)
40 
41 /**
42  * struct ft010_irq_data - irq data container for the Faraday IRQ controller
43  * @base: memory offset in virtual memory
44  * @chip: chip container for this instance
45  * @domain: IRQ domain for this instance
46  */
47 struct ft010_irq_data {
48 	void __iomem *base;
49 	struct irq_chip chip;
50 	struct irq_domain *domain;
51 };
52 
ft010_irq_mask(struct irq_data * d)53 static void ft010_irq_mask(struct irq_data *d)
54 {
55 	struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
56 	unsigned int mask;
57 
58 	mask = readl(FT010_IRQ_MASK(f->base));
59 	mask &= ~BIT(irqd_to_hwirq(d));
60 	writel(mask, FT010_IRQ_MASK(f->base));
61 }
62 
ft010_irq_unmask(struct irq_data * d)63 static void ft010_irq_unmask(struct irq_data *d)
64 {
65 	struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
66 	unsigned int mask;
67 
68 	mask = readl(FT010_IRQ_MASK(f->base));
69 	mask |= BIT(irqd_to_hwirq(d));
70 	writel(mask, FT010_IRQ_MASK(f->base));
71 }
72 
ft010_irq_ack(struct irq_data * d)73 static void ft010_irq_ack(struct irq_data *d)
74 {
75 	struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
76 
77 	writel(BIT(irqd_to_hwirq(d)), FT010_IRQ_CLEAR(f->base));
78 }
79 
ft010_irq_set_type(struct irq_data * d,unsigned int trigger)80 static int ft010_irq_set_type(struct irq_data *d, unsigned int trigger)
81 {
82 	struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
83 	int offset = irqd_to_hwirq(d);
84 	u32 mode, polarity;
85 
86 	mode = readl(FT010_IRQ_MODE(f->base));
87 	polarity = readl(FT010_IRQ_POLARITY(f->base));
88 
89 	if (trigger & (IRQ_TYPE_LEVEL_LOW)) {
90 		irq_set_handler_locked(d, handle_level_irq);
91 		mode &= ~BIT(offset);
92 		polarity |= BIT(offset);
93 	} else if (trigger & (IRQ_TYPE_LEVEL_HIGH)) {
94 		irq_set_handler_locked(d, handle_level_irq);
95 		mode &= ~BIT(offset);
96 		polarity &= ~BIT(offset);
97 	} else if (trigger & IRQ_TYPE_EDGE_FALLING) {
98 		irq_set_handler_locked(d, handle_edge_irq);
99 		mode |= BIT(offset);
100 		polarity |= BIT(offset);
101 	} else if (trigger & IRQ_TYPE_EDGE_RISING) {
102 		irq_set_handler_locked(d, handle_edge_irq);
103 		mode |= BIT(offset);
104 		polarity &= ~BIT(offset);
105 	} else {
106 		irq_set_handler_locked(d, handle_bad_irq);
107 		pr_warn("Faraday IRQ: no supported trigger selected for line %d\n",
108 			offset);
109 	}
110 
111 	writel(mode, FT010_IRQ_MODE(f->base));
112 	writel(polarity, FT010_IRQ_POLARITY(f->base));
113 
114 	return 0;
115 }
116 
117 static struct irq_chip ft010_irq_chip = {
118 	.name		= "FTINTC010",
119 	.irq_ack	= ft010_irq_ack,
120 	.irq_mask	= ft010_irq_mask,
121 	.irq_unmask	= ft010_irq_unmask,
122 	.irq_set_type	= ft010_irq_set_type,
123 };
124 
125 /* Local static for the IRQ entry call */
126 static struct ft010_irq_data firq;
127 
ft010_irqchip_handle_irq(struct pt_regs * regs)128 static asmlinkage void __exception_irq_entry ft010_irqchip_handle_irq(struct pt_regs *regs)
129 {
130 	struct ft010_irq_data *f = &firq;
131 	int irq;
132 	u32 status;
133 
134 	while ((status = readl(FT010_IRQ_STATUS(f->base)))) {
135 		irq = ffs(status) - 1;
136 		generic_handle_domain_irq(f->domain, irq);
137 	}
138 }
139 
ft010_irqdomain_map(struct irq_domain * d,unsigned int irq,irq_hw_number_t hwirq)140 static int ft010_irqdomain_map(struct irq_domain *d, unsigned int irq,
141 				irq_hw_number_t hwirq)
142 {
143 	struct ft010_irq_data *f = d->host_data;
144 
145 	irq_set_chip_data(irq, f);
146 	/* All IRQs should set up their type, flags as bad by default */
147 	irq_set_chip_and_handler(irq, &ft010_irq_chip, handle_bad_irq);
148 	irq_set_probe(irq);
149 
150 	return 0;
151 }
152 
ft010_irqdomain_unmap(struct irq_domain * d,unsigned int irq)153 static void ft010_irqdomain_unmap(struct irq_domain *d, unsigned int irq)
154 {
155 	irq_set_chip_and_handler(irq, NULL, NULL);
156 	irq_set_chip_data(irq, NULL);
157 }
158 
159 static const struct irq_domain_ops ft010_irqdomain_ops = {
160 	.map = ft010_irqdomain_map,
161 	.unmap = ft010_irqdomain_unmap,
162 	.xlate = irq_domain_xlate_onetwocell,
163 };
164 
ft010_of_init_irq(struct device_node * node,struct device_node * parent)165 static int __init ft010_of_init_irq(struct device_node *node,
166 			      struct device_node *parent)
167 {
168 	struct ft010_irq_data *f = &firq;
169 
170 	/*
171 	 * Disable the idle handler by default since it is buggy
172 	 * For more info see arch/arm/mach-gemini/idle.c
173 	 */
174 	cpu_idle_poll_ctrl(true);
175 
176 	f->base = of_iomap(node, 0);
177 	WARN(!f->base, "unable to map gemini irq registers\n");
178 
179 	/* Disable all interrupts */
180 	writel(0, FT010_IRQ_MASK(f->base));
181 	writel(0, FT010_FIQ_MASK(f->base));
182 
183 	f->domain = irq_domain_add_simple(node, FT010_NUM_IRQS, 0,
184 					  &ft010_irqdomain_ops, f);
185 	set_handle_irq(ft010_irqchip_handle_irq);
186 
187 	return 0;
188 }
189 IRQCHIP_DECLARE(faraday, "faraday,ftintc010",
190 		ft010_of_init_irq);
191 IRQCHIP_DECLARE(gemini, "cortina,gemini-interrupt-controller",
192 		ft010_of_init_irq);
193 IRQCHIP_DECLARE(moxa, "moxa,moxart-ic",
194 		ft010_of_init_irq);
195