Commit | Line | Data |
---|---|---|
45528e38 DB |
1 | /* |
2 | * linux/arch/arm/mach-sa1100/gpio.c | |
3 | * | |
4 | * Generic SA-1100 GPIO handling | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 as | |
8 | * published by the Free Software Foundation. | |
9 | */ | |
2f8163ba | 10 | #include <linux/gpio.h> |
45528e38 DB |
11 | #include <linux/init.h> |
12 | #include <linux/module.h> | |
13 | ||
a09e64fb | 14 | #include <mach/hardware.h> |
45528e38 DB |
15 | |
16 | static int sa1100_gpio_get(struct gpio_chip *chip, unsigned offset) | |
17 | { | |
18 | return GPLR & GPIO_GPIO(offset); | |
19 | } | |
20 | ||
21 | static void sa1100_gpio_set(struct gpio_chip *chip, unsigned offset, int value) | |
22 | { | |
23 | if (value) | |
24 | GPSR = GPIO_GPIO(offset); | |
25 | else | |
26 | GPCR = GPIO_GPIO(offset); | |
27 | } | |
28 | ||
29 | static int sa1100_direction_input(struct gpio_chip *chip, unsigned offset) | |
30 | { | |
31 | unsigned long flags; | |
32 | ||
33 | local_irq_save(flags); | |
34 | GPDR &= ~GPIO_GPIO(offset); | |
35 | local_irq_restore(flags); | |
36 | return 0; | |
37 | } | |
38 | ||
39 | static int sa1100_direction_output(struct gpio_chip *chip, unsigned offset, int value) | |
40 | { | |
41 | unsigned long flags; | |
42 | ||
43 | local_irq_save(flags); | |
44 | sa1100_gpio_set(chip, offset, value); | |
45 | GPDR |= GPIO_GPIO(offset); | |
46 | local_irq_restore(flags); | |
47 | return 0; | |
48 | } | |
49 | ||
50 | static struct gpio_chip sa1100_gpio_chip = { | |
51 | .label = "gpio", | |
52 | .direction_input = sa1100_direction_input, | |
53 | .direction_output = sa1100_direction_output, | |
54 | .set = sa1100_gpio_set, | |
55 | .get = sa1100_gpio_get, | |
56 | .base = 0, | |
57 | .ngpio = GPIO_MAX + 1, | |
58 | }; | |
59 | ||
60 | void __init sa1100_init_gpio(void) | |
61 | { | |
62 | gpiochip_add(&sa1100_gpio_chip); | |
63 | } |