blob: 9528779ca463154334fa54db9a22b6f852cddd0f [file] [log] [blame]
Philipp Zabel1c44f5f2008-02-04 22:28:22 -08001/*
Eric Miao38f539a2009-01-20 12:09:06 +08002 * linux/arch/arm/plat-pxa/gpio.c
Philipp Zabel1c44f5f2008-02-04 22:28:22 -08003 *
4 * Generic PXA GPIO handling
5 *
6 * Author: Nicolas Pitre
7 * Created: Jun 15, 2001
8 * Copyright: MontaVista Software Inc.
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 version 2 as
12 * published by the Free Software Foundation.
13 */
Haojian Zhuang7a4d5072012-04-13 15:15:45 +080014#include <linux/module.h>
Haojian Zhuang389eda12011-10-17 21:26:55 +080015#include <linux/clk.h>
16#include <linux/err.h>
Russell King2f8163b2011-07-26 10:53:52 +010017#include <linux/gpio.h>
Haojian Zhuang157d2642011-10-17 20:37:52 +080018#include <linux/gpio-pxa.h>
Philipp Zabel1c44f5f2008-02-04 22:28:22 -080019#include <linux/init.h>
eric miaoe3630db2008-03-04 11:42:26 +080020#include <linux/irq.h>
Haojian Zhuang7a4d5072012-04-13 15:15:45 +080021#include <linux/irqdomain.h>
Russell Kingfced80c2008-09-06 12:10:45 +010022#include <linux/io.h>
Haojian Zhuang7a4d5072012-04-13 15:15:45 +080023#include <linux/of.h>
24#include <linux/of_device.h>
Haojian Zhuang157d2642011-10-17 20:37:52 +080025#include <linux/platform_device.h>
Rafael J. Wysocki2eaa03b2011-04-22 22:03:11 +020026#include <linux/syscore_ops.h>
Daniel Mack4aa78262009-06-19 22:56:09 +020027#include <linux/slab.h>
Philipp Zabel1c44f5f2008-02-04 22:28:22 -080028
Chao Xie0d2ee5d2012-07-31 14:13:09 +080029#include <asm/mach/irq.h>
30
Rob Herringfeefe732012-01-03 15:52:42 -060031#include <mach/irqs.h>
32
Haojian Zhuang157d2642011-10-17 20:37:52 +080033/*
34 * We handle the GPIOs by banks, each bank covers up to 32 GPIOs with
35 * one set of registers. The register offsets are organized below:
36 *
37 * GPLR GPDR GPSR GPCR GRER GFER GEDR
38 * BANK 0 - 0x0000 0x000C 0x0018 0x0024 0x0030 0x003C 0x0048
39 * BANK 1 - 0x0004 0x0010 0x001C 0x0028 0x0034 0x0040 0x004C
40 * BANK 2 - 0x0008 0x0014 0x0020 0x002C 0x0038 0x0044 0x0050
41 *
42 * BANK 3 - 0x0100 0x010C 0x0118 0x0124 0x0130 0x013C 0x0148
43 * BANK 4 - 0x0104 0x0110 0x011C 0x0128 0x0134 0x0140 0x014C
44 * BANK 5 - 0x0108 0x0114 0x0120 0x012C 0x0138 0x0144 0x0150
45 *
46 * NOTE:
47 * BANK 3 is only available on PXA27x and later processors.
48 * BANK 4 and 5 are only available on PXA935
49 */
50
51#define GPLR_OFFSET 0x00
52#define GPDR_OFFSET 0x0C
53#define GPSR_OFFSET 0x18
54#define GPCR_OFFSET 0x24
55#define GRER_OFFSET 0x30
56#define GFER_OFFSET 0x3C
57#define GEDR_OFFSET 0x48
58#define GAFR_OFFSET 0x54
Haojian Zhuangbe241682011-10-17 21:07:15 +080059#define ED_MASK_OFFSET 0x9C /* GPIO edge detection for AP side */
Haojian Zhuang157d2642011-10-17 20:37:52 +080060
61#define BANK_OFF(n) (((n) < 3) ? (n) << 2 : 0x100 + (((n) - 3) << 2))
Philipp Zabel1c44f5f2008-02-04 22:28:22 -080062
Eric Miao3b8e2852009-01-07 11:30:49 +080063int pxa_last_gpio;
Daniel Mack9450be72012-07-22 16:55:44 +020064static int irq_base;
Eric Miao3b8e2852009-01-07 11:30:49 +080065
Haojian Zhuang7a4d5072012-04-13 15:15:45 +080066#ifdef CONFIG_OF
67static struct irq_domain *domain;
Daniel Mack72121572012-07-25 17:35:39 +020068static struct device_node *pxa_gpio_of_node;
Haojian Zhuang7a4d5072012-04-13 15:15:45 +080069#endif
70
Philipp Zabel1c44f5f2008-02-04 22:28:22 -080071struct pxa_gpio_chip {
72 struct gpio_chip chip;
Eric Miao0807da52009-01-07 18:01:51 +080073 void __iomem *regbase;
74 char label[10];
75
76 unsigned long irq_mask;
77 unsigned long irq_edge_rise;
78 unsigned long irq_edge_fall;
Robert Jarzmikb95ace52012-04-22 13:37:24 +020079 int (*set_wake)(unsigned int gpio, unsigned int on);
Eric Miao0807da52009-01-07 18:01:51 +080080
81#ifdef CONFIG_PM
82 unsigned long saved_gplr;
83 unsigned long saved_gpdr;
84 unsigned long saved_grer;
85 unsigned long saved_gfer;
86#endif
Philipp Zabel1c44f5f2008-02-04 22:28:22 -080087};
88
Haojian Zhuang4929f5a2011-10-10 16:03:51 +080089enum {
90 PXA25X_GPIO = 0,
91 PXA26X_GPIO,
92 PXA27X_GPIO,
93 PXA3XX_GPIO,
94 PXA93X_GPIO,
95 MMP_GPIO = 0x10,
Haojian Zhuang4929f5a2011-10-10 16:03:51 +080096};
97
Eric Miao0807da52009-01-07 18:01:51 +080098static DEFINE_SPINLOCK(gpio_lock);
99static struct pxa_gpio_chip *pxa_gpio_chips;
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800100static int gpio_type;
Haojian Zhuang157d2642011-10-17 20:37:52 +0800101static void __iomem *gpio_reg_base;
Eric Miao0807da52009-01-07 18:01:51 +0800102
103#define for_each_gpio_chip(i, c) \
104 for (i = 0, c = &pxa_gpio_chips[0]; i <= pxa_last_gpio; i += 32, c++)
105
106static inline void __iomem *gpio_chip_base(struct gpio_chip *c)
107{
108 return container_of(c, struct pxa_gpio_chip, chip)->regbase;
109}
110
Linus Walleija0656852011-06-13 10:42:19 +0200111static inline struct pxa_gpio_chip *gpio_to_pxachip(unsigned gpio)
Eric Miao0807da52009-01-07 18:01:51 +0800112{
113 return &pxa_gpio_chips[gpio_to_bank(gpio)];
114}
115
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800116static inline int gpio_is_pxa_type(int type)
117{
118 return (type & MMP_GPIO) == 0;
119}
120
121static inline int gpio_is_mmp_type(int type)
122{
123 return (type & MMP_GPIO) != 0;
124}
125
Haojian Zhuang157d2642011-10-17 20:37:52 +0800126/* GPIO86/87/88/89 on PXA26x have their direction bits in PXA_GPDR(2 inverted,
127 * as well as their Alternate Function value being '1' for GPIO in GAFRx.
128 */
129static inline int __gpio_is_inverted(int gpio)
130{
131 if ((gpio_type == PXA26X_GPIO) && (gpio > 85))
132 return 1;
133 return 0;
134}
135
136/*
137 * On PXA25x and PXA27x, GAFRx and GPDRx together decide the alternate
138 * function of a GPIO, and GPDRx cannot be altered once configured. It
139 * is attributed as "occupied" here (I know this terminology isn't
140 * accurate, you are welcome to propose a better one :-)
141 */
142static inline int __gpio_is_occupied(unsigned gpio)
143{
144 struct pxa_gpio_chip *pxachip;
145 void __iomem *base;
146 unsigned long gafr = 0, gpdr = 0;
147 int ret, af = 0, dir = 0;
148
149 pxachip = gpio_to_pxachip(gpio);
150 base = gpio_chip_base(&pxachip->chip);
151 gpdr = readl_relaxed(base + GPDR_OFFSET);
152
153 switch (gpio_type) {
154 case PXA25X_GPIO:
155 case PXA26X_GPIO:
156 case PXA27X_GPIO:
157 gafr = readl_relaxed(base + GAFR_OFFSET);
158 af = (gafr >> ((gpio & 0xf) * 2)) & 0x3;
159 dir = gpdr & GPIO_bit(gpio);
160
161 if (__gpio_is_inverted(gpio))
162 ret = (af != 1) || (dir == 0);
163 else
164 ret = (af != 0) || (dir != 0);
165 break;
166 default:
167 ret = gpdr & GPIO_bit(gpio);
168 break;
169 }
170 return ret;
171}
172
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800173static int pxa_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
174{
Daniel Mack9450be72012-07-22 16:55:44 +0200175 return chip->base + offset + irq_base;
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800176}
177
178int pxa_irq_to_gpio(int irq)
179{
Daniel Mack9450be72012-07-22 16:55:44 +0200180 return irq - irq_base;
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800181}
182
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800183static int pxa_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
184{
Eric Miao0807da52009-01-07 18:01:51 +0800185 void __iomem *base = gpio_chip_base(chip);
186 uint32_t value, mask = 1 << offset;
187 unsigned long flags;
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800188
Eric Miao0807da52009-01-07 18:01:51 +0800189 spin_lock_irqsave(&gpio_lock, flags);
190
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800191 value = readl_relaxed(base + GPDR_OFFSET);
Eric Miao067455a2008-11-26 18:12:04 +0800192 if (__gpio_is_inverted(chip->base + offset))
193 value |= mask;
194 else
195 value &= ~mask;
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800196 writel_relaxed(value, base + GPDR_OFFSET);
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800197
Eric Miao0807da52009-01-07 18:01:51 +0800198 spin_unlock_irqrestore(&gpio_lock, flags);
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800199 return 0;
200}
201
202static int pxa_gpio_direction_output(struct gpio_chip *chip,
Eric Miao0807da52009-01-07 18:01:51 +0800203 unsigned offset, int value)
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800204{
Eric Miao0807da52009-01-07 18:01:51 +0800205 void __iomem *base = gpio_chip_base(chip);
206 uint32_t tmp, mask = 1 << offset;
207 unsigned long flags;
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800208
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800209 writel_relaxed(mask, base + (value ? GPSR_OFFSET : GPCR_OFFSET));
Eric Miao0807da52009-01-07 18:01:51 +0800210
211 spin_lock_irqsave(&gpio_lock, flags);
212
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800213 tmp = readl_relaxed(base + GPDR_OFFSET);
Eric Miao067455a2008-11-26 18:12:04 +0800214 if (__gpio_is_inverted(chip->base + offset))
215 tmp &= ~mask;
216 else
217 tmp |= mask;
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800218 writel_relaxed(tmp, base + GPDR_OFFSET);
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800219
Eric Miao0807da52009-01-07 18:01:51 +0800220 spin_unlock_irqrestore(&gpio_lock, flags);
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800221 return 0;
222}
223
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800224static int pxa_gpio_get(struct gpio_chip *chip, unsigned offset)
225{
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800226 return readl_relaxed(gpio_chip_base(chip) + GPLR_OFFSET) & (1 << offset);
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800227}
228
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800229static void pxa_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
230{
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800231 writel_relaxed(1 << offset, gpio_chip_base(chip) +
Eric Miao0807da52009-01-07 18:01:51 +0800232 (value ? GPSR_OFFSET : GPCR_OFFSET));
Philipp Zabel1c44f5f2008-02-04 22:28:22 -0800233}
234
Daniel Mack72121572012-07-25 17:35:39 +0200235#ifdef CONFIG_OF_GPIO
236static int pxa_gpio_of_xlate(struct gpio_chip *gc,
237 const struct of_phandle_args *gpiospec,
238 u32 *flags)
239{
240 if (gpiospec->args[0] > pxa_last_gpio)
241 return -EINVAL;
242
243 if (gc != &pxa_gpio_chips[gpiospec->args[0] / 32].chip)
244 return -EINVAL;
245
246 if (flags)
247 *flags = gpiospec->args[1];
248
249 return gpiospec->args[0] % 32;
250}
251#endif
252
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200253static int __devinit pxa_init_gpio_chip(int gpio_end,
254 int (*set_wake)(unsigned int, unsigned int))
Eric Miaoa58fbcd2009-01-06 17:37:37 +0800255{
Eric Miao0807da52009-01-07 18:01:51 +0800256 int i, gpio, nbanks = gpio_to_bank(gpio_end) + 1;
257 struct pxa_gpio_chip *chips;
Eric Miaoa58fbcd2009-01-06 17:37:37 +0800258
Daniel Mack4aa78262009-06-19 22:56:09 +0200259 chips = kzalloc(nbanks * sizeof(struct pxa_gpio_chip), GFP_KERNEL);
Eric Miao0807da52009-01-07 18:01:51 +0800260 if (chips == NULL) {
261 pr_err("%s: failed to allocate GPIO chips\n", __func__);
262 return -ENOMEM;
Eric Miaoa58fbcd2009-01-06 17:37:37 +0800263 }
Eric Miao0807da52009-01-07 18:01:51 +0800264
265 for (i = 0, gpio = 0; i < nbanks; i++, gpio += 32) {
266 struct gpio_chip *c = &chips[i].chip;
267
268 sprintf(chips[i].label, "gpio-%d", i);
Haojian Zhuang157d2642011-10-17 20:37:52 +0800269 chips[i].regbase = gpio_reg_base + BANK_OFF(i);
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200270 chips[i].set_wake = set_wake;
Eric Miao0807da52009-01-07 18:01:51 +0800271
272 c->base = gpio;
273 c->label = chips[i].label;
274
275 c->direction_input = pxa_gpio_direction_input;
276 c->direction_output = pxa_gpio_direction_output;
277 c->get = pxa_gpio_get;
278 c->set = pxa_gpio_set;
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800279 c->to_irq = pxa_gpio_to_irq;
Daniel Mack72121572012-07-25 17:35:39 +0200280#ifdef CONFIG_OF_GPIO
281 c->of_node = pxa_gpio_of_node;
282 c->of_xlate = pxa_gpio_of_xlate;
283 c->of_gpio_n_cells = 2;
284#endif
Eric Miao0807da52009-01-07 18:01:51 +0800285
286 /* number of GPIOs on last bank may be less than 32 */
287 c->ngpio = (gpio + 31 > gpio_end) ? (gpio_end - gpio + 1) : 32;
288 gpiochip_add(c);
289 }
290 pxa_gpio_chips = chips;
291 return 0;
Eric Miaoa58fbcd2009-01-06 17:37:37 +0800292}
293
Eric Miaoa8f6fae2009-04-21 14:39:07 +0800294/* Update only those GRERx and GFERx edge detection register bits if those
295 * bits are set in c->irq_mask
296 */
297static inline void update_edge_detect(struct pxa_gpio_chip *c)
298{
299 uint32_t grer, gfer;
300
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800301 grer = readl_relaxed(c->regbase + GRER_OFFSET) & ~c->irq_mask;
302 gfer = readl_relaxed(c->regbase + GFER_OFFSET) & ~c->irq_mask;
Eric Miaoa8f6fae2009-04-21 14:39:07 +0800303 grer |= c->irq_edge_rise & c->irq_mask;
304 gfer |= c->irq_edge_fall & c->irq_mask;
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800305 writel_relaxed(grer, c->regbase + GRER_OFFSET);
306 writel_relaxed(gfer, c->regbase + GFER_OFFSET);
Eric Miaoa8f6fae2009-04-21 14:39:07 +0800307}
308
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100309static int pxa_gpio_irq_type(struct irq_data *d, unsigned int type)
eric miaoe3630db2008-03-04 11:42:26 +0800310{
Eric Miao0807da52009-01-07 18:01:51 +0800311 struct pxa_gpio_chip *c;
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800312 int gpio = pxa_irq_to_gpio(d->irq);
Eric Miao0807da52009-01-07 18:01:51 +0800313 unsigned long gpdr, mask = GPIO_bit(gpio);
eric miaoe3630db2008-03-04 11:42:26 +0800314
Linus Walleija0656852011-06-13 10:42:19 +0200315 c = gpio_to_pxachip(gpio);
eric miaoe3630db2008-03-04 11:42:26 +0800316
317 if (type == IRQ_TYPE_PROBE) {
318 /* Don't mess with enabled GPIOs using preconfigured edges or
319 * GPIOs set to alternate function or to output during probe
320 */
Eric Miao0807da52009-01-07 18:01:51 +0800321 if ((c->irq_edge_rise | c->irq_edge_fall) & GPIO_bit(gpio))
eric miaoe3630db2008-03-04 11:42:26 +0800322 return 0;
eric miao689c04a2008-03-04 17:18:38 +0800323
324 if (__gpio_is_occupied(gpio))
eric miaoe3630db2008-03-04 11:42:26 +0800325 return 0;
eric miao689c04a2008-03-04 17:18:38 +0800326
eric miaoe3630db2008-03-04 11:42:26 +0800327 type = IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING;
328 }
329
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800330 gpdr = readl_relaxed(c->regbase + GPDR_OFFSET);
Eric Miao0807da52009-01-07 18:01:51 +0800331
Eric Miao067455a2008-11-26 18:12:04 +0800332 if (__gpio_is_inverted(gpio))
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800333 writel_relaxed(gpdr | mask, c->regbase + GPDR_OFFSET);
Eric Miao067455a2008-11-26 18:12:04 +0800334 else
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800335 writel_relaxed(gpdr & ~mask, c->regbase + GPDR_OFFSET);
eric miaoe3630db2008-03-04 11:42:26 +0800336
337 if (type & IRQ_TYPE_EDGE_RISING)
Eric Miao0807da52009-01-07 18:01:51 +0800338 c->irq_edge_rise |= mask;
eric miaoe3630db2008-03-04 11:42:26 +0800339 else
Eric Miao0807da52009-01-07 18:01:51 +0800340 c->irq_edge_rise &= ~mask;
eric miaoe3630db2008-03-04 11:42:26 +0800341
342 if (type & IRQ_TYPE_EDGE_FALLING)
Eric Miao0807da52009-01-07 18:01:51 +0800343 c->irq_edge_fall |= mask;
eric miaoe3630db2008-03-04 11:42:26 +0800344 else
Eric Miao0807da52009-01-07 18:01:51 +0800345 c->irq_edge_fall &= ~mask;
eric miaoe3630db2008-03-04 11:42:26 +0800346
Eric Miaoa8f6fae2009-04-21 14:39:07 +0800347 update_edge_detect(c);
eric miaoe3630db2008-03-04 11:42:26 +0800348
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100349 pr_debug("%s: IRQ%d (GPIO%d) - edge%s%s\n", __func__, d->irq, gpio,
eric miaoe3630db2008-03-04 11:42:26 +0800350 ((type & IRQ_TYPE_EDGE_RISING) ? " rising" : ""),
351 ((type & IRQ_TYPE_EDGE_FALLING) ? " falling" : ""));
352 return 0;
353}
354
eric miaoe3630db2008-03-04 11:42:26 +0800355static void pxa_gpio_demux_handler(unsigned int irq, struct irq_desc *desc)
356{
Eric Miao0807da52009-01-07 18:01:51 +0800357 struct pxa_gpio_chip *c;
358 int loop, gpio, gpio_base, n;
359 unsigned long gedr;
Chao Xie0d2ee5d2012-07-31 14:13:09 +0800360 struct irq_chip *chip = irq_desc_get_chip(desc);
361
362 chained_irq_enter(chip, desc);
eric miaoe3630db2008-03-04 11:42:26 +0800363
364 do {
eric miaoe3630db2008-03-04 11:42:26 +0800365 loop = 0;
Eric Miao0807da52009-01-07 18:01:51 +0800366 for_each_gpio_chip(gpio, c) {
367 gpio_base = c->chip.base;
eric miaoe3630db2008-03-04 11:42:26 +0800368
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800369 gedr = readl_relaxed(c->regbase + GEDR_OFFSET);
Eric Miao0807da52009-01-07 18:01:51 +0800370 gedr = gedr & c->irq_mask;
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800371 writel_relaxed(gedr, c->regbase + GEDR_OFFSET);
eric miaoe3630db2008-03-04 11:42:26 +0800372
Eric Miao0807da52009-01-07 18:01:51 +0800373 n = find_first_bit(&gedr, BITS_PER_LONG);
374 while (n < BITS_PER_LONG) {
375 loop = 1;
376
377 generic_handle_irq(gpio_to_irq(gpio_base + n));
378 n = find_next_bit(&gedr, BITS_PER_LONG, n + 1);
379 }
eric miaoe3630db2008-03-04 11:42:26 +0800380 }
381 } while (loop);
Chao Xie0d2ee5d2012-07-31 14:13:09 +0800382
383 chained_irq_exit(chip, desc);
eric miaoe3630db2008-03-04 11:42:26 +0800384}
385
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100386static void pxa_ack_muxed_gpio(struct irq_data *d)
eric miaoe3630db2008-03-04 11:42:26 +0800387{
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800388 int gpio = pxa_irq_to_gpio(d->irq);
Linus Walleija0656852011-06-13 10:42:19 +0200389 struct pxa_gpio_chip *c = gpio_to_pxachip(gpio);
Eric Miao0807da52009-01-07 18:01:51 +0800390
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800391 writel_relaxed(GPIO_bit(gpio), c->regbase + GEDR_OFFSET);
eric miaoe3630db2008-03-04 11:42:26 +0800392}
393
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100394static void pxa_mask_muxed_gpio(struct irq_data *d)
eric miaoe3630db2008-03-04 11:42:26 +0800395{
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800396 int gpio = pxa_irq_to_gpio(d->irq);
Linus Walleija0656852011-06-13 10:42:19 +0200397 struct pxa_gpio_chip *c = gpio_to_pxachip(gpio);
Eric Miao0807da52009-01-07 18:01:51 +0800398 uint32_t grer, gfer;
399
400 c->irq_mask &= ~GPIO_bit(gpio);
401
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800402 grer = readl_relaxed(c->regbase + GRER_OFFSET) & ~GPIO_bit(gpio);
403 gfer = readl_relaxed(c->regbase + GFER_OFFSET) & ~GPIO_bit(gpio);
404 writel_relaxed(grer, c->regbase + GRER_OFFSET);
405 writel_relaxed(gfer, c->regbase + GFER_OFFSET);
eric miaoe3630db2008-03-04 11:42:26 +0800406}
407
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200408static int pxa_gpio_set_wake(struct irq_data *d, unsigned int on)
409{
410 int gpio = pxa_irq_to_gpio(d->irq);
411 struct pxa_gpio_chip *c = gpio_to_pxachip(gpio);
412
413 if (c->set_wake)
414 return c->set_wake(gpio, on);
415 else
416 return 0;
417}
418
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100419static void pxa_unmask_muxed_gpio(struct irq_data *d)
eric miaoe3630db2008-03-04 11:42:26 +0800420{
Haojian Zhuang4929f5a2011-10-10 16:03:51 +0800421 int gpio = pxa_irq_to_gpio(d->irq);
Linus Walleija0656852011-06-13 10:42:19 +0200422 struct pxa_gpio_chip *c = gpio_to_pxachip(gpio);
Eric Miao0807da52009-01-07 18:01:51 +0800423
424 c->irq_mask |= GPIO_bit(gpio);
Eric Miaoa8f6fae2009-04-21 14:39:07 +0800425 update_edge_detect(c);
eric miaoe3630db2008-03-04 11:42:26 +0800426}
427
428static struct irq_chip pxa_muxed_gpio_chip = {
429 .name = "GPIO",
Lennert Buytenheka3f4c922010-11-29 11:18:26 +0100430 .irq_ack = pxa_ack_muxed_gpio,
431 .irq_mask = pxa_mask_muxed_gpio,
432 .irq_unmask = pxa_unmask_muxed_gpio,
433 .irq_set_type = pxa_gpio_irq_type,
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200434 .irq_set_wake = pxa_gpio_set_wake,
eric miaoe3630db2008-03-04 11:42:26 +0800435};
436
Haojian Zhuang478e2232011-10-14 16:44:07 +0800437static int pxa_gpio_nums(void)
438{
439 int count = 0;
440
441#ifdef CONFIG_ARCH_PXA
442 if (cpu_is_pxa25x()) {
443#ifdef CONFIG_CPU_PXA26x
444 count = 89;
445 gpio_type = PXA26X_GPIO;
446#elif defined(CONFIG_PXA25x)
447 count = 84;
448 gpio_type = PXA26X_GPIO;
449#endif /* CONFIG_CPU_PXA26x */
450 } else if (cpu_is_pxa27x()) {
451 count = 120;
452 gpio_type = PXA27X_GPIO;
453 } else if (cpu_is_pxa93x() || cpu_is_pxa95x()) {
454 count = 191;
455 gpio_type = PXA93X_GPIO;
456 } else if (cpu_is_pxa3xx()) {
457 count = 127;
458 gpio_type = PXA3XX_GPIO;
459 }
460#endif /* CONFIG_ARCH_PXA */
461
462#ifdef CONFIG_ARCH_MMP
463 if (cpu_is_pxa168() || cpu_is_pxa910()) {
464 count = 127;
465 gpio_type = MMP_GPIO;
466 } else if (cpu_is_mmp2()) {
467 count = 191;
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800468 gpio_type = MMP_GPIO;
Haojian Zhuang478e2232011-10-14 16:44:07 +0800469 }
470#endif /* CONFIG_ARCH_MMP */
471 return count;
472}
473
Arnd Bergmannf43e04e2012-08-13 14:36:10 +0000474#ifdef CONFIG_OF
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800475static struct of_device_id pxa_gpio_dt_ids[] = {
476 { .compatible = "mrvl,pxa-gpio" },
477 { .compatible = "mrvl,mmp-gpio", .data = (void *)MMP_GPIO },
478 {}
479};
480
481static int pxa_irq_domain_map(struct irq_domain *d, unsigned int irq,
482 irq_hw_number_t hw)
483{
484 irq_set_chip_and_handler(irq, &pxa_muxed_gpio_chip,
485 handle_edge_irq);
486 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
487 return 0;
488}
489
490const struct irq_domain_ops pxa_irq_domain_ops = {
491 .map = pxa_irq_domain_map,
Daniel Mack72121572012-07-25 17:35:39 +0200492 .xlate = irq_domain_xlate_twocell,
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800493};
494
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800495static int __devinit pxa_gpio_probe_dt(struct platform_device *pdev)
496{
Daniel Mack9450be72012-07-22 16:55:44 +0200497 int ret, nr_banks, nr_gpios;
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800498 struct device_node *prev, *next, *np = pdev->dev.of_node;
499 const struct of_device_id *of_id =
500 of_match_device(pxa_gpio_dt_ids, &pdev->dev);
501
502 if (!of_id) {
503 dev_err(&pdev->dev, "Failed to find gpio controller\n");
504 return -EFAULT;
505 }
506 gpio_type = (int)of_id->data;
507
508 next = of_get_next_child(np, NULL);
509 prev = next;
510 if (!next) {
511 dev_err(&pdev->dev, "Failed to find child gpio node\n");
512 ret = -EINVAL;
513 goto err;
514 }
515 for (nr_banks = 1; ; nr_banks++) {
516 next = of_get_next_child(np, prev);
517 if (!next)
518 break;
519 prev = next;
520 }
521 of_node_put(prev);
522 nr_gpios = nr_banks << 5;
523 pxa_last_gpio = nr_gpios - 1;
524
525 irq_base = irq_alloc_descs(-1, 0, nr_gpios, 0);
526 if (irq_base < 0) {
527 dev_err(&pdev->dev, "Failed to allocate IRQ numbers\n");
528 goto err;
529 }
530 domain = irq_domain_add_legacy(np, nr_gpios, irq_base, 0,
531 &pxa_irq_domain_ops, NULL);
Daniel Mack72121572012-07-25 17:35:39 +0200532 pxa_gpio_of_node = np;
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800533 return 0;
534err:
535 iounmap(gpio_reg_base);
536 return ret;
537}
538#else
539#define pxa_gpio_probe_dt(pdev) (-1)
540#endif
541
Haojian Zhuang157d2642011-10-17 20:37:52 +0800542static int __devinit pxa_gpio_probe(struct platform_device *pdev)
eric miaoe3630db2008-03-04 11:42:26 +0800543{
Eric Miao0807da52009-01-07 18:01:51 +0800544 struct pxa_gpio_chip *c;
Haojian Zhuang157d2642011-10-17 20:37:52 +0800545 struct resource *res;
Haojian Zhuang389eda12011-10-17 21:26:55 +0800546 struct clk *clk;
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200547 struct pxa_gpio_platform_data *info;
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800548 int gpio, irq, ret, use_of = 0;
Haojian Zhuang157d2642011-10-17 20:37:52 +0800549 int irq0 = 0, irq1 = 0, irq_mux, gpio_offset = 0;
eric miaoe3630db2008-03-04 11:42:26 +0800550
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800551 ret = pxa_gpio_probe_dt(pdev);
Daniel Mack9450be72012-07-22 16:55:44 +0200552 if (ret < 0) {
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800553 pxa_last_gpio = pxa_gpio_nums();
Daniel Mack9450be72012-07-22 16:55:44 +0200554#ifdef CONFIG_ARCH_PXA
555 if (gpio_is_pxa_type(gpio_type))
556 irq_base = PXA_GPIO_TO_IRQ(0);
557#endif
558#ifdef CONFIG_ARCH_MMP
559 if (gpio_is_mmp_type(gpio_type))
560 irq_base = MMP_GPIO_TO_IRQ(0);
561#endif
562 } else {
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800563 use_of = 1;
Daniel Mack9450be72012-07-22 16:55:44 +0200564 }
565
Haojian Zhuang478e2232011-10-14 16:44:07 +0800566 if (!pxa_last_gpio)
Haojian Zhuang157d2642011-10-17 20:37:52 +0800567 return -EINVAL;
568
569 irq0 = platform_get_irq_byname(pdev, "gpio0");
570 irq1 = platform_get_irq_byname(pdev, "gpio1");
571 irq_mux = platform_get_irq_byname(pdev, "gpio_mux");
572 if ((irq0 > 0 && irq1 <= 0) || (irq0 <= 0 && irq1 > 0)
573 || (irq_mux <= 0))
574 return -EINVAL;
575 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
576 if (!res)
577 return -EINVAL;
578 gpio_reg_base = ioremap(res->start, resource_size(res));
579 if (!gpio_reg_base)
580 return -EINVAL;
581
582 if (irq0 > 0)
583 gpio_offset = 2;
eric miaoe3630db2008-03-04 11:42:26 +0800584
Haojian Zhuang389eda12011-10-17 21:26:55 +0800585 clk = clk_get(&pdev->dev, NULL);
586 if (IS_ERR(clk)) {
587 dev_err(&pdev->dev, "Error %ld to get gpio clock\n",
588 PTR_ERR(clk));
589 iounmap(gpio_reg_base);
590 return PTR_ERR(clk);
591 }
592 ret = clk_prepare(clk);
593 if (ret) {
594 clk_put(clk);
595 iounmap(gpio_reg_base);
596 return ret;
597 }
598 ret = clk_enable(clk);
599 if (ret) {
600 clk_unprepare(clk);
601 clk_put(clk);
602 iounmap(gpio_reg_base);
603 return ret;
604 }
605
Eric Miao0807da52009-01-07 18:01:51 +0800606 /* Initialize GPIO chips */
Robert Jarzmikb95ace52012-04-22 13:37:24 +0200607 info = dev_get_platdata(&pdev->dev);
608 pxa_init_gpio_chip(pxa_last_gpio, info ? info->gpio_set_wake : NULL);
Eric Miao0807da52009-01-07 18:01:51 +0800609
eric miaoe3630db2008-03-04 11:42:26 +0800610 /* clear all GPIO edge detects */
Eric Miao0807da52009-01-07 18:01:51 +0800611 for_each_gpio_chip(gpio, c) {
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800612 writel_relaxed(0, c->regbase + GFER_OFFSET);
613 writel_relaxed(0, c->regbase + GRER_OFFSET);
614 writel_relaxed(~0,c->regbase + GEDR_OFFSET);
Haojian Zhuangbe241682011-10-17 21:07:15 +0800615 /* unmask GPIO edge detect for AP side */
616 if (gpio_is_mmp_type(gpio_type))
617 writel_relaxed(~0, c->regbase + ED_MASK_OFFSET);
eric miaoe3630db2008-03-04 11:42:26 +0800618 }
619
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800620 if (!use_of) {
Haojian Zhuang87c49e22011-10-10 14:38:46 +0800621#ifdef CONFIG_ARCH_PXA
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800622 irq = gpio_to_irq(0);
Thomas Gleixnerf38c02f2011-03-24 13:35:09 +0100623 irq_set_chip_and_handler(irq, &pxa_muxed_gpio_chip,
624 handle_edge_irq);
eric miaoe3630db2008-03-04 11:42:26 +0800625 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
Haojian Zhuang7a4d5072012-04-13 15:15:45 +0800626 irq_set_chained_handler(IRQ_GPIO0, pxa_gpio_demux_handler);
627
628 irq = gpio_to_irq(1);
629 irq_set_chip_and_handler(irq, &pxa_muxed_gpio_chip,
630 handle_edge_irq);
631 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
632 irq_set_chained_handler(IRQ_GPIO1, pxa_gpio_demux_handler);
633#endif
634
635 for (irq = gpio_to_irq(gpio_offset);
636 irq <= gpio_to_irq(pxa_last_gpio); irq++) {
637 irq_set_chip_and_handler(irq, &pxa_muxed_gpio_chip,
638 handle_edge_irq);
639 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
640 }
eric miaoe3630db2008-03-04 11:42:26 +0800641 }
642
Haojian Zhuang157d2642011-10-17 20:37:52 +0800643 irq_set_chained_handler(irq_mux, pxa_gpio_demux_handler);
644 return 0;
eric miaoe3630db2008-03-04 11:42:26 +0800645}
eric miao663707c2008-03-04 16:13:58 +0800646
Haojian Zhuang157d2642011-10-17 20:37:52 +0800647static struct platform_driver pxa_gpio_driver = {
648 .probe = pxa_gpio_probe,
649 .driver = {
650 .name = "pxa-gpio",
Arnd Bergmannf43e04e2012-08-13 14:36:10 +0000651 .of_match_table = of_match_ptr(pxa_gpio_dt_ids),
Haojian Zhuang157d2642011-10-17 20:37:52 +0800652 },
653};
654
655static int __init pxa_gpio_init(void)
656{
657 return platform_driver_register(&pxa_gpio_driver);
658}
659postcore_initcall(pxa_gpio_init);
660
eric miao663707c2008-03-04 16:13:58 +0800661#ifdef CONFIG_PM
Rafael J. Wysocki2eaa03b2011-04-22 22:03:11 +0200662static int pxa_gpio_suspend(void)
eric miao663707c2008-03-04 16:13:58 +0800663{
Eric Miao0807da52009-01-07 18:01:51 +0800664 struct pxa_gpio_chip *c;
665 int gpio;
eric miao663707c2008-03-04 16:13:58 +0800666
Eric Miao0807da52009-01-07 18:01:51 +0800667 for_each_gpio_chip(gpio, c) {
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800668 c->saved_gplr = readl_relaxed(c->regbase + GPLR_OFFSET);
669 c->saved_gpdr = readl_relaxed(c->regbase + GPDR_OFFSET);
670 c->saved_grer = readl_relaxed(c->regbase + GRER_OFFSET);
671 c->saved_gfer = readl_relaxed(c->regbase + GFER_OFFSET);
eric miao663707c2008-03-04 16:13:58 +0800672
673 /* Clear GPIO transition detect bits */
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800674 writel_relaxed(0xffffffff, c->regbase + GEDR_OFFSET);
eric miao663707c2008-03-04 16:13:58 +0800675 }
676 return 0;
677}
678
Rafael J. Wysocki2eaa03b2011-04-22 22:03:11 +0200679static void pxa_gpio_resume(void)
eric miao663707c2008-03-04 16:13:58 +0800680{
Eric Miao0807da52009-01-07 18:01:51 +0800681 struct pxa_gpio_chip *c;
682 int gpio;
eric miao663707c2008-03-04 16:13:58 +0800683
Eric Miao0807da52009-01-07 18:01:51 +0800684 for_each_gpio_chip(gpio, c) {
eric miao663707c2008-03-04 16:13:58 +0800685 /* restore level with set/clear */
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800686 writel_relaxed( c->saved_gplr, c->regbase + GPSR_OFFSET);
687 writel_relaxed(~c->saved_gplr, c->regbase + GPCR_OFFSET);
eric miao663707c2008-03-04 16:13:58 +0800688
Haojian Zhuangdf664d22011-10-14 17:24:03 +0800689 writel_relaxed(c->saved_grer, c->regbase + GRER_OFFSET);
690 writel_relaxed(c->saved_gfer, c->regbase + GFER_OFFSET);
691 writel_relaxed(c->saved_gpdr, c->regbase + GPDR_OFFSET);
eric miao663707c2008-03-04 16:13:58 +0800692 }
eric miao663707c2008-03-04 16:13:58 +0800693}
694#else
695#define pxa_gpio_suspend NULL
696#define pxa_gpio_resume NULL
697#endif
698
Rafael J. Wysocki2eaa03b2011-04-22 22:03:11 +0200699struct syscore_ops pxa_gpio_syscore_ops = {
eric miao663707c2008-03-04 16:13:58 +0800700 .suspend = pxa_gpio_suspend,
701 .resume = pxa_gpio_resume,
702};
Haojian Zhuang157d2642011-10-17 20:37:52 +0800703
704static int __init pxa_gpio_sysinit(void)
705{
706 register_syscore_ops(&pxa_gpio_syscore_ops);
707 return 0;
708}
709postcore_initcall(pxa_gpio_sysinit);