2 * This program is free software; you can redistribute it and/or modify it
3 * under the terms of the GNU General Public License version 2 as published
4 * by the Free Software Foundation.
6 * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
9 #include <linux/slab.h>
10 #include <linux/export.h>
11 #include <linux/platform_device.h>
12 #include <linux/gpio.h>
13 #include <linux/ioport.h>
16 #include <lantiq_soc.h>
18 #define LTQ_GPIO_OUT 0x00
19 #define LTQ_GPIO_IN 0x04
20 #define LTQ_GPIO_DIR 0x08
21 #define LTQ_GPIO_ALTSEL0 0x0C
22 #define LTQ_GPIO_ALTSEL1 0x10
23 #define LTQ_GPIO_OD 0x14
25 #define PINS_PER_PORT 16
28 #define ltq_gpio_getbit(m, r, p) (!!(ltq_r32(m + r) & (1 << p)))
29 #define ltq_gpio_setbit(m, r, p) ltq_w32_mask(0, (1 << p), m + r)
30 #define ltq_gpio_clearbit(m, r, p) ltq_w32_mask((1 << p), 0, m + r)
33 void __iomem *membase;
34 struct gpio_chip chip;
37 static struct ltq_gpio ltq_gpio_port[MAX_PORTS];
39 int ltq_gpio_request(unsigned int pin, unsigned int alt0,
40 unsigned int alt1, unsigned int dir, const char *name)
44 if (pin >= (MAX_PORTS * PINS_PER_PORT))
46 if (gpio_request(pin, name)) {
47 pr_err("failed to setup lantiq gpio: %s\n", name);
51 gpio_direction_output(pin, 1);
53 gpio_direction_input(pin);
54 while (pin >= PINS_PER_PORT) {
59 ltq_gpio_setbit(ltq_gpio_port[id].membase,
60 LTQ_GPIO_ALTSEL0, pin);
62 ltq_gpio_clearbit(ltq_gpio_port[id].membase,
63 LTQ_GPIO_ALTSEL0, pin);
65 ltq_gpio_setbit(ltq_gpio_port[id].membase,
66 LTQ_GPIO_ALTSEL1, pin);
68 ltq_gpio_clearbit(ltq_gpio_port[id].membase,
69 LTQ_GPIO_ALTSEL1, pin);
72 EXPORT_SYMBOL(ltq_gpio_request);
74 static void ltq_gpio_set(struct gpio_chip *chip, unsigned int offset, int value)
76 struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip);
79 ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_OUT, offset);
81 ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_OUT, offset);
84 static int ltq_gpio_get(struct gpio_chip *chip, unsigned int offset)
86 struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip);
88 return ltq_gpio_getbit(ltq_gpio->membase, LTQ_GPIO_IN, offset);
91 static int ltq_gpio_direction_input(struct gpio_chip *chip, unsigned int offset)
93 struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip);
95 ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_OD, offset);
96 ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_DIR, offset);
101 static int ltq_gpio_direction_output(struct gpio_chip *chip,
102 unsigned int offset, int value)
104 struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip);
106 ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_OD, offset);
107 ltq_gpio_setbit(ltq_gpio->membase, LTQ_GPIO_DIR, offset);
108 ltq_gpio_set(chip, offset, value);
113 static int ltq_gpio_req(struct gpio_chip *chip, unsigned offset)
115 struct ltq_gpio *ltq_gpio = container_of(chip, struct ltq_gpio, chip);
117 ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_ALTSEL0, offset);
118 ltq_gpio_clearbit(ltq_gpio->membase, LTQ_GPIO_ALTSEL1, offset);
122 static int ltq_gpio_probe(struct platform_device *pdev)
124 struct resource *res;
126 if (pdev->id >= MAX_PORTS) {
127 dev_err(&pdev->dev, "invalid gpio port %d\n",
131 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
133 dev_err(&pdev->dev, "failed to get memory for gpio port %d\n",
137 res = devm_request_mem_region(&pdev->dev, res->start,
138 resource_size(res), dev_name(&pdev->dev));
141 "failed to request memory for gpio port %d\n",
145 ltq_gpio_port[pdev->id].membase = devm_ioremap_nocache(&pdev->dev,
146 res->start, resource_size(res));
147 if (!ltq_gpio_port[pdev->id].membase) {
148 dev_err(&pdev->dev, "failed to remap memory for gpio port %d\n",
152 ltq_gpio_port[pdev->id].chip.label = "ltq_gpio";
153 ltq_gpio_port[pdev->id].chip.direction_input = ltq_gpio_direction_input;
154 ltq_gpio_port[pdev->id].chip.direction_output =
155 ltq_gpio_direction_output;
156 ltq_gpio_port[pdev->id].chip.get = ltq_gpio_get;
157 ltq_gpio_port[pdev->id].chip.set = ltq_gpio_set;
158 ltq_gpio_port[pdev->id].chip.request = ltq_gpio_req;
159 ltq_gpio_port[pdev->id].chip.base = PINS_PER_PORT * pdev->id;
160 ltq_gpio_port[pdev->id].chip.ngpio = PINS_PER_PORT;
161 platform_set_drvdata(pdev, <q_gpio_port[pdev->id]);
162 return gpiochip_add(<q_gpio_port[pdev->id].chip);
165 static struct platform_driver
167 .probe = ltq_gpio_probe,
170 .owner = THIS_MODULE,
174 int __init ltq_gpio_init(void)
176 int ret = platform_driver_register(<q_gpio_driver);
179 pr_info("ltq_gpio : Error registering platform driver!");
183 postcore_initcall(ltq_gpio_init);