blob: b4d42112d02d5c3388849eac299245f30f193ac8 [file] [log] [blame]
Baruch Siach1e9c2852009-06-18 16:48:58 -07001/*
Grant Likelyc103de22011-06-04 18:38:28 -06002 * Copyright (C) 2008, 2009 Provigent Ltd.
Baruch Siach1e9c2852009-06-18 16:48:58 -07003 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 *
8 * Driver for the ARM PrimeCell(tm) General Purpose Input/Output (PL061)
9 *
10 * Data sheet: ARM DDI 0190B, September 2000
11 */
12#include <linux/spinlock.h>
13#include <linux/errno.h>
14#include <linux/module.h>
Baruch Siach1e9c2852009-06-18 16:48:58 -070015#include <linux/io.h>
16#include <linux/ioport.h>
17#include <linux/irq.h>
Haojian Zhuangf1f70472013-02-17 19:42:49 +080018#include <linux/irqdomain.h>
Catalin Marinasde88cbb2013-01-18 15:31:37 +000019#include <linux/irqchip/chained_irq.h>
Baruch Siach1e9c2852009-06-18 16:48:58 -070020#include <linux/bitops.h>
21#include <linux/workqueue.h>
22#include <linux/gpio.h>
23#include <linux/device.h>
24#include <linux/amba/bus.h>
25#include <linux/amba/pl061.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090026#include <linux/slab.h>
Haojian Zhuang39b70ee2013-02-17 19:42:51 +080027#include <linux/pinctrl/consumer.h>
Deepak Sikrie198a8de2011-11-18 15:20:12 +053028#include <linux/pm.h>
Baruch Siach1e9c2852009-06-18 16:48:58 -070029
30#define GPIODIR 0x400
31#define GPIOIS 0x404
32#define GPIOIBE 0x408
33#define GPIOIEV 0x40C
34#define GPIOIE 0x410
35#define GPIORIS 0x414
36#define GPIOMIS 0x418
37#define GPIOIC 0x41C
38
39#define PL061_GPIO_NR 8
40
Deepak Sikrie198a8de2011-11-18 15:20:12 +053041#ifdef CONFIG_PM
42struct pl061_context_save_regs {
43 u8 gpio_data;
44 u8 gpio_dir;
45 u8 gpio_is;
46 u8 gpio_ibe;
47 u8 gpio_iev;
48 u8 gpio_ie;
49};
50#endif
Baruch Siach1e9c2852009-06-18 16:48:58 -070051
Baruch Siach1e9c2852009-06-18 16:48:58 -070052struct pl061_gpio {
Baruch Siach835c1922012-11-22 11:46:14 +020053 spinlock_t lock;
Baruch Siach1e9c2852009-06-18 16:48:58 -070054
55 void __iomem *base;
Haojian Zhuangf1f70472013-02-17 19:42:49 +080056 struct irq_domain *domain;
Baruch Siach1e9c2852009-06-18 16:48:58 -070057 struct gpio_chip gc;
Deepak Sikrie198a8de2011-11-18 15:20:12 +053058
59#ifdef CONFIG_PM
60 struct pl061_context_save_regs csave_regs;
61#endif
Baruch Siach1e9c2852009-06-18 16:48:58 -070062};
63
Haojian Zhuang39b70ee2013-02-17 19:42:51 +080064static int pl061_gpio_request(struct gpio_chip *chip, unsigned offset)
65{
66 /*
67 * Map back to global GPIO space and request muxing, the direction
68 * parameter does not matter for this controller.
69 */
70 int gpio = chip->base + offset;
71
72 return pinctrl_request_gpio(gpio);
73}
74
Axel Lin22ce4462013-03-15 20:52:07 +080075static void pl061_gpio_free(struct gpio_chip *chip, unsigned offset)
76{
77 int gpio = chip->base + offset;
78
79 pinctrl_free_gpio(gpio);
80}
81
Baruch Siach1e9c2852009-06-18 16:48:58 -070082static int pl061_direction_input(struct gpio_chip *gc, unsigned offset)
83{
84 struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
85 unsigned long flags;
86 unsigned char gpiodir;
87
88 if (offset >= gc->ngpio)
89 return -EINVAL;
90
91 spin_lock_irqsave(&chip->lock, flags);
92 gpiodir = readb(chip->base + GPIODIR);
93 gpiodir &= ~(1 << offset);
94 writeb(gpiodir, chip->base + GPIODIR);
95 spin_unlock_irqrestore(&chip->lock, flags);
96
97 return 0;
98}
99
100static int pl061_direction_output(struct gpio_chip *gc, unsigned offset,
101 int value)
102{
103 struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
104 unsigned long flags;
105 unsigned char gpiodir;
106
107 if (offset >= gc->ngpio)
108 return -EINVAL;
109
110 spin_lock_irqsave(&chip->lock, flags);
111 writeb(!!value << offset, chip->base + (1 << (offset + 2)));
112 gpiodir = readb(chip->base + GPIODIR);
113 gpiodir |= 1 << offset;
114 writeb(gpiodir, chip->base + GPIODIR);
viresh kumar64b997c52010-04-21 09:42:05 +0100115
116 /*
117 * gpio value is set again, because pl061 doesn't allow to set value of
118 * a gpio pin before configuring it in OUT mode.
119 */
120 writeb(!!value << offset, chip->base + (1 << (offset + 2)));
Baruch Siach1e9c2852009-06-18 16:48:58 -0700121 spin_unlock_irqrestore(&chip->lock, flags);
122
123 return 0;
124}
125
126static int pl061_get_value(struct gpio_chip *gc, unsigned offset)
127{
128 struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
129
130 return !!readb(chip->base + (1 << (offset + 2)));
131}
132
133static void pl061_set_value(struct gpio_chip *gc, unsigned offset, int value)
134{
135 struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
136
137 writeb(!!value << offset, chip->base + (1 << (offset + 2)));
138}
139
Baruch Siach50efacf2009-06-30 11:41:39 -0700140static int pl061_to_irq(struct gpio_chip *gc, unsigned offset)
141{
142 struct pl061_gpio *chip = container_of(gc, struct pl061_gpio, gc);
143
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800144 return irq_create_mapping(chip->domain, offset);
Baruch Siach50efacf2009-06-30 11:41:39 -0700145}
146
Lennert Buytenhekb2221862011-01-12 17:00:16 -0800147static int pl061_irq_type(struct irq_data *d, unsigned trigger)
Baruch Siach1e9c2852009-06-18 16:48:58 -0700148{
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800149 struct pl061_gpio *chip = irq_data_get_irq_chip_data(d);
150 int offset = irqd_to_hwirq(d);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700151 unsigned long flags;
152 u8 gpiois, gpioibe, gpioiev;
153
Axel Linc1cc9b92010-05-26 14:42:19 -0700154 if (offset < 0 || offset >= PL061_GPIO_NR)
Baruch Siach1e9c2852009-06-18 16:48:58 -0700155 return -EINVAL;
156
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800157 spin_lock_irqsave(&chip->lock, flags);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700158
159 gpioiev = readb(chip->base + GPIOIEV);
160
161 gpiois = readb(chip->base + GPIOIS);
162 if (trigger & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) {
163 gpiois |= 1 << offset;
164 if (trigger & IRQ_TYPE_LEVEL_HIGH)
165 gpioiev |= 1 << offset;
166 else
167 gpioiev &= ~(1 << offset);
168 } else
169 gpiois &= ~(1 << offset);
170 writeb(gpiois, chip->base + GPIOIS);
171
172 gpioibe = readb(chip->base + GPIOIBE);
173 if ((trigger & IRQ_TYPE_EDGE_BOTH) == IRQ_TYPE_EDGE_BOTH)
174 gpioibe |= 1 << offset;
175 else {
176 gpioibe &= ~(1 << offset);
177 if (trigger & IRQ_TYPE_EDGE_RISING)
178 gpioiev |= 1 << offset;
viresh kumardb7e1bc2010-04-29 12:22:52 +0100179 else if (trigger & IRQ_TYPE_EDGE_FALLING)
Baruch Siach1e9c2852009-06-18 16:48:58 -0700180 gpioiev &= ~(1 << offset);
181 }
182 writeb(gpioibe, chip->base + GPIOIBE);
183
184 writeb(gpioiev, chip->base + GPIOIEV);
185
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800186 spin_unlock_irqrestore(&chip->lock, flags);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700187
188 return 0;
189}
190
Baruch Siach1e9c2852009-06-18 16:48:58 -0700191static void pl061_irq_handler(unsigned irq, struct irq_desc *desc)
192{
Rob Herring2de0dbc2012-01-04 10:36:07 -0600193 unsigned long pending;
194 int offset;
195 struct pl061_gpio *chip = irq_desc_get_handler_data(desc);
Rob Herringdece9042011-12-09 14:12:53 -0600196 struct irq_chip *irqchip = irq_desc_get_chip(desc);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700197
Rob Herringdece9042011-12-09 14:12:53 -0600198 chained_irq_enter(irqchip, desc);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700199
Rob Herring2de0dbc2012-01-04 10:36:07 -0600200 pending = readb(chip->base + GPIOMIS);
201 writeb(pending, chip->base + GPIOIC);
202 if (pending) {
Akinobu Mita984b3f52010-03-05 13:41:37 -0800203 for_each_set_bit(offset, &pending, PL061_GPIO_NR)
Baruch Siach50efacf2009-06-30 11:41:39 -0700204 generic_handle_irq(pl061_to_irq(&chip->gc, offset));
Baruch Siach1e9c2852009-06-18 16:48:58 -0700205 }
Rob Herring2de0dbc2012-01-04 10:36:07 -0600206
Rob Herringdece9042011-12-09 14:12:53 -0600207 chained_irq_exit(irqchip, desc);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700208}
209
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800210static void pl061_irq_mask(struct irq_data *d)
Rob Herring3ab52472011-10-21 08:05:53 -0500211{
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800212 struct pl061_gpio *chip = irq_data_get_irq_chip_data(d);
213 u8 mask = 1 << (irqd_to_hwirq(d) % PL061_GPIO_NR);
214 u8 gpioie;
Rob Herring3ab52472011-10-21 08:05:53 -0500215
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800216 spin_lock(&chip->lock);
217 gpioie = readb(chip->base + GPIOIE) & ~mask;
218 writeb(gpioie, chip->base + GPIOIE);
219 spin_unlock(&chip->lock);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700220}
221
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800222static void pl061_irq_unmask(struct irq_data *d)
223{
224 struct pl061_gpio *chip = irq_data_get_irq_chip_data(d);
225 u8 mask = 1 << (irqd_to_hwirq(d) % PL061_GPIO_NR);
226 u8 gpioie;
227
228 spin_lock(&chip->lock);
229 gpioie = readb(chip->base + GPIOIE) | mask;
230 writeb(gpioie, chip->base + GPIOIE);
231 spin_unlock(&chip->lock);
232}
233
234static struct irq_chip pl061_irqchip = {
235 .name = "pl061 gpio",
236 .irq_mask = pl061_irq_mask,
237 .irq_unmask = pl061_irq_unmask,
238 .irq_set_type = pl061_irq_type,
239};
240
Linus Walleijf8f669f2013-10-11 19:40:16 +0200241static int pl061_irq_map(struct irq_domain *d, unsigned int irq,
242 irq_hw_number_t hwirq)
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800243{
244 struct pl061_gpio *chip = d->host_data;
245
Linus Walleijf8f669f2013-10-11 19:40:16 +0200246 irq_set_chip_and_handler_name(irq, &pl061_irqchip, handle_simple_irq,
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800247 "pl061");
Linus Walleijf8f669f2013-10-11 19:40:16 +0200248 irq_set_chip_data(irq, chip);
249 irq_set_irq_type(irq, IRQ_TYPE_NONE);
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800250
251 return 0;
252}
253
254static const struct irq_domain_ops pl061_domain_ops = {
255 .map = pl061_irq_map,
256 .xlate = irq_domain_xlate_twocell,
257};
258
Tobias Klauser8944df72012-10-05 11:45:28 +0200259static int pl061_probe(struct amba_device *adev, const struct amba_id *id)
Baruch Siach1e9c2852009-06-18 16:48:58 -0700260{
Tobias Klauser8944df72012-10-05 11:45:28 +0200261 struct device *dev = &adev->dev;
Jingoo Hane56aee12013-07-30 17:08:05 +0900262 struct pl061_platform_data *pdata = dev_get_platdata(dev);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700263 struct pl061_gpio *chip;
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800264 int ret, irq, i, irq_base;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700265
Tobias Klauser8944df72012-10-05 11:45:28 +0200266 chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700267 if (chip == NULL)
268 return -ENOMEM;
269
Rob Herring76c05c82011-08-10 16:31:46 -0500270 if (pdata) {
271 chip->gc.base = pdata->gpio_base;
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800272 irq_base = pdata->irq_base;
273 if (irq_base <= 0)
274 return -ENODEV;
275 } else {
Rob Herring76c05c82011-08-10 16:31:46 -0500276 chip->gc.base = -1;
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800277 irq_base = 0;
278 }
Rob Herring76c05c82011-08-10 16:31:46 -0500279
Tobias Klauser8944df72012-10-05 11:45:28 +0200280 if (!devm_request_mem_region(dev, adev->res.start,
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800281 resource_size(&adev->res), "pl061"))
Tobias Klauser8944df72012-10-05 11:45:28 +0200282 return -EBUSY;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700283
Tobias Klauser8944df72012-10-05 11:45:28 +0200284 chip->base = devm_ioremap(dev, adev->res.start,
Haojian Zhuangf1f70472013-02-17 19:42:49 +0800285 resource_size(&adev->res));
286 if (!chip->base)
Tobias Klauser8944df72012-10-05 11:45:28 +0200287 return -ENOMEM;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700288
289 spin_lock_init(&chip->lock);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700290
Haojian Zhuang39b70ee2013-02-17 19:42:51 +0800291 chip->gc.request = pl061_gpio_request;
Axel Lin22ce4462013-03-15 20:52:07 +0800292 chip->gc.free = pl061_gpio_free;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700293 chip->gc.direction_input = pl061_direction_input;
294 chip->gc.direction_output = pl061_direction_output;
295 chip->gc.get = pl061_get_value;
296 chip->gc.set = pl061_set_value;
Baruch Siach50efacf2009-06-30 11:41:39 -0700297 chip->gc.to_irq = pl061_to_irq;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700298 chip->gc.ngpio = PL061_GPIO_NR;
Tobias Klauser8944df72012-10-05 11:45:28 +0200299 chip->gc.label = dev_name(dev);
300 chip->gc.dev = dev;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700301 chip->gc.owner = THIS_MODULE;
302
Baruch Siach1e9c2852009-06-18 16:48:58 -0700303 ret = gpiochip_add(&chip->gc);
304 if (ret)
Tobias Klauser8944df72012-10-05 11:45:28 +0200305 return ret;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700306
307 /*
308 * irq_chip support
309 */
Baruch Siach1e9c2852009-06-18 16:48:58 -0700310 writeb(0, chip->base + GPIOIE); /* disable irqs */
Tobias Klauser8944df72012-10-05 11:45:28 +0200311 irq = adev->irq[0];
312 if (irq < 0)
313 return -ENODEV;
314
Thomas Gleixnerb51804b2011-03-24 21:27:36 +0000315 irq_set_chained_handler(irq, pl061_irq_handler);
Rob Herring2de0dbc2012-01-04 10:36:07 -0600316 irq_set_handler_data(irq, chip);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700317
Linus Walleij2ba31542013-11-27 08:47:02 +0100318 chip->domain = irq_domain_add_simple(adev->dev.of_node, PL061_GPIO_NR,
319 irq_base, &pl061_domain_ops, chip);
320 if (!chip->domain)
321 return -ENODEV;
322
Baruch Siach1e9c2852009-06-18 16:48:58 -0700323 for (i = 0; i < PL061_GPIO_NR; i++) {
Rob Herring76c05c82011-08-10 16:31:46 -0500324 if (pdata) {
325 if (pdata->directions & (1 << i))
326 pl061_direction_output(&chip->gc, i,
327 pdata->values & (1 << i));
328 else
329 pl061_direction_input(&chip->gc, i);
330 }
Baruch Siach1e9c2852009-06-18 16:48:58 -0700331 }
332
Tobias Klauser8944df72012-10-05 11:45:28 +0200333 amba_set_drvdata(adev, chip);
Deepak Sikrie198a8de2011-11-18 15:20:12 +0530334
Baruch Siach1e9c2852009-06-18 16:48:58 -0700335 return 0;
Baruch Siach1e9c2852009-06-18 16:48:58 -0700336}
337
Deepak Sikrie198a8de2011-11-18 15:20:12 +0530338#ifdef CONFIG_PM
339static int pl061_suspend(struct device *dev)
340{
341 struct pl061_gpio *chip = dev_get_drvdata(dev);
342 int offset;
343
344 chip->csave_regs.gpio_data = 0;
345 chip->csave_regs.gpio_dir = readb(chip->base + GPIODIR);
346 chip->csave_regs.gpio_is = readb(chip->base + GPIOIS);
347 chip->csave_regs.gpio_ibe = readb(chip->base + GPIOIBE);
348 chip->csave_regs.gpio_iev = readb(chip->base + GPIOIEV);
349 chip->csave_regs.gpio_ie = readb(chip->base + GPIOIE);
350
351 for (offset = 0; offset < PL061_GPIO_NR; offset++) {
352 if (chip->csave_regs.gpio_dir & (1 << offset))
353 chip->csave_regs.gpio_data |=
354 pl061_get_value(&chip->gc, offset) << offset;
355 }
356
357 return 0;
358}
359
360static int pl061_resume(struct device *dev)
361{
362 struct pl061_gpio *chip = dev_get_drvdata(dev);
363 int offset;
364
365 for (offset = 0; offset < PL061_GPIO_NR; offset++) {
366 if (chip->csave_regs.gpio_dir & (1 << offset))
367 pl061_direction_output(&chip->gc, offset,
368 chip->csave_regs.gpio_data &
369 (1 << offset));
370 else
371 pl061_direction_input(&chip->gc, offset);
372 }
373
374 writeb(chip->csave_regs.gpio_is, chip->base + GPIOIS);
375 writeb(chip->csave_regs.gpio_ibe, chip->base + GPIOIBE);
376 writeb(chip->csave_regs.gpio_iev, chip->base + GPIOIEV);
377 writeb(chip->csave_regs.gpio_ie, chip->base + GPIOIE);
378
379 return 0;
380}
381
Viresh Kumar6e33ace2012-01-11 15:25:20 +0530382static const struct dev_pm_ops pl061_dev_pm_ops = {
383 .suspend = pl061_suspend,
384 .resume = pl061_resume,
385 .freeze = pl061_suspend,
386 .restore = pl061_resume,
387};
Deepak Sikrie198a8de2011-11-18 15:20:12 +0530388#endif
389
Russell King2c39c9e2010-07-27 08:50:16 +0100390static struct amba_id pl061_ids[] = {
Baruch Siach1e9c2852009-06-18 16:48:58 -0700391 {
392 .id = 0x00041061,
393 .mask = 0x000fffff,
394 },
395 { 0, 0 },
396};
397
Dave Martin955b6782011-10-05 15:15:21 +0100398MODULE_DEVICE_TABLE(amba, pl061_ids);
399
Baruch Siach1e9c2852009-06-18 16:48:58 -0700400static struct amba_driver pl061_gpio_driver = {
401 .drv = {
402 .name = "pl061_gpio",
Deepak Sikrie198a8de2011-11-18 15:20:12 +0530403#ifdef CONFIG_PM
404 .pm = &pl061_dev_pm_ops,
405#endif
Baruch Siach1e9c2852009-06-18 16:48:58 -0700406 },
407 .id_table = pl061_ids,
408 .probe = pl061_probe,
409};
410
411static int __init pl061_gpio_init(void)
412{
413 return amba_driver_register(&pl061_gpio_driver);
414}
Haojian Zhuang5985d762013-01-18 15:31:13 +0800415module_init(pl061_gpio_init);
Baruch Siach1e9c2852009-06-18 16:48:58 -0700416
417MODULE_AUTHOR("Baruch Siach <baruch@tkos.co.il>");
418MODULE_DESCRIPTION("PL061 GPIO driver");
419MODULE_LICENSE("GPL");