]> pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/ide/ide-generic.c
ide-generic: probing fix
[linux-2.6-omap-h63xx.git] / 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         ide_hwif_t *hwif;
32         unsigned int base, ctl;
33         int irq;
34         hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
35         u8 idx[] = { 0xff, 0xff, 0xff, 0xff };
36
37         if (sscanf(buf, "%x:%x:%d", &base, &ctl, &irq) != 3)
38                 return -EINVAL;
39
40         hwif = ide_find_port();
41         if (hwif == NULL)
42                 return -ENOENT;
43
44         memset(&hw, 0, sizeof(hw));
45         ide_std_init_ports(&hw, base, ctl);
46         hw.irq = irq;
47         hw.chipset = ide_generic;
48
49         idx[0] = hwif->index;
50
51         ide_device_add(idx, NULL, hws);
52
53         return n;
54 };
55
56 static struct class_attribute ide_generic_class_attrs[] = {
57         __ATTR(add, S_IWUSR, NULL, store_add),
58         __ATTR_NULL
59 };
60
61 static void ide_generic_class_release(struct class *cls)
62 {
63         kfree(cls);
64 }
65
66 static int __init ide_generic_sysfs_init(void)
67 {
68         struct class *cls;
69         int rc;
70
71         cls = kzalloc(sizeof(*cls), GFP_KERNEL);
72         if (!cls)
73                 return -ENOMEM;
74
75         cls->name = DRV_NAME;
76         cls->owner = THIS_MODULE;
77         cls->class_release = ide_generic_class_release;
78         cls->class_attrs = ide_generic_class_attrs;
79
80         rc = class_register(cls);
81         if (rc) {
82                 kfree(cls);
83                 return rc;
84         }
85
86         return 0;
87 }
88
89 static int __init ide_generic_init(void)
90 {
91         hw_regs_t hw[MAX_HWIFS], *hws[MAX_HWIFS];
92         u8 idx[MAX_HWIFS];
93         int i;
94
95         printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" module "
96                          "parameter for probing all legacy ISA IDE ports\n");
97
98         for (i = 0; i < MAX_HWIFS; i++) {
99                 ide_hwif_t *hwif;
100                 unsigned long io_addr = ide_default_io_base(i);
101
102                 hws[i] = NULL;
103                 idx[i] = 0xff;
104
105                 if ((probe_mask & (1 << i)) && io_addr) {
106                         if (!request_region(io_addr, 8, DRV_NAME)) {
107                                 printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
108                                                 "not free.\n",
109                                                 DRV_NAME, io_addr, io_addr + 7);
110                                 continue;
111                         }
112
113                         if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
114                                 printk(KERN_ERR "%s: I/O resource 0x%lX "
115                                                 "not free.\n",
116                                                 DRV_NAME, io_addr + 0x206);
117                                 release_region(io_addr, 8);
118                                 continue;
119                         }
120
121                         hwif = ide_find_port();
122                         if (hwif == NULL)
123                                 continue;
124
125                         hwif->chipset = ide_generic;
126
127                         memset(&hw[i], 0, sizeof(hw[i]));
128                         ide_std_init_ports(&hw[i], io_addr, io_addr + 0x206);
129                         hw[i].irq = ide_default_irq(io_addr);
130                         hw[i].chipset = ide_generic;
131
132                         hws[i] = &hw[i];
133                         idx[i] = i;
134                 }
135         }
136
137         ide_device_add_all(idx, NULL, hws);
138
139         if (ide_generic_sysfs_init())
140                 printk(KERN_ERR DRV_NAME ": failed to create ide_generic "
141                                          "class\n");
142
143         return 0;
144 }
145
146 module_init(ide_generic_init);
147
148 MODULE_LICENSE("GPL");