Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 1 | /* |
Grant Likely | c103de2 | 2011-06-04 18:38:28 -0600 | [diff] [blame] | 2 | * Copyright (C) 2008, 2009 Provigent Ltd. |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 3 | * |
| 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 Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 15 | #include <linux/io.h> |
| 16 | #include <linux/ioport.h> |
| 17 | #include <linux/irq.h> |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 18 | #include <linux/irqdomain.h> |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 19 | #include <linux/bitops.h> |
| 20 | #include <linux/workqueue.h> |
| 21 | #include <linux/gpio.h> |
| 22 | #include <linux/device.h> |
| 23 | #include <linux/amba/bus.h> |
| 24 | #include <linux/amba/pl061.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 25 | #include <linux/slab.h> |
Haojian Zhuang | 39b70ee | 2013-02-17 19:42:51 +0800 | [diff] [blame] | 26 | #include <linux/pinctrl/consumer.h> |
Deepak Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 27 | #include <linux/pm.h> |
Rob Herring | dece904 | 2011-12-09 14:12:53 -0600 | [diff] [blame] | 28 | #include <asm/mach/irq.h> |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 29 | |
| 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 Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 41 | #ifdef CONFIG_PM |
| 42 | struct 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 Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 51 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 52 | struct pl061_gpio { |
Baruch Siach | 835c192 | 2012-11-22 11:46:14 +0200 | [diff] [blame] | 53 | spinlock_t lock; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 54 | |
| 55 | void __iomem *base; |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 56 | struct irq_domain *domain; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 57 | struct gpio_chip gc; |
Deepak Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 58 | |
| 59 | #ifdef CONFIG_PM |
| 60 | struct pl061_context_save_regs csave_regs; |
| 61 | #endif |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 62 | }; |
| 63 | |
Haojian Zhuang | 39b70ee | 2013-02-17 19:42:51 +0800 | [diff] [blame] | 64 | static 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 Lin | 22ce446 | 2013-03-15 20:52:07 +0800 | [diff] [blame^] | 75 | static 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 Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 82 | static 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 | |
| 100 | static 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 kumar | 64b997c5 | 2010-04-21 09:42:05 +0100 | [diff] [blame] | 115 | |
| 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 Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 121 | spin_unlock_irqrestore(&chip->lock, flags); |
| 122 | |
| 123 | return 0; |
| 124 | } |
| 125 | |
| 126 | static 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 | |
| 133 | static 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 Siach | 50efacf | 2009-06-30 11:41:39 -0700 | [diff] [blame] | 140 | static 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 Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 144 | return irq_create_mapping(chip->domain, offset); |
Baruch Siach | 50efacf | 2009-06-30 11:41:39 -0700 | [diff] [blame] | 145 | } |
| 146 | |
Lennert Buytenhek | b222186 | 2011-01-12 17:00:16 -0800 | [diff] [blame] | 147 | static int pl061_irq_type(struct irq_data *d, unsigned trigger) |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 148 | { |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 149 | struct pl061_gpio *chip = irq_data_get_irq_chip_data(d); |
| 150 | int offset = irqd_to_hwirq(d); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 151 | unsigned long flags; |
| 152 | u8 gpiois, gpioibe, gpioiev; |
| 153 | |
Axel Lin | c1cc9b9 | 2010-05-26 14:42:19 -0700 | [diff] [blame] | 154 | if (offset < 0 || offset >= PL061_GPIO_NR) |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 155 | return -EINVAL; |
| 156 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 157 | spin_lock_irqsave(&chip->lock, flags); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 158 | |
| 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 kumar | db7e1bc | 2010-04-29 12:22:52 +0100 | [diff] [blame] | 179 | else if (trigger & IRQ_TYPE_EDGE_FALLING) |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 180 | gpioiev &= ~(1 << offset); |
| 181 | } |
| 182 | writeb(gpioibe, chip->base + GPIOIBE); |
| 183 | |
| 184 | writeb(gpioiev, chip->base + GPIOIEV); |
| 185 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 186 | spin_unlock_irqrestore(&chip->lock, flags); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 187 | |
| 188 | return 0; |
| 189 | } |
| 190 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 191 | static void pl061_irq_handler(unsigned irq, struct irq_desc *desc) |
| 192 | { |
Rob Herring | 2de0dbc | 2012-01-04 10:36:07 -0600 | [diff] [blame] | 193 | unsigned long pending; |
| 194 | int offset; |
| 195 | struct pl061_gpio *chip = irq_desc_get_handler_data(desc); |
Rob Herring | dece904 | 2011-12-09 14:12:53 -0600 | [diff] [blame] | 196 | struct irq_chip *irqchip = irq_desc_get_chip(desc); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 197 | |
Rob Herring | dece904 | 2011-12-09 14:12:53 -0600 | [diff] [blame] | 198 | chained_irq_enter(irqchip, desc); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 199 | |
Rob Herring | 2de0dbc | 2012-01-04 10:36:07 -0600 | [diff] [blame] | 200 | pending = readb(chip->base + GPIOMIS); |
| 201 | writeb(pending, chip->base + GPIOIC); |
| 202 | if (pending) { |
Akinobu Mita | 984b3f5 | 2010-03-05 13:41:37 -0800 | [diff] [blame] | 203 | for_each_set_bit(offset, &pending, PL061_GPIO_NR) |
Baruch Siach | 50efacf | 2009-06-30 11:41:39 -0700 | [diff] [blame] | 204 | generic_handle_irq(pl061_to_irq(&chip->gc, offset)); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 205 | } |
Rob Herring | 2de0dbc | 2012-01-04 10:36:07 -0600 | [diff] [blame] | 206 | |
Rob Herring | dece904 | 2011-12-09 14:12:53 -0600 | [diff] [blame] | 207 | chained_irq_exit(irqchip, desc); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 208 | } |
| 209 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 210 | static void pl061_irq_mask(struct irq_data *d) |
Rob Herring | 3ab5247 | 2011-10-21 08:05:53 -0500 | [diff] [blame] | 211 | { |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 212 | 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 Herring | 3ab5247 | 2011-10-21 08:05:53 -0500 | [diff] [blame] | 215 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 216 | spin_lock(&chip->lock); |
| 217 | gpioie = readb(chip->base + GPIOIE) & ~mask; |
| 218 | writeb(gpioie, chip->base + GPIOIE); |
| 219 | spin_unlock(&chip->lock); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 220 | } |
| 221 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 222 | static 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 | |
| 234 | static 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 | |
| 241 | static int pl061_irq_map(struct irq_domain *d, unsigned int virq, |
| 242 | irq_hw_number_t hw) |
| 243 | { |
| 244 | struct pl061_gpio *chip = d->host_data; |
| 245 | |
| 246 | irq_set_chip_and_handler_name(virq, &pl061_irqchip, handle_simple_irq, |
| 247 | "pl061"); |
| 248 | irq_set_chip_data(virq, chip); |
| 249 | irq_set_irq_type(virq, IRQ_TYPE_NONE); |
| 250 | |
| 251 | return 0; |
| 252 | } |
| 253 | |
| 254 | static const struct irq_domain_ops pl061_domain_ops = { |
| 255 | .map = pl061_irq_map, |
| 256 | .xlate = irq_domain_xlate_twocell, |
| 257 | }; |
| 258 | |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 259 | static int pl061_probe(struct amba_device *adev, const struct amba_id *id) |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 260 | { |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 261 | struct device *dev = &adev->dev; |
| 262 | struct pl061_platform_data *pdata = dev->platform_data; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 263 | struct pl061_gpio *chip; |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 264 | int ret, irq, i, irq_base; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 265 | |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 266 | chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 267 | if (chip == NULL) |
| 268 | return -ENOMEM; |
| 269 | |
Rob Herring | 76c05c8 | 2011-08-10 16:31:46 -0500 | [diff] [blame] | 270 | if (pdata) { |
| 271 | chip->gc.base = pdata->gpio_base; |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 272 | irq_base = pdata->irq_base; |
| 273 | if (irq_base <= 0) |
| 274 | return -ENODEV; |
| 275 | } else { |
Rob Herring | 76c05c8 | 2011-08-10 16:31:46 -0500 | [diff] [blame] | 276 | chip->gc.base = -1; |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 277 | irq_base = 0; |
| 278 | } |
Rob Herring | 76c05c8 | 2011-08-10 16:31:46 -0500 | [diff] [blame] | 279 | |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 280 | if (!devm_request_mem_region(dev, adev->res.start, |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 281 | resource_size(&adev->res), "pl061")) |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 282 | return -EBUSY; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 283 | |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 284 | chip->base = devm_ioremap(dev, adev->res.start, |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 285 | resource_size(&adev->res)); |
| 286 | if (!chip->base) |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 287 | return -ENOMEM; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 288 | |
Haojian Zhuang | f1f7047 | 2013-02-17 19:42:49 +0800 | [diff] [blame] | 289 | chip->domain = irq_domain_add_simple(adev->dev.of_node, PL061_GPIO_NR, |
| 290 | irq_base, &pl061_domain_ops, chip); |
| 291 | if (!chip->domain) |
| 292 | return -ENODEV; |
| 293 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 294 | spin_lock_init(&chip->lock); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 295 | |
Haojian Zhuang | 39b70ee | 2013-02-17 19:42:51 +0800 | [diff] [blame] | 296 | chip->gc.request = pl061_gpio_request; |
Axel Lin | 22ce446 | 2013-03-15 20:52:07 +0800 | [diff] [blame^] | 297 | chip->gc.free = pl061_gpio_free; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 298 | chip->gc.direction_input = pl061_direction_input; |
| 299 | chip->gc.direction_output = pl061_direction_output; |
| 300 | chip->gc.get = pl061_get_value; |
| 301 | chip->gc.set = pl061_set_value; |
Baruch Siach | 50efacf | 2009-06-30 11:41:39 -0700 | [diff] [blame] | 302 | chip->gc.to_irq = pl061_to_irq; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 303 | chip->gc.ngpio = PL061_GPIO_NR; |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 304 | chip->gc.label = dev_name(dev); |
| 305 | chip->gc.dev = dev; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 306 | chip->gc.owner = THIS_MODULE; |
| 307 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 308 | ret = gpiochip_add(&chip->gc); |
| 309 | if (ret) |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 310 | return ret; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 311 | |
| 312 | /* |
| 313 | * irq_chip support |
| 314 | */ |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 315 | writeb(0, chip->base + GPIOIE); /* disable irqs */ |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 316 | irq = adev->irq[0]; |
| 317 | if (irq < 0) |
| 318 | return -ENODEV; |
| 319 | |
Thomas Gleixner | b51804b | 2011-03-24 21:27:36 +0000 | [diff] [blame] | 320 | irq_set_chained_handler(irq, pl061_irq_handler); |
Rob Herring | 2de0dbc | 2012-01-04 10:36:07 -0600 | [diff] [blame] | 321 | irq_set_handler_data(irq, chip); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 322 | |
| 323 | for (i = 0; i < PL061_GPIO_NR; i++) { |
Rob Herring | 76c05c8 | 2011-08-10 16:31:46 -0500 | [diff] [blame] | 324 | 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 Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 331 | } |
| 332 | |
Tobias Klauser | 8944df7 | 2012-10-05 11:45:28 +0200 | [diff] [blame] | 333 | amba_set_drvdata(adev, chip); |
Deepak Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 334 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 335 | return 0; |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 336 | } |
| 337 | |
Deepak Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 338 | #ifdef CONFIG_PM |
| 339 | static 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 | |
| 360 | static 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 Kumar | 6e33ace | 2012-01-11 15:25:20 +0530 | [diff] [blame] | 382 | static 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 Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 388 | #endif |
| 389 | |
Russell King | 2c39c9e | 2010-07-27 08:50:16 +0100 | [diff] [blame] | 390 | static struct amba_id pl061_ids[] = { |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 391 | { |
| 392 | .id = 0x00041061, |
| 393 | .mask = 0x000fffff, |
| 394 | }, |
| 395 | { 0, 0 }, |
| 396 | }; |
| 397 | |
Dave Martin | 955b678 | 2011-10-05 15:15:21 +0100 | [diff] [blame] | 398 | MODULE_DEVICE_TABLE(amba, pl061_ids); |
| 399 | |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 400 | static struct amba_driver pl061_gpio_driver = { |
| 401 | .drv = { |
| 402 | .name = "pl061_gpio", |
Deepak Sikri | e198a8de | 2011-11-18 15:20:12 +0530 | [diff] [blame] | 403 | #ifdef CONFIG_PM |
| 404 | .pm = &pl061_dev_pm_ops, |
| 405 | #endif |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 406 | }, |
| 407 | .id_table = pl061_ids, |
| 408 | .probe = pl061_probe, |
| 409 | }; |
| 410 | |
| 411 | static int __init pl061_gpio_init(void) |
| 412 | { |
| 413 | return amba_driver_register(&pl061_gpio_driver); |
| 414 | } |
Haojian Zhuang | 5985d76 | 2013-01-18 15:31:13 +0800 | [diff] [blame] | 415 | module_init(pl061_gpio_init); |
Baruch Siach | 1e9c285 | 2009-06-18 16:48:58 -0700 | [diff] [blame] | 416 | |
| 417 | MODULE_AUTHOR("Baruch Siach <baruch@tkos.co.il>"); |
| 418 | MODULE_DESCRIPTION("PL061 GPIO driver"); |
| 419 | MODULE_LICENSE("GPL"); |