1
2
3
4
5
6
7
8
9
10
11
12
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
21static unsigned long gpio_valid_input[BITS_TO_LONGS(GPIO_MAX)];
22static unsigned long gpio_valid_output[BITS_TO_LONGS(GPIO_MAX)];
23
24void __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
38static 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
50static 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
62int 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
73err_out:
74 printf("%s: invalid GPIO %d\n", __func__, pin);
75 return 1;
76}
77
78void 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
93
94int kw_gpio_direction_input(unsigned pin)
95{
96 if (kw_gpio_is_valid(pin, GPIO_INPUT_OK) != 0)
97 return 1;
98
99
100 __set_direction(pin, 1);
101
102 return 0;
103}
104
105int 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
116 __set_level(pin, value);
117
118
119 __set_direction(pin, 0);
120
121 return 0;
122}
123
124int 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
136void kw_gpio_set_value(unsigned pin, int value)
137{
138
139 __set_level(pin, value);
140}
141
142void kw_gpio_set_blink(unsigned pin, int blink)
143{
144
145 __set_level(pin, 0);
146
147
148 __set_blinking(pin, blink);
149}
150