This source file includes following definitions.
- ixp4xx_gpio_irq_ack
- ixp4xx_gpio_irq_unmask
- ixp4xx_gpio_irq_set_type
- ixp4xx_gpio_child_to_parent_hwirq
- ixp4xx_gpio_probe
1
2
3
4
5
6
7
8
9 #include <linux/gpio/driver.h>
10 #include <linux/io.h>
11 #include <linux/irq.h>
12 #include <linux/irqdomain.h>
13 #include <linux/irqchip.h>
14 #include <linux/of_irq.h>
15 #include <linux/platform_device.h>
16 #include <linux/bitops.h>
17
18 #include <linux/irqchip/irq-ixp4xx.h>
19
20 #include <asm/mach-types.h>
21
22 #define IXP4XX_REG_GPOUT 0x00
23 #define IXP4XX_REG_GPOE 0x04
24 #define IXP4XX_REG_GPIN 0x08
25 #define IXP4XX_REG_GPIS 0x0C
26 #define IXP4XX_REG_GPIT1 0x10
27 #define IXP4XX_REG_GPIT2 0x14
28 #define IXP4XX_REG_GPCLK 0x18
29 #define IXP4XX_REG_GPDBSEL 0x1C
30
31
32
33
34
35
36
37 #define IXP4XX_GPIO_STYLE_ACTIVE_HIGH 0x0
38 #define IXP4XX_GPIO_STYLE_ACTIVE_LOW 0x1
39 #define IXP4XX_GPIO_STYLE_RISING_EDGE 0x2
40 #define IXP4XX_GPIO_STYLE_FALLING_EDGE 0x3
41 #define IXP4XX_GPIO_STYLE_TRANSITIONAL 0x4
42 #define IXP4XX_GPIO_STYLE_MASK GENMASK(2, 0)
43 #define IXP4XX_GPIO_STYLE_SIZE 3
44
45
46
47
48
49
50
51
52
53
54 struct ixp4xx_gpio {
55 struct device *dev;
56 struct fwnode_handle *fwnode;
57 struct gpio_chip gc;
58 void __iomem *base;
59 unsigned long long irq_edge;
60 };
61
62 static void ixp4xx_gpio_irq_ack(struct irq_data *d)
63 {
64 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
65 struct ixp4xx_gpio *g = gpiochip_get_data(gc);
66
67 __raw_writel(BIT(d->hwirq), g->base + IXP4XX_REG_GPIS);
68 }
69
70 static void ixp4xx_gpio_irq_unmask(struct irq_data *d)
71 {
72 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
73 struct ixp4xx_gpio *g = gpiochip_get_data(gc);
74
75
76 if (!(g->irq_edge & BIT(d->hwirq)))
77 ixp4xx_gpio_irq_ack(d);
78
79 irq_chip_unmask_parent(d);
80 }
81
82 static int ixp4xx_gpio_irq_set_type(struct irq_data *d, unsigned int type)
83 {
84 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
85 struct ixp4xx_gpio *g = gpiochip_get_data(gc);
86 int line = d->hwirq;
87 unsigned long flags;
88 u32 int_style;
89 u32 int_reg;
90 u32 val;
91
92 switch (type) {
93 case IRQ_TYPE_EDGE_BOTH:
94 irq_set_handler_locked(d, handle_edge_irq);
95 int_style = IXP4XX_GPIO_STYLE_TRANSITIONAL;
96 g->irq_edge |= BIT(d->hwirq);
97 break;
98 case IRQ_TYPE_EDGE_RISING:
99 irq_set_handler_locked(d, handle_edge_irq);
100 int_style = IXP4XX_GPIO_STYLE_RISING_EDGE;
101 g->irq_edge |= BIT(d->hwirq);
102 break;
103 case IRQ_TYPE_EDGE_FALLING:
104 irq_set_handler_locked(d, handle_edge_irq);
105 int_style = IXP4XX_GPIO_STYLE_FALLING_EDGE;
106 g->irq_edge |= BIT(d->hwirq);
107 break;
108 case IRQ_TYPE_LEVEL_HIGH:
109 irq_set_handler_locked(d, handle_level_irq);
110 int_style = IXP4XX_GPIO_STYLE_ACTIVE_HIGH;
111 g->irq_edge &= ~BIT(d->hwirq);
112 break;
113 case IRQ_TYPE_LEVEL_LOW:
114 irq_set_handler_locked(d, handle_level_irq);
115 int_style = IXP4XX_GPIO_STYLE_ACTIVE_LOW;
116 g->irq_edge &= ~BIT(d->hwirq);
117 break;
118 default:
119 return -EINVAL;
120 }
121
122 if (line >= 8) {
123
124 line -= 8;
125 int_reg = IXP4XX_REG_GPIT2;
126 } else {
127
128 int_reg = IXP4XX_REG_GPIT1;
129 }
130
131 spin_lock_irqsave(&g->gc.bgpio_lock, flags);
132
133
134 val = __raw_readl(g->base + int_reg);
135 val &= ~(IXP4XX_GPIO_STYLE_MASK << (line * IXP4XX_GPIO_STYLE_SIZE));
136 __raw_writel(val, g->base + int_reg);
137
138 __raw_writel(BIT(line), g->base + IXP4XX_REG_GPIS);
139
140
141 val = __raw_readl(g->base + int_reg);
142 val |= (int_style << (line * IXP4XX_GPIO_STYLE_SIZE));
143 __raw_writel(val, g->base + int_reg);
144
145
146 val = __raw_readl(g->base + IXP4XX_REG_GPOE);
147 val |= BIT(d->hwirq);
148 __raw_writel(val, g->base + IXP4XX_REG_GPOE);
149
150 spin_unlock_irqrestore(&g->gc.bgpio_lock, flags);
151
152
153 return irq_chip_set_type_parent(d, IRQ_TYPE_LEVEL_HIGH);
154 }
155
156 static struct irq_chip ixp4xx_gpio_irqchip = {
157 .name = "IXP4GPIO",
158 .irq_ack = ixp4xx_gpio_irq_ack,
159 .irq_mask = irq_chip_mask_parent,
160 .irq_unmask = ixp4xx_gpio_irq_unmask,
161 .irq_set_type = ixp4xx_gpio_irq_set_type,
162 };
163
164 static int ixp4xx_gpio_child_to_parent_hwirq(struct gpio_chip *gc,
165 unsigned int child,
166 unsigned int child_type,
167 unsigned int *parent,
168 unsigned int *parent_type)
169 {
170
171 *parent_type = IRQ_TYPE_LEVEL_HIGH;
172
173
174 if (child == 0) {
175 *parent = 6;
176 return 0;
177 }
178 if (child == 1) {
179 *parent = 7;
180 return 0;
181 }
182 if (child >= 2 && child <= 12) {
183 *parent = child + 17;
184 return 0;
185 }
186 return -EINVAL;
187 }
188
189 static int ixp4xx_gpio_probe(struct platform_device *pdev)
190 {
191 unsigned long flags;
192 struct device *dev = &pdev->dev;
193 struct device_node *np = dev->of_node;
194 struct irq_domain *parent;
195 struct resource *res;
196 struct ixp4xx_gpio *g;
197 struct gpio_irq_chip *girq;
198 int ret;
199
200 g = devm_kzalloc(dev, sizeof(*g), GFP_KERNEL);
201 if (!g)
202 return -ENOMEM;
203 g->dev = dev;
204
205 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
206 g->base = devm_ioremap_resource(dev, res);
207 if (IS_ERR(g->base))
208 return PTR_ERR(g->base);
209
210
211
212
213
214
215
216 if (np) {
217 struct device_node *irq_parent;
218
219 irq_parent = of_irq_find_parent(np);
220 if (!irq_parent) {
221 dev_err(dev, "no IRQ parent node\n");
222 return -ENODEV;
223 }
224 parent = irq_find_host(irq_parent);
225 if (!parent) {
226 dev_err(dev, "no IRQ parent domain\n");
227 return -ENODEV;
228 }
229 g->fwnode = of_node_to_fwnode(np);
230 } else {
231 parent = ixp4xx_get_irq_domain();
232 g->fwnode = irq_domain_alloc_fwnode(&res->start);
233 if (!g->fwnode) {
234 dev_err(dev, "no domain base\n");
235 return -ENODEV;
236 }
237 }
238
239
240
241
242
243 if (machine_is_dsmg600() || machine_is_nas100d())
244 __raw_writel(0x0, g->base + IXP4XX_REG_GPCLK);
245
246
247
248
249
250
251
252
253
254
255 #if defined(CONFIG_CPU_BIG_ENDIAN)
256 flags = BGPIOF_BIG_ENDIAN_BYTE_ORDER;
257 #else
258 flags = 0;
259 #endif
260
261
262 ret = bgpio_init(&g->gc, dev, 4,
263 g->base + IXP4XX_REG_GPIN,
264 g->base + IXP4XX_REG_GPOUT,
265 NULL,
266 NULL,
267 g->base + IXP4XX_REG_GPOE,
268 flags);
269 if (ret) {
270 dev_err(dev, "unable to init generic GPIO\n");
271 return ret;
272 }
273 g->gc.ngpio = 16;
274 g->gc.label = "IXP4XX_GPIO_CHIP";
275
276
277
278
279
280 g->gc.base = 0;
281 g->gc.parent = &pdev->dev;
282 g->gc.owner = THIS_MODULE;
283
284 girq = &g->gc.irq;
285 girq->chip = &ixp4xx_gpio_irqchip;
286 girq->fwnode = g->fwnode;
287 girq->parent_domain = parent;
288 girq->child_to_parent_hwirq = ixp4xx_gpio_child_to_parent_hwirq;
289 girq->handler = handle_bad_irq;
290 girq->default_type = IRQ_TYPE_NONE;
291
292 ret = devm_gpiochip_add_data(dev, &g->gc, g);
293 if (ret) {
294 dev_err(dev, "failed to add SoC gpiochip\n");
295 return ret;
296 }
297
298 platform_set_drvdata(pdev, g);
299 dev_info(dev, "IXP4 GPIO registered\n");
300
301 return 0;
302 }
303
304 static const struct of_device_id ixp4xx_gpio_of_match[] = {
305 {
306 .compatible = "intel,ixp4xx-gpio",
307 },
308 {},
309 };
310
311
312 static struct platform_driver ixp4xx_gpio_driver = {
313 .driver = {
314 .name = "ixp4xx-gpio",
315 .of_match_table = of_match_ptr(ixp4xx_gpio_of_match),
316 },
317 .probe = ixp4xx_gpio_probe,
318 };
319 builtin_platform_driver(ixp4xx_gpio_driver);