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         /*
 329          * Ensure that we have the right interrupt routed.
 330          */
 331         icside_maskproc(drive, 0);
 332
 333         /*
 334          * Route the DMA signals to the correct interface.
 335          */
 336         writeb(state->sel | hwif->channel, state->ioc_base);
 337
 338         /*
 339          * Select the correct timing for this drive.
 340          */
 341         set_dma_speed(ec->dma, drive->drive_data);
 342
 343         /*
 344          * Tell the DMA engine about the SG table and
 345          * data direction.
 346          */
 347         set_dma_sg(ec->dma, hwif->sg_table, hwif->sg_nents);
 348         set_dma_mode(ec->dma, dma_mode);
 349
 350         drive->waiting_for_dma = 1;
 351
 352         return 0;
 353 }
 354
 355 static void icside_dma_exec_cmd(ide_drive_t *drive, u8 cmd)
 356 {
 357         /* issue cmd to drive */
 358         ide_execute_command(drive, cmd, ide_dma_intr, 2 * WAIT_CMD, NULL);
 359 }
 360
 361 static int icside_dma_test_irq(ide_drive_t *drive)
 362 {
 363         ide_hwif_t *hwif = drive->hwif;
 364         struct expansion_card *ec = ECARD_DEV(hwif->dev);
 365         struct icside_state *state = ecard_get_drvdata(ec);
 366
 367         return readb(state->irq_port +
 368                      (hwif->channel ?
 369                         ICS_ARCIN_V6_INTRSTAT_2 :
 370                         ICS_ARCIN_V6_INTRSTAT_1)) & 1;
 371 }
 372
 373 static int icside_dma_init(ide_hwif_t *hwif, const struct ide_port_info *d)
 374 {
 375         hwif->dmatable_cpu      = NULL;
 376         hwif->dmatable_dma      = 0;
 377
 378         return 0;
 379 }
 380
 381 static const struct ide_dma_ops icside_v6_dma_ops = {
 382         .dma_host_set           = icside_dma_host_set,
 383         .dma_setup              = icside_dma_setup,
 384         .dma_exec_cmd           = icside_dma_exec_cmd,
 385         .dma_start              = icside_dma_start,
 386         .dma_end                = icside_dma_end,
 387         .dma_test_irq           = icside_dma_test_irq,
 388         .dma_timeout            = ide_dma_timeout,
 389         .dma_lost_irq           = ide_dma_lost_irq,
 390 };
 391 #else
 392 #define icside_v6_dma_ops NULL
 393 #endif
 394
 395 static int icside_dma_off_init(ide_hwif_t *hwif, const struct ide_port_info *d)
 396 {
 397         return -EOPNOTSUPP;
 398 }
 399
 400 static void icside_setup_ports(hw_regs_t *hw, void __iomem *base,
 401                                struct cardinfo *info, struct expansion_card *ec)
 402 {
 403         unsigned long port = (unsigned long)base + info->dataoffset;
 404
 405         hw->io_ports.data_addr   = port;
 406         hw->io_ports.error_addr  = port + (1 << info->stepping);
 407         hw->io_ports.nsect_addr  = port + (2 << info->stepping);
 408         hw->io_ports.lbal_addr   = port + (3 << info->stepping);
 409         hw->io_ports.lbam_addr   = port + (4 << info->stepping);
 410         hw->io_ports.lbah_addr   = port + (5 << info->stepping);
 411         hw->io_ports.device_addr = port + (6 << info->stepping);
 412         hw->io_ports.status_addr = port + (7 << info->stepping);
 413         hw->io_ports.ctl_addr    = (unsigned long)base + info->ctrloffset;
 414
 415         hw->irq = ec->irq;
 416         hw->dev = &ec->dev;
 417         hw->chipset = ide_acorn;
 418 }
 419
 420 static const struct ide_port_info icside_v5_port_info = {
 421         .host_flags             = IDE_HFLAG_NO_DMA,
 422 };
 423
 424 static int __devinit
 425 icside_register_v5(struct icside_state *state, struct expansion_card *ec)
 426 {
 427         void __iomem *base;
 428         struct ide_host *host;
 429         hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
 430         int ret;
 431
 432         base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
 433         if (!base)
 434                 return -ENOMEM;
 435
 436         state->irq_port = base;
 437
 438         ec->irqaddr  = base + ICS_ARCIN_V5_INTRSTAT;
 439         ec->irqmask  = 1;
 440
 441         ecard_setirq(ec, &icside_ops_arcin_v5, state);
 442
 443         /*
 444          * Be on the safe side - disable interrupts
 445          */
 446         icside_irqdisable_arcin_v5(ec, 0);
 447
 448         icside_setup_ports(&hw, base, &icside_cardinfo_v5, ec);
 449
 450         host = ide_host_alloc(&icside_v5_port_info, hws);
 451         if (host == NULL)
 452                 return -ENODEV;
 453
 454         state->host = host;
 455
 456         ecard_set_drvdata(ec, state);
 457
 458         ret = ide_host_register(host, &icside_v5_port_info, hws);
 459         if (ret)
 460                 goto err_free;
 461
 462         return 0;
 463 err_free:
 464         ide_host_free(host);
 465         ecard_set_drvdata(ec, NULL);
 466         return ret;
 467 }
 468
 469 static const struct ide_port_info icside_v6_port_info __initdata = {
 470         .init_dma               = icside_dma_off_init,
 471         .port_ops               = &icside_v6_no_dma_port_ops,
 472         .dma_ops                = &icside_v6_dma_ops,
 473         .host_flags             = IDE_HFLAG_SERIALIZE | IDE_HFLAG_MMIO,
 474         .mwdma_mask             = ATA_MWDMA2,
 475         .swdma_mask             = ATA_SWDMA2,
 476 };
 477
 478 static int __devinit
 479 icside_register_v6(struct icside_state *state, struct expansion_card *ec)
 480 {
 481         void __iomem *ioc_base, *easi_base;
 482         struct ide_host *host;
 483         unsigned int sel = 0;
 484         int ret;
 485         hw_regs_t hw[2], *hws[] = { &hw[0], NULL, NULL, NULL };
 486         struct ide_port_info d = icside_v6_port_info;
 487
 488         ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
 489         if (!ioc_base) {
 490                 ret = -ENOMEM;
 491                 goto out;
 492         }
 493
 494         easi_base = ioc_base;
 495
 496         if (ecard_resource_flags(ec, ECARD_RES_EASI)) {
 497                 easi_base = ecardm_iomap(ec, ECARD_RES_EASI, 0, 0);
 498                 if (!easi_base) {
 499                         ret = -ENOMEM;
 500                         goto out;
 501                 }
 502
 503                 /*
 504                  * Enable access to the EASI region.
 505                  */
 506                 sel = 1 << 5;
 507         }
 508
 509         writeb(sel, ioc_base);
 510
 511         ecard_setirq(ec, &icside_ops_arcin_v6, state);
 512
 513         state->irq_port   = easi_base;
 514         state->ioc_base   = ioc_base;
 515         state->sel        = sel;
 516
 517         /*
 518          * Be on the safe side - disable interrupts
 519          */
 520         icside_irqdisable_arcin_v6(ec, 0);
 521
 522         icside_setup_ports(&hw[0], easi_base, &icside_cardinfo_v6_1, ec);
 523         icside_setup_ports(&hw[1], easi_base, &icside_cardinfo_v6_2, ec);
 524
 525         host = ide_host_alloc(&d, hws);
 526         if (host == NULL)
 527                 return -ENODEV;
 528
 529         state->host = host;
 530
 531         ecard_set_drvdata(ec, state);
 532
 533         if (ec->dma != NO_DMA && !request_dma(ec->dma, DRV_NAME)) {
 534                 d.init_dma = icside_dma_init;
 535                 d.port_ops = &icside_v6_port_ops;
 536                 d.dma_ops = NULL;
 537         }
 538
 539         ret = ide_host_register(host, &d, hws);
 540         if (ret)
 541                 goto err_free;
 542
 543         return 0;
 544 err_free:
 545         ide_host_free(host);
 546         if (d.dma_ops)
 547                 free_dma(ec->dma);
 548         ecard_set_drvdata(ec, NULL);
 549 out:
 550         return ret;
 551 }
 552
 553 static int __devinit
 554 icside_probe(struct expansion_card *ec, const struct ecard_id *id)
 555 {
 556         struct icside_state *state;
 557         void __iomem *idmem;
 558         int ret;
 559
 560         ret = ecard_request_resources(ec);
 561         if (ret)
 562                 goto out;
 563
 564         state = kzalloc(sizeof(struct icside_state), GFP_KERNEL);
 565         if (!state) {
 566                 ret = -ENOMEM;
 567                 goto release;
 568         }
 569
 570         state->type     = ICS_TYPE_NOTYPE;
 571
 572         idmem = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
 573         if (idmem) {
 574                 unsigned int type;
 575
 576                 type = readb(idmem + ICS_IDENT_OFFSET) & 1;
 577                 type |= (readb(idmem + ICS_IDENT_OFFSET + 4) & 1) << 1;
 578                 type |= (readb(idmem + ICS_IDENT_OFFSET + 8) & 1) << 2;
 579                 type |= (readb(idmem + ICS_IDENT_OFFSET + 12) & 1) << 3;
 580                 ecardm_iounmap(ec, idmem);
 581
 582                 state->type = type;
 583         }
 584
 585         switch (state->type) {
 586         case ICS_TYPE_A3IN:
 587                 dev_warn(&ec->dev, "A3IN unsupported\n");
 588                 ret = -ENODEV;
 589                 break;
 590
 591         case ICS_TYPE_A3USER:
 592                 dev_warn(&ec->dev, "A3USER unsupported\n");
 593                 ret = -ENODEV;
 594                 break;
 595
 596         case ICS_TYPE_V5:
 597                 ret = icside_register_v5(state, ec);
 598                 break;
 599
 600         case ICS_TYPE_V6:
 601                 ret = icside_register_v6(state, ec);
 602                 break;
 603
 604         default:
 605                 dev_warn(&ec->dev, "unknown interface type\n");
 606                 ret = -ENODEV;
 607                 break;
 608         }
 609
 610         if (ret == 0)
 611                 goto out;
 612
 613         kfree(state);
 614  release:
 615         ecard_release_resources(ec);
 616  out:
 617         return ret;
 618 }
 619
 620 static void __devexit icside_remove(struct expansion_card *ec)
 621 {
 622         struct icside_state *state = ecard_get_drvdata(ec);
 623
 624         switch (state->type) {
 625         case ICS_TYPE_V5:
 626                 /* FIXME: tell IDE to stop using the interface */
 627
 628                 /* Disable interrupts */
 629                 icside_irqdisable_arcin_v5(ec, 0);
 630                 break;
 631
 632         case ICS_TYPE_V6:
 633                 /* FIXME: tell IDE to stop using the interface */
 634                 if (ec->dma != NO_DMA)
 635                         free_dma(ec->dma);
 636
 637                 /* Disable interrupts */
 638                 icside_irqdisable_arcin_v6(ec, 0);
 639
 640                 /* Reset the ROM pointer/EASI selection */
 641                 writeb(0, state->ioc_base);
 642                 break;
 643         }
 644
 645         ecard_set_drvdata(ec, NULL);
 646
 647         kfree(state);
 648         ecard_release_resources(ec);
 649 }
 650
 651 static void icside_shutdown(struct expansion_card *ec)
 652 {
 653         struct icside_state *state = ecard_get_drvdata(ec);
 654         unsigned long flags;
 655
 656         /*
 657          * Disable interrupts from this card.  We need to do
 658          * this before disabling EASI since we may be accessing
 659          * this register via that region.
 660          */
 661         local_irq_save(flags);
 662         ec->ops->irqdisable(ec, 0);
 663         local_irq_restore(flags);
 664
 665         /*
 666          * Reset the ROM pointer so that we can read the ROM
 667          * after a soft reboot.  This also disables access to
 668          * the IDE taskfile via the EASI region.
 669          */
 670         if (state->ioc_base)
 671                 writeb(0, state->ioc_base);
 672 }
 673
 674 static const struct ecard_id icside_ids[] = {
 675         { MANU_ICS,  PROD_ICS_IDE  },
 676         { MANU_ICS2, PROD_ICS2_IDE },
 677         { 0xffff, 0xffff }
 678 };
 679
 680 static struct ecard_driver icside_driver = {
 681         .probe          = icside_probe,
 682         .remove         = __devexit_p(icside_remove),
 683         .shutdown       = icside_shutdown,
 684         .id_table       = icside_ids,
 685         .drv = {
 686                 .name   = "icside",
 687         },
 688 };
 689
 690 static int __init icside_init(void)
 691 {
 692         return ecard_register_driver(&icside_driver);
 693 }
 694
 695 static void __exit icside_exit(void)
 696 {
 697         ecard_remove_driver(&icside_driver);
 698 }
 699
 700 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
 701 MODULE_LICENSE("GPL");
 702 MODULE_DESCRIPTION("ICS IDE driver");
 703
 704 module_init(icside_init);
 705 module_exit(icside_exit);