2 * arch/arm/plat-orion/gpio.c
4 * Marvell Orion SoC GPIO handling.
6 * This file is licensed under the terms of the GNU General Public
7 * License version 2. This program is licensed "as is" without any
8 * warranty of any kind, whether express or implied.
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/irq.h>
16 #include <linux/irqdomain.h>
17 #include <linux/module.h>
18 #include <linux/spinlock.h>
19 #include <linux/bitops.h>
21 #include <linux/gpio.h>
22 #include <linux/leds.h>
24 #include <linux/of_irq.h>
25 #include <linux/of_address.h>
26 #include <plat/orion-gpio.h>
29 * GPIO unit register offsets.
31 #define GPIO_OUT_OFF 0x0000
32 #define GPIO_IO_CONF_OFF 0x0004
33 #define GPIO_BLINK_EN_OFF 0x0008
34 #define GPIO_IN_POL_OFF 0x000c
35 #define GPIO_DATA_IN_OFF 0x0010
36 #define GPIO_EDGE_CAUSE_OFF 0x0014
37 #define GPIO_EDGE_MASK_OFF 0x0018
38 #define GPIO_LEVEL_MASK_OFF 0x001c
40 struct orion_gpio_chip
{
41 struct gpio_chip chip
;
44 unsigned long valid_input
;
45 unsigned long valid_output
;
47 int secondary_irq_base
;
48 struct irq_domain
*domain
;
51 static void __iomem
*GPIO_OUT(struct orion_gpio_chip
*ochip
)
53 return ochip
->base
+ GPIO_OUT_OFF
;
56 static void __iomem
*GPIO_IO_CONF(struct orion_gpio_chip
*ochip
)
58 return ochip
->base
+ GPIO_IO_CONF_OFF
;
61 static void __iomem
*GPIO_BLINK_EN(struct orion_gpio_chip
*ochip
)
63 return ochip
->base
+ GPIO_BLINK_EN_OFF
;
66 static void __iomem
*GPIO_IN_POL(struct orion_gpio_chip
*ochip
)
68 return ochip
->base
+ GPIO_IN_POL_OFF
;
71 static void __iomem
*GPIO_DATA_IN(struct orion_gpio_chip
*ochip
)
73 return ochip
->base
+ GPIO_DATA_IN_OFF
;
76 static void __iomem
*GPIO_EDGE_CAUSE(struct orion_gpio_chip
*ochip
)
78 return ochip
->base
+ GPIO_EDGE_CAUSE_OFF
;
81 static void __iomem
*GPIO_EDGE_MASK(struct orion_gpio_chip
*ochip
)
83 return ochip
->base
+ ochip
->mask_offset
+ GPIO_EDGE_MASK_OFF
;
86 static void __iomem
*GPIO_LEVEL_MASK(struct orion_gpio_chip
*ochip
)
88 return ochip
->base
+ ochip
->mask_offset
+ GPIO_LEVEL_MASK_OFF
;
92 static struct orion_gpio_chip orion_gpio_chips
[2];
93 static int orion_gpio_chip_count
;
96 __set_direction(struct orion_gpio_chip
*ochip
, unsigned pin
, int input
)
100 u
= readl(GPIO_IO_CONF(ochip
));
105 writel(u
, GPIO_IO_CONF(ochip
));
108 static void __set_level(struct orion_gpio_chip
*ochip
, unsigned pin
, int high
)
112 u
= readl(GPIO_OUT(ochip
));
117 writel(u
, GPIO_OUT(ochip
));
121 __set_blinking(struct orion_gpio_chip
*ochip
, unsigned pin
, int blink
)
125 u
= readl(GPIO_BLINK_EN(ochip
));
130 writel(u
, GPIO_BLINK_EN(ochip
));
134 orion_gpio_is_valid(struct orion_gpio_chip
*ochip
, unsigned pin
, int mode
)
136 if (pin
>= ochip
->chip
.ngpio
)
139 if ((mode
& GPIO_INPUT_OK
) && !test_bit(pin
, &ochip
->valid_input
))
142 if ((mode
& GPIO_OUTPUT_OK
) && !test_bit(pin
, &ochip
->valid_output
))
148 pr_debug("%s: invalid GPIO %d\n", __func__
, pin
);
155 static int orion_gpio_request(struct gpio_chip
*chip
, unsigned pin
)
157 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
159 if (orion_gpio_is_valid(ochip
, pin
, GPIO_INPUT_OK
) ||
160 orion_gpio_is_valid(ochip
, pin
, GPIO_OUTPUT_OK
))
166 static int orion_gpio_direction_input(struct gpio_chip
*chip
, unsigned pin
)
168 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
171 if (!orion_gpio_is_valid(ochip
, pin
, GPIO_INPUT_OK
))
174 spin_lock_irqsave(&ochip
->lock
, flags
);
175 __set_direction(ochip
, pin
, 1);
176 spin_unlock_irqrestore(&ochip
->lock
, flags
);
181 static int orion_gpio_get(struct gpio_chip
*chip
, unsigned pin
)
183 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
186 if (readl(GPIO_IO_CONF(ochip
)) & (1 << pin
)) {
187 val
= readl(GPIO_DATA_IN(ochip
)) ^ readl(GPIO_IN_POL(ochip
));
189 val
= readl(GPIO_OUT(ochip
));
192 return (val
>> pin
) & 1;
196 orion_gpio_direction_output(struct gpio_chip
*chip
, unsigned pin
, int value
)
198 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
201 if (!orion_gpio_is_valid(ochip
, pin
, GPIO_OUTPUT_OK
))
204 spin_lock_irqsave(&ochip
->lock
, flags
);
205 __set_blinking(ochip
, pin
, 0);
206 __set_level(ochip
, pin
, value
);
207 __set_direction(ochip
, pin
, 0);
208 spin_unlock_irqrestore(&ochip
->lock
, flags
);
213 static void orion_gpio_set(struct gpio_chip
*chip
, unsigned pin
, int value
)
215 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
218 spin_lock_irqsave(&ochip
->lock
, flags
);
219 __set_level(ochip
, pin
, value
);
220 spin_unlock_irqrestore(&ochip
->lock
, flags
);
223 static int orion_gpio_to_irq(struct gpio_chip
*chip
, unsigned pin
)
225 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
227 return irq_create_mapping(ochip
->domain
,
228 ochip
->secondary_irq_base
+ pin
);
232 * Orion-specific GPIO API extensions.
234 static struct orion_gpio_chip
*orion_gpio_chip_find(int pin
)
238 for (i
= 0; i
< orion_gpio_chip_count
; i
++) {
239 struct orion_gpio_chip
*ochip
= orion_gpio_chips
+ i
;
240 struct gpio_chip
*chip
= &ochip
->chip
;
242 if (pin
>= chip
->base
&& pin
< chip
->base
+ chip
->ngpio
)
249 void __init
orion_gpio_set_unused(unsigned pin
)
251 struct orion_gpio_chip
*ochip
= orion_gpio_chip_find(pin
);
256 pin
-= ochip
->chip
.base
;
258 /* Configure as output, drive low. */
259 __set_level(ochip
, pin
, 0);
260 __set_direction(ochip
, pin
, 0);
263 void __init
orion_gpio_set_valid(unsigned pin
, int mode
)
265 struct orion_gpio_chip
*ochip
= orion_gpio_chip_find(pin
);
270 pin
-= ochip
->chip
.base
;
273 mode
= GPIO_INPUT_OK
| GPIO_OUTPUT_OK
;
275 if (mode
& GPIO_INPUT_OK
)
276 __set_bit(pin
, &ochip
->valid_input
);
278 __clear_bit(pin
, &ochip
->valid_input
);
280 if (mode
& GPIO_OUTPUT_OK
)
281 __set_bit(pin
, &ochip
->valid_output
);
283 __clear_bit(pin
, &ochip
->valid_output
);
286 void orion_gpio_set_blink(unsigned pin
, int blink
)
288 struct orion_gpio_chip
*ochip
= orion_gpio_chip_find(pin
);
294 spin_lock_irqsave(&ochip
->lock
, flags
);
295 __set_level(ochip
, pin
& 31, 0);
296 __set_blinking(ochip
, pin
& 31, blink
);
297 spin_unlock_irqrestore(&ochip
->lock
, flags
);
299 EXPORT_SYMBOL(orion_gpio_set_blink
);
301 #define ORION_BLINK_HALF_PERIOD 100 /* ms */
303 int orion_gpio_led_blink_set(struct gpio_desc
*desc
, int state
,
304 unsigned long *delay_on
, unsigned long *delay_off
)
306 unsigned gpio
= desc_to_gpio(desc
);
308 if (delay_on
&& delay_off
&& !*delay_on
&& !*delay_off
)
309 *delay_on
= *delay_off
= ORION_BLINK_HALF_PERIOD
;
312 case GPIO_LED_NO_BLINK_LOW
:
313 case GPIO_LED_NO_BLINK_HIGH
:
314 orion_gpio_set_blink(gpio
, 0);
315 gpio_set_value(gpio
, state
);
318 orion_gpio_set_blink(gpio
, 1);
322 EXPORT_SYMBOL_GPL(orion_gpio_led_blink_set
);
325 /*****************************************************************************
328 * GPIO_IN_POL register controls whether GPIO_DATA_IN will hold the same
329 * value of the line or the opposite value.
331 * Level IRQ handlers: DATA_IN is used directly as cause register.
332 * Interrupt are masked by LEVEL_MASK registers.
333 * Edge IRQ handlers: Change in DATA_IN are latched in EDGE_CAUSE.
334 * Interrupt are masked by EDGE_MASK registers.
335 * Both-edge handlers: Similar to regular Edge handlers, but also swaps
336 * the polarity to catch the next line transaction.
337 * This is a race condition that might not perfectly
338 * work on some use cases.
340 * Every eight GPIO lines are grouped (OR'ed) before going up to main
344 * data-in /--------| |-----| |----\
345 * -----| |----- ---- to main cause reg
346 * X \----------------| |----/
347 * polarity LEVEL mask
349 ****************************************************************************/
351 static int gpio_irq_set_type(struct irq_data
*d
, u32 type
)
353 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
354 struct irq_chip_type
*ct
= irq_data_get_chip_type(d
);
355 struct orion_gpio_chip
*ochip
= gc
->private;
359 pin
= d
->hwirq
- ochip
->secondary_irq_base
;
361 u
= readl(GPIO_IO_CONF(ochip
)) & (1 << pin
);
366 type
&= IRQ_TYPE_SENSE_MASK
;
367 if (type
== IRQ_TYPE_NONE
)
370 /* Check if we need to change chip and handler */
371 if (!(ct
->type
& type
))
372 if (irq_setup_alt_chip(d
, type
))
376 * Configure interrupt polarity.
378 if (type
== IRQ_TYPE_EDGE_RISING
|| type
== IRQ_TYPE_LEVEL_HIGH
) {
379 u
= readl(GPIO_IN_POL(ochip
));
381 writel(u
, GPIO_IN_POL(ochip
));
382 } else if (type
== IRQ_TYPE_EDGE_FALLING
|| type
== IRQ_TYPE_LEVEL_LOW
) {
383 u
= readl(GPIO_IN_POL(ochip
));
385 writel(u
, GPIO_IN_POL(ochip
));
386 } else if (type
== IRQ_TYPE_EDGE_BOTH
) {
389 v
= readl(GPIO_IN_POL(ochip
)) ^ readl(GPIO_DATA_IN(ochip
));
392 * set initial polarity based on current input level
394 u
= readl(GPIO_IN_POL(ochip
));
396 u
|= 1 << pin
; /* falling */
398 u
&= ~(1 << pin
); /* rising */
399 writel(u
, GPIO_IN_POL(ochip
));
404 static void gpio_irq_handler(struct irq_desc
*desc
)
406 struct orion_gpio_chip
*ochip
= irq_desc_get_handler_data(desc
);
413 cause
= readl(GPIO_DATA_IN(ochip
)) & readl(GPIO_LEVEL_MASK(ochip
));
414 cause
|= readl(GPIO_EDGE_CAUSE(ochip
)) & readl(GPIO_EDGE_MASK(ochip
));
416 for (i
= 0; i
< ochip
->chip
.ngpio
; i
++) {
419 irq
= ochip
->secondary_irq_base
+ i
;
421 if (!(cause
& (1 << i
)))
424 type
= irq_get_trigger_type(irq
);
425 if ((type
& IRQ_TYPE_SENSE_MASK
) == IRQ_TYPE_EDGE_BOTH
) {
426 /* Swap polarity (race with GPIO line) */
429 polarity
= readl(GPIO_IN_POL(ochip
));
431 writel(polarity
, GPIO_IN_POL(ochip
));
433 generic_handle_irq(irq
);
437 #ifdef CONFIG_DEBUG_FS
438 #include <linux/seq_file.h>
440 static void orion_gpio_dbg_show(struct seq_file
*s
, struct gpio_chip
*chip
)
443 struct orion_gpio_chip
*ochip
= gpiochip_get_data(chip
);
444 u32 out
, io_conf
, blink
, in_pol
, data_in
, cause
, edg_msk
, lvl_msk
;
448 out
= readl_relaxed(GPIO_OUT(ochip
));
449 io_conf
= readl_relaxed(GPIO_IO_CONF(ochip
));
450 blink
= readl_relaxed(GPIO_BLINK_EN(ochip
));
451 in_pol
= readl_relaxed(GPIO_IN_POL(ochip
));
452 data_in
= readl_relaxed(GPIO_DATA_IN(ochip
));
453 cause
= readl_relaxed(GPIO_EDGE_CAUSE(ochip
));
454 edg_msk
= readl_relaxed(GPIO_EDGE_MASK(ochip
));
455 lvl_msk
= readl_relaxed(GPIO_LEVEL_MASK(ochip
));
457 for_each_requested_gpio(chip
, i
, label
) {
462 is_out
= !(io_conf
& msk
);
464 seq_printf(s
, " gpio-%-3d (%-20.20s)", chip
->base
+ i
, label
);
467 seq_printf(s
, " out %s %s\n",
468 out
& msk
? "hi" : "lo",
469 blink
& msk
? "(blink )" : "");
473 seq_printf(s
, " in %s (act %s) - IRQ",
474 (data_in
^ in_pol
) & msk
? "hi" : "lo",
475 in_pol
& msk
? "lo" : "hi");
476 if (!((edg_msk
| lvl_msk
) & msk
)) {
477 seq_puts(s
, " disabled\n");
481 seq_puts(s
, " edge ");
483 seq_puts(s
, " level");
484 seq_printf(s
, " (%s)\n", cause
& msk
? "pending" : "clear ");
488 #define orion_gpio_dbg_show NULL
491 static void orion_gpio_unmask_irq(struct irq_data
*d
)
493 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
494 struct irq_chip_type
*ct
= irq_data_get_chip_type(d
);
499 reg_val
= irq_reg_readl(gc
, ct
->regs
.mask
);
501 irq_reg_writel(gc
, reg_val
, ct
->regs
.mask
);
505 static void orion_gpio_mask_irq(struct irq_data
*d
)
507 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
508 struct irq_chip_type
*ct
= irq_data_get_chip_type(d
);
513 reg_val
= irq_reg_readl(gc
, ct
->regs
.mask
);
515 irq_reg_writel(gc
, reg_val
, ct
->regs
.mask
);
519 void __init
orion_gpio_init(struct device_node
*np
,
520 int gpio_base
, int ngpio
,
521 void __iomem
*base
, int mask_offset
,
522 int secondary_irq_base
,
525 struct orion_gpio_chip
*ochip
;
526 struct irq_chip_generic
*gc
;
527 struct irq_chip_type
*ct
;
531 if (orion_gpio_chip_count
== ARRAY_SIZE(orion_gpio_chips
))
534 snprintf(gc_label
, sizeof(gc_label
), "orion_gpio%d",
535 orion_gpio_chip_count
);
537 ochip
= orion_gpio_chips
+ orion_gpio_chip_count
;
538 ochip
->chip
.label
= kstrdup(gc_label
, GFP_KERNEL
);
539 ochip
->chip
.request
= orion_gpio_request
;
540 ochip
->chip
.direction_input
= orion_gpio_direction_input
;
541 ochip
->chip
.get
= orion_gpio_get
;
542 ochip
->chip
.direction_output
= orion_gpio_direction_output
;
543 ochip
->chip
.set
= orion_gpio_set
;
544 ochip
->chip
.to_irq
= orion_gpio_to_irq
;
545 ochip
->chip
.base
= gpio_base
;
546 ochip
->chip
.ngpio
= ngpio
;
547 ochip
->chip
.can_sleep
= 0;
549 ochip
->chip
.of_node
= np
;
551 ochip
->chip
.dbg_show
= orion_gpio_dbg_show
;
553 spin_lock_init(&ochip
->lock
);
554 ochip
->base
= (void __iomem
*)base
;
555 ochip
->valid_input
= 0;
556 ochip
->valid_output
= 0;
557 ochip
->mask_offset
= mask_offset
;
558 ochip
->secondary_irq_base
= secondary_irq_base
;
560 gpiochip_add_data(&ochip
->chip
, ochip
);
563 * Mask and clear GPIO interrupts.
565 writel(0, GPIO_EDGE_CAUSE(ochip
));
566 writel(0, GPIO_EDGE_MASK(ochip
));
567 writel(0, GPIO_LEVEL_MASK(ochip
));
569 /* Setup the interrupt handlers. Each chip can have up to 4
570 * interrupt handlers, with each handler dealing with 8 GPIO
573 for (i
= 0; i
< 4; i
++) {
575 irq_set_chained_handler_and_data(irqs
[i
],
581 gc
= irq_alloc_generic_chip("orion_gpio_irq", 2,
583 ochip
->base
, handle_level_irq
);
586 ct
->regs
.mask
= ochip
->mask_offset
+ GPIO_LEVEL_MASK_OFF
;
587 ct
->type
= IRQ_TYPE_LEVEL_HIGH
| IRQ_TYPE_LEVEL_LOW
;
588 ct
->chip
.irq_mask
= orion_gpio_mask_irq
;
589 ct
->chip
.irq_unmask
= orion_gpio_unmask_irq
;
590 ct
->chip
.irq_set_type
= gpio_irq_set_type
;
591 ct
->chip
.name
= ochip
->chip
.label
;
594 ct
->regs
.mask
= ochip
->mask_offset
+ GPIO_EDGE_MASK_OFF
;
595 ct
->regs
.ack
= GPIO_EDGE_CAUSE_OFF
;
596 ct
->type
= IRQ_TYPE_EDGE_RISING
| IRQ_TYPE_EDGE_FALLING
;
597 ct
->chip
.irq_ack
= irq_gc_ack_clr_bit
;
598 ct
->chip
.irq_mask
= orion_gpio_mask_irq
;
599 ct
->chip
.irq_unmask
= orion_gpio_unmask_irq
;
600 ct
->chip
.irq_set_type
= gpio_irq_set_type
;
601 ct
->handler
= handle_edge_irq
;
602 ct
->chip
.name
= ochip
->chip
.label
;
604 irq_setup_generic_chip(gc
, IRQ_MSK(ngpio
), IRQ_GC_INIT_MASK_CACHE
,
605 IRQ_NOREQUEST
, IRQ_LEVEL
| IRQ_NOPROBE
);
607 /* Setup irq domain on top of the generic chip. */
608 ochip
->domain
= irq_domain_add_legacy(np
,
610 ochip
->secondary_irq_base
,
611 ochip
->secondary_irq_base
,
612 &irq_domain_simple_ops
,
615 panic("%s: couldn't allocate irq domain (DT).\n",
618 orion_gpio_chip_count
++;