git.oblomov.eu Git - linux-2.6/blob - drivers/ide/ide-generic.c

   1 /*
   2  * generic/default IDE host driver
   3  *
   4  * Copyright (C) 2004, 2008 Bartlomiej Zolnierkiewicz
   5  * This code was split off from ide.c.  See it for original copyrights.
   6  *
   7  * May be copied or modified under the terms of the GNU General Public License.
   8  */
   9
  10 /*
  11  * For special cases new interfaces may be added using sysfs, i.e.
  12  *
  13  *      echo -n "0x168:0x36e:10" > /sys/class/ide_generic/add
  14  *
  15  * will add an interface using I/O ports 0x168-0x16f/0x36e and IRQ 10.
  16  */
  17
  18 #include <linux/kernel.h>
  19 #include <linux/init.h>
  20 #include <linux/module.h>
  21 #include <linux/ide.h>
  22
  23 #define DRV_NAME        "ide_generic"
  24
  25 static int probe_mask = 0x03;
  26 module_param(probe_mask, int, 0);
  27 MODULE_PARM_DESC(probe_mask, "probe mask for legacy ISA IDE ports");
  28
  29 static ssize_t store_add(struct class *cls, const char *buf, size_t n)
  30 {
  31         unsigned int base, ctl;
  32         int irq, rc;
  33         hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
  34
  35         if (sscanf(buf, "%x:%x:%d", &base, &ctl, &irq) != 3)
  36                 return -EINVAL;
  37
  38         memset(&hw, 0, sizeof(hw));
  39         ide_std_init_ports(&hw, base, ctl);
  40         hw.irq = irq;
  41         hw.chipset = ide_generic;
  42
  43         rc = ide_host_add(NULL, hws, NULL);
  44         if (rc)
  45                 return rc;
  46
  47         return n;
  48 };
  49
  50 static struct class_attribute ide_generic_class_attrs[] = {
  51         __ATTR(add, S_IWUSR, NULL, store_add),
  52         __ATTR_NULL
  53 };
  54
  55 static void ide_generic_class_release(struct class *cls)
  56 {
  57         kfree(cls);
  58 }
  59
  60 static int __init ide_generic_sysfs_init(void)
  61 {
  62         struct class *cls;
  63         int rc;
  64
  65         cls = kzalloc(sizeof(*cls), GFP_KERNEL);
  66         if (!cls)
  67                 return -ENOMEM;
  68
  69         cls->name = DRV_NAME;
  70         cls->owner = THIS_MODULE;
  71         cls->class_release = ide_generic_class_release;
  72         cls->class_attrs = ide_generic_class_attrs;
  73
  74         rc = class_register(cls);
  75         if (rc) {
  76                 kfree(cls);
  77                 return rc;
  78         }
  79
  80         return 0;
  81 }
  82
  83 static int __init ide_generic_init(void)
  84 {
  85         hw_regs_t hw[MAX_HWIFS], *hws[MAX_HWIFS];
  86         struct ide_host *host;
  87         unsigned long io_addr;
  88         int i, rc;
  89
  90         printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" module "
  91                          "parameter for probing all legacy ISA IDE ports\n");
  92
  93         for (i = 0; i < MAX_HWIFS; i++) {
  94                 io_addr = ide_default_io_base(i);
  95
  96                 hws[i] = NULL;
  97
  98                 if ((probe_mask & (1 << i)) && io_addr) {
  99                         if (!request_region(io_addr, 8, DRV_NAME)) {
 100                                 printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
 101                                                 "not free.\n",
 102                                                 DRV_NAME, io_addr, io_addr + 7);
 103                                 continue;
 104                         }
 105
 106                         if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
 107                                 printk(KERN_ERR "%s: I/O resource 0x%lX "
 108                                                 "not free.\n",
 109                                                 DRV_NAME, io_addr + 0x206);
 110                                 release_region(io_addr, 8);
 111                                 continue;
 112                         }
 113
 114                         memset(&hw[i], 0, sizeof(hw[i]));
 115                         ide_std_init_ports(&hw[i], io_addr, io_addr + 0x206);
 116                         hw[i].irq = ide_default_irq(io_addr);
 117                         hw[i].chipset = ide_generic;
 118
 119                         hws[i] = &hw[i];
 120                 }
 121         }
 122
 123         host = ide_host_alloc_all(NULL, hws);
 124         if (host == NULL) {
 125                 rc = -ENOMEM;
 126                 goto err;
 127         }
 128
 129         rc = ide_host_register(host, NULL, hws);
 130         if (rc)
 131                 goto err_free;
 132
 133         if (ide_generic_sysfs_init())
 134                 printk(KERN_ERR DRV_NAME ": failed to create ide_generic "
 135                                          "class\n");
 136
 137         return 0;
 138 err_free:
 139         ide_host_free(host);
 140 err:
 141         for (i = 0; i < MAX_HWIFS; i++) {
 142                 if (hws[i] == NULL)
 143                         continue;
 144
 145                 io_addr = hws[i]->io_ports.data_addr;
 146                 release_region(io_addr + 0x206, 1);
 147                 release_region(io_addr, 8);
 148         }
 149         return rc;
 150 }
 151
 152 module_init(ide_generic_init);
 153
 154 MODULE_LICENSE("GPL");