|
@@ -12,7 +12,9 @@
|
|
|
#include <linux/debugfs.h>
|
|
|
#include <linux/fs.h>
|
|
|
#include <linux/platform_device.h>
|
|
|
+#include <linux/irq.h>
|
|
|
|
|
|
+#include <asm/gpio.h>
|
|
|
#include <asm/io.h>
|
|
|
|
|
|
#include <asm/arch/portmux.h>
|
|
@@ -26,7 +28,8 @@ struct pio_device {
|
|
|
const struct platform_device *pdev;
|
|
|
struct clk *clk;
|
|
|
u32 pinmux_mask;
|
|
|
- char name[32];
|
|
|
+ u32 gpio_mask;
|
|
|
+ char name[8];
|
|
|
};
|
|
|
|
|
|
static struct pio_device pio_dev[MAX_NR_PIO_DEVICES];
|
|
@@ -76,6 +79,9 @@ void __init at32_select_periph(unsigned int pin, unsigned int periph,
|
|
|
if (!(flags & AT32_GPIOF_PULLUP))
|
|
|
pio_writel(pio, PUDR, mask);
|
|
|
|
|
|
+ /* gpio_request NOT allowed */
|
|
|
+ set_bit(pin_index, &pio->gpio_mask);
|
|
|
+
|
|
|
return;
|
|
|
|
|
|
fail:
|
|
@@ -99,19 +105,52 @@ void __init at32_select_gpio(unsigned int pin, unsigned long flags)
|
|
|
goto fail;
|
|
|
}
|
|
|
|
|
|
- pio_writel(pio, PUER, mask);
|
|
|
- if (flags & AT32_GPIOF_HIGH)
|
|
|
- pio_writel(pio, SODR, mask);
|
|
|
- else
|
|
|
- pio_writel(pio, CODR, mask);
|
|
|
- if (flags & AT32_GPIOF_OUTPUT)
|
|
|
+ if (flags & AT32_GPIOF_OUTPUT) {
|
|
|
+ if (flags & AT32_GPIOF_HIGH)
|
|
|
+ pio_writel(pio, SODR, mask);
|
|
|
+ else
|
|
|
+ pio_writel(pio, CODR, mask);
|
|
|
+ pio_writel(pio, PUDR, mask);
|
|
|
pio_writel(pio, OER, mask);
|
|
|
- else
|
|
|
+ } else {
|
|
|
+ if (flags & AT32_GPIOF_PULLUP)
|
|
|
+ pio_writel(pio, PUER, mask);
|
|
|
+ else
|
|
|
+ pio_writel(pio, PUDR, mask);
|
|
|
+ if (flags & AT32_GPIOF_DEGLITCH)
|
|
|
+ pio_writel(pio, IFER, mask);
|
|
|
+ else
|
|
|
+ pio_writel(pio, IFDR, mask);
|
|
|
pio_writel(pio, ODR, mask);
|
|
|
+ }
|
|
|
|
|
|
pio_writel(pio, PER, mask);
|
|
|
- if (!(flags & AT32_GPIOF_PULLUP))
|
|
|
- pio_writel(pio, PUDR, mask);
|
|
|
+
|
|
|
+ /* gpio_request now allowed */
|
|
|
+ clear_bit(pin_index, &pio->gpio_mask);
|
|
|
+
|
|
|
+ return;
|
|
|
+
|
|
|
+fail:
|
|
|
+ dump_stack();
|
|
|
+}
|
|
|
+
|
|
|
+/* Reserve a pin, preventing anyone else from changing its configuration. */
|
|
|
+void __init at32_reserve_pin(unsigned int pin)
|
|
|
+{
|
|
|
+ struct pio_device *pio;
|
|
|
+ unsigned int pin_index = pin & 0x1f;
|
|
|
+
|
|
|
+ pio = gpio_to_pio(pin);
|
|
|
+ if (unlikely(!pio)) {
|
|
|
+ printk("pio: invalid pin %u\n", pin);
|
|
|
+ goto fail;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (unlikely(test_and_set_bit(pin_index, &pio->pinmux_mask))) {
|
|
|
+ printk("%s: pin %u is busy\n", pio->name, pin_index);
|
|
|
+ goto fail;
|
|
|
+ }
|
|
|
|
|
|
return;
|
|
|
|
|
@@ -119,20 +158,197 @@ fail:
|
|
|
dump_stack();
|
|
|
}
|
|
|
|
|
|
+/*--------------------------------------------------------------------------*/
|
|
|
+
|
|
|
+/* GPIO API */
|
|
|
+
|
|
|
+int gpio_request(unsigned int gpio, const char *label)
|
|
|
+{
|
|
|
+ struct pio_device *pio;
|
|
|
+ unsigned int pin;
|
|
|
+
|
|
|
+ pio = gpio_to_pio(gpio);
|
|
|
+ if (!pio)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ pin = gpio & 0x1f;
|
|
|
+ if (test_and_set_bit(pin, &pio->gpio_mask))
|
|
|
+ return -EBUSY;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_request);
|
|
|
+
|
|
|
+void gpio_free(unsigned int gpio)
|
|
|
+{
|
|
|
+ struct pio_device *pio;
|
|
|
+ unsigned int pin;
|
|
|
+
|
|
|
+ pio = gpio_to_pio(gpio);
|
|
|
+ if (!pio) {
|
|
|
+ printk(KERN_ERR
|
|
|
+ "gpio: attempted to free invalid pin %u\n", gpio);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ pin = gpio & 0x1f;
|
|
|
+ if (!test_and_clear_bit(pin, &pio->gpio_mask))
|
|
|
+ printk(KERN_ERR "gpio: freeing free or non-gpio pin %s-%u\n",
|
|
|
+ pio->name, pin);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_free);
|
|
|
+
|
|
|
+int gpio_direction_input(unsigned int gpio)
|
|
|
+{
|
|
|
+ struct pio_device *pio;
|
|
|
+ unsigned int pin;
|
|
|
+
|
|
|
+ pio = gpio_to_pio(gpio);
|
|
|
+ if (!pio)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ pin = gpio & 0x1f;
|
|
|
+ pio_writel(pio, ODR, 1 << pin);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_direction_input);
|
|
|
+
|
|
|
+int gpio_direction_output(unsigned int gpio)
|
|
|
+{
|
|
|
+ struct pio_device *pio;
|
|
|
+ unsigned int pin;
|
|
|
+
|
|
|
+ pio = gpio_to_pio(gpio);
|
|
|
+ if (!pio)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ pin = gpio & 0x1f;
|
|
|
+ pio_writel(pio, OER, 1 << pin);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_direction_output);
|
|
|
+
|
|
|
+int gpio_get_value(unsigned int gpio)
|
|
|
+{
|
|
|
+ struct pio_device *pio = &pio_dev[gpio >> 5];
|
|
|
+
|
|
|
+ return (pio_readl(pio, PDSR) >> (gpio & 0x1f)) & 1;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_get_value);
|
|
|
+
|
|
|
+void gpio_set_value(unsigned int gpio, int value)
|
|
|
+{
|
|
|
+ struct pio_device *pio = &pio_dev[gpio >> 5];
|
|
|
+ u32 mask;
|
|
|
+
|
|
|
+ mask = 1 << (gpio & 0x1f);
|
|
|
+ if (value)
|
|
|
+ pio_writel(pio, SODR, mask);
|
|
|
+ else
|
|
|
+ pio_writel(pio, CODR, mask);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(gpio_set_value);
|
|
|
+
|
|
|
+/*--------------------------------------------------------------------------*/
|
|
|
+
|
|
|
+/* GPIO IRQ support */
|
|
|
+
|
|
|
+static void gpio_irq_mask(unsigned irq)
|
|
|
+{
|
|
|
+ unsigned gpio = irq_to_gpio(irq);
|
|
|
+ struct pio_device *pio = &pio_dev[gpio >> 5];
|
|
|
+
|
|
|
+ pio_writel(pio, IDR, 1 << (gpio & 0x1f));
|
|
|
+}
|
|
|
+
|
|
|
+static void gpio_irq_unmask(unsigned irq)
|
|
|
+{
|
|
|
+ unsigned gpio = irq_to_gpio(irq);
|
|
|
+ struct pio_device *pio = &pio_dev[gpio >> 5];
|
|
|
+
|
|
|
+ pio_writel(pio, IER, 1 << (gpio & 0x1f));
|
|
|
+}
|
|
|
+
|
|
|
+static int gpio_irq_type(unsigned irq, unsigned type)
|
|
|
+{
|
|
|
+ if (type != IRQ_TYPE_EDGE_BOTH && type != IRQ_TYPE_NONE)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct irq_chip gpio_irqchip = {
|
|
|
+ .name = "gpio",
|
|
|
+ .mask = gpio_irq_mask,
|
|
|
+ .unmask = gpio_irq_unmask,
|
|
|
+ .set_type = gpio_irq_type,
|
|
|
+};
|
|
|
+
|
|
|
+static void gpio_irq_handler(unsigned irq, struct irq_desc *desc)
|
|
|
+{
|
|
|
+ struct pio_device *pio = get_irq_chip_data(irq);
|
|
|
+ unsigned gpio_irq;
|
|
|
+
|
|
|
+ gpio_irq = (unsigned) get_irq_data(irq);
|
|
|
+ for (;;) {
|
|
|
+ u32 isr;
|
|
|
+ struct irq_desc *d;
|
|
|
+
|
|
|
+ /* ack pending GPIO interrupts */
|
|
|
+ isr = pio_readl(pio, ISR) & pio_readl(pio, IMR);
|
|
|
+ if (!isr)
|
|
|
+ break;
|
|
|
+ do {
|
|
|
+ int i;
|
|
|
+
|
|
|
+ i = ffs(isr) - 1;
|
|
|
+ isr &= ~(1 << i);
|
|
|
+
|
|
|
+ i += gpio_irq;
|
|
|
+ d = &irq_desc[i];
|
|
|
+
|
|
|
+ d->handle_irq(i, d);
|
|
|
+ } while (isr);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void __init
|
|
|
+gpio_irq_setup(struct pio_device *pio, int irq, int gpio_irq)
|
|
|
+{
|
|
|
+ unsigned i;
|
|
|
+
|
|
|
+ set_irq_chip_data(irq, pio);
|
|
|
+ set_irq_data(irq, (void *) gpio_irq);
|
|
|
+
|
|
|
+ for (i = 0; i < 32; i++, gpio_irq++) {
|
|
|
+ set_irq_chip_data(gpio_irq, pio);
|
|
|
+ set_irq_chip_and_handler(gpio_irq, &gpio_irqchip,
|
|
|
+ handle_simple_irq);
|
|
|
+ }
|
|
|
+
|
|
|
+ set_irq_chained_handler(irq, gpio_irq_handler);
|
|
|
+}
|
|
|
+
|
|
|
+/*--------------------------------------------------------------------------*/
|
|
|
+
|
|
|
static int __init pio_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
struct pio_device *pio = NULL;
|
|
|
+ int irq = platform_get_irq(pdev, 0);
|
|
|
+ int gpio_irq_base = GPIO_IRQ_BASE + pdev->id * 32;
|
|
|
|
|
|
BUG_ON(pdev->id >= MAX_NR_PIO_DEVICES);
|
|
|
pio = &pio_dev[pdev->id];
|
|
|
BUG_ON(!pio->regs);
|
|
|
|
|
|
- /* TODO: Interrupts */
|
|
|
+ gpio_irq_setup(pio, irq, gpio_irq_base);
|
|
|
|
|
|
platform_set_drvdata(pdev, pio);
|
|
|
|
|
|
- printk(KERN_INFO "%s: Atmel Port Multiplexer at 0x%p (irq %d)\n",
|
|
|
- pio->name, pio->regs, platform_get_irq(pdev, 0));
|
|
|
+ printk(KERN_DEBUG "%s: base 0x%p, irq %d chains %d..%d\n",
|
|
|
+ pio->name, pio->regs, irq, gpio_irq_base, gpio_irq_base + 31);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -148,7 +364,7 @@ static int __init pio_init(void)
|
|
|
{
|
|
|
return platform_driver_register(&pio_driver);
|
|
|
}
|
|
|
-subsys_initcall(pio_init);
|
|
|
+postcore_initcall(pio_init);
|
|
|
|
|
|
void __init at32_init_pio(struct platform_device *pdev)
|
|
|
{
|
|
@@ -184,6 +400,13 @@ void __init at32_init_pio(struct platform_device *pdev)
|
|
|
pio->pdev = pdev;
|
|
|
pio->regs = ioremap(regs->start, regs->end - regs->start + 1);
|
|
|
|
|
|
- pio_writel(pio, ODR, ~0UL);
|
|
|
- pio_writel(pio, PER, ~0UL);
|
|
|
+ /*
|
|
|
+ * request_gpio() is only valid for pins that have been
|
|
|
+ * explicitly configured as GPIO and not previously requested
|
|
|
+ */
|
|
|
+ pio->gpio_mask = ~0UL;
|
|
|
+
|
|
|
+ /* start with irqs disabled and acked */
|
|
|
+ pio_writel(pio, IDR, ~0UL);
|
|
|
+ (void) pio_readl(pio, ISR);
|
|
|
}
|