Commit | Line | Data |
---|---|---|
1df621ae PZ |
1 | /* |
2 | * Gemini gpiochip and interrupt routines | |
3 | * | |
4 | * Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@teltonika.lt> | |
5 | * | |
6 | * Based on plat-mxc/gpio.c: | |
7 | * MXC GPIO support. (c) 2008 Daniel Mack <daniel@caiaq.de> | |
8 | * Copyright 2008 Juergen Beisert, kernel@pengutronix.de | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | */ | |
15 | ||
16 | #include <linux/kernel.h> | |
17 | #include <linux/init.h> | |
18 | #include <linux/io.h> | |
19 | #include <linux/irq.h> | |
20 | #include <linux/gpio.h> | |
21 | ||
22 | #include <mach/hardware.h> | |
23 | #include <mach/irqs.h> | |
24 | ||
25 | #define GPIO_BASE(x) IO_ADDRESS(GEMINI_GPIO_BASE(x)) | |
26 | ||
27 | /* GPIO registers definition */ | |
28 | #define GPIO_DATA_OUT 0x0 | |
29 | #define GPIO_DATA_IN 0x4 | |
30 | #define GPIO_DIR 0x8 | |
31 | #define GPIO_DATA_SET 0x10 | |
32 | #define GPIO_DATA_CLR 0x14 | |
33 | #define GPIO_PULL_EN 0x18 | |
34 | #define GPIO_PULL_TYPE 0x1C | |
35 | #define GPIO_INT_EN 0x20 | |
36 | #define GPIO_INT_STAT 0x24 | |
37 | #define GPIO_INT_MASK 0x2C | |
38 | #define GPIO_INT_CLR 0x30 | |
39 | #define GPIO_INT_TYPE 0x34 | |
40 | #define GPIO_INT_BOTH_EDGE 0x38 | |
41 | #define GPIO_INT_LEVEL 0x3C | |
42 | #define GPIO_DEBOUNCE_EN 0x40 | |
43 | #define GPIO_DEBOUNCE_PRESCALE 0x44 | |
44 | ||
45 | #define GPIO_PORT_NUM 3 | |
46 | ||
47 | static void _set_gpio_irqenable(unsigned int base, unsigned int index, | |
48 | int enable) | |
49 | { | |
50 | unsigned int reg; | |
51 | ||
52 | reg = __raw_readl(base + GPIO_INT_EN); | |
53 | reg = (reg & (~(1 << index))) | (!!enable << index); | |
54 | __raw_writel(reg, base + GPIO_INT_EN); | |
55 | } | |
56 | ||
413802b6 | 57 | static void gpio_ack_irq(struct irq_data *d) |
1df621ae | 58 | { |
413802b6 | 59 | unsigned int gpio = irq_to_gpio(d->irq); |
1df621ae PZ |
60 | unsigned int base = GPIO_BASE(gpio / 32); |
61 | ||
62 | __raw_writel(1 << (gpio % 32), base + GPIO_INT_CLR); | |
63 | } | |
64 | ||
413802b6 | 65 | static void gpio_mask_irq(struct irq_data *d) |
1df621ae | 66 | { |
413802b6 | 67 | unsigned int gpio = irq_to_gpio(d->irq); |
1df621ae PZ |
68 | unsigned int base = GPIO_BASE(gpio / 32); |
69 | ||
70 | _set_gpio_irqenable(base, gpio % 32, 0); | |
71 | } | |
72 | ||
413802b6 | 73 | static void gpio_unmask_irq(struct irq_data *d) |
1df621ae | 74 | { |
413802b6 | 75 | unsigned int gpio = irq_to_gpio(d->irq); |
1df621ae PZ |
76 | unsigned int base = GPIO_BASE(gpio / 32); |
77 | ||
78 | _set_gpio_irqenable(base, gpio % 32, 1); | |
79 | } | |
80 | ||
413802b6 | 81 | static int gpio_set_irq_type(struct irq_data *d, unsigned int type) |
1df621ae | 82 | { |
413802b6 | 83 | unsigned int gpio = irq_to_gpio(d->irq); |
1df621ae PZ |
84 | unsigned int gpio_mask = 1 << (gpio % 32); |
85 | unsigned int base = GPIO_BASE(gpio / 32); | |
86 | unsigned int reg_both, reg_level, reg_type; | |
87 | ||
88 | reg_type = __raw_readl(base + GPIO_INT_TYPE); | |
079e1091 | 89 | reg_level = __raw_readl(base + GPIO_INT_LEVEL); |
1df621ae PZ |
90 | reg_both = __raw_readl(base + GPIO_INT_BOTH_EDGE); |
91 | ||
92 | switch (type) { | |
93 | case IRQ_TYPE_EDGE_BOTH: | |
94 | reg_type &= ~gpio_mask; | |
95 | reg_both |= gpio_mask; | |
96 | break; | |
97 | case IRQ_TYPE_EDGE_RISING: | |
98 | reg_type &= ~gpio_mask; | |
99 | reg_both &= ~gpio_mask; | |
100 | reg_level &= ~gpio_mask; | |
101 | break; | |
102 | case IRQ_TYPE_EDGE_FALLING: | |
103 | reg_type &= ~gpio_mask; | |
104 | reg_both &= ~gpio_mask; | |
105 | reg_level |= gpio_mask; | |
106 | break; | |
107 | case IRQ_TYPE_LEVEL_HIGH: | |
108 | reg_type |= gpio_mask; | |
109 | reg_level &= ~gpio_mask; | |
110 | break; | |
111 | case IRQ_TYPE_LEVEL_LOW: | |
112 | reg_type |= gpio_mask; | |
113 | reg_level |= gpio_mask; | |
114 | break; | |
115 | default: | |
116 | return -EINVAL; | |
117 | } | |
118 | ||
119 | __raw_writel(reg_type, base + GPIO_INT_TYPE); | |
079e1091 | 120 | __raw_writel(reg_level, base + GPIO_INT_LEVEL); |
1df621ae PZ |
121 | __raw_writel(reg_both, base + GPIO_INT_BOTH_EDGE); |
122 | ||
413802b6 | 123 | gpio_ack_irq(d->irq); |
1df621ae PZ |
124 | |
125 | return 0; | |
126 | } | |
127 | ||
128 | static void gpio_irq_handler(unsigned int irq, struct irq_desc *desc) | |
129 | { | |
a0b0f5ac | 130 | unsigned int port = (unsigned int)irq_desc_get_handler_data(desc); |
1df621ae | 131 | unsigned int gpio_irq_no, irq_stat; |
1df621ae PZ |
132 | |
133 | irq_stat = __raw_readl(GPIO_BASE(port) + GPIO_INT_STAT); | |
134 | ||
135 | gpio_irq_no = GPIO_IRQ_BASE + port * 32; | |
136 | for (; irq_stat != 0; irq_stat >>= 1, gpio_irq_no++) { | |
137 | ||
138 | if ((irq_stat & 1) == 0) | |
139 | continue; | |
140 | ||
a0b0f5ac | 141 | generic_handle_irq(gpio_irq_no); |
1df621ae PZ |
142 | } |
143 | } | |
144 | ||
145 | static struct irq_chip gpio_irq_chip = { | |
146 | .name = "GPIO", | |
413802b6 LB |
147 | .irq_ack = gpio_ack_irq, |
148 | .irq_mask = gpio_mask_irq, | |
149 | .irq_unmask = gpio_unmask_irq, | |
150 | .irq_set_type = gpio_set_irq_type, | |
1df621ae PZ |
151 | }; |
152 | ||
153 | static void _set_gpio_direction(struct gpio_chip *chip, unsigned offset, | |
154 | int dir) | |
155 | { | |
156 | unsigned int base = GPIO_BASE(offset / 32); | |
157 | unsigned int reg; | |
158 | ||
159 | reg = __raw_readl(base + GPIO_DIR); | |
160 | if (dir) | |
161 | reg |= 1 << (offset % 32); | |
162 | else | |
163 | reg &= ~(1 << (offset % 32)); | |
164 | __raw_writel(reg, base + GPIO_DIR); | |
165 | } | |
166 | ||
167 | static void gemini_gpio_set(struct gpio_chip *chip, unsigned offset, int value) | |
168 | { | |
169 | unsigned int base = GPIO_BASE(offset / 32); | |
170 | ||
171 | if (value) | |
172 | __raw_writel(1 << (offset % 32), base + GPIO_DATA_SET); | |
173 | else | |
174 | __raw_writel(1 << (offset % 32), base + GPIO_DATA_CLR); | |
175 | } | |
176 | ||
177 | static int gemini_gpio_get(struct gpio_chip *chip, unsigned offset) | |
178 | { | |
179 | unsigned int base = GPIO_BASE(offset / 32); | |
180 | ||
181 | return (__raw_readl(base + GPIO_DATA_IN) >> (offset % 32)) & 1; | |
182 | } | |
183 | ||
184 | static int gemini_gpio_direction_input(struct gpio_chip *chip, unsigned offset) | |
185 | { | |
186 | _set_gpio_direction(chip, offset, 0); | |
187 | return 0; | |
188 | } | |
189 | ||
190 | static int gemini_gpio_direction_output(struct gpio_chip *chip, unsigned offset, | |
191 | int value) | |
192 | { | |
193 | _set_gpio_direction(chip, offset, 1); | |
194 | gemini_gpio_set(chip, offset, value); | |
195 | return 0; | |
196 | } | |
197 | ||
198 | static struct gpio_chip gemini_gpio_chip = { | |
199 | .label = "Gemini", | |
200 | .direction_input = gemini_gpio_direction_input, | |
201 | .get = gemini_gpio_get, | |
202 | .direction_output = gemini_gpio_direction_output, | |
203 | .set = gemini_gpio_set, | |
204 | .base = 0, | |
205 | .ngpio = GPIO_PORT_NUM * 32, | |
206 | }; | |
207 | ||
208 | void __init gemini_gpio_init(void) | |
209 | { | |
210 | int i, j; | |
211 | ||
212 | for (i = 0; i < GPIO_PORT_NUM; i++) { | |
213 | /* disable, unmask and clear all interrupts */ | |
214 | __raw_writel(0x0, GPIO_BASE(i) + GPIO_INT_EN); | |
215 | __raw_writel(0x0, GPIO_BASE(i) + GPIO_INT_MASK); | |
216 | __raw_writel(~0x0, GPIO_BASE(i) + GPIO_INT_CLR); | |
217 | ||
218 | for (j = GPIO_IRQ_BASE + i * 32; | |
219 | j < GPIO_IRQ_BASE + (i + 1) * 32; j++) { | |
f38c02f3 TG |
220 | irq_set_chip_and_handler(j, &gpio_irq_chip, |
221 | handle_edge_irq); | |
1df621ae PZ |
222 | set_irq_flags(j, IRQF_VALID); |
223 | } | |
224 | ||
6845664a TG |
225 | irq_set_chained_handler(IRQ_GPIO(i), gpio_irq_handler); |
226 | irq_set_handler_data(IRQ_GPIO(i), (void *)i); | |
1df621ae PZ |
227 | } |
228 | ||
229 | BUG_ON(gpiochip_add(&gemini_gpio_chip)); | |
230 | } |