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