]>
git.ipfire.org Git - people/ms/u-boot.git/blob - drivers/gpio/kw_gpio.c
2 * arch/arm/plat-orion/gpio.c
4 * Marvell Orion SoC GPIO handling.
6 * SPDX-License-Identifier: GPL-2.0+
10 * Based on (mostly copied from) plat-orion based Linux 2.6 kernel driver.
11 * Removed orion_gpiochip struct and kernel level irq handling.
13 * Dieter Kiermaier dk-arm-linux@gmx.de
17 #include <asm/bitops.h>
19 #include <asm/arch/soc.h>
20 #include <asm/arch/gpio.h>
22 static unsigned long gpio_valid_input
[BITS_TO_LONGS(GPIO_MAX
)];
23 static unsigned long gpio_valid_output
[BITS_TO_LONGS(GPIO_MAX
)];
25 void __set_direction(unsigned pin
, int input
)
29 u
= readl(GPIO_IO_CONF(pin
));
33 u
&= ~(1 << (pin
& 31));
34 writel(u
, GPIO_IO_CONF(pin
));
36 u
= readl(GPIO_IO_CONF(pin
));
39 static void __set_level(unsigned pin
, int high
)
43 u
= readl(GPIO_OUT(pin
));
47 u
&= ~(1 << (pin
& 31));
48 writel(u
, GPIO_OUT(pin
));
51 static void __set_blinking(unsigned pin
, int blink
)
55 u
= readl(GPIO_BLINK_EN(pin
));
59 u
&= ~(1 << (pin
& 31));
60 writel(u
, GPIO_BLINK_EN(pin
));
63 int kw_gpio_is_valid(unsigned pin
, int mode
)
66 if ((mode
& GPIO_INPUT_OK
) && !test_bit(pin
, gpio_valid_input
))
69 if ((mode
& GPIO_OUTPUT_OK
) && !test_bit(pin
, gpio_valid_output
))
75 printf("%s: invalid GPIO %d\n", __func__
, pin
);
79 void kw_gpio_set_valid(unsigned pin
, int mode
)
82 mode
= GPIO_INPUT_OK
| GPIO_OUTPUT_OK
;
83 if (mode
& GPIO_INPUT_OK
)
84 __set_bit(pin
, gpio_valid_input
);
86 __clear_bit(pin
, gpio_valid_input
);
87 if (mode
& GPIO_OUTPUT_OK
)
88 __set_bit(pin
, gpio_valid_output
);
90 __clear_bit(pin
, gpio_valid_output
);
93 * GENERIC_GPIO primitives.
95 int kw_gpio_direction_input(unsigned pin
)
97 if (kw_gpio_is_valid(pin
, GPIO_INPUT_OK
) != 0)
100 /* Configure GPIO direction. */
101 __set_direction(pin
, 1);
106 int kw_gpio_direction_output(unsigned pin
, int value
)
108 if (kw_gpio_is_valid(pin
, GPIO_OUTPUT_OK
) != 0)
110 printf("%s: invalid GPIO %d\n", __func__
, pin
);
114 __set_blinking(pin
, 0);
116 /* Configure GPIO output value. */
117 __set_level(pin
, value
);
119 /* Configure GPIO direction. */
120 __set_direction(pin
, 0);
125 int kw_gpio_get_value(unsigned pin
)
129 if (readl(GPIO_IO_CONF(pin
)) & (1 << (pin
& 31)))
130 val
= readl(GPIO_DATA_IN(pin
)) ^ readl(GPIO_IN_POL(pin
));
132 val
= readl(GPIO_OUT(pin
));
134 return (val
>> (pin
& 31)) & 1;
137 void kw_gpio_set_value(unsigned pin
, int value
)
139 /* Configure GPIO output value. */
140 __set_level(pin
, value
);
143 void kw_gpio_set_blink(unsigned pin
, int blink
)
145 /* Set output value to zero. */
149 __set_blinking(pin
, blink
);