xref: /openbmc/u-boot/drivers/gpio/kw_gpio.c (revision e8f80a5a)
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * arch/arm/plat-orion/gpio.c
4  *
5  * Marvell Orion SoC GPIO handling.
6  */
7 
8 /*
9  * Based on (mostly copied from) plat-orion based Linux 2.6 kernel driver.
10  * Removed orion_gpiochip struct and kernel level irq handling.
11  *
12  * Dieter Kiermaier dk-arm-linux@gmx.de
13  */
14 
15 #include <common.h>
16 #include <linux/bitops.h>
17 #include <asm/io.h>
18 #include <asm/arch/soc.h>
19 #include <asm/arch/gpio.h>
20 
21 static unsigned long gpio_valid_input[BITS_TO_LONGS(GPIO_MAX)];
22 static unsigned long gpio_valid_output[BITS_TO_LONGS(GPIO_MAX)];
23 
__set_direction(unsigned pin,int input)24 void __set_direction(unsigned pin, int input)
25 {
26 	u32 u;
27 
28 	u = readl(GPIO_IO_CONF(pin));
29 	if (input)
30 		u |= 1 << (pin & 31);
31 	else
32 		u &= ~(1 << (pin & 31));
33 	writel(u, GPIO_IO_CONF(pin));
34 
35 	u = readl(GPIO_IO_CONF(pin));
36 }
37 
__set_level(unsigned pin,int high)38 static void __set_level(unsigned pin, int high)
39 {
40 	u32 u;
41 
42 	u = readl(GPIO_OUT(pin));
43 	if (high)
44 		u |= 1 << (pin & 31);
45 	else
46 		u &= ~(1 << (pin & 31));
47 	writel(u, GPIO_OUT(pin));
48 }
49 
__set_blinking(unsigned pin,int blink)50 static void __set_blinking(unsigned pin, int blink)
51 {
52 	u32 u;
53 
54 	u = readl(GPIO_BLINK_EN(pin));
55 	if (blink)
56 		u |= 1 << (pin & 31);
57 	else
58 		u &= ~(1 << (pin & 31));
59 	writel(u, GPIO_BLINK_EN(pin));
60 }
61 
kw_gpio_is_valid(unsigned pin,int mode)62 int kw_gpio_is_valid(unsigned pin, int mode)
63 {
64 	if (pin < GPIO_MAX) {
65 		if ((mode & GPIO_INPUT_OK) && !test_bit(pin, gpio_valid_input))
66 			goto err_out;
67 
68 		if ((mode & GPIO_OUTPUT_OK) && !test_bit(pin, gpio_valid_output))
69 			goto err_out;
70 		return 0;
71 	}
72 
73 err_out:
74 		printf("%s: invalid GPIO %d\n", __func__, pin);
75 	return 1;
76 }
77 
kw_gpio_set_valid(unsigned pin,int mode)78 void kw_gpio_set_valid(unsigned pin, int mode)
79 {
80 	if (mode == 1)
81 		mode = GPIO_INPUT_OK | GPIO_OUTPUT_OK;
82 	if (mode & GPIO_INPUT_OK)
83 		__set_bit(pin, gpio_valid_input);
84 	else
85 		__clear_bit(pin, gpio_valid_input);
86 	if (mode & GPIO_OUTPUT_OK)
87 		__set_bit(pin, gpio_valid_output);
88 	else
89 		__clear_bit(pin, gpio_valid_output);
90 }
91 /*
92  * GENERIC_GPIO primitives.
93  */
kw_gpio_direction_input(unsigned pin)94 int kw_gpio_direction_input(unsigned pin)
95 {
96 	if (kw_gpio_is_valid(pin, GPIO_INPUT_OK) != 0)
97 		return 1;
98 
99 	/* Configure GPIO direction. */
100 	__set_direction(pin, 1);
101 
102 	return 0;
103 }
104 
kw_gpio_direction_output(unsigned pin,int value)105 int kw_gpio_direction_output(unsigned pin, int value)
106 {
107 	if (kw_gpio_is_valid(pin, GPIO_OUTPUT_OK) != 0)
108 	{
109 		printf("%s: invalid GPIO %d\n", __func__, pin);
110 		return 1;
111 	}
112 
113 	__set_blinking(pin, 0);
114 
115 	/* Configure GPIO output value. */
116 	__set_level(pin, value);
117 
118 	/* Configure GPIO direction. */
119 	__set_direction(pin, 0);
120 
121 	return 0;
122 }
123 
kw_gpio_get_value(unsigned pin)124 int kw_gpio_get_value(unsigned pin)
125 {
126 	int val;
127 
128 	if (readl(GPIO_IO_CONF(pin)) & (1 << (pin & 31)))
129 		val = readl(GPIO_DATA_IN(pin)) ^ readl(GPIO_IN_POL(pin));
130 	else
131 		val = readl(GPIO_OUT(pin));
132 
133 	return (val >> (pin & 31)) & 1;
134 }
135 
kw_gpio_set_value(unsigned pin,int value)136 void kw_gpio_set_value(unsigned pin, int value)
137 {
138 	/* Configure GPIO output value. */
139 	__set_level(pin, value);
140 }
141 
kw_gpio_set_blink(unsigned pin,int blink)142 void kw_gpio_set_blink(unsigned pin, int blink)
143 {
144 	/* Set output value to zero. */
145 	__set_level(pin, 0);
146 
147 	/* Set blinking. */
148 	__set_blinking(pin, blink);
149 }
150