Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
gpio.c
Go to the documentation of this file.
1 /*
2  * Gemini gpiochip and interrupt routines
3  *
4  * Copyright (C) 2008-2009 Paulius Zaleckas <[email protected]>
5  *
6  * Based on plat-mxc/gpio.c:
7  * MXC GPIO support. (c) 2008 Daniel Mack <[email protected]>
8  * Copyright 2008 Juergen Beisert, [email protected]
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 
57 static void gpio_ack_irq(struct irq_data *d)
58 {
59  unsigned int gpio = irq_to_gpio(d->irq);
60  unsigned int base = GPIO_BASE(gpio / 32);
61 
62  __raw_writel(1 << (gpio % 32), base + GPIO_INT_CLR);
63 }
64 
65 static void gpio_mask_irq(struct irq_data *d)
66 {
67  unsigned int gpio = irq_to_gpio(d->irq);
68  unsigned int base = GPIO_BASE(gpio / 32);
69 
70  _set_gpio_irqenable(base, gpio % 32, 0);
71 }
72 
73 static void gpio_unmask_irq(struct irq_data *d)
74 {
75  unsigned int gpio = irq_to_gpio(d->irq);
76  unsigned int base = GPIO_BASE(gpio / 32);
77 
78  _set_gpio_irqenable(base, gpio % 32, 1);
79 }
80 
81 static int gpio_set_irq_type(struct irq_data *d, unsigned int type)
82 {
83  unsigned int gpio = irq_to_gpio(d->irq);
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);
89  reg_level = __raw_readl(base + GPIO_INT_LEVEL);
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;
98  reg_type &= ~gpio_mask;
99  reg_both &= ~gpio_mask;
100  reg_level &= ~gpio_mask;
101  break;
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);
120  __raw_writel(reg_level, base + GPIO_INT_LEVEL);
121  __raw_writel(reg_both, base + GPIO_INT_BOTH_EDGE);
122 
123  gpio_ack_irq(d->irq);
124 
125  return 0;
126 }
127 
128 static void gpio_irq_handler(unsigned int irq, struct irq_desc *desc)
129 {
130  unsigned int port = (unsigned int)irq_desc_get_handler_data(desc);
131  unsigned int gpio_irq_no, irq_stat;
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 
141  generic_handle_irq(gpio_irq_no);
142  }
143 }
144 
145 static struct irq_chip gpio_irq_chip = {
146  .name = "GPIO",
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,
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 
209 {
210  int i, j;
211 
212  for (i = 0; i < GPIO_PORT_NUM; i++) {
213  /* disable, unmask and clear all interrupts */
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++) {
220  irq_set_chip_and_handler(j, &gpio_irq_chip,
223  }
224 
225  irq_set_chained_handler(IRQ_GPIO(i), gpio_irq_handler);
226  irq_set_handler_data(IRQ_GPIO(i), (void *)i);
227  }
228 
229  BUG_ON(gpiochip_add(&gemini_gpio_chip));
230 }