Commit | Line | Data |
---|---|---|
ec43b08b HM |
1 | /* |
2 | * Sonics Silicon Backplane | |
3 | * GPIO driver | |
4 | * | |
5 | * Copyright 2011, Broadcom Corporation | |
6 | * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de> | |
7 | * | |
8 | * Licensed under the GNU/GPL. See COPYING for details. | |
9 | */ | |
10 | ||
11 | #include <linux/gpio.h> | |
7c1bc0da RM |
12 | #include <linux/irq.h> |
13 | #include <linux/interrupt.h> | |
14 | #include <linux/irqdomain.h> | |
ec43b08b HM |
15 | #include <linux/export.h> |
16 | #include <linux/ssb/ssb.h> | |
17 | ||
18 | #include "ssb_private.h" | |
19 | ||
7c1bc0da RM |
20 | |
21 | /************************************************** | |
22 | * Shared | |
23 | **************************************************/ | |
24 | ||
ec43b08b HM |
25 | static struct ssb_bus *ssb_gpio_get_bus(struct gpio_chip *chip) |
26 | { | |
27 | return container_of(chip, struct ssb_bus, gpio); | |
28 | } | |
29 | ||
7c1bc0da RM |
30 | #if IS_ENABLED(CONFIG_SSB_EMBEDDED) |
31 | static int ssb_gpio_to_irq(struct gpio_chip *chip, unsigned gpio) | |
32 | { | |
33 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
34 | ||
35 | if (bus->bustype == SSB_BUSTYPE_SSB) | |
36 | return irq_find_mapping(bus->irq_domain, gpio); | |
37 | else | |
38 | return -EINVAL; | |
39 | } | |
40 | #endif | |
41 | ||
42 | /************************************************** | |
43 | * ChipCommon | |
44 | **************************************************/ | |
45 | ||
ec43b08b HM |
46 | static int ssb_gpio_chipco_get_value(struct gpio_chip *chip, unsigned gpio) |
47 | { | |
48 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
49 | ||
50 | return !!ssb_chipco_gpio_in(&bus->chipco, 1 << gpio); | |
51 | } | |
52 | ||
53 | static void ssb_gpio_chipco_set_value(struct gpio_chip *chip, unsigned gpio, | |
54 | int value) | |
55 | { | |
56 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
57 | ||
58 | ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0); | |
59 | } | |
60 | ||
61 | static int ssb_gpio_chipco_direction_input(struct gpio_chip *chip, | |
62 | unsigned gpio) | |
63 | { | |
64 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
65 | ||
66 | ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 0); | |
67 | return 0; | |
68 | } | |
69 | ||
70 | static int ssb_gpio_chipco_direction_output(struct gpio_chip *chip, | |
71 | unsigned gpio, int value) | |
72 | { | |
73 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
74 | ||
75 | ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 1 << gpio); | |
76 | ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0); | |
77 | return 0; | |
78 | } | |
79 | ||
80 | static int ssb_gpio_chipco_request(struct gpio_chip *chip, unsigned gpio) | |
81 | { | |
82 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
83 | ||
84 | ssb_chipco_gpio_control(&bus->chipco, 1 << gpio, 0); | |
85 | /* clear pulldown */ | |
86 | ssb_chipco_gpio_pulldown(&bus->chipco, 1 << gpio, 0); | |
87 | /* Set pullup */ | |
88 | ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 1 << gpio); | |
89 | ||
90 | return 0; | |
91 | } | |
92 | ||
93 | static void ssb_gpio_chipco_free(struct gpio_chip *chip, unsigned gpio) | |
94 | { | |
95 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
96 | ||
97 | /* clear pullup */ | |
98 | ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 0); | |
99 | } | |
100 | ||
7c1bc0da RM |
101 | #if IS_ENABLED(CONFIG_SSB_EMBEDDED) |
102 | static void ssb_gpio_irq_chipco_mask(struct irq_data *d) | |
a6ca2e10 | 103 | { |
7c1bc0da RM |
104 | struct ssb_bus *bus = irq_data_get_irq_chip_data(d); |
105 | int gpio = irqd_to_hwirq(d); | |
a6ca2e10 | 106 | |
7c1bc0da RM |
107 | ssb_chipco_gpio_intmask(&bus->chipco, BIT(gpio), 0); |
108 | } | |
109 | ||
110 | static void ssb_gpio_irq_chipco_unmask(struct irq_data *d) | |
111 | { | |
112 | struct ssb_bus *bus = irq_data_get_irq_chip_data(d); | |
113 | int gpio = irqd_to_hwirq(d); | |
114 | u32 val = ssb_chipco_gpio_in(&bus->chipco, BIT(gpio)); | |
115 | ||
116 | ssb_chipco_gpio_polarity(&bus->chipco, BIT(gpio), val); | |
117 | ssb_chipco_gpio_intmask(&bus->chipco, BIT(gpio), BIT(gpio)); | |
118 | } | |
119 | ||
120 | static struct irq_chip ssb_gpio_irq_chipco_chip = { | |
121 | .name = "SSB-GPIO-CC", | |
122 | .irq_mask = ssb_gpio_irq_chipco_mask, | |
123 | .irq_unmask = ssb_gpio_irq_chipco_unmask, | |
124 | }; | |
125 | ||
126 | static irqreturn_t ssb_gpio_irq_chipco_handler(int irq, void *dev_id) | |
127 | { | |
128 | struct ssb_bus *bus = dev_id; | |
129 | struct ssb_chipcommon *chipco = &bus->chipco; | |
130 | u32 val = chipco_read32(chipco, SSB_CHIPCO_GPIOIN); | |
131 | u32 mask = chipco_read32(chipco, SSB_CHIPCO_GPIOIRQ); | |
132 | u32 pol = chipco_read32(chipco, SSB_CHIPCO_GPIOPOL); | |
133 | unsigned long irqs = (val ^ pol) & mask; | |
134 | int gpio; | |
135 | ||
136 | if (!irqs) | |
137 | return IRQ_NONE; | |
138 | ||
139 | for_each_set_bit(gpio, &irqs, bus->gpio.ngpio) | |
140 | generic_handle_irq(ssb_gpio_to_irq(&bus->gpio, gpio)); | |
141 | ssb_chipco_gpio_polarity(chipco, irqs, val & irqs); | |
142 | ||
143 | return IRQ_HANDLED; | |
144 | } | |
145 | ||
146 | static int ssb_gpio_irq_chipco_domain_init(struct ssb_bus *bus) | |
147 | { | |
148 | struct ssb_chipcommon *chipco = &bus->chipco; | |
149 | struct gpio_chip *chip = &bus->gpio; | |
150 | int gpio, hwirq, err; | |
151 | ||
152 | if (bus->bustype != SSB_BUSTYPE_SSB) | |
153 | return 0; | |
154 | ||
155 | bus->irq_domain = irq_domain_add_linear(NULL, chip->ngpio, | |
156 | &irq_domain_simple_ops, chipco); | |
157 | if (!bus->irq_domain) { | |
158 | err = -ENODEV; | |
159 | goto err_irq_domain; | |
160 | } | |
161 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
162 | int irq = irq_create_mapping(bus->irq_domain, gpio); | |
163 | ||
164 | irq_set_chip_data(irq, bus); | |
165 | irq_set_chip_and_handler(irq, &ssb_gpio_irq_chipco_chip, | |
166 | handle_simple_irq); | |
167 | } | |
168 | ||
169 | hwirq = ssb_mips_irq(bus->chipco.dev) + 2; | |
170 | err = request_irq(hwirq, ssb_gpio_irq_chipco_handler, IRQF_SHARED, | |
171 | "gpio", bus); | |
172 | if (err) | |
173 | goto err_req_irq; | |
174 | ||
175 | ssb_chipco_gpio_intmask(&bus->chipco, ~0, 0); | |
176 | chipco_set32(chipco, SSB_CHIPCO_IRQMASK, SSB_CHIPCO_IRQ_GPIO); | |
177 | ||
178 | return 0; | |
179 | ||
180 | err_req_irq: | |
181 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
182 | int irq = irq_find_mapping(bus->irq_domain, gpio); | |
183 | ||
184 | irq_dispose_mapping(irq); | |
185 | } | |
186 | irq_domain_remove(bus->irq_domain); | |
187 | err_irq_domain: | |
188 | return err; | |
189 | } | |
190 | ||
191 | static void ssb_gpio_irq_chipco_domain_exit(struct ssb_bus *bus) | |
192 | { | |
193 | struct ssb_chipcommon *chipco = &bus->chipco; | |
194 | struct gpio_chip *chip = &bus->gpio; | |
195 | int gpio; | |
196 | ||
197 | if (bus->bustype != SSB_BUSTYPE_SSB) | |
198 | return; | |
199 | ||
200 | chipco_mask32(chipco, SSB_CHIPCO_IRQMASK, ~SSB_CHIPCO_IRQ_GPIO); | |
201 | free_irq(ssb_mips_irq(bus->chipco.dev) + 2, chipco); | |
202 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
203 | int irq = irq_find_mapping(bus->irq_domain, gpio); | |
204 | ||
205 | irq_dispose_mapping(irq); | |
206 | } | |
207 | irq_domain_remove(bus->irq_domain); | |
208 | } | |
209 | #else | |
210 | static int ssb_gpio_irq_chipco_domain_init(struct ssb_bus *bus) | |
211 | { | |
212 | return 0; | |
a6ca2e10 HM |
213 | } |
214 | ||
7c1bc0da RM |
215 | static void ssb_gpio_irq_chipco_domain_exit(struct ssb_bus *bus) |
216 | { | |
217 | } | |
218 | #endif | |
219 | ||
ec43b08b HM |
220 | static int ssb_gpio_chipco_init(struct ssb_bus *bus) |
221 | { | |
222 | struct gpio_chip *chip = &bus->gpio; | |
7c1bc0da | 223 | int err; |
ec43b08b HM |
224 | |
225 | chip->label = "ssb_chipco_gpio"; | |
226 | chip->owner = THIS_MODULE; | |
227 | chip->request = ssb_gpio_chipco_request; | |
228 | chip->free = ssb_gpio_chipco_free; | |
229 | chip->get = ssb_gpio_chipco_get_value; | |
230 | chip->set = ssb_gpio_chipco_set_value; | |
231 | chip->direction_input = ssb_gpio_chipco_direction_input; | |
232 | chip->direction_output = ssb_gpio_chipco_direction_output; | |
7c1bc0da RM |
233 | #if IS_ENABLED(CONFIG_SSB_EMBEDDED) |
234 | chip->to_irq = ssb_gpio_to_irq; | |
235 | #endif | |
ec43b08b HM |
236 | chip->ngpio = 16; |
237 | /* There is just one SoC in one device and its GPIO addresses should be | |
238 | * deterministic to address them more easily. The other buses could get | |
239 | * a random base number. */ | |
240 | if (bus->bustype == SSB_BUSTYPE_SSB) | |
241 | chip->base = 0; | |
242 | else | |
243 | chip->base = -1; | |
244 | ||
7c1bc0da RM |
245 | err = ssb_gpio_irq_chipco_domain_init(bus); |
246 | if (err) | |
247 | return err; | |
248 | ||
249 | err = gpiochip_add(chip); | |
250 | if (err) { | |
251 | ssb_gpio_irq_chipco_domain_exit(bus); | |
252 | return err; | |
253 | } | |
254 | ||
255 | return 0; | |
ec43b08b HM |
256 | } |
257 | ||
7c1bc0da RM |
258 | /************************************************** |
259 | * EXTIF | |
260 | **************************************************/ | |
261 | ||
ec43b08b HM |
262 | #ifdef CONFIG_SSB_DRIVER_EXTIF |
263 | ||
264 | static int ssb_gpio_extif_get_value(struct gpio_chip *chip, unsigned gpio) | |
265 | { | |
266 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
267 | ||
268 | return !!ssb_extif_gpio_in(&bus->extif, 1 << gpio); | |
269 | } | |
270 | ||
271 | static void ssb_gpio_extif_set_value(struct gpio_chip *chip, unsigned gpio, | |
272 | int value) | |
273 | { | |
274 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
275 | ||
276 | ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0); | |
277 | } | |
278 | ||
279 | static int ssb_gpio_extif_direction_input(struct gpio_chip *chip, | |
280 | unsigned gpio) | |
281 | { | |
282 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
283 | ||
284 | ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 0); | |
285 | return 0; | |
286 | } | |
287 | ||
288 | static int ssb_gpio_extif_direction_output(struct gpio_chip *chip, | |
289 | unsigned gpio, int value) | |
290 | { | |
291 | struct ssb_bus *bus = ssb_gpio_get_bus(chip); | |
292 | ||
293 | ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 1 << gpio); | |
294 | ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0); | |
295 | return 0; | |
296 | } | |
297 | ||
7c1bc0da RM |
298 | #if IS_ENABLED(CONFIG_SSB_EMBEDDED) |
299 | static void ssb_gpio_irq_extif_mask(struct irq_data *d) | |
a6ca2e10 | 300 | { |
7c1bc0da RM |
301 | struct ssb_bus *bus = irq_data_get_irq_chip_data(d); |
302 | int gpio = irqd_to_hwirq(d); | |
a6ca2e10 | 303 | |
7c1bc0da RM |
304 | ssb_extif_gpio_intmask(&bus->extif, BIT(gpio), 0); |
305 | } | |
306 | ||
307 | static void ssb_gpio_irq_extif_unmask(struct irq_data *d) | |
308 | { | |
309 | struct ssb_bus *bus = irq_data_get_irq_chip_data(d); | |
310 | int gpio = irqd_to_hwirq(d); | |
311 | u32 val = ssb_extif_gpio_in(&bus->extif, BIT(gpio)); | |
312 | ||
313 | ssb_extif_gpio_polarity(&bus->extif, BIT(gpio), val); | |
314 | ssb_extif_gpio_intmask(&bus->extif, BIT(gpio), BIT(gpio)); | |
315 | } | |
316 | ||
317 | static struct irq_chip ssb_gpio_irq_extif_chip = { | |
318 | .name = "SSB-GPIO-EXTIF", | |
319 | .irq_mask = ssb_gpio_irq_extif_mask, | |
320 | .irq_unmask = ssb_gpio_irq_extif_unmask, | |
321 | }; | |
322 | ||
323 | static irqreturn_t ssb_gpio_irq_extif_handler(int irq, void *dev_id) | |
324 | { | |
325 | struct ssb_bus *bus = dev_id; | |
326 | struct ssb_extif *extif = &bus->extif; | |
327 | u32 val = ssb_read32(extif->dev, SSB_EXTIF_GPIO_IN); | |
328 | u32 mask = ssb_read32(extif->dev, SSB_EXTIF_GPIO_INTMASK); | |
329 | u32 pol = ssb_read32(extif->dev, SSB_EXTIF_GPIO_INTPOL); | |
330 | unsigned long irqs = (val ^ pol) & mask; | |
331 | int gpio; | |
332 | ||
333 | if (!irqs) | |
334 | return IRQ_NONE; | |
335 | ||
336 | for_each_set_bit(gpio, &irqs, bus->gpio.ngpio) | |
337 | generic_handle_irq(ssb_gpio_to_irq(&bus->gpio, gpio)); | |
338 | ssb_extif_gpio_polarity(extif, irqs, val & irqs); | |
339 | ||
340 | return IRQ_HANDLED; | |
341 | } | |
342 | ||
343 | static int ssb_gpio_irq_extif_domain_init(struct ssb_bus *bus) | |
344 | { | |
345 | struct ssb_extif *extif = &bus->extif; | |
346 | struct gpio_chip *chip = &bus->gpio; | |
347 | int gpio, hwirq, err; | |
348 | ||
349 | if (bus->bustype != SSB_BUSTYPE_SSB) | |
350 | return 0; | |
351 | ||
352 | bus->irq_domain = irq_domain_add_linear(NULL, chip->ngpio, | |
353 | &irq_domain_simple_ops, extif); | |
354 | if (!bus->irq_domain) { | |
355 | err = -ENODEV; | |
356 | goto err_irq_domain; | |
357 | } | |
358 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
359 | int irq = irq_create_mapping(bus->irq_domain, gpio); | |
360 | ||
361 | irq_set_chip_data(irq, bus); | |
362 | irq_set_chip_and_handler(irq, &ssb_gpio_irq_extif_chip, | |
363 | handle_simple_irq); | |
364 | } | |
365 | ||
366 | hwirq = ssb_mips_irq(bus->extif.dev) + 2; | |
367 | err = request_irq(hwirq, ssb_gpio_irq_extif_handler, IRQF_SHARED, | |
368 | "gpio", bus); | |
369 | if (err) | |
370 | goto err_req_irq; | |
371 | ||
372 | ssb_extif_gpio_intmask(&bus->extif, ~0, 0); | |
373 | ||
374 | return 0; | |
375 | ||
376 | err_req_irq: | |
377 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
378 | int irq = irq_find_mapping(bus->irq_domain, gpio); | |
379 | ||
380 | irq_dispose_mapping(irq); | |
381 | } | |
382 | irq_domain_remove(bus->irq_domain); | |
383 | err_irq_domain: | |
384 | return err; | |
385 | } | |
386 | ||
387 | static void ssb_gpio_irq_extif_domain_exit(struct ssb_bus *bus) | |
388 | { | |
389 | struct ssb_extif *extif = &bus->extif; | |
390 | struct gpio_chip *chip = &bus->gpio; | |
391 | int gpio; | |
392 | ||
393 | if (bus->bustype != SSB_BUSTYPE_SSB) | |
394 | return; | |
395 | ||
396 | free_irq(ssb_mips_irq(bus->extif.dev) + 2, extif); | |
397 | for (gpio = 0; gpio < chip->ngpio; gpio++) { | |
398 | int irq = irq_find_mapping(bus->irq_domain, gpio); | |
399 | ||
400 | irq_dispose_mapping(irq); | |
401 | } | |
402 | irq_domain_remove(bus->irq_domain); | |
a6ca2e10 | 403 | } |
7c1bc0da RM |
404 | #else |
405 | static int ssb_gpio_irq_extif_domain_init(struct ssb_bus *bus) | |
406 | { | |
407 | return 0; | |
408 | } | |
409 | ||
410 | static void ssb_gpio_irq_extif_domain_exit(struct ssb_bus *bus) | |
411 | { | |
412 | } | |
413 | #endif | |
a6ca2e10 | 414 | |
ec43b08b HM |
415 | static int ssb_gpio_extif_init(struct ssb_bus *bus) |
416 | { | |
417 | struct gpio_chip *chip = &bus->gpio; | |
7c1bc0da | 418 | int err; |
ec43b08b HM |
419 | |
420 | chip->label = "ssb_extif_gpio"; | |
421 | chip->owner = THIS_MODULE; | |
422 | chip->get = ssb_gpio_extif_get_value; | |
423 | chip->set = ssb_gpio_extif_set_value; | |
424 | chip->direction_input = ssb_gpio_extif_direction_input; | |
425 | chip->direction_output = ssb_gpio_extif_direction_output; | |
7c1bc0da RM |
426 | #if IS_ENABLED(CONFIG_SSB_EMBEDDED) |
427 | chip->to_irq = ssb_gpio_to_irq; | |
428 | #endif | |
ec43b08b HM |
429 | chip->ngpio = 5; |
430 | /* There is just one SoC in one device and its GPIO addresses should be | |
431 | * deterministic to address them more easily. The other buses could get | |
432 | * a random base number. */ | |
433 | if (bus->bustype == SSB_BUSTYPE_SSB) | |
434 | chip->base = 0; | |
435 | else | |
436 | chip->base = -1; | |
437 | ||
7c1bc0da RM |
438 | err = ssb_gpio_irq_extif_domain_init(bus); |
439 | if (err) | |
440 | return err; | |
441 | ||
442 | err = gpiochip_add(chip); | |
443 | if (err) { | |
444 | ssb_gpio_irq_extif_domain_exit(bus); | |
445 | return err; | |
446 | } | |
447 | ||
448 | return 0; | |
ec43b08b HM |
449 | } |
450 | ||
451 | #else | |
452 | static int ssb_gpio_extif_init(struct ssb_bus *bus) | |
453 | { | |
454 | return -ENOTSUPP; | |
455 | } | |
456 | #endif | |
457 | ||
7c1bc0da RM |
458 | /************************************************** |
459 | * Init | |
460 | **************************************************/ | |
461 | ||
ec43b08b HM |
462 | int ssb_gpio_init(struct ssb_bus *bus) |
463 | { | |
464 | if (ssb_chipco_available(&bus->chipco)) | |
465 | return ssb_gpio_chipco_init(bus); | |
466 | else if (ssb_extif_available(&bus->extif)) | |
467 | return ssb_gpio_extif_init(bus); | |
468 | else | |
469 | SSB_WARN_ON(1); | |
470 | ||
471 | return -1; | |
472 | } | |
600485ed HM |
473 | |
474 | int ssb_gpio_unregister(struct ssb_bus *bus) | |
475 | { | |
476 | if (ssb_chipco_available(&bus->chipco) || | |
477 | ssb_extif_available(&bus->extif)) { | |
88d5e520 | 478 | gpiochip_remove(&bus->gpio); |
479 | return 0; | |
600485ed HM |
480 | } else { |
481 | SSB_WARN_ON(1); | |
482 | } | |
483 | ||
484 | return -1; | |
485 | } |