drivers/ide/arm/rapide.c

   1 /*
   2  * linux/drivers/ide/arm/rapide.c
   3  *
   4  * Copyright (c) 1996-2002 Russell King.
   5  */
   6
   7 #include <linux/module.h>
   8 #include <linux/slab.h>
   9 #include <linux/blkdev.h>
  10 #include <linux/errno.h>
  11 #include <linux/ide.h>
  12 #include <linux/init.h>
  13
  14 #include <asm/ecard.h>
  15
  16 static void rapide_setup_ports(hw_regs_t *hw, void __iomem *base,
  17                                void __iomem *ctrl, unsigned int sz, int irq)
  18 {
  19         unsigned long port = (unsigned long)base;
  20         int i;
  21
  22         for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
  23                 hw->io_ports[i] = port;
  24                 port += sz;
  25         }
  26         hw->io_ports[IDE_CONTROL_OFFSET] = (unsigned long)ctrl;
  27         hw->irq = irq;
  28 }
  29
  30 static int __devinit
  31 rapide_probe(struct expansion_card *ec, const struct ecard_id *id)
  32 {
  33         ide_hwif_t *hwif;
  34         void __iomem *base;
  35         int ret;
  36         u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
  37         hw_regs_t hw;
  38
  39         ret = ecard_request_resources(ec);
  40         if (ret)
  41                 goto out;
  42
  43         base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
  44         if (!base) {
  45                 ret = -ENOMEM;
  46                 goto release;
  47         }
  48
  49         hwif = ide_find_port((unsigned long)base);
  50         if (hwif) {
  51                 memset(&hw, 0, sizeof(hw));
  52                 rapide_setup_ports(&hw, base, base + 0x818, 1 << 6, ec->irq);
  53                 hw.chipset = ide_generic;
  54                 hw.dev = &ec->dev;
  55
  56                 ide_init_port_hw(hwif, &hw);
  57
  58                 hwif->mmio = 1;
  59                 default_hwif_mmiops(hwif);
  60
  61                 hwif->hwif_data = base;
  62
  63                 idx[0] = hwif->index;
  64
  65                 ide_device_add(idx);
  66
  67                 ecard_set_drvdata(ec, hwif);
  68                 goto out;
  69         }
  70
  71  release:
  72         ecard_release_resources(ec);
  73  out:
  74         return ret;
  75 }
  76
  77 static void __devexit rapide_remove(struct expansion_card *ec)
  78 {
  79         ide_hwif_t *hwif = ecard_get_drvdata(ec);
  80
  81         ecard_set_drvdata(ec, NULL);
  82
  83         /* there must be a better way */
  84         ide_unregister(hwif - ide_hwifs);
  85         ecard_release_resources(ec);
  86 }
  87
  88 static struct ecard_id rapide_ids[] = {
  89         { MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
  90         { 0xffff, 0xffff }
  91 };
  92
  93 static struct ecard_driver rapide_driver = {
  94         .probe          = rapide_probe,
  95         .remove         = __devexit_p(rapide_remove),
  96         .id_table       = rapide_ids,
  97         .drv = {
  98                 .name   = "rapide",
  99         },
 100 };
 101
 102 static int __init rapide_init(void)
 103 {
 104         return ecard_register_driver(&rapide_driver);
 105 }
 106
 107 MODULE_LICENSE("GPL");
 108 MODULE_DESCRIPTION("Yellowstone RAPIDE driver");
 109
 110 module_init(rapide_init);