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.
12 * Based on (mostly copied from) plat-orion based Linux 2.6 kernel driver.
13 * Removed orion_gpiochip struct and kernel level irq handling.
15 * Dieter Kiermaier dk-arm-linux@gmx.de
19 #include <asm/bitops.h>
20 #include <asm/arch/kirkwood.h>
21 #include <asm/arch/gpio.h>
23 static unsigned long gpio_valid_input[BITS_TO_LONGS(GPIO_MAX)];
24 static unsigned long gpio_valid_output[BITS_TO_LONGS(GPIO_MAX)];
26 void __set_direction(unsigned pin, int input)
30 u = readl(GPIO_IO_CONF(pin));
34 u &= ~(1 << (pin & 31));
35 writel(u, GPIO_IO_CONF(pin));
37 u = readl(GPIO_IO_CONF(pin));
40 void __set_level(unsigned pin, int high)
44 u = readl(GPIO_OUT(pin));
48 u &= ~(1 << (pin & 31));
49 writel(u, GPIO_OUT(pin));
52 void __set_blinking(unsigned pin, int blink)
56 u = readl(GPIO_BLINK_EN(pin));
60 u &= ~(1 << (pin & 31));
61 writel(u, GPIO_BLINK_EN(pin));
64 int kw_gpio_is_valid(unsigned pin, int mode)
67 if ((mode & GPIO_INPUT_OK) && !test_bit(pin, gpio_valid_input))
70 if ((mode & GPIO_OUTPUT_OK) && !test_bit(pin, gpio_valid_output))
76 printf("%s: invalid GPIO %d\n", __func__, pin);
80 void kw_gpio_set_valid(unsigned pin, int mode)
83 mode = GPIO_INPUT_OK | GPIO_OUTPUT_OK;
84 if (mode & GPIO_INPUT_OK)
85 __set_bit(pin, gpio_valid_input);
87 __clear_bit(pin, gpio_valid_input);
88 if (mode & GPIO_OUTPUT_OK)
89 __set_bit(pin, gpio_valid_output);
91 __clear_bit(pin, gpio_valid_output);
94 * GENERIC_GPIO primitives.
96 int kw_gpio_direction_input(unsigned pin)
98 if (!kw_gpio_is_valid(pin, GPIO_INPUT_OK))
101 /* Configure GPIO direction. */
102 __set_direction(pin, 1);
107 int kw_gpio_direction_output(unsigned pin, int value)
109 if (kw_gpio_is_valid(pin, GPIO_OUTPUT_OK) != 0)
111 printf("%s: invalid GPIO %d\n", __func__, pin);
115 __set_blinking(pin, 0);
117 /* Configure GPIO output value. */
118 __set_level(pin, value);
120 /* Configure GPIO direction. */
121 __set_direction(pin, 0);
126 int kw_gpio_get_value(unsigned pin)
130 if (readl(GPIO_IO_CONF(pin)) & (1 << (pin & 31)))
131 val = readl(GPIO_DATA_IN(pin)) ^ readl(GPIO_IN_POL(pin));
133 val = readl(GPIO_OUT(pin));
135 return (val >> (pin & 31)) & 1;
138 void kw_gpio_set_value(unsigned pin, int value)
140 /* Configure GPIO output value. */
141 __set_level(pin, value);
144 void kw_gpio_set_blink(unsigned pin, int blink)
146 /* Set output value to zero. */
150 __set_blinking(pin, blink);