linux/drivers/ide/arm/rapide.c
<<
>>
Prefs
   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
  16static ide_hwif_t *
  17rapide_locate_hwif(void __iomem *base, void __iomem *ctrl, unsigned int sz, int irq)
  18{
  19        unsigned long port = (unsigned long)base;
  20        ide_hwif_t *hwif = ide_find_port(port);
  21        int i;
  22
  23        if (hwif == NULL)
  24                goto out;
  25
  26        for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
  27                hwif->io_ports[i] = port;
  28                port += sz;
  29        }
  30        hwif->io_ports[IDE_CONTROL_OFFSET] = (unsigned long)ctrl;
  31        hwif->irq = irq;
  32        hwif->mmio = 1;
  33        default_hwif_mmiops(hwif);
  34out:
  35        return hwif;
  36}
  37
  38static int __devinit
  39rapide_probe(struct expansion_card *ec, const struct ecard_id *id)
  40{
  41        ide_hwif_t *hwif;
  42        void __iomem *base;
  43        int ret;
  44        u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
  45
  46        ret = ecard_request_resources(ec);
  47        if (ret)
  48                goto out;
  49
  50        base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
  51        if (!base) {
  52                ret = -ENOMEM;
  53                goto release;
  54        }
  55
  56        hwif = rapide_locate_hwif(base, base + 0x818, 1 << 6, ec->irq);
  57        if (hwif) {
  58                hwif->hwif_data = base;
  59                hwif->gendev.parent = &ec->dev;
  60                hwif->noprobe = 0;
  61
  62                idx[0] = hwif->index;
  63
  64                ide_device_add(idx);
  65
  66                ecard_set_drvdata(ec, hwif);
  67                goto out;
  68        }
  69
  70 release:
  71        ecard_release_resources(ec);
  72 out:
  73        return ret;
  74}
  75
  76static void __devexit rapide_remove(struct expansion_card *ec)
  77{
  78        ide_hwif_t *hwif = ecard_get_drvdata(ec);
  79
  80        ecard_set_drvdata(ec, NULL);
  81
  82        /* there must be a better way */
  83        ide_unregister(hwif - ide_hwifs);
  84        ecard_release_resources(ec);
  85}
  86
  87static struct ecard_id rapide_ids[] = {
  88        { MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
  89        { 0xffff, 0xffff }
  90};
  91
  92static struct ecard_driver rapide_driver = {
  93        .probe          = rapide_probe,
  94        .remove         = __devexit_p(rapide_remove),
  95        .id_table       = rapide_ids,
  96        .drv = {
  97                .name   = "rapide",
  98        },
  99};
 100
 101static int __init rapide_init(void)
 102{
 103        return ecard_register_driver(&rapide_driver);
 104}
 105
 106MODULE_LICENSE("GPL");
 107MODULE_DESCRIPTION("Yellowstone RAPIDE driver");
 108
 109module_init(rapide_init);
 110
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.