SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/ide/icside.c

   1 /*
   2  * Copyright (c) 1996-2004 Russell King.
   3  *
   4  * Please note that this platform does not support 32-bit IDE IO.
   5  */
   6
   7 #include <linux/string.h>
   8 #include <linux/module.h>
   9 #include <linux/ioport.h>
  10 #include <linux/slab.h>
  11 #include <linux/blkdev.h>
  12 #include <linux/errno.h>
  13 #include <linux/ide.h>
  14 #include <linux/dma-mapping.h>
  15 #include <linux/device.h>
  16 #include <linux/init.h>
  17 #include <linux/scatterlist.h>
  18 #include <linux/io.h>
  19
  20 #include <asm/dma.h>
  21 #include <asm/ecard.h>
  22
  23 #define DRV_NAME "icside"
  24
  25 #define ICS_IDENT_OFFSET                0x2280
  26
  27 #define ICS_ARCIN_V5_INTRSTAT           0x0000
  28 #define ICS_ARCIN_V5_INTROFFSET         0x0004
  29 #define ICS_ARCIN_V5_IDEOFFSET          0x2800
  30 #define ICS_ARCIN_V5_IDEALTOFFSET       0x2b80
  31 #define ICS_ARCIN_V5_IDESTEPPING        6
  32
  33 #define ICS_ARCIN_V6_IDEOFFSET_1        0x2000
  34 #define ICS_ARCIN_V6_INTROFFSET_1       0x2200
  35 #define ICS_ARCIN_V6_INTRSTAT_1         0x2290
  36 #define ICS_ARCIN_V6_IDEALTOFFSET_1     0x2380
  37 #define ICS_ARCIN_V6_IDEOFFSET_2        0x3000
  38 #define ICS_ARCIN_V6_INTROFFSET_2       0x3200
  39 #define ICS_ARCIN_V6_INTRSTAT_2         0x3290
  40 #define ICS_ARCIN_V6_IDEALTOFFSET_2     0x3380
  41 #define ICS_ARCIN_V6_IDESTEPPING        6
  42
  43 struct cardinfo {
  44         unsigned int dataoffset;
  45         unsigned int ctrloffset;
  46         unsigned int stepping;
  47 };
  48
  49 static struct cardinfo icside_cardinfo_v5 = {
  50         .dataoffset     = ICS_ARCIN_V5_IDEOFFSET,
  51         .ctrloffset     = ICS_ARCIN_V5_IDEALTOFFSET,
  52         .stepping       = ICS_ARCIN_V5_IDESTEPPING,
  53 };
  54
  55 static struct cardinfo icside_cardinfo_v6_1 = {
  56         .dataoffset     = ICS_ARCIN_V6_IDEOFFSET_1,
  57         .ctrloffset     = ICS_ARCIN_V6_IDEALTOFFSET_1,
  58         .stepping       = ICS_ARCIN_V6_IDESTEPPING,
  59 };
  60
  61 static struct cardinfo icside_cardinfo_v6_2 = {
  62         .dataoffset     = ICS_ARCIN_V6_IDEOFFSET_2,
  63         .ctrloffset     = ICS_ARCIN_V6_IDEALTOFFSET_2,
  64         .stepping       = ICS_ARCIN_V6_IDESTEPPING,
  65 };
  66
  67 struct icside_state {
  68         unsigned int channel;
  69         unsigned int enabled;
  70         void __iomem *irq_port;
  71         void __iomem *ioc_base;
  72         unsigned int sel;
  73         unsigned int type;
  74         struct ide_host *host;
  75 };
  76
  77 #define ICS_TYPE_A3IN   0
  78 #define ICS_TYPE_A3USER 1
  79 #define ICS_TYPE_V6     3
  80 #define ICS_TYPE_V5     15
  81 #define ICS_TYPE_NOTYPE ((unsigned int)-1)
  82
  83 /* ---------------- Version 5 PCB Support Functions --------------------- */
  84 /* Prototype: icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr)
  85  * Purpose  : enable interrupts from card
  86  */
  87 static void icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr)
  88 {
  89         struct icside_state *state = ec->irq_data;
  90
  91         writeb(0, state->irq_port + ICS_ARCIN_V5_INTROFFSET);
  92 }
  93
  94 /* Prototype: icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr)
  95  * Purpose  : disable interrupts from card
  96  */
  97 static void icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr)
  98 {
  99         struct icside_state *state = ec->irq_data;
 100
 101         readb(state->irq_port + ICS_ARCIN_V5_INTROFFSET);
 102 }
 103
 104 static const expansioncard_ops_t icside_ops_arcin_v5 = {
 105         .irqenable      = icside_irqenable_arcin_v5,
 106         .irqdisable     = icside_irqdisable_arcin_v5,
 107 };
 108
 109
 110 /* ---------------- Version 6 PCB Support Functions --------------------- */
 111 /* Prototype: icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr)
 112  * Purpose  : enable interrupts from card
 113  */
 114 static void icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr)
 115 {
 116         struct icside_state *state = ec->irq_data;
 117         void __iomem *base = state->irq_port;
 118
 119         state->enabled = 1;
 120
 121         switch (state->channel) {
 122         case 0:
 123                 writeb(0, base + ICS_ARCIN_V6_INTROFFSET_1);
 124                 readb(base + ICS_ARCIN_V6_INTROFFSET_2);
 125                 break;
 126         case 1:
 127                 writeb(0, base + ICS_ARCIN_V6_INTROFFSET_2);
 128                 readb(base + ICS_ARCIN_V6_INTROFFSET_1);
 129                 break;
 130         }
 131 }
 132
 133 /* Prototype: icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr)
 134  * Purpose  : disable interrupts from card
 135  */
 136 static void icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr)
 137 {
 138         struct icside_state *state = ec->irq_data;
 139
 140         state->enabled = 0;
 141
 142         readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
 143         readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
 144 }
 145
 146 /* Prototype: icside_irqprobe(struct expansion_card *ec)
 147  * Purpose  : detect an active interrupt from card
 148  */
 149 static int icside_irqpending_arcin_v6(struct expansion_card *ec)
 150 {
 151         struct icside_state *state = ec->irq_data;
 152
 153         return readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_1) & 1 ||
 154                readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_2) & 1;
 155 }
 156
 157 static const expansioncard_ops_t icside_ops_arcin_v6 = {
 158         .irqenable      = icside_irqenable_arcin_v6,
 159         .irqdisable     = icside_irqdisable_arcin_v6,
 160         .irqpending     = icside_irqpending_arcin_v6,
 161 };
 162
 163 /*
 164  * Handle routing of interrupts.  This is called before
 165  * we write the command to the drive.
 166  */
 167 static void icside_maskproc(ide_drive_t *drive, int mask)
 168 {
 169         ide_hwif_t *hwif = drive->hwif;
 170         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 171         struct icside_state *state = ecard_get_drvdata(ec);
 172         unsigned long flags;
 173
 174         local_irq_save(flags);
 175
 176         state->channel = hwif->channel;
 177
 178         if (state->enabled && !mask) {
 179                 switch (hwif->channel) {
 180                 case 0:
 181                         writeb(0, state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
 182                         readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
 183                         break;
 184                 case 1:
 185                         writeb(0, state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
 186                         readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
 187                         break;
 188                 }
 189         } else {
 190                 readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2);
 191                 readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1);
 192         }
 193
 194         local_irq_restore(flags);
 195 }
 196
 197 static const struct ide_port_ops icside_v6_no_dma_port_ops = {
 198         .maskproc               = icside_maskproc,
 199 };
 200
 201 #ifdef CONFIG_BLK_DEV_IDEDMA_ICS
 202 /*
 203  * SG-DMA support.
 204  *
 205  * Similar to the BM-DMA, but we use the RiscPCs IOMD DMA controllers.
 206  * There is only one DMA controller per card, which means that only
 207  * one drive can be accessed at one time.  NOTE! We do not enforce that
 208  * here, but we rely on the main IDE driver spotting that both
 209  * interfaces use the same IRQ, which should guarantee this.
 210  */
 211
 212 /*
 213  * Configure the IOMD to give the appropriate timings for the transfer
 214  * mode being requested.  We take the advice of the ATA standards, and
 215  * calculate the cycle time based on the transfer mode, and the EIDE
 216  * MW DMA specs that the drive provides in the IDENTIFY command.
 217  *
 218  * We have the following IOMD DMA modes to choose from:
 219  *
 220  *      Type    Active          Recovery        Cycle
 221  *      A       250 (250)       312 (550)       562 (800)
 222  *      B       187             250             437
 223  *      C       125 (125)       125 (375)       250 (500)
 224  *      D       62              125             187
 225  *
 226  * (figures in brackets are actual measured timings)
 227  *
 228  * However, we also need to take care of the read/write active and
 229  * recovery timings:
 230  *
 231  *                      Read    Write
 232  *      Mode    Active  -- Recovery --  Cycle   IOMD type
 233  *      MW0     215     50      215     480     A
 234  *      MW1     80      50      50      150     C
 235  *      MW2     70      25      25      120     C
 236  */
 237 static void icside_set_dma_mode(ide_drive_t *drive, const u8 xfer_mode)
 238 {
 239         int cycle_time, use_dma_info = 0;
 240
 241         switch (xfer_mode) {
 242         case XFER_MW_DMA_2:
 243                 cycle_time = 250;
 244                 use_dma_info = 1;
 245                 break;
 246
 247         case XFER_MW_DMA_1:
 248                 cycle_time = 250;
 249                 use_dma_info = 1;
 250                 break;
 251
 252         case XFER_MW_DMA_0:
 253                 cycle_time = 480;
 254                 break;
 255
 256         case XFER_SW_DMA_2:
 257         case XFER_SW_DMA_1:
 258         case XFER_SW_DMA_0:
 259                 cycle_time = 480;
 260                 break;
 261         }
 262
 263         /*
 264          * If we're going to be doing MW_DMA_1 or MW_DMA_2, we should
 265          * take care to note the values in the ID...
 266          */
 267         if (use_dma_info && drive->id[ATA_ID_EIDE_DMA_TIME] > cycle_time)
 268                 cycle_time = drive->id[ATA_ID_EIDE_DMA_TIME];
 269
 270         drive->drive_data = cycle_time;
 271
 272         printk("%s: %s selected (peak %dMB/s)\n", drive->name,
 273                 ide_xfer_verbose(xfer_mode), 2000 / drive->drive_data);
 274 }
 275
 276 static const struct ide_port_ops icside_v6_port_ops = {
 277         .set_dma_mode           = icside_set_dma_mode,
 278         .maskproc               = icside_maskproc,
 279 };
 280
 281 static void icside_dma_host_set(ide_drive_t *drive, int on)
 282 {
 283 }
 284
 285 static int icside_dma_end(ide_drive_t *drive)
 286 {
 287         ide_hwif_t *hwif = drive->hwif;
 288         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 289
 290         drive->waiting_for_dma = 0;
 291
 292         disable_dma(ec->dma);
 293
 294         /* Teardown mappings after DMA has completed. */
 295         ide_destroy_dmatable(drive);
 296
 297         return get_dma_residue(ec->dma) != 0;
 298 }
 299
 300 static void icside_dma_start(ide_drive_t *drive)
 301 {
 302         ide_hwif_t *hwif = drive->hwif;
 303         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 304
 305         /* We can not enable DMA on both channels simultaneously. */
 306         BUG_ON(dma_channel_active(ec->dma));
 307         enable_dma(ec->dma);
 308 }
 309
 310 static int icside_dma_setup(ide_drive_t *drive)
 311 {
 312         ide_hwif_t *hwif = drive->hwif;
 313         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 314         struct icside_state *state = ecard_get_drvdata(ec);
 315         struct request *rq = hwif->rq;
 316         unsigned int dma_mode;
 317
 318         if (rq_data_dir(rq))
 319                 dma_mode = DMA_MODE_WRITE;
 320         else
 321                 dma_mode = DMA_MODE_READ;
 322
 323         /*
 324          * We can not enable DMA on both channels.
 325          */
 326         BUG_ON(dma_channel_active(ec->dma));
 327
 328         hwif->sg_nents = ide_build_sglist(drive, rq);
 329
 330         /*
 331          * Ensure that we have the right interrupt routed.
 332          */
 333         icside_maskproc(drive, 0);
 334
 335         /*
 336          * Route the DMA signals to the correct interface.
 337          */
 338         writeb(state->sel | hwif->channel, state->ioc_base);
 339
 340         /*
 341          * Select the correct timing for this drive.
 342          */
 343         set_dma_speed(ec->dma, drive->drive_data);
 344
 345         /*
 346          * Tell the DMA engine about the SG table and
 347          * data direction.
 348          */
 349         set_dma_sg(ec->dma, hwif->sg_table, hwif->sg_nents);
 350         set_dma_mode(ec->dma, dma_mode);
 351
 352         drive->waiting_for_dma = 1;
 353
 354         return 0;
 355 }
 356
 357 static void icside_dma_exec_cmd(ide_drive_t *drive, u8 cmd)
 358 {
 359         /* issue cmd to drive */
 360         ide_execute_command(drive, cmd, ide_dma_intr, 2 * WAIT_CMD, NULL);
 361 }
 362
 363 static int icside_dma_test_irq(ide_drive_t *drive)
 364 {
 365         ide_hwif_t *hwif = drive->hwif;
 366         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 367         struct icside_state *state = ecard_get_drvdata(ec);
 368
 369         return readb(state->irq_port +
 370                      (hwif->channel ?
 371                         ICS_ARCIN_V6_INTRSTAT_2 :
 372                         ICS_ARCIN_V6_INTRSTAT_1)) & 1;
 373 }
 374
 375 static int icside_dma_init(ide_hwif_t *hwif, const struct ide_port_info *d)
 376 {
 377         hwif->dmatable_cpu      = NULL;
 378         hwif->dmatable_dma      = 0;
 379
 380         return 0;
 381 }
 382
 383 static const struct ide_dma_ops icside_v6_dma_ops = {
 384         .dma_host_set           = icside_dma_host_set,
 385         .dma_setup              = icside_dma_setup,
 386         .dma_exec_cmd           = icside_dma_exec_cmd,
 387         .dma_start              = icside_dma_start,
 388         .dma_end                = icside_dma_end,
 389         .dma_test_irq           = icside_dma_test_irq,
 390         .dma_timeout            = ide_dma_timeout,
 391         .dma_lost_irq           = ide_dma_lost_irq,
 392 };
 393 #else
 394 #define icside_v6_dma_ops NULL
 395 #endif
 396
 397 static int icside_dma_off_init(ide_hwif_t *hwif, const struct ide_port_info *d)
 398 {
 399         return -EOPNOTSUPP;
 400 }
 401
 402 static void icside_setup_ports(hw_regs_t *hw, void __iomem *base,
 403                                struct cardinfo *info, struct expansion_card *ec)
 404 {
 405         unsigned long port = (unsigned long)base + info->dataoffset;
 406
 407         hw->io_ports.data_addr   = port;
 408         hw->io_ports.error_addr  = port + (1 << info->stepping);
 409         hw->io_ports.nsect_addr  = port + (2 << info->stepping);
 410         hw->io_ports.lbal_addr   = port + (3 << info->stepping);
 411         hw->io_ports.lbam_addr   = port + (4 << info->stepping);
 412         hw->io_ports.lbah_addr   = port + (5 << info->stepping);
 413         hw->io_ports.device_addr = port + (6 << info->stepping);
 414         hw->io_ports.status_addr = port + (7 << info->stepping);
 415         hw->io_ports.ctl_addr    = (unsigned long)base + info->ctrloffset;
 416
 417         hw->irq = ec->irq;
 418         hw->dev = &ec->dev;
 419         hw->chipset = ide_acorn;
 420 }
 421
 422 static const struct ide_port_info icside_v5_port_info = {
 423         .host_flags             = IDE_HFLAG_NO_DMA,
 424 };
 425
 426 static int __devinit
 427 icside_register_v5(struct icside_state *state, struct expansion_card *ec)
 428 {
 429         void __iomem *base;
 430         struct ide_host *host;
 431         hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
 432         int ret;
 433
 434         base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
 435         if (!base)
 436                 return -ENOMEM;
 437
 438         state->irq_port = base;
 439
 440         ec->irqaddr  = base + ICS_ARCIN_V5_INTRSTAT;
 441         ec->irqmask  = 1;
 442
 443         ecard_setirq(ec, &icside_ops_arcin_v5, state);
 444
 445         /*
 446          * Be on the safe side - disable interrupts
 447          */
 448         icside_irqdisable_arcin_v5(ec, 0);
 449
 450         icside_setup_ports(&hw, base, &icside_cardinfo_v5, ec);
 451
 452         host = ide_host_alloc(&icside_v5_port_info, hws);
 453         if (host == NULL)
 454                 return -ENODEV;
 455
 456         state->host = host;
 457
 458         ecard_set_drvdata(ec, state);
 459
 460         ret = ide_host_register(host, &icside_v5_port_info, hws);
 461         if (ret)
 462                 goto err_free;
 463
 464         return 0;
 465 err_free:
 466         ide_host_free(host);
 467         ecard_set_drvdata(ec, NULL);
 468         return ret;
 469 }
 470
 471 static const struct ide_port_info icside_v6_port_info __initdata = {
 472         .init_dma               = icside_dma_off_init,
 473         .port_ops               = &icside_v6_no_dma_port_ops,
 474         .dma_ops                = &icside_v6_dma_ops,
 475         .host_flags             = IDE_HFLAG_SERIALIZE | IDE_HFLAG_MMIO,
 476         .mwdma_mask             = ATA_MWDMA2,
 477         .swdma_mask             = ATA_SWDMA2,
 478 };
 479
 480 static int __devinit
 481 icside_register_v6(struct icside_state *state, struct expansion_card *ec)
 482 {
 483         void __iomem *ioc_base, *easi_base;
 484         struct ide_host *host;
 485         unsigned int sel = 0;
 486         int ret;
 487         hw_regs_t hw[2], *hws[] = { &hw[0], NULL, NULL, NULL };
 488         struct ide_port_info d = icside_v6_port_info;
 489
 490         ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
 491         if (!ioc_base) {
 492                 ret = -ENOMEM;
 493                 goto out;
 494         }
 495
 496         easi_base = ioc_base;
 497
 498         if (ecard_resource_flags(ec, ECARD_RES_EASI)) {
 499                 easi_base = ecardm_iomap(ec, ECARD_RES_EASI, 0, 0);
 500                 if (!easi_base) {
 501                         ret = -ENOMEM;
 502                         goto out;
 503                 }
 504
 505                 /*
 506                  * Enable access to the EASI region.
 507                  */
 508                 sel = 1 << 5;
 509         }
 510
 511         writeb(sel, ioc_base);
 512
 513         ecard_setirq(ec, &icside_ops_arcin_v6, state);
 514
 515         state->irq_port   = easi_base;
 516         state->ioc_base   = ioc_base;
 517         state->sel        = sel;
 518
 519         /*
 520          * Be on the safe side - disable interrupts
 521          */
 522         icside_irqdisable_arcin_v6(ec, 0);
 523
 524         icside_setup_ports(&hw[0], easi_base, &icside_cardinfo_v6_1, ec);
 525         icside_setup_ports(&hw[1], easi_base, &icside_cardinfo_v6_2, ec);
 526
 527         host = ide_host_alloc(&d, hws);
 528         if (host == NULL)
 529                 return -ENODEV;
 530
 531         state->host = host;
 532
 533         ecard_set_drvdata(ec, state);
 534
 535         if (ec->dma != NO_DMA && !request_dma(ec->dma, DRV_NAME)) {
 536                 d.init_dma = icside_dma_init;
 537                 d.port_ops = &icside_v6_port_ops;
 538                 d.dma_ops = NULL;
 539         }
 540
 541         ret = ide_host_register(host, &d, hws);
 542         if (ret)
 543                 goto err_free;
 544
 545         return 0;
 546 err_free:
 547         ide_host_free(host);
 548         if (d.dma_ops)
 549                 free_dma(ec->dma);
 550         ecard_set_drvdata(ec, NULL);
 551 out:
 552         return ret;
 553 }
 554
 555 static int __devinit
 556 icside_probe(struct expansion_card *ec, const struct ecard_id *id)
 557 {
 558         struct icside_state *state;
 559         void __iomem *idmem;
 560         int ret;
 561
 562         ret = ecard_request_resources(ec);
 563         if (ret)
 564                 goto out;
 565
 566         state = kzalloc(sizeof(struct icside_state), GFP_KERNEL);
 567         if (!state) {
 568                 ret = -ENOMEM;
 569                 goto release;
 570         }
 571
 572         state->type     = ICS_TYPE_NOTYPE;
 573
 574         idmem = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
 575         if (idmem) {
 576                 unsigned int type;
 577
 578                 type = readb(idmem + ICS_IDENT_OFFSET) & 1;
 579                 type |= (readb(idmem + ICS_IDENT_OFFSET + 4) & 1) << 1;
 580                 type |= (readb(idmem + ICS_IDENT_OFFSET + 8) & 1) << 2;
 581                 type |= (readb(idmem + ICS_IDENT_OFFSET + 12) & 1) << 3;
 582                 ecardm_iounmap(ec, idmem);
 583
 584                 state->type = type;
 585         }
 586
 587         switch (state->type) {
 588         case ICS_TYPE_A3IN:
 589                 dev_warn(&ec->dev, "A3IN unsupported\n");
 590                 ret = -ENODEV;
 591                 break;
 592
 593         case ICS_TYPE_A3USER:
 594                 dev_warn(&ec->dev, "A3USER unsupported\n");
 595                 ret = -ENODEV;
 596                 break;
 597
 598         case ICS_TYPE_V5:
 599                 ret = icside_register_v5(state, ec);
 600                 break;
 601
 602         case ICS_TYPE_V6:
 603                 ret = icside_register_v6(state, ec);
 604                 break;
 605
 606         default:
 607                 dev_warn(&ec->dev, "unknown interface type\n");
 608                 ret = -ENODEV;
 609                 break;
 610         }
 611
 612         if (ret == 0)
 613                 goto out;
 614
 615         kfree(state);
 616  release:
 617         ecard_release_resources(ec);
 618  out:
 619         return ret;
 620 }
 621
 622 static void __devexit icside_remove(struct expansion_card *ec)
 623 {
 624         struct icside_state *state = ecard_get_drvdata(ec);
 625
 626         switch (state->type) {
 627         case ICS_TYPE_V5:
 628                 /* FIXME: tell IDE to stop using the interface */
 629
 630                 /* Disable interrupts */
 631                 icside_irqdisable_arcin_v5(ec, 0);
 632                 break;
 633
 634         case ICS_TYPE_V6:
 635                 /* FIXME: tell IDE to stop using the interface */
 636                 if (ec->dma != NO_DMA)
 637                         free_dma(ec->dma);
 638
 639                 /* Disable interrupts */
 640                 icside_irqdisable_arcin_v6(ec, 0);
 641
 642                 /* Reset the ROM pointer/EASI selection */
 643                 writeb(0, state->ioc_base);
 644                 break;
 645         }
 646
 647         ecard_set_drvdata(ec, NULL);
 648
 649         kfree(state);
 650         ecard_release_resources(ec);
 651 }
 652
 653 static void icside_shutdown(struct expansion_card *ec)
 654 {
 655         struct icside_state *state = ecard_get_drvdata(ec);
 656         unsigned long flags;
 657
 658         /*
 659          * Disable interrupts from this card.  We need to do
 660          * this before disabling EASI since we may be accessing
 661          * this register via that region.
 662          */
 663         local_irq_save(flags);
 664         ec->ops->irqdisable(ec, 0);
 665         local_irq_restore(flags);
 666
 667         /*
 668          * Reset the ROM pointer so that we can read the ROM
 669          * after a soft reboot.  This also disables access to
 670          * the IDE taskfile via the EASI region.
 671          */
 672         if (state->ioc_base)
 673                 writeb(0, state->ioc_base);
 674 }
 675
 676 static const struct ecard_id icside_ids[] = {
 677         { MANU_ICS,  PROD_ICS_IDE  },
 678         { MANU_ICS2, PROD_ICS2_IDE },
 679         { 0xffff, 0xffff }
 680 };
 681
 682 static struct ecard_driver icside_driver = {
 683         .probe          = icside_probe,
 684         .remove         = __devexit_p(icside_remove),
 685         .shutdown       = icside_shutdown,
 686         .id_table       = icside_ids,
 687         .drv = {
 688                 .name   = "icside",
 689         },
 690 };
 691
 692 static int __init icside_init(void)
 693 {
 694         return ecard_register_driver(&icside_driver);
 695 }
 696
 697 static void __exit icside_exit(void)
 698 {
 699         ecard_remove_driver(&icside_driver);
 700 }
 701
 702 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
 703 MODULE_LICENSE("GPL");
 704 MODULE_DESCRIPTION("ICS IDE driver");
 705
 706 module_init(icside_init);
 707 module_exit(icside_exit);