[PATCH] Fix memory leak in isapnp
[linux-2.6] / drivers / scsi / sim710.c
1 /*
2  * sim710.c - Copyright (C) 1999 Richard Hirst <richard@sleepie.demon.co.uk>
3  *
4  *----------------------------------------------------------------------------
5  *  This program is free software; you can redistribute it and/or modify
6  *  it under the terms of the GNU General Public License as published by 
7  *  the Free Software Foundation; either version 2 of the License, or
8  *  (at your option) any later version.
9  *
10  *  This program is distributed in the hope that it will be useful,
11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  *  GNU General Public License for more details.
14  *
15  *  You should have received a copy of the GNU General Public License
16  *  along with this program; if not, write to the Free Software
17  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18  *----------------------------------------------------------------------------
19  *
20  * MCA card detection code by Trent McNair.
21  * Fixes to not explicitly nul bss data from Xavier Bestel.
22  * Some multiboard fixes from Rolf Eike Beer.
23  * Auto probing of EISA config space from Trevor Hemsley.
24  *
25  * Rewritten to use 53c700.c by James.Bottomley@SteelEye.com
26  *
27  */
28
29 #include <linux/config.h>
30 #include <linux/module.h>
31
32 #include <linux/blkdev.h>
33 #include <linux/device.h>
34 #include <linux/init.h>
35 #include <linux/mca.h>
36 #include <linux/eisa.h>
37 #include <linux/interrupt.h>
38 #include <scsi/scsi_host.h>
39 #include <scsi/scsi_device.h>
40 #include <scsi/scsi_transport.h>
41 #include <scsi/scsi_transport_spi.h>
42
43 #include "53c700.h"
44
45
46 /* Must be enough for both EISA and MCA */
47 #define MAX_SLOTS 8
48 static __u8 __initdata id_array[MAX_SLOTS] = { [0 ... MAX_SLOTS-1] = 7 };
49
50 static char *sim710;            /* command line passed by insmod */
51
52 MODULE_AUTHOR("Richard Hirst");
53 MODULE_DESCRIPTION("Simple NCR53C710 driver");
54 MODULE_LICENSE("GPL");
55
56 module_param(sim710, charp, 0);
57
58 #ifdef MODULE
59 #define ARG_SEP ' '
60 #else
61 #define ARG_SEP ','
62 #endif
63
64 static __init int
65 param_setup(char *str)
66 {
67         char *pos = str, *next;
68         int slot = -1;
69
70         while(pos != NULL && (next = strchr(pos, ':')) != NULL) {
71                 int val = (int)simple_strtoul(++next, NULL, 0);
72
73                 if(!strncmp(pos, "slot:", 5))
74                         slot = val;
75                 else if(!strncmp(pos, "id:", 3)) {
76                         if(slot == -1) {
77                                 printk(KERN_WARNING "sim710: Must specify slot for id parameter\n");
78                         } else if(slot > MAX_SLOTS) {
79                                 printk(KERN_WARNING "sim710: Illegal slot %d for id %d\n", slot, val);
80                         } else {
81                                 id_array[slot] = val;
82                         }
83                 }
84                 if((pos = strchr(pos, ARG_SEP)) != NULL)
85                         pos++;
86         }
87         return 1;
88 }
89 __setup("sim710=", param_setup);
90
91 static struct scsi_host_template sim710_driver_template = {
92         .name                   = "LSI (Symbios) 710 MCA/EISA",
93         .proc_name              = "sim710",
94         .this_id                = 7,
95         .module                 = THIS_MODULE,
96 };
97
98 static __devinit int
99 sim710_probe_common(struct device *dev, unsigned long base_addr,
100                     int irq, int clock, int differential, int scsi_id)
101 {
102         struct Scsi_Host * host = NULL;
103         struct NCR_700_Host_Parameters *hostdata =
104                 kmalloc(sizeof(struct NCR_700_Host_Parameters), GFP_KERNEL);
105
106         printk(KERN_NOTICE "sim710: %s\n", dev->bus_id);
107         printk(KERN_NOTICE "sim710: irq = %d, clock = %d, base = 0x%lx, scsi_id = %d\n",
108                irq, clock, base_addr, scsi_id);
109
110         if(hostdata == NULL) {
111                 printk(KERN_ERR "sim710: Failed to allocate host data\n");
112                 goto out;
113         }
114         memset(hostdata, 0, sizeof(struct NCR_700_Host_Parameters));
115
116         if(request_region(base_addr, 64, "sim710") == NULL) {
117                 printk(KERN_ERR "sim710: Failed to reserve IO region 0x%lx\n",
118                        base_addr);
119                 goto out_free;
120         }
121
122         /* Fill in the three required pieces of hostdata */
123         hostdata->base = ioport_map(base_addr, 64);
124         hostdata->differential = differential;
125         hostdata->clock = clock;
126         hostdata->chip710 = 1;
127
128         /* and register the chip */
129         if((host = NCR_700_detect(&sim710_driver_template, hostdata, dev))
130            == NULL) {
131                 printk(KERN_ERR "sim710: No host detected; card configuration problem?\n");
132                 goto out_release;
133         }
134         host->this_id = scsi_id;
135         host->base = base_addr;
136         host->irq = irq;
137         if (request_irq(irq, NCR_700_intr, SA_SHIRQ, "sim710", host)) {
138                 printk(KERN_ERR "sim710: request_irq failed\n");
139                 goto out_put_host;
140         }
141
142         scsi_scan_host(host);
143
144         return 0;
145
146  out_put_host:
147         scsi_host_put(host);
148  out_release:
149         release_region(base_addr, 64);
150  out_free:
151         kfree(hostdata);
152  out:
153         return -ENODEV;
154 }
155
156 static __devexit int
157 sim710_device_remove(struct device *dev)
158 {
159         struct Scsi_Host *host = dev_to_shost(dev);
160         struct NCR_700_Host_Parameters *hostdata =
161                 (struct NCR_700_Host_Parameters *)host->hostdata[0];
162
163         scsi_remove_host(host);
164         NCR_700_release(host);
165         kfree(hostdata);
166         free_irq(host->irq, host);
167         release_region(host->base, 64);
168         return 0;
169 }
170
171 #ifdef CONFIG_MCA
172
173 /* CARD ID 01BB and 01BA use the same pos values */
174 #define MCA_01BB_IO_PORTS { 0x0000, 0x0000, 0x0800, 0x0C00, 0x1000, 0x1400, \
175                             0x1800, 0x1C00, 0x2000, 0x2400, 0x2800, \
176                             0x2C00, 0x3000, 0x3400, 0x3800, 0x3C00, \
177                             0x4000, 0x4400, 0x4800, 0x4C00, 0x5000  }
178
179 #define MCA_01BB_IRQS { 3, 5, 11, 14 }
180
181 /* CARD ID 004f */
182 #define MCA_004F_IO_PORTS { 0x0000, 0x0200, 0x0300, 0x0400, 0x0500,  0x0600 }
183 #define MCA_004F_IRQS { 5, 9, 14 }
184
185 static short sim710_mca_id_table[] = { 0x01bb, 0x01ba, 0x004f, 0};
186
187 static __init int
188 sim710_mca_probe(struct device *dev)
189 {
190         struct mca_device *mca_dev = to_mca_device(dev);
191         int slot = mca_dev->slot;
192         int pos[3];
193         unsigned int base;
194         int irq_vector;
195         short id = sim710_mca_id_table[mca_dev->index];
196         static int io_004f_by_pos[] = MCA_004F_IO_PORTS;
197         static int irq_004f_by_pos[] = MCA_004F_IRQS;
198         static int io_01bb_by_pos[] = MCA_01BB_IO_PORTS;
199         static int irq_01bb_by_pos[] = MCA_01BB_IRQS;
200         char *name;
201         int clock;
202
203         pos[0] = mca_device_read_stored_pos(mca_dev, 2);
204         pos[1] = mca_device_read_stored_pos(mca_dev, 3);
205         pos[2] = mca_device_read_stored_pos(mca_dev, 4);
206
207         /*
208          * 01BB & 01BA port base by bits 7,6,5,4,3,2 in pos[2]
209          *
210          *    000000  <disabled>   001010  0x2800
211          *    000001  <invalid>    001011  0x2C00
212          *    000010  0x0800       001100  0x3000
213          *    000011  0x0C00       001101  0x3400
214          *    000100  0x1000       001110  0x3800
215          *    000101  0x1400       001111  0x3C00
216          *    000110  0x1800       010000  0x4000
217          *    000111  0x1C00       010001  0x4400
218          *    001000  0x2000       010010  0x4800
219          *    001001  0x2400       010011  0x4C00
220          *                         010100  0x5000
221          *
222          * 00F4 port base by bits 3,2,1 in pos[0]
223          *
224          *    000  <disabled>      001    0x200
225          *    010  0x300           011    0x400
226          *    100  0x500           101    0x600
227          *
228          * 01BB & 01BA IRQ is specified in pos[0] bits 7 and 6:
229          *
230          *    00   3               10   11
231          *    01   5               11   14
232          *
233          * 00F4 IRQ specified by bits 6,5,4 in pos[0]
234          *
235          *    100   5              101    9
236          *    110   14
237          */
238
239         if (id == 0x01bb || id == 0x01ba) {
240                 base = io_01bb_by_pos[(pos[2] & 0xFC) >> 2];
241                 irq_vector =
242                         irq_01bb_by_pos[((pos[0] & 0xC0) >> 6)];
243
244                 clock = 50;
245                 if (id == 0x01bb)
246                         name = "NCR 3360/3430 SCSI SubSystem";
247                 else
248                         name = "NCR Dual SIOP SCSI Host Adapter Board";
249         } else if ( id == 0x004f ) {
250                 base = io_004f_by_pos[((pos[0] & 0x0E) >> 1)];
251                 irq_vector =
252                         irq_004f_by_pos[((pos[0] & 0x70) >> 4) - 4];
253                 clock = 50;
254                 name = "NCR 53c710 SCSI Host Adapter Board";
255         } else {
256                 return -ENODEV;
257         }
258         mca_device_set_name(mca_dev, name);
259         mca_device_set_claim(mca_dev, 1);
260         base = mca_device_transform_ioport(mca_dev, base);
261         irq_vector = mca_device_transform_irq(mca_dev, irq_vector);
262
263         return sim710_probe_common(dev, base, irq_vector, clock,
264                                    0, id_array[slot]);
265 }
266
267 static struct mca_driver sim710_mca_driver = {
268         .id_table               = sim710_mca_id_table,
269         .driver = {
270                 .name           = "sim710",
271                 .bus            = &mca_bus_type,
272                 .probe          = sim710_mca_probe,
273                 .remove         = __devexit_p(sim710_device_remove),
274         },
275 };
276
277 #endif /* CONFIG_MCA */
278
279 #ifdef CONFIG_EISA
280 static struct eisa_device_id sim710_eisa_ids[] = {
281         { "CPQ4410" },
282         { "CPQ4411" },
283         { "HWP0C80" },
284         { "" }
285 };
286
287 static __init int
288 sim710_eisa_probe(struct device *dev)
289 {
290         struct eisa_device *edev = to_eisa_device(dev);
291         unsigned long io_addr = edev->base_addr;
292         char eisa_cpq_irqs[] = { 11, 14, 15, 10, 9, 0 };
293         char eisa_hwp_irqs[] = { 3, 4, 5, 7, 12, 10, 11, 0};
294         char *eisa_irqs;
295         unsigned char irq_index;
296         unsigned char irq, differential = 0, scsi_id = 7;
297
298         if(strcmp(edev->id.sig, "HWP0C80") == 0) {
299                 __u8 val;
300                 eisa_irqs =  eisa_hwp_irqs;
301                 irq_index = (inb(io_addr + 0xc85) & 0x7) - 1;
302
303                 val = inb(io_addr + 0x4);
304                 scsi_id = ffs(val) - 1;
305
306                 if(scsi_id > 7 || (val & ~(1<<scsi_id)) != 0) {
307                         printk(KERN_ERR "sim710.c, EISA card %s has incorrect scsi_id, setting to 7\n", dev->bus_id);
308                         scsi_id = 7;
309                 }
310         } else {
311                 eisa_irqs = eisa_cpq_irqs;
312                 irq_index = inb(io_addr + 0xc88) & 0x07;
313         }
314
315         if(irq_index >= strlen(eisa_irqs)) {
316                 printk("sim710.c: irq nasty\n");
317                 return -ENODEV;
318         }
319
320         irq = eisa_irqs[irq_index];
321                 
322         return sim710_probe_common(dev, io_addr, irq, 50,
323                                    differential, scsi_id);
324 }
325
326 static struct eisa_driver sim710_eisa_driver = {
327         .id_table               = sim710_eisa_ids,
328         .driver = {
329                 .name           = "sim710",
330                 .probe          = sim710_eisa_probe,
331                 .remove         = __devexit_p(sim710_device_remove),
332         },
333 };
334 #endif /* CONFIG_EISA */
335
336 static int __init sim710_init(void)
337 {
338         int err = -ENODEV;
339
340 #ifdef MODULE
341         if (sim710)
342                 param_setup(sim710);
343 #endif
344
345 #ifdef CONFIG_MCA
346         err = mca_register_driver(&sim710_mca_driver);
347 #endif
348
349 #ifdef CONFIG_EISA
350         err = eisa_driver_register(&sim710_eisa_driver);
351 #endif
352         /* FIXME: what we'd really like to return here is -ENODEV if
353          * no devices have actually been found.  Instead, the err
354          * above actually only reports problems with kobject_register,
355          * so for the moment return success */
356
357         return 0;
358 }
359
360 static void __exit sim710_exit(void)
361 {
362 #ifdef CONFIG_MCA
363         if (MCA_bus)
364                 mca_unregister_driver(&sim710_mca_driver);
365 #endif
366
367 #ifdef CONFIG_EISA
368         eisa_driver_unregister(&sim710_eisa_driver);
369 #endif
370 }
371
372 module_init(sim710_init);
373 module_exit(sim710_exit);