git.oblomov.eu Git - linux-2.6/blob - drivers/char/vr41xx_giu.c

   1 /*
   2  *  Driver for NEC VR4100 series General-purpose I/O Unit.
   3  *
   4  *  Copyright (C) 2002 MontaVista Software Inc.
   5  *      Author: Yoichi Yuasa <yyuasa@mvista.com or source@mvista.com>
   6  *  Copyright (C) 2003-2005  Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  */
  22 #include <linux/platform_device.h>
  23 #include <linux/errno.h>
  24 #include <linux/fs.h>
  25 #include <linux/init.h>
  26 #include <linux/irq.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/kernel.h>
  29 #include <linux/module.h>
  30 #include <linux/spinlock.h>
  31 #include <linux/types.h>
  32
  33 #include <asm/cpu.h>
  34 #include <asm/io.h>
  35 #include <asm/vr41xx/giu.h>
  36 #include <asm/vr41xx/vr41xx.h>
  37
  38 MODULE_AUTHOR("Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>");
  39 MODULE_DESCRIPTION("NEC VR4100 series General-purpose I/O Unit driver");
  40 MODULE_LICENSE("GPL");
  41
  42 static int major;       /* default is dynamic major device number */
  43 module_param(major, int, 0);
  44 MODULE_PARM_DESC(major, "Major device number");
  45
  46 #define GIU_TYPE1_START         0x0b000100UL
  47 #define GIU_TYPE1_SIZE          0x20UL
  48
  49 #define GIU_TYPE2_START         0x0f000140UL
  50 #define GIU_TYPE2_SIZE          0x20UL
  51
  52 #define GIU_TYPE3_START         0x0f000140UL
  53 #define GIU_TYPE3_SIZE          0x28UL
  54
  55 #define GIU_PULLUPDOWN_START    0x0b0002e0UL
  56 #define GIU_PULLUPDOWN_SIZE     0x04UL
  57
  58 #define GIUIOSELL       0x00
  59 #define GIUIOSELH       0x02
  60 #define GIUPIODL        0x04
  61 #define GIUPIODH        0x06
  62 #define GIUINTSTATL     0x08
  63 #define GIUINTSTATH     0x0a
  64 #define GIUINTENL       0x0c
  65 #define GIUINTENH       0x0e
  66 #define GIUINTTYPL      0x10
  67 #define GIUINTTYPH      0x12
  68 #define GIUINTALSELL    0x14
  69 #define GIUINTALSELH    0x16
  70 #define GIUINTHTSELL    0x18
  71 #define GIUINTHTSELH    0x1a
  72 #define GIUPODATL       0x1c
  73 #define GIUPODATEN      0x1c
  74 #define GIUPODATH       0x1e
  75  #define PIOEN0         0x0100
  76  #define PIOEN1         0x0200
  77 #define GIUPODAT        0x1e
  78 #define GIUFEDGEINHL    0x20
  79 #define GIUFEDGEINHH    0x22
  80 #define GIUREDGEINHL    0x24
  81 #define GIUREDGEINHH    0x26
  82
  83 #define GIUUSEUPDN      0x1e0
  84 #define GIUTERMUPDN     0x1e2
  85
  86 #define GPIO_HAS_PULLUPDOWN_IO          0x0001
  87 #define GPIO_HAS_OUTPUT_ENABLE          0x0002
  88 #define GPIO_HAS_INTERRUPT_EDGE_SELECT  0x0100
  89
  90 static spinlock_t giu_lock;
  91 static struct resource *giu_resource1;
  92 static struct resource *giu_resource2;
  93 static unsigned long giu_flags;
  94 static unsigned int giu_nr_pins;
  95
  96 static void __iomem *giu_base;
  97
  98 #define giu_read(offset)                readw(giu_base + (offset))
  99 #define giu_write(offset, value)        writew((value), giu_base + (offset))
 100
 101 #define GPIO_PIN_OF_IRQ(irq)    ((irq) - GIU_IRQ_BASE)
 102 #define GIUINT_HIGH_OFFSET      16
 103 #define GIUINT_HIGH_MAX         32
 104
 105 static inline uint16_t giu_set(uint16_t offset, uint16_t set)
 106 {
 107         uint16_t data;
 108
 109         data = giu_read(offset);
 110         data |= set;
 111         giu_write(offset, data);
 112
 113         return data;
 114 }
 115
 116 static inline uint16_t giu_clear(uint16_t offset, uint16_t clear)
 117 {
 118         uint16_t data;
 119
 120         data = giu_read(offset);
 121         data &= ~clear;
 122         giu_write(offset, data);
 123
 124         return data;
 125 }
 126
 127 static unsigned int startup_giuint_low_irq(unsigned int irq)
 128 {
 129         unsigned int pin;
 130
 131         pin = GPIO_PIN_OF_IRQ(irq);
 132         giu_write(GIUINTSTATL, 1 << pin);
 133         giu_set(GIUINTENL, 1 << pin);
 134
 135         return 0;
 136 }
 137
 138 static void shutdown_giuint_low_irq(unsigned int irq)
 139 {
 140         giu_clear(GIUINTENL, 1 << GPIO_PIN_OF_IRQ(irq));
 141 }
 142
 143 static void enable_giuint_low_irq(unsigned int irq)
 144 {
 145         giu_set(GIUINTENL, 1 << GPIO_PIN_OF_IRQ(irq));
 146 }
 147
 148 #define disable_giuint_low_irq  shutdown_giuint_low_irq
 149
 150 static void ack_giuint_low_irq(unsigned int irq)
 151 {
 152         unsigned int pin;
 153
 154         pin = GPIO_PIN_OF_IRQ(irq);
 155         giu_clear(GIUINTENL, 1 << pin);
 156         giu_write(GIUINTSTATL, 1 << pin);
 157 }
 158
 159 static void end_giuint_low_irq(unsigned int irq)
 160 {
 161         if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
 162                 giu_set(GIUINTENL, 1 << GPIO_PIN_OF_IRQ(irq));
 163 }
 164
 165 static struct hw_interrupt_type giuint_low_irq_type = {
 166         .typename       = "GIUINTL",
 167         .startup        = startup_giuint_low_irq,
 168         .shutdown       = shutdown_giuint_low_irq,
 169         .enable         = enable_giuint_low_irq,
 170         .disable        = disable_giuint_low_irq,
 171         .ack            = ack_giuint_low_irq,
 172         .end            = end_giuint_low_irq,
 173 };
 174
 175 static unsigned int startup_giuint_high_irq(unsigned int irq)
 176 {
 177         unsigned int pin;
 178
 179         pin = GPIO_PIN_OF_IRQ(irq) - GIUINT_HIGH_OFFSET;
 180         giu_write(GIUINTSTATH, 1 << pin);
 181         giu_set(GIUINTENH, 1 << pin);
 182
 183         return 0;
 184 }
 185
 186 static void shutdown_giuint_high_irq(unsigned int irq)
 187 {
 188         giu_clear(GIUINTENH, 1 << (GPIO_PIN_OF_IRQ(irq) - GIUINT_HIGH_OFFSET));
 189 }
 190
 191 static void enable_giuint_high_irq(unsigned int irq)
 192 {
 193         giu_set(GIUINTENH, 1 << (GPIO_PIN_OF_IRQ(irq) - GIUINT_HIGH_OFFSET));
 194 }
 195
 196 #define disable_giuint_high_irq shutdown_giuint_high_irq
 197
 198 static void ack_giuint_high_irq(unsigned int irq)
 199 {
 200         unsigned int pin;
 201
 202         pin = GPIO_PIN_OF_IRQ(irq) - GIUINT_HIGH_OFFSET;
 203         giu_clear(GIUINTENH, 1 << pin);
 204         giu_write(GIUINTSTATH, 1 << pin);
 205 }
 206
 207 static void end_giuint_high_irq(unsigned int irq)
 208 {
 209         if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
 210                 giu_set(GIUINTENH, 1 << (GPIO_PIN_OF_IRQ(irq) - GIUINT_HIGH_OFFSET));
 211 }
 212
 213 static struct hw_interrupt_type giuint_high_irq_type = {
 214         .typename       = "GIUINTH",
 215         .startup        = startup_giuint_high_irq,
 216         .shutdown       = shutdown_giuint_high_irq,
 217         .enable         = enable_giuint_high_irq,
 218         .disable        = disable_giuint_high_irq,
 219         .ack            = ack_giuint_high_irq,
 220         .end            = end_giuint_high_irq,
 221 };
 222
 223 static int giu_get_irq(unsigned int irq, struct pt_regs *regs)
 224 {
 225         uint16_t pendl, pendh, maskl, maskh;
 226         int i;
 227
 228         pendl = giu_read(GIUINTSTATL);
 229         pendh = giu_read(GIUINTSTATH);
 230         maskl = giu_read(GIUINTENL);
 231         maskh = giu_read(GIUINTENH);
 232
 233         maskl &= pendl;
 234         maskh &= pendh;
 235
 236         if (maskl) {
 237                 for (i = 0; i < 16; i++) {
 238                         if (maskl & (1 << i))
 239                                 return GIU_IRQ(i);
 240                 }
 241         } else if (maskh) {
 242                 for (i = 0; i < 16; i++) {
 243                         if (maskh & (1 << i))
 244                                 return GIU_IRQ(i + GIUINT_HIGH_OFFSET);
 245                 }
 246         }
 247
 248         printk(KERN_ERR "spurious GIU interrupt: %04x(%04x),%04x(%04x)\n",
 249                maskl, pendl, maskh, pendh);
 250
 251         atomic_inc(&irq_err_count);
 252
 253         return -EINVAL;
 254 }
 255
 256 void vr41xx_set_irq_trigger(unsigned int pin, irq_trigger_t trigger, irq_signal_t signal)
 257 {
 258         uint16_t mask;
 259
 260         if (pin < GIUINT_HIGH_OFFSET) {
 261                 mask = 1 << pin;
 262                 if (trigger != IRQ_TRIGGER_LEVEL) {
 263                         giu_set(GIUINTTYPL, mask);
 264                         if (signal == IRQ_SIGNAL_HOLD)
 265                                 giu_set(GIUINTHTSELL, mask);
 266                         else
 267                                 giu_clear(GIUINTHTSELL, mask);
 268                         if (current_cpu_data.cputype == CPU_VR4133) {
 269                                 switch (trigger) {
 270                                 case IRQ_TRIGGER_EDGE_FALLING:
 271                                         giu_set(GIUFEDGEINHL, mask);
 272                                         giu_clear(GIUREDGEINHL, mask);
 273                                         break;
 274                                 case IRQ_TRIGGER_EDGE_RISING:
 275                                         giu_clear(GIUFEDGEINHL, mask);
 276                                         giu_set(GIUREDGEINHL, mask);
 277                                         break;
 278                                 default:
 279                                         giu_set(GIUFEDGEINHL, mask);
 280                                         giu_set(GIUREDGEINHL, mask);
 281                                         break;
 282                                 }
 283                         }
 284                 } else {
 285                         giu_clear(GIUINTTYPL, mask);
 286                         giu_clear(GIUINTHTSELL, mask);
 287                 }
 288                 giu_write(GIUINTSTATL, mask);
 289         } else if (pin < GIUINT_HIGH_MAX) {
 290                 mask = 1 << (pin - GIUINT_HIGH_OFFSET);
 291                 if (trigger != IRQ_TRIGGER_LEVEL) {
 292                         giu_set(GIUINTTYPH, mask);
 293                         if (signal == IRQ_SIGNAL_HOLD)
 294                                 giu_set(GIUINTHTSELH, mask);
 295                         else
 296                                 giu_clear(GIUINTHTSELH, mask);
 297                         if (current_cpu_data.cputype == CPU_VR4133) {
 298                                 switch (trigger) {
 299                                 case IRQ_TRIGGER_EDGE_FALLING:
 300                                         giu_set(GIUFEDGEINHH, mask);
 301                                         giu_clear(GIUREDGEINHH, mask);
 302                                         break;
 303                                 case IRQ_TRIGGER_EDGE_RISING:
 304                                         giu_clear(GIUFEDGEINHH, mask);
 305                                         giu_set(GIUREDGEINHH, mask);
 306                                         break;
 307                                 default:
 308                                         giu_set(GIUFEDGEINHH, mask);
 309                                         giu_set(GIUREDGEINHH, mask);
 310                                         break;
 311                                 }
 312                         }
 313                 } else {
 314                         giu_clear(GIUINTTYPH, mask);
 315                         giu_clear(GIUINTHTSELH, mask);
 316                 }
 317                 giu_write(GIUINTSTATH, mask);
 318         }
 319 }
 320
 321 EXPORT_SYMBOL_GPL(vr41xx_set_irq_trigger);
 322
 323 void vr41xx_set_irq_level(unsigned int pin, irq_level_t level)
 324 {
 325         uint16_t mask;
 326
 327         if (pin < GIUINT_HIGH_OFFSET) {
 328                 mask = 1 << pin;
 329                 if (level == IRQ_LEVEL_HIGH)
 330                         giu_set(GIUINTALSELL, mask);
 331                 else
 332                         giu_clear(GIUINTALSELL, mask);
 333                 giu_write(GIUINTSTATL, mask);
 334         } else if (pin < GIUINT_HIGH_MAX) {
 335                 mask = 1 << (pin - GIUINT_HIGH_OFFSET);
 336                 if (level == IRQ_LEVEL_HIGH)
 337                         giu_set(GIUINTALSELH, mask);
 338                 else
 339                         giu_clear(GIUINTALSELH, mask);
 340                 giu_write(GIUINTSTATH, mask);
 341         }
 342 }
 343
 344 EXPORT_SYMBOL_GPL(vr41xx_set_irq_level);
 345
 346 gpio_data_t vr41xx_gpio_get_pin(unsigned int pin)
 347 {
 348         uint16_t reg, mask;
 349
 350         if (pin >= giu_nr_pins)
 351                 return GPIO_DATA_INVAL;
 352
 353         if (pin < 16) {
 354                 reg = giu_read(GIUPIODL);
 355                 mask = (uint16_t)1 << pin;
 356         } else if (pin < 32) {
 357                 reg = giu_read(GIUPIODH);
 358                 mask = (uint16_t)1 << (pin - 16);
 359         } else if (pin < 48) {
 360                 reg = giu_read(GIUPODATL);
 361                 mask = (uint16_t)1 << (pin - 32);
 362         } else {
 363                 reg = giu_read(GIUPODATH);
 364                 mask = (uint16_t)1 << (pin - 48);
 365         }
 366
 367         if (reg & mask)
 368                 return GPIO_DATA_HIGH;
 369
 370         return GPIO_DATA_LOW;
 371 }
 372
 373 EXPORT_SYMBOL_GPL(vr41xx_gpio_get_pin);
 374
 375 int vr41xx_gpio_set_pin(unsigned int pin, gpio_data_t data)
 376 {
 377         uint16_t offset, mask, reg;
 378         unsigned long flags;
 379
 380         if (pin >= giu_nr_pins)
 381                 return -EINVAL;
 382
 383         if (pin < 16) {
 384                 offset = GIUPIODL;
 385                 mask = (uint16_t)1 << pin;
 386         } else if (pin < 32) {
 387                 offset = GIUPIODH;
 388                 mask = (uint16_t)1 << (pin - 16);
 389         } else if (pin < 48) {
 390                 offset = GIUPODATL;
 391                 mask = (uint16_t)1 << (pin - 32);
 392         } else {
 393                 offset = GIUPODATH;
 394                 mask = (uint16_t)1 << (pin - 48);
 395         }
 396
 397         spin_lock_irqsave(&giu_lock, flags);
 398
 399         reg = giu_read(offset);
 400         if (data == GPIO_DATA_HIGH)
 401                 reg |= mask;
 402         else
 403                 reg &= ~mask;
 404         giu_write(offset, reg);
 405
 406         spin_unlock_irqrestore(&giu_lock, flags);
 407
 408         return 0;
 409 }
 410
 411 EXPORT_SYMBOL_GPL(vr41xx_gpio_set_pin);
 412
 413 int vr41xx_gpio_set_direction(unsigned int pin, gpio_direction_t dir)
 414 {
 415         uint16_t offset, mask, reg;
 416         unsigned long flags;
 417
 418         if (pin >= giu_nr_pins)
 419                 return -EINVAL;
 420
 421         if (pin < 16) {
 422                 offset = GIUIOSELL;
 423                 mask = (uint16_t)1 << pin;
 424         } else if (pin < 32) {
 425                 offset = GIUIOSELH;
 426                 mask = (uint16_t)1 << (pin - 16);
 427         } else {
 428                 if (giu_flags & GPIO_HAS_OUTPUT_ENABLE) {
 429                         offset = GIUPODATEN;
 430                         mask = (uint16_t)1 << (pin - 32);
 431                 } else {
 432                         switch (pin) {
 433                         case 48:
 434                                 offset = GIUPODATH;
 435                                 mask = PIOEN0;
 436                                 break;
 437                         case 49:
 438                                 offset = GIUPODATH;
 439                                 mask = PIOEN1;
 440                                 break;
 441                         default:
 442                                 return -EINVAL;
 443                         }
 444                 }
 445         }
 446
 447         spin_lock_irqsave(&giu_lock, flags);
 448
 449         reg = giu_read(offset);
 450         if (dir == GPIO_OUTPUT)
 451                 reg |= mask;
 452         else
 453                 reg &= ~mask;
 454         giu_write(offset, reg);
 455
 456         spin_unlock_irqrestore(&giu_lock, flags);
 457
 458         return 0;
 459 }
 460
 461 EXPORT_SYMBOL_GPL(vr41xx_gpio_set_direction);
 462
 463 int vr41xx_gpio_pullupdown(unsigned int pin, gpio_pull_t pull)
 464 {
 465         uint16_t reg, mask;
 466         unsigned long flags;
 467
 468         if ((giu_flags & GPIO_HAS_PULLUPDOWN_IO) != GPIO_HAS_PULLUPDOWN_IO)
 469                 return -EPERM;
 470
 471         if (pin >= 15)
 472                 return -EINVAL;
 473
 474         mask = (uint16_t)1 << pin;
 475
 476         spin_lock_irqsave(&giu_lock, flags);
 477
 478         if (pull == GPIO_PULL_UP || pull == GPIO_PULL_DOWN) {
 479                 reg = giu_read(GIUTERMUPDN);
 480                 if (pull == GPIO_PULL_UP)
 481                         reg |= mask;
 482                 else
 483                         reg &= ~mask;
 484                 giu_write(GIUTERMUPDN, reg);
 485
 486                 reg = giu_read(GIUUSEUPDN);
 487                 reg |= mask;
 488                 giu_write(GIUUSEUPDN, reg);
 489         } else {
 490                 reg = giu_read(GIUUSEUPDN);
 491                 reg &= ~mask;
 492                 giu_write(GIUUSEUPDN, reg);
 493         }
 494
 495         spin_unlock_irqrestore(&giu_lock, flags);
 496
 497         return 0;
 498 }
 499
 500 EXPORT_SYMBOL_GPL(vr41xx_gpio_pullupdown);
 501
 502 static ssize_t gpio_read(struct file *file, char __user *buf, size_t len,
 503                          loff_t *ppos)
 504 {
 505         unsigned int pin;
 506         char value = '0';
 507
 508         pin = iminor(file->f_dentry->d_inode);
 509         if (pin >= giu_nr_pins)
 510                 return -EBADF;
 511
 512         if (vr41xx_gpio_get_pin(pin) == GPIO_DATA_HIGH)
 513                 value = '1';
 514
 515         if (len <= 0)
 516                 return -EFAULT;
 517
 518         if (put_user(value, buf))
 519                 return -EFAULT;
 520
 521         return 1;
 522 }
 523
 524 static ssize_t gpio_write(struct file *file, const char __user *data,
 525                           size_t len, loff_t *ppos)
 526 {
 527         unsigned int pin;
 528         size_t i;
 529         char c;
 530         int retval = 0;
 531
 532         pin = iminor(file->f_dentry->d_inode);
 533         if (pin >= giu_nr_pins)
 534                 return -EBADF;
 535
 536         for (i = 0; i < len; i++) {
 537                 if (get_user(c, data + i))
 538                         return -EFAULT;
 539
 540                 switch (c) {
 541                 case '0':
 542                         retval = vr41xx_gpio_set_pin(pin, GPIO_DATA_LOW);
 543                         break;
 544                 case '1':
 545                         retval = vr41xx_gpio_set_pin(pin, GPIO_DATA_HIGH);
 546                         break;
 547                 case 'D':
 548                         printk(KERN_INFO "GPIO%d: pull down\n", pin);
 549                         retval = vr41xx_gpio_pullupdown(pin, GPIO_PULL_DOWN);
 550                         break;
 551                 case 'd':
 552                         printk(KERN_INFO "GPIO%d: pull up/down disable\n", pin);
 553                         retval = vr41xx_gpio_pullupdown(pin, GPIO_PULL_DISABLE);
 554                         break;
 555                 case 'I':
 556                         printk(KERN_INFO "GPIO%d: input\n", pin);
 557                         retval = vr41xx_gpio_set_direction(pin, GPIO_INPUT);
 558                         break;
 559                 case 'O':
 560                         printk(KERN_INFO "GPIO%d: output\n", pin);
 561                         retval = vr41xx_gpio_set_direction(pin, GPIO_OUTPUT);
 562                         break;
 563                 case 'o':
 564                         printk(KERN_INFO "GPIO%d: output disable\n", pin);
 565                         retval = vr41xx_gpio_set_direction(pin, GPIO_OUTPUT_DISABLE);
 566                         break;
 567                 case 'P':
 568                         printk(KERN_INFO "GPIO%d: pull up\n", pin);
 569                         retval = vr41xx_gpio_pullupdown(pin, GPIO_PULL_UP);
 570                         break;
 571                 case 'p':
 572                         printk(KERN_INFO "GPIO%d: pull up/down disable\n", pin);
 573                         retval = vr41xx_gpio_pullupdown(pin, GPIO_PULL_DISABLE);
 574                         break;
 575                 default:
 576                         break;
 577                 }
 578
 579                 if (retval < 0)
 580                         break;
 581         }
 582
 583         return i;
 584 }
 585
 586 static int gpio_open(struct inode *inode, struct file *file)
 587 {
 588         unsigned int pin;
 589
 590         pin = iminor(inode);
 591         if (pin >= giu_nr_pins)
 592                 return -EBADF;
 593
 594         return nonseekable_open(inode, file);
 595 }
 596
 597 static int gpio_release(struct inode *inode, struct file *file)
 598 {
 599         unsigned int pin;
 600
 601         pin = iminor(inode);
 602         if (pin >= giu_nr_pins)
 603                 return -EBADF;
 604
 605         return 0;
 606 }
 607
 608 static struct file_operations gpio_fops = {
 609         .owner          = THIS_MODULE,
 610         .read           = gpio_read,
 611         .write          = gpio_write,
 612         .open           = gpio_open,
 613         .release        = gpio_release,
 614 };
 615
 616 static int __devinit giu_probe(struct platform_device *dev)
 617 {
 618         unsigned long start, size, flags = 0;
 619         unsigned int nr_pins = 0;
 620         struct resource *res1, *res2 = NULL;
 621         void *base;
 622         int retval, i;
 623
 624         switch (current_cpu_data.cputype) {
 625         case CPU_VR4111:
 626         case CPU_VR4121:
 627                 start = GIU_TYPE1_START;
 628                 size = GIU_TYPE1_SIZE;
 629                 flags = GPIO_HAS_PULLUPDOWN_IO;
 630                 nr_pins = 50;
 631                 break;
 632         case CPU_VR4122:
 633         case CPU_VR4131:
 634                 start = GIU_TYPE2_START;
 635                 size = GIU_TYPE2_SIZE;
 636                 nr_pins = 36;
 637                 break;
 638         case CPU_VR4133:
 639                 start = GIU_TYPE3_START;
 640                 size = GIU_TYPE3_SIZE;
 641                 flags = GPIO_HAS_INTERRUPT_EDGE_SELECT;
 642                 nr_pins = 48;
 643                 break;
 644         default:
 645                 return -ENODEV;
 646         }
 647
 648         res1 = request_mem_region(start, size, "GIU");
 649         if (res1 == NULL)
 650                 return -EBUSY;
 651
 652         base = ioremap(start, size);
 653         if (base == NULL) {
 654                 release_resource(res1);
 655                 return -ENOMEM;
 656         }
 657
 658         if (flags & GPIO_HAS_PULLUPDOWN_IO) {
 659                 res2 = request_mem_region(GIU_PULLUPDOWN_START, GIU_PULLUPDOWN_SIZE, "GIU");
 660                 if (res2 == NULL) {
 661                         iounmap(base);
 662                         release_resource(res1);
 663                         return -EBUSY;
 664                 }
 665         }
 666
 667         retval = register_chrdev(major, "GIU", &gpio_fops);
 668         if (retval < 0) {
 669                 iounmap(base);
 670                 release_resource(res1);
 671                 release_resource(res2);
 672                 return retval;
 673         }
 674
 675         if (major == 0) {
 676                 major = retval;
 677                 printk(KERN_INFO "GIU: major number %d\n", major);
 678         }
 679
 680         spin_lock_init(&giu_lock);
 681         giu_base = base;
 682         giu_resource1 = res1;
 683         giu_resource2 = res2;
 684         giu_flags = flags;
 685         giu_nr_pins = nr_pins;
 686
 687         giu_write(GIUINTENL, 0);
 688         giu_write(GIUINTENH, 0);
 689
 690         for (i = GIU_IRQ_BASE; i <= GIU_IRQ_LAST; i++) {
 691                 if (i < GIU_IRQ(GIUINT_HIGH_OFFSET))
 692                         irq_desc[i].handler = &giuint_low_irq_type;
 693                 else
 694                         irq_desc[i].handler = &giuint_high_irq_type;
 695         }
 696
 697         return cascade_irq(GIUINT_IRQ, giu_get_irq);
 698 }
 699
 700 static int __devexit giu_remove(struct platform_device *dev)
 701 {
 702         iounmap(giu_base);
 703
 704         release_resource(giu_resource1);
 705         if (giu_flags & GPIO_HAS_PULLUPDOWN_IO)
 706                 release_resource(giu_resource2);
 707
 708         return 0;
 709 }
 710
 711 static struct platform_device *giu_platform_device;
 712
 713 static struct platform_driver giu_device_driver = {
 714         .probe          = giu_probe,
 715         .remove         = __devexit_p(giu_remove),
 716         .driver         = {
 717                 .name   = "GIU",
 718                 .owner  = THIS_MODULE,
 719         },
 720 };
 721
 722 static int __init vr41xx_giu_init(void)
 723 {
 724         int retval;
 725
 726         giu_platform_device = platform_device_alloc("GIU", -1);
 727         if (!giu_platform_device)
 728                 return -ENOMEM;
 729
 730         retval = platform_device_add(giu_platform_device);
 731         if (retval < 0) {
 732                 platform_device_put(giu_platform_device);
 733                 return retval;
 734         }
 735
 736         retval = platform_driver_register(&giu_device_driver);
 737         if (retval < 0)
 738                 platform_device_unregister(giu_platform_device);
 739
 740         return retval;
 741 }
 742
 743 static void __exit vr41xx_giu_exit(void)
 744 {
 745         platform_driver_unregister(&giu_device_driver);
 746
 747         platform_device_unregister(giu_platform_device);
 748 }
 749
 750 module_init(vr41xx_giu_init);
 751 module_exit(vr41xx_giu_exit);