ide: add ide_host_add() helper
[deliverable/linux.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 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 int i;
88
89 printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" module "
90 "parameter for probing all legacy ISA IDE ports\n");
91
92 for (i = 0; i < MAX_HWIFS; i++) {
93 unsigned long io_addr = ide_default_io_base(i);
94
95 hws[i] = NULL;
96
97 if ((probe_mask & (1 << i)) && io_addr) {
98 if (!request_region(io_addr, 8, DRV_NAME)) {
99 printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
100 "not free.\n",
101 DRV_NAME, io_addr, io_addr + 7);
102 continue;
103 }
104
105 if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
106 printk(KERN_ERR "%s: I/O resource 0x%lX "
107 "not free.\n",
108 DRV_NAME, io_addr + 0x206);
109 release_region(io_addr, 8);
110 continue;
111 }
112
113 memset(&hw[i], 0, sizeof(hw[i]));
114 ide_std_init_ports(&hw[i], io_addr, io_addr + 0x206);
115 hw[i].irq = ide_default_irq(io_addr);
116 hw[i].chipset = ide_generic;
117
118 hws[i] = &hw[i];
119 }
120 }
121
122 host = ide_host_alloc_all(NULL, hws);
123 if (host)
124 ide_host_register(host, NULL, hws);
125
126 if (ide_generic_sysfs_init())
127 printk(KERN_ERR DRV_NAME ": failed to create ide_generic "
128 "class\n");
129
130 return 0;
131 }
132
133 module_init(ide_generic_init);
134
135 MODULE_LICENSE("GPL");
This page took 0.032172 seconds and 5 git commands to generate.