2 * Atmel PIO2 Port Multiplexer support
4 * Copyright (C) 2004-2006 Atmel Corporation
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/clk.h>
12 #include <linux/debugfs.h>
14 #include <linux/platform_device.h>
15 #include <linux/irq.h>
20 #include <asm/arch/portmux.h>
24 #define MAX_NR_PIO_DEVICES 8
28 const struct platform_device *pdev;
35 static struct pio_device pio_dev[MAX_NR_PIO_DEVICES];
37 static struct pio_device *gpio_to_pio(unsigned int gpio)
39 struct pio_device *pio;
43 if (index >= MAX_NR_PIO_DEVICES)
45 pio = &pio_dev[index];
52 /* Pin multiplexing API */
54 void __init at32_select_periph(unsigned int pin, unsigned int periph,
57 struct pio_device *pio;
58 unsigned int pin_index = pin & 0x1f;
59 u32 mask = 1 << pin_index;
61 pio = gpio_to_pio(pin);
63 printk("pio: invalid pin %u\n", pin);
67 if (unlikely(test_and_set_bit(pin_index, &pio->pinmux_mask))) {
68 printk("%s: pin %u is busy\n", pio->name, pin_index);
72 pio_writel(pio, PUER, mask);
74 pio_writel(pio, BSR, mask);
76 pio_writel(pio, ASR, mask);
78 pio_writel(pio, PDR, mask);
79 if (!(flags & AT32_GPIOF_PULLUP))
80 pio_writel(pio, PUDR, mask);
82 /* gpio_request NOT allowed */
83 set_bit(pin_index, &pio->gpio_mask);
91 void __init at32_select_gpio(unsigned int pin, unsigned long flags)
93 struct pio_device *pio;
94 unsigned int pin_index = pin & 0x1f;
95 u32 mask = 1 << pin_index;
97 pio = gpio_to_pio(pin);
99 printk("pio: invalid pin %u\n", pin);
103 if (unlikely(test_and_set_bit(pin_index, &pio->pinmux_mask))) {
104 printk("%s: pin %u is busy\n", pio->name, pin_index);
108 if (flags & AT32_GPIOF_OUTPUT) {
109 if (flags & AT32_GPIOF_HIGH)
110 pio_writel(pio, SODR, mask);
112 pio_writel(pio, CODR, mask);
113 pio_writel(pio, PUDR, mask);
114 pio_writel(pio, OER, mask);
116 if (flags & AT32_GPIOF_PULLUP)
117 pio_writel(pio, PUER, mask);
119 pio_writel(pio, PUDR, mask);
120 if (flags & AT32_GPIOF_DEGLITCH)
121 pio_writel(pio, IFER, mask);
123 pio_writel(pio, IFDR, mask);
124 pio_writel(pio, ODR, mask);
127 pio_writel(pio, PER, mask);
129 /* gpio_request now allowed */
130 clear_bit(pin_index, &pio->gpio_mask);
138 /*--------------------------------------------------------------------------*/
140 /*--------------------------------------------------------------------------*/
144 int gpio_request(unsigned int gpio, const char *label)
146 struct pio_device *pio;
149 pio = gpio_to_pio(gpio);
154 if (test_and_set_bit(pin, &pio->gpio_mask))
159 EXPORT_SYMBOL(gpio_request);
161 void gpio_free(unsigned int gpio)
163 struct pio_device *pio;
166 pio = gpio_to_pio(gpio);
169 "gpio: attempted to free invalid pin %u\n", gpio);
174 if (!test_and_clear_bit(pin, &pio->gpio_mask))
175 printk(KERN_ERR "gpio: freeing free or non-gpio pin %s-%u\n",
178 EXPORT_SYMBOL(gpio_free);
180 int gpio_direction_input(unsigned int gpio)
182 struct pio_device *pio;
185 pio = gpio_to_pio(gpio);
190 pio_writel(pio, ODR, 1 << pin);
194 EXPORT_SYMBOL(gpio_direction_input);
196 int gpio_direction_output(unsigned int gpio)
198 struct pio_device *pio;
201 pio = gpio_to_pio(gpio);
206 pio_writel(pio, OER, 1 << pin);
210 EXPORT_SYMBOL(gpio_direction_output);
212 int gpio_get_value(unsigned int gpio)
214 struct pio_device *pio = &pio_dev[gpio >> 5];
216 return (pio_readl(pio, PDSR) >> (gpio & 0x1f)) & 1;
218 EXPORT_SYMBOL(gpio_get_value);
220 void gpio_set_value(unsigned int gpio, int value)
222 struct pio_device *pio = &pio_dev[gpio >> 5];
225 mask = 1 << (gpio & 0x1f);
227 pio_writel(pio, SODR, mask);
229 pio_writel(pio, CODR, mask);
231 EXPORT_SYMBOL(gpio_set_value);
233 /*--------------------------------------------------------------------------*/
235 /* GPIO IRQ support */
237 static void gpio_irq_mask(unsigned irq)
239 unsigned gpio = irq_to_gpio(irq);
240 struct pio_device *pio = &pio_dev[gpio >> 5];
242 pio_writel(pio, IDR, 1 << (gpio & 0x1f));
245 static void gpio_irq_unmask(unsigned irq)
247 unsigned gpio = irq_to_gpio(irq);
248 struct pio_device *pio = &pio_dev[gpio >> 5];
250 pio_writel(pio, IER, 1 << (gpio & 0x1f));
253 static int gpio_irq_type(unsigned irq, unsigned type)
255 if (type != IRQ_TYPE_EDGE_BOTH && type != IRQ_TYPE_NONE)
261 static struct irq_chip gpio_irqchip = {
263 .mask = gpio_irq_mask,
264 .unmask = gpio_irq_unmask,
265 .set_type = gpio_irq_type,
268 static void gpio_irq_handler(unsigned irq, struct irq_desc *desc)
270 struct pio_device *pio = get_irq_chip_data(irq);
273 gpio_irq = (unsigned) get_irq_data(irq);
278 /* ack pending GPIO interrupts */
279 isr = pio_readl(pio, ISR) & pio_readl(pio, IMR);
297 gpio_irq_setup(struct pio_device *pio, int irq, int gpio_irq)
301 set_irq_chip_data(irq, pio);
302 set_irq_data(irq, (void *) gpio_irq);
304 for (i = 0; i < 32; i++, gpio_irq++) {
305 set_irq_chip_data(gpio_irq, pio);
306 set_irq_chip_and_handler(gpio_irq, &gpio_irqchip,
310 set_irq_chained_handler(irq, gpio_irq_handler);
313 /*--------------------------------------------------------------------------*/
315 static int __init pio_probe(struct platform_device *pdev)
317 struct pio_device *pio = NULL;
318 int irq = platform_get_irq(pdev, 0);
319 int gpio_irq_base = GPIO_IRQ_BASE + pdev->id * 32;
321 BUG_ON(pdev->id >= MAX_NR_PIO_DEVICES);
322 pio = &pio_dev[pdev->id];
325 gpio_irq_setup(pio, irq, gpio_irq_base);
327 platform_set_drvdata(pdev, pio);
329 printk(KERN_DEBUG "%s: base 0x%p, irq %d chains %d..%d\n",
330 pio->name, pio->regs, irq, gpio_irq_base, gpio_irq_base + 31);
335 static struct platform_driver pio_driver = {
342 static int __init pio_init(void)
344 return platform_driver_register(&pio_driver);
346 postcore_initcall(pio_init);
348 void __init at32_init_pio(struct platform_device *pdev)
350 struct resource *regs;
351 struct pio_device *pio;
353 if (pdev->id > MAX_NR_PIO_DEVICES) {
354 dev_err(&pdev->dev, "only %d PIO devices supported\n",
359 pio = &pio_dev[pdev->id];
360 snprintf(pio->name, sizeof(pio->name), "pio%d", pdev->id);
362 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
364 dev_err(&pdev->dev, "no mmio resource defined\n");
368 pio->clk = clk_get(&pdev->dev, "mck");
369 if (IS_ERR(pio->clk))
371 * This is a fatal error, but if we continue we might
372 * be so lucky that we manage to initialize the
373 * console and display this message...
375 dev_err(&pdev->dev, "no mck clock defined\n");
377 clk_enable(pio->clk);
380 pio->regs = ioremap(regs->start, regs->end - regs->start + 1);
383 * request_gpio() is only valid for pins that have been
384 * explicitly configured as GPIO and not previously requested
386 pio->gpio_mask = ~0UL;
388 pio_writel(pio, ODR, ~0UL);
389 pio_writel(pio, PER, ~0UL);
391 /* start with irqs disabled and acked */
392 pio_writel(pio, IDR, ~0UL);
393 (void) pio_readl(pio, ISR);