This commit was manufactured by cvs2svn to create branch 'vserver'.

[linux-2.6.git] / arch / avr32 / mach-at32ap / pio.c

diff --git a/arch/avr32/mach-at32ap/pio.c b/arch/avr32/mach-at32ap/pio.c
new file mode 100644 (file)
index 0000000..f1280ed
--- /dev/null
+++ b/arch/avr32/mach-at32ap/pio.c
@@ -0,0 +1,189 @@
+/*
+ * Atmel PIO2 Port Multiplexer support
+ *
+ * Copyright (C) 2004-2006 Atmel Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/clk.h>
+#include <linux/debugfs.h>
+#include <linux/fs.h>
+#include <linux/platform_device.h>
+
+#include <asm/io.h>
+
+#include <asm/arch/portmux.h>
+
+#include "pio.h"
+
+#define MAX_NR_PIO_DEVICES             8
+
+struct pio_device {
+       void __iomem *regs;
+       const struct platform_device *pdev;
+       struct clk *clk;
+       u32 pinmux_mask;
+       char name[32];
+};
+
+static struct pio_device pio_dev[MAX_NR_PIO_DEVICES];
+
+static struct pio_device *gpio_to_pio(unsigned int gpio)
+{
+       struct pio_device *pio;
+       unsigned int index;
+
+       index = gpio >> 5;
+       if (index >= MAX_NR_PIO_DEVICES)
+               return NULL;
+       pio = &pio_dev[index];
+       if (!pio->regs)
+               return NULL;
+
+       return pio;
+}
+
+/* Pin multiplexing API */
+
+void __init at32_select_periph(unsigned int pin, unsigned int periph,
+                              unsigned long flags)
+{
+       struct pio_device *pio;
+       unsigned int pin_index = pin & 0x1f;
+       u32 mask = 1 << pin_index;
+
+       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;
+       }
+
+       pio_writel(pio, PUER, mask);
+       if (periph)
+               pio_writel(pio, BSR, mask);
+       else
+               pio_writel(pio, ASR, mask);
+
+       pio_writel(pio, PDR, mask);
+       if (!(flags & AT32_GPIOF_PULLUP))
+               pio_writel(pio, PUDR, mask);
+
+       return;
+
+fail:
+       dump_stack();
+}
+
+void __init at32_select_gpio(unsigned int pin, unsigned long flags)
+{
+       struct pio_device *pio;
+       unsigned int pin_index = pin & 0x1f;
+       u32 mask = 1 << pin_index;
+
+       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;
+       }
+
+       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)
+               pio_writel(pio, OER, mask);
+       else
+               pio_writel(pio, ODR, mask);
+
+       pio_writel(pio, PER, mask);
+       if (!(flags & AT32_GPIOF_PULLUP))
+               pio_writel(pio, PUDR, mask);
+
+       return;
+
+fail:
+       dump_stack();
+}
+
+static int __init pio_probe(struct platform_device *pdev)
+{
+       struct pio_device *pio = NULL;
+
+       BUG_ON(pdev->id >= MAX_NR_PIO_DEVICES);
+       pio = &pio_dev[pdev->id];
+       BUG_ON(!pio->regs);
+
+       /* TODO: Interrupts */
+
+       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));
+
+       return 0;
+}
+
+static struct platform_driver pio_driver = {
+       .probe          = pio_probe,
+       .driver         = {
+               .name           = "pio",
+       },
+};
+
+static int __init pio_init(void)
+{
+       return platform_driver_register(&pio_driver);
+}
+subsys_initcall(pio_init);
+
+void __init at32_init_pio(struct platform_device *pdev)
+{
+       struct resource *regs;
+       struct pio_device *pio;
+
+       if (pdev->id > MAX_NR_PIO_DEVICES) {
+               dev_err(&pdev->dev, "only %d PIO devices supported\n",
+                       MAX_NR_PIO_DEVICES);
+               return;
+       }
+
+       pio = &pio_dev[pdev->id];
+       snprintf(pio->name, sizeof(pio->name), "pio%d", pdev->id);
+
+       regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       if (!regs) {
+               dev_err(&pdev->dev, "no mmio resource defined\n");
+               return;
+       }
+
+       pio->clk = clk_get(&pdev->dev, "mck");
+       if (IS_ERR(pio->clk))
+               /*
+                * This is a fatal error, but if we continue we might
+                * be so lucky that we manage to initialize the
+                * console and display this message...
+                */
+               dev_err(&pdev->dev, "no mck clock defined\n");
+       else
+               clk_enable(pio->clk);
+
+       pio->pdev = pdev;
+       pio->regs = ioremap(regs->start, regs->end - regs->start + 1);
+
+       pio_writel(pio, ODR, ~0UL);
+       pio_writel(pio, PER, ~0UL);
+}