err.no Git - linux-2.6/blob - drivers/ide/arm/rapide.c

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