release/src-rt-6.x.4708/linux/linux-2.6.36/arch/avr32/mach-at32ap/pio.c

   1 /*
   2  * Atmel PIO2 Port Multiplexer support
   3  *
   4  * Copyright (C) 2004-2006 Atmel Corporation
   5  *
   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.
   9  */
  10
  11 #include <linux/clk.h>
  12 #include <linux/debugfs.h>
  13 #include <linux/fs.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/irq.h>
  16
  17 #include <asm/gpio.h>
  18 #include <asm/io.h>
  19
  20 #include <mach/portmux.h>
  21
  22 #include "pio.h"
  23
  24 #define MAX_NR_PIO_DEVICES              8
  25
  26 struct pio_device {
  27         struct gpio_chip chip;
  28         void __iomem *regs;
  29         const struct platform_device *pdev;
  30         struct clk *clk;
  31         u32 pinmux_mask;
  32         char name[8];
  33 };
  34
  35 static struct pio_device pio_dev[MAX_NR_PIO_DEVICES];
  36
  37 static struct pio_device *gpio_to_pio(unsigned int gpio)
  38 {
  39         struct pio_device *pio;
  40         unsigned int index;
  41
  42         index = gpio >> 5;
  43         if (index >= MAX_NR_PIO_DEVICES)
  44                 return NULL;
  45         pio = &pio_dev[index];
  46         if (!pio->regs)
  47                 return NULL;
  48
  49         return pio;
  50 }
  51
  52 /* Pin multiplexing API */
  53 static DEFINE_SPINLOCK(pio_lock);
  54
  55 void __init at32_select_periph(unsigned int port, u32 pin_mask,
  56                                unsigned int periph, unsigned long flags)
  57 {
  58         struct pio_device *pio;
  59
  60         /* assign and verify pio */
  61         pio = gpio_to_pio(port);
  62         if (unlikely(!pio)) {
  63                 printk(KERN_WARNING "pio: invalid port %u\n", port);
  64                 goto fail;
  65         }
  66
  67         /* Test if any of the requested pins is already muxed */
  68         spin_lock(&pio_lock);
  69         if (unlikely(pio->pinmux_mask & pin_mask)) {
  70                 printk(KERN_WARNING "%s: pin(s) busy (requested 0x%x, busy 0x%x)\n",
  71                        pio->name, pin_mask, pio->pinmux_mask & pin_mask);
  72                 spin_unlock(&pio_lock);
  73                 goto fail;
  74         }
  75
  76         pio->pinmux_mask |= pin_mask;
  77
  78         /* enable pull ups */
  79         pio_writel(pio, PUER, pin_mask);
  80
  81         /* select either peripheral A or B */
  82         if (periph)
  83                 pio_writel(pio, BSR, pin_mask);
  84         else
  85                 pio_writel(pio, ASR, pin_mask);
  86
  87         /* enable peripheral control */
  88         pio_writel(pio, PDR, pin_mask);
  89
  90         /* Disable pull ups if not requested. */
  91         if (!(flags & AT32_GPIOF_PULLUP))
  92                 pio_writel(pio, PUDR, pin_mask);
  93
  94         spin_unlock(&pio_lock);
  95
  96         return;
  97
  98 fail:
  99         dump_stack();
 100 }
 101
 102 void __init at32_select_gpio(unsigned int pin, unsigned long flags)
 103 {
 104         struct pio_device *pio;
 105         unsigned int pin_index = pin & 0x1f;
 106         u32 mask = 1 << pin_index;
 107
 108         pio = gpio_to_pio(pin);
 109         if (unlikely(!pio)) {
 110                 printk("pio: invalid pin %u\n", pin);
 111                 goto fail;
 112         }
 113
 114         if (unlikely(test_and_set_bit(pin_index, &pio->pinmux_mask))) {
 115                 printk("%s: pin %u is busy\n", pio->name, pin_index);
 116                 goto fail;
 117         }
 118
 119         if (flags & AT32_GPIOF_OUTPUT) {
 120                 if (flags & AT32_GPIOF_HIGH)
 121                         pio_writel(pio, SODR, mask);
 122                 else
 123                         pio_writel(pio, CODR, mask);
 124                 if (flags & AT32_GPIOF_MULTIDRV)
 125                         pio_writel(pio, MDER, mask);
 126                 else
 127                         pio_writel(pio, MDDR, mask);
 128                 pio_writel(pio, PUDR, mask);
 129                 pio_writel(pio, OER, mask);
 130         } else {
 131                 if (flags & AT32_GPIOF_PULLUP)
 132                         pio_writel(pio, PUER, mask);
 133                 else
 134                         pio_writel(pio, PUDR, mask);
 135                 if (flags & AT32_GPIOF_DEGLITCH)
 136                         pio_writel(pio, IFER, mask);
 137                 else
 138                         pio_writel(pio, IFDR, mask);
 139                 pio_writel(pio, ODR, mask);
 140         }
 141
 142         pio_writel(pio, PER, mask);
 143
 144         return;
 145
 146 fail:
 147         dump_stack();
 148 }
 149
 150 /*
 151  * Undo a previous pin reservation. Will not affect the hardware
 152  * configuration.
 153  */
 154 void at32_deselect_pin(unsigned int pin)
 155 {
 156         struct pio_device *pio;
 157         unsigned int pin_index = pin & 0x1f;
 158
 159         pio = gpio_to_pio(pin);
 160         if (unlikely(!pio)) {
 161                 printk("pio: invalid pin %u\n", pin);
 162                 dump_stack();
 163                 return;
 164         }
 165
 166         clear_bit(pin_index, &pio->pinmux_mask);
 167 }
 168
 169 /* Reserve a pin, preventing anyone else from changing its configuration. */
 170 void __init at32_reserve_pin(unsigned int port, u32 pin_mask)
 171 {
 172         struct pio_device *pio;
 173
 174         /* assign and verify pio */
 175         pio = gpio_to_pio(port);
 176         if (unlikely(!pio)) {
 177                 printk(KERN_WARNING "pio: invalid port %u\n", port);
 178                 goto fail;
 179         }
 180
 181         /* Test if any of the requested pins is already muxed */
 182         spin_lock(&pio_lock);
 183         if (unlikely(pio->pinmux_mask & pin_mask)) {
 184                 printk(KERN_WARNING "%s: pin(s) busy (req. 0x%x, busy 0x%x)\n",
 185                        pio->name, pin_mask, pio->pinmux_mask & pin_mask);
 186                 spin_unlock(&pio_lock);
 187                 goto fail;
 188         }
 189
 190         /* Reserve pins */
 191         pio->pinmux_mask |= pin_mask;
 192         spin_unlock(&pio_lock);
 193         return;
 194
 195 fail:
 196         dump_stack();
 197 }
 198
 199 /*--------------------------------------------------------------------------*/
 200
 201 /* GPIO API */
 202
 203 static int direction_input(struct gpio_chip *chip, unsigned offset)
 204 {
 205         struct pio_device *pio = container_of(chip, struct pio_device, chip);
 206         u32 mask = 1 << offset;
 207
 208         if (!(pio_readl(pio, PSR) & mask))
 209                 return -EINVAL;
 210
 211         pio_writel(pio, ODR, mask);
 212         return 0;
 213 }
 214
 215 static int gpio_get(struct gpio_chip *chip, unsigned offset)
 216 {
 217         struct pio_device *pio = container_of(chip, struct pio_device, chip);
 218
 219         return (pio_readl(pio, PDSR) >> offset) & 1;
 220 }
 221
 222 static void gpio_set(struct gpio_chip *chip, unsigned offset, int value);
 223
 224 static int direction_output(struct gpio_chip *chip, unsigned offset, int value)
 225 {
 226         struct pio_device *pio = container_of(chip, struct pio_device, chip);
 227         u32 mask = 1 << offset;
 228
 229         if (!(pio_readl(pio, PSR) & mask))
 230                 return -EINVAL;
 231
 232         gpio_set(chip, offset, value);
 233         pio_writel(pio, OER, mask);
 234         return 0;
 235 }
 236
 237 static void gpio_set(struct gpio_chip *chip, unsigned offset, int value)
 238 {
 239         struct pio_device *pio = container_of(chip, struct pio_device, chip);
 240         u32 mask = 1 << offset;
 241
 242         if (value)
 243                 pio_writel(pio, SODR, mask);
 244         else
 245                 pio_writel(pio, CODR, mask);
 246 }
 247
 248 /*--------------------------------------------------------------------------*/
 249
 250 /* GPIO IRQ support */
 251
 252 static void gpio_irq_mask(unsigned irq)
 253 {
 254         unsigned                gpio = irq_to_gpio(irq);
 255         struct pio_device       *pio = &pio_dev[gpio >> 5];
 256
 257         pio_writel(pio, IDR, 1 << (gpio & 0x1f));
 258 }
 259
 260 static void gpio_irq_unmask(unsigned irq)
 261 {
 262         unsigned                gpio = irq_to_gpio(irq);
 263         struct pio_device       *pio = &pio_dev[gpio >> 5];
 264
 265         pio_writel(pio, IER, 1 << (gpio & 0x1f));
 266 }
 267
 268 static int gpio_irq_type(unsigned irq, unsigned type)
 269 {
 270         if (type != IRQ_TYPE_EDGE_BOTH && type != IRQ_TYPE_NONE)
 271                 return -EINVAL;
 272
 273         return 0;
 274 }
 275
 276 static struct irq_chip gpio_irqchip = {
 277         .name           = "gpio",
 278         .mask           = gpio_irq_mask,
 279         .unmask         = gpio_irq_unmask,
 280         .set_type       = gpio_irq_type,
 281 };
 282
 283 static void gpio_irq_handler(unsigned irq, struct irq_desc *desc)
 284 {
 285         struct pio_device       *pio = get_irq_chip_data(irq);
 286         unsigned                gpio_irq;
 287
 288         gpio_irq = (unsigned) get_irq_data(irq);
 289         for (;;) {
 290                 u32             isr;
 291                 struct irq_desc *d;
 292
 293                 /* ack pending GPIO interrupts */
 294                 isr = pio_readl(pio, ISR) & pio_readl(pio, IMR);
 295                 if (!isr)
 296                         break;
 297                 do {
 298                         int i;
 299
 300                         i = ffs(isr) - 1;
 301                         isr &= ~(1 << i);
 302
 303                         i += gpio_irq;
 304                         d = &irq_desc[i];
 305
 306                         d->handle_irq(i, d);
 307                 } while (isr);
 308         }
 309 }
 310
 311 static void __init
 312 gpio_irq_setup(struct pio_device *pio, int irq, int gpio_irq)
 313 {
 314         unsigned        i;
 315
 316         set_irq_chip_data(irq, pio);
 317         set_irq_data(irq, (void *) gpio_irq);
 318
 319         for (i = 0; i < 32; i++, gpio_irq++) {
 320                 set_irq_chip_data(gpio_irq, pio);
 321                 set_irq_chip_and_handler(gpio_irq, &gpio_irqchip,
 322                                 handle_simple_irq);
 323         }
 324
 325         set_irq_chained_handler(irq, gpio_irq_handler);
 326 }
 327
 328 /*--------------------------------------------------------------------------*/
 329
 330 #ifdef CONFIG_DEBUG_FS
 331
 332 #include <linux/seq_file.h>
 333
 334 /*
 335  * This shows more info than the generic gpio dump code:
 336  * pullups, deglitching, open drain drive.
 337  */
 338 static void pio_bank_show(struct seq_file *s, struct gpio_chip *chip)
 339 {
 340         struct pio_device *pio = container_of(chip, struct pio_device, chip);
 341         u32                     psr, osr, imr, pdsr, pusr, ifsr, mdsr;
 342         unsigned                i;
 343         u32                     mask;
 344         char                    bank;
 345
 346         psr = pio_readl(pio, PSR);
 347         osr = pio_readl(pio, OSR);
 348         imr = pio_readl(pio, IMR);
 349         pdsr = pio_readl(pio, PDSR);
 350         pusr = pio_readl(pio, PUSR);
 351         ifsr = pio_readl(pio, IFSR);
 352         mdsr = pio_readl(pio, MDSR);
 353
 354         bank = 'A' + pio->pdev->id;
 355
 356         for (i = 0, mask = 1; i < 32; i++, mask <<= 1) {
 357                 const char *label;
 358
 359                 label = gpiochip_is_requested(chip, i);
 360                 if (!label && (imr & mask))
 361                         label = "[irq]";
 362                 if (!label)
 363                         continue;
 364
 365                 seq_printf(s, " gpio-%-3d P%c%-2d (%-12s) %s %s %s",
 366                         chip->base + i, bank, i,
 367                         label,
 368                         (osr & mask) ? "out" : "in ",
 369                         (mask & pdsr) ? "hi" : "lo",
 370                         (mask & pusr) ? "  " : "up");
 371                 if (ifsr & mask)
 372                         seq_printf(s, " deglitch");
 373                 if ((osr & mdsr) & mask)
 374                         seq_printf(s, " open-drain");
 375                 if (imr & mask)
 376                         seq_printf(s, " irq-%d edge-both",
 377                                 gpio_to_irq(chip->base + i));
 378                 seq_printf(s, "\n");
 379         }
 380 }
 381
 382 #else
 383 #define pio_bank_show   NULL
 384 #endif
 385
 386
 387 /*--------------------------------------------------------------------------*/
 388
 389 static int __init pio_probe(struct platform_device *pdev)
 390 {
 391         struct pio_device *pio = NULL;
 392         int irq = platform_get_irq(pdev, 0);
 393         int gpio_irq_base = GPIO_IRQ_BASE + pdev->id * 32;
 394
 395         BUG_ON(pdev->id >= MAX_NR_PIO_DEVICES);
 396         pio = &pio_dev[pdev->id];
 397         BUG_ON(!pio->regs);
 398
 399         pio->chip.label = pio->name;
 400         pio->chip.base = pdev->id * 32;
 401         pio->chip.ngpio = 32;
 402         pio->chip.dev = &pdev->dev;
 403         pio->chip.owner = THIS_MODULE;
 404
 405         pio->chip.direction_input = direction_input;
 406         pio->chip.get = gpio_get;
 407         pio->chip.direction_output = direction_output;
 408         pio->chip.set = gpio_set;
 409         pio->chip.dbg_show = pio_bank_show;
 410
 411         gpiochip_add(&pio->chip);
 412
 413         gpio_irq_setup(pio, irq, gpio_irq_base);
 414
 415         platform_set_drvdata(pdev, pio);
 416
 417         printk(KERN_DEBUG "%s: base 0x%p, irq %d chains %d..%d\n",
 418                pio->name, pio->regs, irq, gpio_irq_base, gpio_irq_base + 31);
 419
 420         return 0;
 421 }
 422
 423 static struct platform_driver pio_driver = {
 424         .driver         = {
 425                 .name           = "pio",
 426         },
 427 };
 428
 429 static int __init pio_init(void)
 430 {
 431         return platform_driver_probe(&pio_driver, pio_probe);
 432 }
 433 postcore_initcall(pio_init);
 434
 435 void __init at32_init_pio(struct platform_device *pdev)
 436 {
 437         struct resource *regs;
 438         struct pio_device *pio;
 439
 440         if (pdev->id > MAX_NR_PIO_DEVICES) {
 441                 dev_err(&pdev->dev, "only %d PIO devices supported\n",
 442                         MAX_NR_PIO_DEVICES);
 443                 return;
 444         }
 445
 446         pio = &pio_dev[pdev->id];
 447         snprintf(pio->name, sizeof(pio->name), "pio%d", pdev->id);
 448
 449         regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 450         if (!regs) {
 451                 dev_err(&pdev->dev, "no mmio resource defined\n");
 452                 return;
 453         }
 454
 455         pio->clk = clk_get(&pdev->dev, "mck");
 456         if (IS_ERR(pio->clk))
 457                 /*
 458                  * This is a fatal error, but if we continue we might
 459                  * be so lucky that we manage to initialize the
 460                  * console and display this message...
 461                  */
 462                 dev_err(&pdev->dev, "no mck clock defined\n");
 463         else
 464                 clk_enable(pio->clk);
 465
 466         pio->pdev = pdev;
 467         pio->regs = ioremap(regs->start, regs->end - regs->start + 1);
 468
 469         /* start with irqs disabled and acked */
 470         pio_writel(pio, IDR, ~0UL);
 471         (void) pio_readl(pio, ISR);
 472 }