drivers/block/rapide.c

   1 /*
   2  * linux/arch/arm/drivers/block/ide-rapide.c
   3  *
   4  * Copyright (c) 1996-1998 Russell King.
   5  *
   6  * Changelog:
   7  *  08-06-1996  RMK     Created
   8  *  13-04-1998  RMK     Added manufacturer and product IDs
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/malloc.h>
  13 #include <linux/blkdev.h>
  14 #include <linux/errno.h>
  15 #include <linux/ide.h>
  16
  17 #include <asm/ecard.h>
  18
  19 static const card_ids rapide_cids[] = {
  20         { MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
  21         { 0xffff, 0xffff }
  22 };
  23
  24 static struct expansion_card *ec[MAX_ECARDS];
  25 static int result[MAX_ECARDS];
  26
  27 static inline int rapide_register(struct expansion_card *ec)
  28 {
  29         unsigned long port = ecard_address (ec, ECARD_MEMC, 0);
  30         hw_regs_t hw;
  31
  32         int i;
  33
  34         memset(&hw, 0, sizeof(hw));
  35
  36         for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
  37                 hw.io_ports[i] = (ide_ioreg_t)port;
  38                 port += 1 << 4;
  39         }
  40         hw.io_ports[IDE_CONTROL_OFFSET] = port + 0x206;
  41         hw.irq = ec->irq;
  42
  43         return ide_register_hw(&hw, NULL);
  44 }
  45
  46 int rapide_init(void)
  47 {
  48         int i;
  49
  50         for (i = 0; i < MAX_ECARDS; i++)
  51                 ec[i] = NULL;
  52
  53         ecard_startfind();
  54
  55         for (i = 0; ; i++) {
  56                 if ((ec[i] = ecard_find(0, rapide_cids)) == NULL)
  57                         break;
  58
  59                 ecard_claim(ec[i]);
  60                 result[i] = rapide_register(ec[i]);
  61         }
  62         for (i = 0; i < MAX_ECARDS; i++)
  63                 if (ec[i] && result[i] < 0) {
  64                         ecard_release(ec[i]);
  65                         ec[i] = NULL;
  66         }
  67         return 0;
  68 }
  69
  70 #ifdef MODULE
  71
  72 int init_module (void)
  73 {
  74         return rapide_init();
  75 }
  76
  77 void cleanup_module (void)
  78 {
  79         int i;
  80
  81         for (i = 0; i < MAX_ECARDS; i++)
  82                 if (ec[i]) {
  83                         unsigned long port;
  84                         port = ecard_address(ec[i], ECARD_MEMC, 0);
  85
  86                         ide_unregister_port(port, ec[i]->irq, 16);
  87                         ecard_release(ec[i]);
  88                         ec[i] = NULL;
  89                 }
  90 }
  91 #endif
  92