Blame view
drivers/gpio/gpio-tegra.c
10.4 KB
3c92db9ac [ARM] tegra: add ... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 |
/* * arch/arm/mach-tegra/gpio.c * * Copyright (c) 2010 Google, Inc * * Author: * Erik Gilling <konkers@google.com> * * This software is licensed under the terms of the GNU General Public * License version 2, as published by the Free Software Foundation, and * may be copied, distributed, and modified under those terms. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include <linux/init.h> #include <linux/irq.h> |
2e47b8b3c [ARM] tegra: gpio... |
22 |
#include <linux/interrupt.h> |
3c92db9ac [ARM] tegra: add ... |
23 24 25 |
#include <linux/io.h> #include <linux/gpio.h> |
df2212270 gpio/tegra: add d... |
26 |
#include <linux/of.h> |
3c92db9ac [ARM] tegra: add ... |
27 |
|
98022940c ARM: tegra: updat... |
28 |
#include <asm/mach/irq.h> |
3c92db9ac [ARM] tegra: add ... |
29 |
#include <mach/iomap.h> |
2ea67fd14 ARM: tegra: Add p... |
30 |
#include <mach/suspend.h> |
3c92db9ac [ARM] tegra: add ... |
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 |
#define GPIO_BANK(x) ((x) >> 5) #define GPIO_PORT(x) (((x) >> 3) & 0x3) #define GPIO_BIT(x) ((x) & 0x7) #define GPIO_REG(x) (IO_TO_VIRT(TEGRA_GPIO_BASE) + \ GPIO_BANK(x) * 0x80 + \ GPIO_PORT(x) * 4) #define GPIO_CNF(x) (GPIO_REG(x) + 0x00) #define GPIO_OE(x) (GPIO_REG(x) + 0x10) #define GPIO_OUT(x) (GPIO_REG(x) + 0X20) #define GPIO_IN(x) (GPIO_REG(x) + 0x30) #define GPIO_INT_STA(x) (GPIO_REG(x) + 0x40) #define GPIO_INT_ENB(x) (GPIO_REG(x) + 0x50) #define GPIO_INT_LVL(x) (GPIO_REG(x) + 0x60) #define GPIO_INT_CLR(x) (GPIO_REG(x) + 0x70) #define GPIO_MSK_CNF(x) (GPIO_REG(x) + 0x800) #define GPIO_MSK_OE(x) (GPIO_REG(x) + 0x810) #define GPIO_MSK_OUT(x) (GPIO_REG(x) + 0X820) #define GPIO_MSK_INT_STA(x) (GPIO_REG(x) + 0x840) #define GPIO_MSK_INT_ENB(x) (GPIO_REG(x) + 0x850) #define GPIO_MSK_INT_LVL(x) (GPIO_REG(x) + 0x860) #define GPIO_INT_LVL_MASK 0x010101 #define GPIO_INT_LVL_EDGE_RISING 0x000101 #define GPIO_INT_LVL_EDGE_FALLING 0x000100 #define GPIO_INT_LVL_EDGE_BOTH 0x010100 #define GPIO_INT_LVL_LEVEL_HIGH 0x000001 #define GPIO_INT_LVL_LEVEL_LOW 0x000000 struct tegra_gpio_bank { int bank; int irq; spinlock_t lvl_lock[4]; |
2e47b8b3c [ARM] tegra: gpio... |
67 68 69 70 71 72 73 |
#ifdef CONFIG_PM u32 cnf[4]; u32 out[4]; u32 oe[4]; u32 int_enb[4]; u32 int_lvl[4]; #endif |
3c92db9ac [ARM] tegra: add ... |
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 |
}; static struct tegra_gpio_bank tegra_gpio_banks[] = { {.bank = 0, .irq = INT_GPIO1}, {.bank = 1, .irq = INT_GPIO2}, {.bank = 2, .irq = INT_GPIO3}, {.bank = 3, .irq = INT_GPIO4}, {.bank = 4, .irq = INT_GPIO5}, {.bank = 5, .irq = INT_GPIO6}, {.bank = 6, .irq = INT_GPIO7}, }; static int tegra_gpio_compose(int bank, int port, int bit) { return (bank << 5) | ((port & 0x3) << 3) | (bit & 0x7); } static void tegra_gpio_mask_write(u32 reg, int gpio, int value) { u32 val; val = 0x100 << GPIO_BIT(gpio); if (value) val |= 1 << GPIO_BIT(gpio); __raw_writel(val, reg); } void tegra_gpio_enable(int gpio) { tegra_gpio_mask_write(GPIO_MSK_CNF(gpio), gpio, 1); } void tegra_gpio_disable(int gpio) { tegra_gpio_mask_write(GPIO_MSK_CNF(gpio), gpio, 0); } static void tegra_gpio_set(struct gpio_chip *chip, unsigned offset, int value) { tegra_gpio_mask_write(GPIO_MSK_OUT(offset), offset, value); } static int tegra_gpio_get(struct gpio_chip *chip, unsigned offset) { return (__raw_readl(GPIO_IN(offset)) >> GPIO_BIT(offset)) & 0x1; } static int tegra_gpio_direction_input(struct gpio_chip *chip, unsigned offset) { tegra_gpio_mask_write(GPIO_MSK_OE(offset), offset, 0); return 0; } static int tegra_gpio_direction_output(struct gpio_chip *chip, unsigned offset, int value) { tegra_gpio_set(chip, offset, value); tegra_gpio_mask_write(GPIO_MSK_OE(offset), offset, 1); return 0; } static struct gpio_chip tegra_gpio_chip = { .label = "tegra-gpio", .direction_input = tegra_gpio_direction_input, .get = tegra_gpio_get, .direction_output = tegra_gpio_direction_output, .set = tegra_gpio_set, .base = 0, |
2e47b8b3c [ARM] tegra: gpio... |
145 |
.ngpio = TEGRA_NR_GPIOS, |
3c92db9ac [ARM] tegra: add ... |
146 |
}; |
37337a8d5 ARM: tegra: irq_d... |
147 |
static void tegra_gpio_irq_ack(struct irq_data *d) |
3c92db9ac [ARM] tegra: add ... |
148 |
{ |
37337a8d5 ARM: tegra: irq_d... |
149 |
int gpio = d->irq - INT_GPIO_BASE; |
3c92db9ac [ARM] tegra: add ... |
150 151 152 |
__raw_writel(1 << GPIO_BIT(gpio), GPIO_INT_CLR(gpio)); } |
37337a8d5 ARM: tegra: irq_d... |
153 |
static void tegra_gpio_irq_mask(struct irq_data *d) |
3c92db9ac [ARM] tegra: add ... |
154 |
{ |
37337a8d5 ARM: tegra: irq_d... |
155 |
int gpio = d->irq - INT_GPIO_BASE; |
3c92db9ac [ARM] tegra: add ... |
156 157 158 |
tegra_gpio_mask_write(GPIO_MSK_INT_ENB(gpio), gpio, 0); } |
37337a8d5 ARM: tegra: irq_d... |
159 |
static void tegra_gpio_irq_unmask(struct irq_data *d) |
3c92db9ac [ARM] tegra: add ... |
160 |
{ |
37337a8d5 ARM: tegra: irq_d... |
161 |
int gpio = d->irq - INT_GPIO_BASE; |
3c92db9ac [ARM] tegra: add ... |
162 163 164 |
tegra_gpio_mask_write(GPIO_MSK_INT_ENB(gpio), gpio, 1); } |
37337a8d5 ARM: tegra: irq_d... |
165 |
static int tegra_gpio_irq_set_type(struct irq_data *d, unsigned int type) |
3c92db9ac [ARM] tegra: add ... |
166 |
{ |
37337a8d5 ARM: tegra: irq_d... |
167 168 |
int gpio = d->irq - INT_GPIO_BASE; struct tegra_gpio_bank *bank = irq_data_get_irq_chip_data(d); |
3c92db9ac [ARM] tegra: add ... |
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 |
int port = GPIO_PORT(gpio); int lvl_type; int val; unsigned long flags; switch (type & IRQ_TYPE_SENSE_MASK) { case IRQ_TYPE_EDGE_RISING: lvl_type = GPIO_INT_LVL_EDGE_RISING; break; case IRQ_TYPE_EDGE_FALLING: lvl_type = GPIO_INT_LVL_EDGE_FALLING; break; case IRQ_TYPE_EDGE_BOTH: lvl_type = GPIO_INT_LVL_EDGE_BOTH; break; case IRQ_TYPE_LEVEL_HIGH: lvl_type = GPIO_INT_LVL_LEVEL_HIGH; break; case IRQ_TYPE_LEVEL_LOW: lvl_type = GPIO_INT_LVL_LEVEL_LOW; break; default: return -EINVAL; } spin_lock_irqsave(&bank->lvl_lock[port], flags); val = __raw_readl(GPIO_INT_LVL(gpio)); val &= ~(GPIO_INT_LVL_MASK << GPIO_BIT(gpio)); val |= lvl_type << GPIO_BIT(gpio); __raw_writel(val, GPIO_INT_LVL(gpio)); spin_unlock_irqrestore(&bank->lvl_lock[port], flags); if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH)) |
6845664a6 arm: Cleanup the ... |
209 |
__irq_set_handler_locked(d->irq, handle_level_irq); |
3c92db9ac [ARM] tegra: add ... |
210 |
else if (type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING)) |
6845664a6 arm: Cleanup the ... |
211 |
__irq_set_handler_locked(d->irq, handle_edge_irq); |
3c92db9ac [ARM] tegra: add ... |
212 213 214 215 216 217 218 219 220 221 |
return 0; } static void tegra_gpio_irq_handler(unsigned int irq, struct irq_desc *desc) { struct tegra_gpio_bank *bank; int port; int pin; int unmasked = 0; |
98022940c ARM: tegra: updat... |
222 |
struct irq_chip *chip = irq_desc_get_chip(desc); |
3c92db9ac [ARM] tegra: add ... |
223 |
|
98022940c ARM: tegra: updat... |
224 |
chained_irq_enter(chip, desc); |
3c92db9ac [ARM] tegra: add ... |
225 |
|
6845664a6 arm: Cleanup the ... |
226 |
bank = irq_get_handler_data(irq); |
3c92db9ac [ARM] tegra: add ... |
227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 |
for (port = 0; port < 4; port++) { int gpio = tegra_gpio_compose(bank->bank, port, 0); unsigned long sta = __raw_readl(GPIO_INT_STA(gpio)) & __raw_readl(GPIO_INT_ENB(gpio)); u32 lvl = __raw_readl(GPIO_INT_LVL(gpio)); for_each_set_bit(pin, &sta, 8) { __raw_writel(1 << pin, GPIO_INT_CLR(gpio)); /* if gpio is edge triggered, clear condition * before executing the hander so that we don't * miss edges */ if (lvl & (0x100 << pin)) { unmasked = 1; |
98022940c ARM: tegra: updat... |
243 |
chained_irq_exit(chip, desc); |
3c92db9ac [ARM] tegra: add ... |
244 245 246 247 248 249 250 |
} generic_handle_irq(gpio_to_irq(gpio + pin)); } } if (!unmasked) |
98022940c ARM: tegra: updat... |
251 |
chained_irq_exit(chip, desc); |
3c92db9ac [ARM] tegra: add ... |
252 253 |
} |
2e47b8b3c [ARM] tegra: gpio... |
254 255 256 257 |
#ifdef CONFIG_PM void tegra_gpio_resume(void) { unsigned long flags; |
c8309ef6a ARM: tegra: gpio:... |
258 259 |
int b; int p; |
2e47b8b3c [ARM] tegra: gpio... |
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 |
local_irq_save(flags); for (b = 0; b < ARRAY_SIZE(tegra_gpio_banks); b++) { struct tegra_gpio_bank *bank = &tegra_gpio_banks[b]; for (p = 0; p < ARRAY_SIZE(bank->oe); p++) { unsigned int gpio = (b<<5) | (p<<3); __raw_writel(bank->cnf[p], GPIO_CNF(gpio)); __raw_writel(bank->out[p], GPIO_OUT(gpio)); __raw_writel(bank->oe[p], GPIO_OE(gpio)); __raw_writel(bank->int_lvl[p], GPIO_INT_LVL(gpio)); __raw_writel(bank->int_enb[p], GPIO_INT_ENB(gpio)); } } local_irq_restore(flags); |
2e47b8b3c [ARM] tegra: gpio... |
277 278 279 280 281 |
} void tegra_gpio_suspend(void) { unsigned long flags; |
c8309ef6a ARM: tegra: gpio:... |
282 283 |
int b; int p; |
2e47b8b3c [ARM] tegra: gpio... |
284 |
|
2e47b8b3c [ARM] tegra: gpio... |
285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 |
local_irq_save(flags); for (b = 0; b < ARRAY_SIZE(tegra_gpio_banks); b++) { struct tegra_gpio_bank *bank = &tegra_gpio_banks[b]; for (p = 0; p < ARRAY_SIZE(bank->oe); p++) { unsigned int gpio = (b<<5) | (p<<3); bank->cnf[p] = __raw_readl(GPIO_CNF(gpio)); bank->out[p] = __raw_readl(GPIO_OUT(gpio)); bank->oe[p] = __raw_readl(GPIO_OE(gpio)); bank->int_enb[p] = __raw_readl(GPIO_INT_ENB(gpio)); bank->int_lvl[p] = __raw_readl(GPIO_INT_LVL(gpio)); } } local_irq_restore(flags); } |
37337a8d5 ARM: tegra: irq_d... |
300 |
static int tegra_gpio_wake_enable(struct irq_data *d, unsigned int enable) |
2e47b8b3c [ARM] tegra: gpio... |
301 |
{ |
37337a8d5 ARM: tegra: irq_d... |
302 |
struct tegra_gpio_bank *bank = irq_data_get_irq_chip_data(d); |
6845664a6 arm: Cleanup the ... |
303 |
return irq_set_irq_wake(bank->irq, enable); |
2e47b8b3c [ARM] tegra: gpio... |
304 305 |
} #endif |
3c92db9ac [ARM] tegra: add ... |
306 307 308 |
static struct irq_chip tegra_gpio_irq_chip = { .name = "GPIO", |
37337a8d5 ARM: tegra: irq_d... |
309 310 311 312 |
.irq_ack = tegra_gpio_irq_ack, .irq_mask = tegra_gpio_irq_mask, .irq_unmask = tegra_gpio_irq_unmask, .irq_set_type = tegra_gpio_irq_set_type, |
2e47b8b3c [ARM] tegra: gpio... |
313 |
#ifdef CONFIG_PM |
37337a8d5 ARM: tegra: irq_d... |
314 |
.irq_set_wake = tegra_gpio_wake_enable, |
2e47b8b3c [ARM] tegra: gpio... |
315 |
#endif |
3c92db9ac [ARM] tegra: add ... |
316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 |
}; /* This lock class tells lockdep that GPIO irqs are in a different * category than their parents, so it won't report false recursion. */ static struct lock_class_key gpio_lock_class; static int __init tegra_gpio_init(void) { struct tegra_gpio_bank *bank; int i; int j; for (i = 0; i < 7; i++) { for (j = 0; j < 4; j++) { int gpio = tegra_gpio_compose(i, j, 0); __raw_writel(0x00, GPIO_INT_ENB(gpio)); } } |
df2212270 gpio/tegra: add d... |
336 337 338 339 340 341 |
#ifdef CONFIG_OF_GPIO /* * This isn't ideal, but it gets things hooked up until this * driver is converted into a platform_device */ tegra_gpio_chip.of_node = of_find_compatible_node(NULL, NULL, |
f7f678a06 gpio/tegra: Use e... |
342 |
"nvidia,tegra20-gpio"); |
df2212270 gpio/tegra: add d... |
343 |
#endif /* CONFIG_OF_GPIO */ |
3c92db9ac [ARM] tegra: add ... |
344 |
gpiochip_add(&tegra_gpio_chip); |
2e47b8b3c [ARM] tegra: gpio... |
345 |
for (i = INT_GPIO_BASE; i < (INT_GPIO_BASE + TEGRA_NR_GPIOS); i++) { |
3c92db9ac [ARM] tegra: add ... |
346 |
bank = &tegra_gpio_banks[GPIO_BANK(irq_to_gpio(i))]; |
1475b85d0 arm: Use genirq l... |
347 |
irq_set_lockdep_class(i, &gpio_lock_class); |
6845664a6 arm: Cleanup the ... |
348 |
irq_set_chip_data(i, bank); |
f38c02f3b arm: Fold irq_set... |
349 350 |
irq_set_chip_and_handler(i, &tegra_gpio_irq_chip, handle_simple_irq); |
3c92db9ac [ARM] tegra: add ... |
351 352 353 354 355 |
set_irq_flags(i, IRQF_VALID); } for (i = 0; i < ARRAY_SIZE(tegra_gpio_banks); i++) { bank = &tegra_gpio_banks[i]; |
6845664a6 arm: Cleanup the ... |
356 357 |
irq_set_chained_handler(bank->irq, tegra_gpio_irq_handler); irq_set_handler_data(bank->irq, bank); |
3c92db9ac [ARM] tegra: add ... |
358 359 360 361 362 363 364 365 366 |
for (j = 0; j < 4; j++) spin_lock_init(&bank->lvl_lock[j]); } return 0; } postcore_initcall(tegra_gpio_init); |
632095ea1 ARM: tegra: add t... |
367 368 369 370 371 372 373 374 375 376 377 378 379 |
void __init tegra_gpio_config(struct tegra_gpio_table *table, int num) { int i; for (i = 0; i < num; i++) { int gpio = table[i].gpio; if (table[i].enable) tegra_gpio_enable(gpio); else tegra_gpio_disable(gpio); } } |
3c92db9ac [ARM] tegra: add ... |
380 381 382 383 384 385 386 387 388 389 390 391 392 |
#ifdef CONFIG_DEBUG_FS #include <linux/debugfs.h> #include <linux/seq_file.h> static int dbg_gpio_show(struct seq_file *s, void *unused) { int i; int j; for (i = 0; i < 7; i++) { for (j = 0; j < 4; j++) { int gpio = tegra_gpio_compose(i, j, 0); |
2e47b8b3c [ARM] tegra: gpio... |
393 394 395 396 397 398 399 400 401 402 403 |
seq_printf(s, "%d:%d %02x %02x %02x %02x %02x %02x %06x ", i, j, __raw_readl(GPIO_CNF(gpio)), __raw_readl(GPIO_OE(gpio)), __raw_readl(GPIO_OUT(gpio)), __raw_readl(GPIO_IN(gpio)), __raw_readl(GPIO_INT_STA(gpio)), __raw_readl(GPIO_INT_ENB(gpio)), __raw_readl(GPIO_INT_LVL(gpio))); |
3c92db9ac [ARM] tegra: add ... |
404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 |
} } return 0; } static int dbg_gpio_open(struct inode *inode, struct file *file) { return single_open(file, dbg_gpio_show, &inode->i_private); } static const struct file_operations debug_fops = { .open = dbg_gpio_open, .read = seq_read, .llseek = seq_lseek, .release = single_release, }; static int __init tegra_gpio_debuginit(void) { (void) debugfs_create_file("tegra_gpio", S_IRUGO, NULL, NULL, &debug_fops); return 0; } late_initcall(tegra_gpio_debuginit); #endif |