diff options
Diffstat (limited to 'drivers/scsi/aic94xx/aic94xx_init.c')
-rw-r--r-- | drivers/scsi/aic94xx/aic94xx_init.c | 860 |
1 files changed, 860 insertions, 0 deletions
diff --git a/drivers/scsi/aic94xx/aic94xx_init.c b/drivers/scsi/aic94xx/aic94xx_init.c new file mode 100644 index 000000000000..3ec2e46f80c6 --- /dev/null +++ b/drivers/scsi/aic94xx/aic94xx_init.c | |||
@@ -0,0 +1,860 @@ | |||
1 | /* | ||
2 | * Aic94xx SAS/SATA driver initialization. | ||
3 | * | ||
4 | * Copyright (C) 2005 Adaptec, Inc. All rights reserved. | ||
5 | * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com> | ||
6 | * | ||
7 | * This file is licensed under GPLv2. | ||
8 | * | ||
9 | * This file is part of the aic94xx driver. | ||
10 | * | ||
11 | * The aic94xx driver is free software; you can redistribute it and/or | ||
12 | * modify it under the terms of the GNU General Public License as | ||
13 | * published by the Free Software Foundation; version 2 of the | ||
14 | * License. | ||
15 | * | ||
16 | * The aic94xx driver is distributed in the hope that it will be useful, | ||
17 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
19 | * General Public License for more details. | ||
20 | * | ||
21 | * You should have received a copy of the GNU General Public License | ||
22 | * along with the aic94xx driver; if not, write to the Free Software | ||
23 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | ||
24 | * | ||
25 | */ | ||
26 | |||
27 | #include <linux/config.h> | ||
28 | #include <linux/module.h> | ||
29 | #include <linux/init.h> | ||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/pci.h> | ||
32 | #include <linux/delay.h> | ||
33 | |||
34 | #include <scsi/scsi_host.h> | ||
35 | |||
36 | #include "aic94xx.h" | ||
37 | #include "aic94xx_reg.h" | ||
38 | #include "aic94xx_hwi.h" | ||
39 | #include "aic94xx_seq.h" | ||
40 | |||
41 | /* The format is "version.release.patchlevel" */ | ||
42 | #define ASD_DRIVER_VERSION "1.0.2" | ||
43 | |||
44 | static int use_msi = 0; | ||
45 | module_param_named(use_msi, use_msi, int, S_IRUGO); | ||
46 | MODULE_PARM_DESC(use_msi, "\n" | ||
47 | "\tEnable(1) or disable(0) using PCI MSI.\n" | ||
48 | "\tDefault: 0"); | ||
49 | |||
50 | static int lldd_max_execute_num = 0; | ||
51 | module_param_named(collector, lldd_max_execute_num, int, S_IRUGO); | ||
52 | MODULE_PARM_DESC(collector, "\n" | ||
53 | "\tIf greater than one, tells the SAS Layer to run in Task Collector\n" | ||
54 | "\tMode. If 1 or 0, tells the SAS Layer to run in Direct Mode.\n" | ||
55 | "\tThe aic94xx SAS LLDD supports both modes.\n" | ||
56 | "\tDefault: 0 (Direct Mode).\n"); | ||
57 | |||
58 | char sas_addr_str[2*SAS_ADDR_SIZE + 1] = ""; | ||
59 | |||
60 | static struct scsi_transport_template *aic94xx_transport_template; | ||
61 | |||
62 | static struct scsi_host_template aic94xx_sht = { | ||
63 | .module = THIS_MODULE, | ||
64 | /* .name is initialized */ | ||
65 | .name = "aic94xx", | ||
66 | .queuecommand = sas_queuecommand, | ||
67 | .target_alloc = sas_target_alloc, | ||
68 | .slave_configure = sas_slave_configure, | ||
69 | .slave_destroy = sas_slave_destroy, | ||
70 | .change_queue_depth = sas_change_queue_depth, | ||
71 | .change_queue_type = sas_change_queue_type, | ||
72 | .bios_param = sas_bios_param, | ||
73 | .can_queue = 1, | ||
74 | .cmd_per_lun = 1, | ||
75 | .this_id = -1, | ||
76 | .sg_tablesize = SG_ALL, | ||
77 | .max_sectors = SCSI_DEFAULT_MAX_SECTORS, | ||
78 | .use_clustering = ENABLE_CLUSTERING, | ||
79 | }; | ||
80 | |||
81 | static int __devinit asd_map_memio(struct asd_ha_struct *asd_ha) | ||
82 | { | ||
83 | int err, i; | ||
84 | struct asd_ha_addrspace *io_handle; | ||
85 | |||
86 | asd_ha->iospace = 0; | ||
87 | for (i = 0; i < 3; i += 2) { | ||
88 | io_handle = &asd_ha->io_handle[i==0?0:1]; | ||
89 | io_handle->start = pci_resource_start(asd_ha->pcidev, i); | ||
90 | io_handle->len = pci_resource_len(asd_ha->pcidev, i); | ||
91 | io_handle->flags = pci_resource_flags(asd_ha->pcidev, i); | ||
92 | err = -ENODEV; | ||
93 | if (!io_handle->start || !io_handle->len) { | ||
94 | asd_printk("MBAR%d start or length for %s is 0.\n", | ||
95 | i==0?0:1, pci_name(asd_ha->pcidev)); | ||
96 | goto Err; | ||
97 | } | ||
98 | err = pci_request_region(asd_ha->pcidev, i, ASD_DRIVER_NAME); | ||
99 | if (err) { | ||
100 | asd_printk("couldn't reserve memory region for %s\n", | ||
101 | pci_name(asd_ha->pcidev)); | ||
102 | goto Err; | ||
103 | } | ||
104 | if (io_handle->flags & IORESOURCE_CACHEABLE) | ||
105 | io_handle->addr = ioremap(io_handle->start, | ||
106 | io_handle->len); | ||
107 | else | ||
108 | io_handle->addr = ioremap_nocache(io_handle->start, | ||
109 | io_handle->len); | ||
110 | if (!io_handle->addr) { | ||
111 | asd_printk("couldn't map MBAR%d of %s\n", i==0?0:1, | ||
112 | pci_name(asd_ha->pcidev)); | ||
113 | goto Err_unreq; | ||
114 | } | ||
115 | } | ||
116 | |||
117 | return 0; | ||
118 | Err_unreq: | ||
119 | pci_release_region(asd_ha->pcidev, i); | ||
120 | Err: | ||
121 | if (i > 0) { | ||
122 | io_handle = &asd_ha->io_handle[0]; | ||
123 | iounmap(io_handle->addr); | ||
124 | pci_release_region(asd_ha->pcidev, 0); | ||
125 | } | ||
126 | return err; | ||
127 | } | ||
128 | |||
129 | static void __devexit asd_unmap_memio(struct asd_ha_struct *asd_ha) | ||
130 | { | ||
131 | struct asd_ha_addrspace *io_handle; | ||
132 | |||
133 | io_handle = &asd_ha->io_handle[1]; | ||
134 | iounmap(io_handle->addr); | ||
135 | pci_release_region(asd_ha->pcidev, 2); | ||
136 | |||
137 | io_handle = &asd_ha->io_handle[0]; | ||
138 | iounmap(io_handle->addr); | ||
139 | pci_release_region(asd_ha->pcidev, 0); | ||
140 | } | ||
141 | |||
142 | static int __devinit asd_map_ioport(struct asd_ha_struct *asd_ha) | ||
143 | { | ||
144 | int i = PCI_IOBAR_OFFSET, err; | ||
145 | struct asd_ha_addrspace *io_handle = &asd_ha->io_handle[0]; | ||
146 | |||
147 | asd_ha->iospace = 1; | ||
148 | io_handle->start = pci_resource_start(asd_ha->pcidev, i); | ||
149 | io_handle->len = pci_resource_len(asd_ha->pcidev, i); | ||
150 | io_handle->flags = pci_resource_flags(asd_ha->pcidev, i); | ||
151 | io_handle->addr = (void __iomem *) io_handle->start; | ||
152 | if (!io_handle->start || !io_handle->len) { | ||
153 | asd_printk("couldn't get IO ports for %s\n", | ||
154 | pci_name(asd_ha->pcidev)); | ||
155 | return -ENODEV; | ||
156 | } | ||
157 | err = pci_request_region(asd_ha->pcidev, i, ASD_DRIVER_NAME); | ||
158 | if (err) { | ||
159 | asd_printk("couldn't reserve io space for %s\n", | ||
160 | pci_name(asd_ha->pcidev)); | ||
161 | } | ||
162 | |||
163 | return err; | ||
164 | } | ||
165 | |||
166 | static void __devexit asd_unmap_ioport(struct asd_ha_struct *asd_ha) | ||
167 | { | ||
168 | pci_release_region(asd_ha->pcidev, PCI_IOBAR_OFFSET); | ||
169 | } | ||
170 | |||
171 | static int __devinit asd_map_ha(struct asd_ha_struct *asd_ha) | ||
172 | { | ||
173 | int err; | ||
174 | u16 cmd_reg; | ||
175 | |||
176 | err = pci_read_config_word(asd_ha->pcidev, PCI_COMMAND, &cmd_reg); | ||
177 | if (err) { | ||
178 | asd_printk("couldn't read command register of %s\n", | ||
179 | pci_name(asd_ha->pcidev)); | ||
180 | goto Err; | ||
181 | } | ||
182 | |||
183 | err = -ENODEV; | ||
184 | if (cmd_reg & PCI_COMMAND_MEMORY) { | ||
185 | if ((err = asd_map_memio(asd_ha))) | ||
186 | goto Err; | ||
187 | } else if (cmd_reg & PCI_COMMAND_IO) { | ||
188 | if ((err = asd_map_ioport(asd_ha))) | ||
189 | goto Err; | ||
190 | asd_printk("%s ioport mapped -- upgrade your hardware\n", | ||
191 | pci_name(asd_ha->pcidev)); | ||
192 | } else { | ||
193 | asd_printk("no proper device access to %s\n", | ||
194 | pci_name(asd_ha->pcidev)); | ||
195 | goto Err; | ||
196 | } | ||
197 | |||
198 | return 0; | ||
199 | Err: | ||
200 | return err; | ||
201 | } | ||
202 | |||
203 | static void __devexit asd_unmap_ha(struct asd_ha_struct *asd_ha) | ||
204 | { | ||
205 | if (asd_ha->iospace) | ||
206 | asd_unmap_ioport(asd_ha); | ||
207 | else | ||
208 | asd_unmap_memio(asd_ha); | ||
209 | } | ||
210 | |||
211 | static const char *asd_dev_rev[30] = { | ||
212 | [0] = "A0", | ||
213 | [1] = "A1", | ||
214 | [8] = "B0", | ||
215 | }; | ||
216 | |||
217 | static int __devinit asd_common_setup(struct asd_ha_struct *asd_ha) | ||
218 | { | ||
219 | int err, i; | ||
220 | |||
221 | err = pci_read_config_byte(asd_ha->pcidev, PCI_REVISION_ID, | ||
222 | &asd_ha->revision_id); | ||
223 | if (err) { | ||
224 | asd_printk("couldn't read REVISION ID register of %s\n", | ||
225 | pci_name(asd_ha->pcidev)); | ||
226 | goto Err; | ||
227 | } | ||
228 | err = -ENODEV; | ||
229 | if (asd_ha->revision_id < AIC9410_DEV_REV_B0) { | ||
230 | asd_printk("%s is revision %s (%X), which is not supported\n", | ||
231 | pci_name(asd_ha->pcidev), | ||
232 | asd_dev_rev[asd_ha->revision_id], | ||
233 | asd_ha->revision_id); | ||
234 | goto Err; | ||
235 | } | ||
236 | /* Provide some sane default values. */ | ||
237 | asd_ha->hw_prof.max_scbs = 512; | ||
238 | asd_ha->hw_prof.max_ddbs = 128; | ||
239 | asd_ha->hw_prof.num_phys = ASD_MAX_PHYS; | ||
240 | /* All phys are enabled, by default. */ | ||
241 | asd_ha->hw_prof.enabled_phys = 0xFF; | ||
242 | for (i = 0; i < ASD_MAX_PHYS; i++) { | ||
243 | asd_ha->hw_prof.phy_desc[i].max_sas_lrate = PHY_LINKRATE_3; | ||
244 | asd_ha->hw_prof.phy_desc[i].min_sas_lrate = PHY_LINKRATE_1_5; | ||
245 | asd_ha->hw_prof.phy_desc[i].max_sata_lrate= PHY_LINKRATE_1_5; | ||
246 | asd_ha->hw_prof.phy_desc[i].min_sata_lrate= PHY_LINKRATE_1_5; | ||
247 | } | ||
248 | |||
249 | return 0; | ||
250 | Err: | ||
251 | return err; | ||
252 | } | ||
253 | |||
254 | static int __devinit asd_aic9410_setup(struct asd_ha_struct *asd_ha) | ||
255 | { | ||
256 | int err = asd_common_setup(asd_ha); | ||
257 | |||
258 | if (err) | ||
259 | return err; | ||
260 | |||
261 | asd_ha->hw_prof.addr_range = 8; | ||
262 | asd_ha->hw_prof.port_name_base = 0; | ||
263 | asd_ha->hw_prof.dev_name_base = 8; | ||
264 | asd_ha->hw_prof.sata_name_base = 16; | ||
265 | |||
266 | return 0; | ||
267 | } | ||
268 | |||
269 | static int __devinit asd_aic9405_setup(struct asd_ha_struct *asd_ha) | ||
270 | { | ||
271 | int err = asd_common_setup(asd_ha); | ||
272 | |||
273 | if (err) | ||
274 | return err; | ||
275 | |||
276 | asd_ha->hw_prof.addr_range = 4; | ||
277 | asd_ha->hw_prof.port_name_base = 0; | ||
278 | asd_ha->hw_prof.dev_name_base = 4; | ||
279 | asd_ha->hw_prof.sata_name_base = 8; | ||
280 | |||
281 | return 0; | ||
282 | } | ||
283 | |||
284 | static ssize_t asd_show_dev_rev(struct device *dev, | ||
285 | struct device_attribute *attr, char *buf) | ||
286 | { | ||
287 | struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev); | ||
288 | return snprintf(buf, PAGE_SIZE, "%s\n", | ||
289 | asd_dev_rev[asd_ha->revision_id]); | ||
290 | } | ||
291 | static DEVICE_ATTR(revision, S_IRUGO, asd_show_dev_rev, NULL); | ||
292 | |||
293 | static ssize_t asd_show_dev_bios_build(struct device *dev, | ||
294 | struct device_attribute *attr,char *buf) | ||
295 | { | ||
296 | struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev); | ||
297 | return snprintf(buf, PAGE_SIZE, "%d\n", asd_ha->hw_prof.bios.bld); | ||
298 | } | ||
299 | static DEVICE_ATTR(bios_build, S_IRUGO, asd_show_dev_bios_build, NULL); | ||
300 | |||
301 | static ssize_t asd_show_dev_pcba_sn(struct device *dev, | ||
302 | struct device_attribute *attr, char *buf) | ||
303 | { | ||
304 | struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev); | ||
305 | return snprintf(buf, PAGE_SIZE, "%s\n", asd_ha->hw_prof.pcba_sn); | ||
306 | } | ||
307 | static DEVICE_ATTR(pcba_sn, S_IRUGO, asd_show_dev_pcba_sn, NULL); | ||
308 | |||
309 | static void asd_create_dev_attrs(struct asd_ha_struct *asd_ha) | ||
310 | { | ||
311 | device_create_file(&asd_ha->pcidev->dev, &dev_attr_revision); | ||
312 | device_create_file(&asd_ha->pcidev->dev, &dev_attr_bios_build); | ||
313 | device_create_file(&asd_ha->pcidev->dev, &dev_attr_pcba_sn); | ||
314 | } | ||
315 | |||
316 | static void asd_remove_dev_attrs(struct asd_ha_struct *asd_ha) | ||
317 | { | ||
318 | device_remove_file(&asd_ha->pcidev->dev, &dev_attr_revision); | ||
319 | device_remove_file(&asd_ha->pcidev->dev, &dev_attr_bios_build); | ||
320 | device_remove_file(&asd_ha->pcidev->dev, &dev_attr_pcba_sn); | ||
321 | } | ||
322 | |||
323 | /* The first entry, 0, is used for dynamic ids, the rest for devices | ||
324 | * we know about. | ||
325 | */ | ||
326 | static struct asd_pcidev_struct { | ||
327 | const char * name; | ||
328 | int (*setup)(struct asd_ha_struct *asd_ha); | ||
329 | } asd_pcidev_data[] = { | ||
330 | /* Id 0 is used for dynamic ids. */ | ||
331 | { .name = "Adaptec AIC-94xx SAS/SATA Host Adapter", | ||
332 | .setup = asd_aic9410_setup | ||
333 | }, | ||
334 | { .name = "Adaptec AIC-9410W SAS/SATA Host Adapter", | ||
335 | .setup = asd_aic9410_setup | ||
336 | }, | ||
337 | { .name = "Adaptec AIC-9405W SAS/SATA Host Adapter", | ||
338 | .setup = asd_aic9405_setup | ||
339 | }, | ||
340 | }; | ||
341 | |||
342 | static inline int asd_create_ha_caches(struct asd_ha_struct *asd_ha) | ||
343 | { | ||
344 | asd_ha->scb_pool = dma_pool_create(ASD_DRIVER_NAME "_scb_pool", | ||
345 | &asd_ha->pcidev->dev, | ||
346 | sizeof(struct scb), | ||
347 | 8, 0); | ||
348 | if (!asd_ha->scb_pool) { | ||
349 | asd_printk("couldn't create scb pool\n"); | ||
350 | return -ENOMEM; | ||
351 | } | ||
352 | |||
353 | return 0; | ||
354 | } | ||
355 | |||
356 | /** | ||
357 | * asd_free_edbs -- free empty data buffers | ||
358 | * asd_ha: pointer to host adapter structure | ||
359 | */ | ||
360 | static inline void asd_free_edbs(struct asd_ha_struct *asd_ha) | ||
361 | { | ||
362 | struct asd_seq_data *seq = &asd_ha->seq; | ||
363 | int i; | ||
364 | |||
365 | for (i = 0; i < seq->num_edbs; i++) | ||
366 | asd_free_coherent(asd_ha, seq->edb_arr[i]); | ||
367 | kfree(seq->edb_arr); | ||
368 | seq->edb_arr = NULL; | ||
369 | } | ||
370 | |||
371 | static inline void asd_free_escbs(struct asd_ha_struct *asd_ha) | ||
372 | { | ||
373 | struct asd_seq_data *seq = &asd_ha->seq; | ||
374 | int i; | ||
375 | |||
376 | for (i = 0; i < seq->num_escbs; i++) { | ||
377 | if (!list_empty(&seq->escb_arr[i]->list)) | ||
378 | list_del_init(&seq->escb_arr[i]->list); | ||
379 | |||
380 | asd_ascb_free(seq->escb_arr[i]); | ||
381 | } | ||
382 | kfree(seq->escb_arr); | ||
383 | seq->escb_arr = NULL; | ||
384 | } | ||
385 | |||
386 | static inline void asd_destroy_ha_caches(struct asd_ha_struct *asd_ha) | ||
387 | { | ||
388 | int i; | ||
389 | |||
390 | if (asd_ha->hw_prof.ddb_ext) | ||
391 | asd_free_coherent(asd_ha, asd_ha->hw_prof.ddb_ext); | ||
392 | if (asd_ha->hw_prof.scb_ext) | ||
393 | asd_free_coherent(asd_ha, asd_ha->hw_prof.scb_ext); | ||
394 | |||
395 | if (asd_ha->hw_prof.ddb_bitmap) | ||
396 | kfree(asd_ha->hw_prof.ddb_bitmap); | ||
397 | asd_ha->hw_prof.ddb_bitmap = NULL; | ||
398 | |||
399 | for (i = 0; i < ASD_MAX_PHYS; i++) { | ||
400 | struct asd_phy *phy = &asd_ha->phys[i]; | ||
401 | |||
402 | asd_free_coherent(asd_ha, phy->id_frm_tok); | ||
403 | } | ||
404 | if (asd_ha->seq.escb_arr) | ||
405 | asd_free_escbs(asd_ha); | ||
406 | if (asd_ha->seq.edb_arr) | ||
407 | asd_free_edbs(asd_ha); | ||
408 | if (asd_ha->hw_prof.ue.area) { | ||
409 | kfree(asd_ha->hw_prof.ue.area); | ||
410 | asd_ha->hw_prof.ue.area = NULL; | ||
411 | } | ||
412 | if (asd_ha->seq.tc_index_array) { | ||
413 | kfree(asd_ha->seq.tc_index_array); | ||
414 | kfree(asd_ha->seq.tc_index_bitmap); | ||
415 | asd_ha->seq.tc_index_array = NULL; | ||
416 | asd_ha->seq.tc_index_bitmap = NULL; | ||
417 | } | ||
418 | if (asd_ha->seq.actual_dl) { | ||
419 | asd_free_coherent(asd_ha, asd_ha->seq.actual_dl); | ||
420 | asd_ha->seq.actual_dl = NULL; | ||
421 | asd_ha->seq.dl = NULL; | ||
422 | } | ||
423 | if (asd_ha->seq.next_scb.vaddr) { | ||
424 | dma_pool_free(asd_ha->scb_pool, asd_ha->seq.next_scb.vaddr, | ||
425 | asd_ha->seq.next_scb.dma_handle); | ||
426 | asd_ha->seq.next_scb.vaddr = NULL; | ||
427 | } | ||
428 | dma_pool_destroy(asd_ha->scb_pool); | ||
429 | asd_ha->scb_pool = NULL; | ||
430 | } | ||
431 | |||
432 | kmem_cache_t *asd_dma_token_cache; | ||
433 | kmem_cache_t *asd_ascb_cache; | ||
434 | |||
435 | static int asd_create_global_caches(void) | ||
436 | { | ||
437 | if (!asd_dma_token_cache) { | ||
438 | asd_dma_token_cache | ||
439 | = kmem_cache_create(ASD_DRIVER_NAME "_dma_token", | ||
440 | sizeof(struct asd_dma_tok), | ||
441 | 0, | ||
442 | SLAB_HWCACHE_ALIGN, | ||
443 | NULL, NULL); | ||
444 | if (!asd_dma_token_cache) { | ||
445 | asd_printk("couldn't create dma token cache\n"); | ||
446 | return -ENOMEM; | ||
447 | } | ||
448 | } | ||
449 | |||
450 | if (!asd_ascb_cache) { | ||
451 | asd_ascb_cache = kmem_cache_create(ASD_DRIVER_NAME "_ascb", | ||
452 | sizeof(struct asd_ascb), | ||
453 | 0, | ||
454 | SLAB_HWCACHE_ALIGN, | ||
455 | NULL, NULL); | ||
456 | if (!asd_ascb_cache) { | ||
457 | asd_printk("couldn't create ascb cache\n"); | ||
458 | goto Err; | ||
459 | } | ||
460 | } | ||
461 | |||
462 | return 0; | ||
463 | Err: | ||
464 | kmem_cache_destroy(asd_dma_token_cache); | ||
465 | asd_dma_token_cache = NULL; | ||
466 | return -ENOMEM; | ||
467 | } | ||
468 | |||
469 | static void asd_destroy_global_caches(void) | ||
470 | { | ||
471 | if (asd_dma_token_cache) | ||
472 | kmem_cache_destroy(asd_dma_token_cache); | ||
473 | asd_dma_token_cache = NULL; | ||
474 | |||
475 | if (asd_ascb_cache) | ||
476 | kmem_cache_destroy(asd_ascb_cache); | ||
477 | asd_ascb_cache = NULL; | ||
478 | } | ||
479 | |||
480 | static int asd_register_sas_ha(struct asd_ha_struct *asd_ha) | ||
481 | { | ||
482 | int i; | ||
483 | struct asd_sas_phy **sas_phys = | ||
484 | kmalloc(ASD_MAX_PHYS * sizeof(struct asd_sas_phy), GFP_KERNEL); | ||
485 | struct asd_sas_port **sas_ports = | ||
486 | kmalloc(ASD_MAX_PHYS * sizeof(struct asd_sas_port), GFP_KERNEL); | ||
487 | |||
488 | if (!sas_phys || !sas_ports) { | ||
489 | kfree(sas_phys); | ||
490 | kfree(sas_ports); | ||
491 | return -ENOMEM; | ||
492 | } | ||
493 | |||
494 | asd_ha->sas_ha.sas_ha_name = (char *) asd_ha->name; | ||
495 | asd_ha->sas_ha.lldd_module = THIS_MODULE; | ||
496 | asd_ha->sas_ha.sas_addr = &asd_ha->hw_prof.sas_addr[0]; | ||
497 | |||
498 | for (i = 0; i < ASD_MAX_PHYS; i++) { | ||
499 | sas_phys[i] = &asd_ha->phys[i].sas_phy; | ||
500 | sas_ports[i] = &asd_ha->ports[i]; | ||
501 | } | ||
502 | |||
503 | asd_ha->sas_ha.sas_phy = sas_phys; | ||
504 | asd_ha->sas_ha.sas_port= sas_ports; | ||
505 | asd_ha->sas_ha.num_phys= ASD_MAX_PHYS; | ||
506 | |||
507 | asd_ha->sas_ha.lldd_queue_size = asd_ha->seq.can_queue; | ||
508 | |||
509 | return sas_register_ha(&asd_ha->sas_ha); | ||
510 | } | ||
511 | |||
512 | static int asd_unregister_sas_ha(struct asd_ha_struct *asd_ha) | ||
513 | { | ||
514 | int err; | ||
515 | |||
516 | err = sas_unregister_ha(&asd_ha->sas_ha); | ||
517 | |||
518 | sas_remove_host(asd_ha->sas_ha.core.shost); | ||
519 | scsi_remove_host(asd_ha->sas_ha.core.shost); | ||
520 | scsi_host_put(asd_ha->sas_ha.core.shost); | ||
521 | |||
522 | kfree(asd_ha->sas_ha.sas_phy); | ||
523 | kfree(asd_ha->sas_ha.sas_port); | ||
524 | |||
525 | return err; | ||
526 | } | ||
527 | |||
528 | static int __devinit asd_pci_probe(struct pci_dev *dev, | ||
529 | const struct pci_device_id *id) | ||
530 | { | ||
531 | struct asd_pcidev_struct *asd_dev; | ||
532 | unsigned asd_id = (unsigned) id->driver_data; | ||
533 | struct asd_ha_struct *asd_ha; | ||
534 | struct Scsi_Host *shost; | ||
535 | int err; | ||
536 | |||
537 | if (asd_id >= ARRAY_SIZE(asd_pcidev_data)) { | ||
538 | asd_printk("wrong driver_data in PCI table\n"); | ||
539 | return -ENODEV; | ||
540 | } | ||
541 | |||
542 | if ((err = pci_enable_device(dev))) { | ||
543 | asd_printk("couldn't enable device %s\n", pci_name(dev)); | ||
544 | return err; | ||
545 | } | ||
546 | |||
547 | pci_set_master(dev); | ||
548 | |||
549 | err = -ENOMEM; | ||
550 | |||
551 | shost = scsi_host_alloc(&aic94xx_sht, sizeof(void *)); | ||
552 | if (!shost) | ||
553 | goto Err; | ||
554 | |||
555 | asd_dev = &asd_pcidev_data[asd_id]; | ||
556 | |||
557 | asd_ha = kzalloc(sizeof(*asd_ha), GFP_KERNEL); | ||
558 | if (!asd_ha) { | ||
559 | asd_printk("out of memory\n"); | ||
560 | goto Err; | ||
561 | } | ||
562 | asd_ha->pcidev = dev; | ||
563 | asd_ha->sas_ha.pcidev = asd_ha->pcidev; | ||
564 | asd_ha->sas_ha.lldd_ha = asd_ha; | ||
565 | |||
566 | asd_ha->name = asd_dev->name; | ||
567 | asd_printk("found %s, device %s\n", asd_ha->name, pci_name(dev)); | ||
568 | |||
569 | SHOST_TO_SAS_HA(shost) = &asd_ha->sas_ha; | ||
570 | asd_ha->sas_ha.core.shost = shost; | ||
571 | shost->transportt = aic94xx_transport_template; | ||
572 | shost->max_id = ~0; | ||
573 | shost->max_lun = ~0; | ||
574 | shost->max_cmd_len = 16; | ||
575 | |||
576 | err = scsi_add_host(shost, &dev->dev); | ||
577 | if (err) { | ||
578 | scsi_host_put(shost); | ||
579 | goto Err_free; | ||
580 | } | ||
581 | |||
582 | |||
583 | |||
584 | err = asd_dev->setup(asd_ha); | ||
585 | if (err) | ||
586 | goto Err_free; | ||
587 | |||
588 | err = -ENODEV; | ||
589 | if (!pci_set_dma_mask(dev, DMA_64BIT_MASK) | ||
590 | && !pci_set_consistent_dma_mask(dev, DMA_64BIT_MASK)) | ||
591 | ; | ||
592 | else if (!pci_set_dma_mask(dev, DMA_32BIT_MASK) | ||
593 | && !pci_set_consistent_dma_mask(dev, DMA_32BIT_MASK)) | ||
594 | ; | ||
595 | else { | ||
596 | asd_printk("no suitable DMA mask for %s\n", pci_name(dev)); | ||
597 | goto Err_free; | ||
598 | } | ||
599 | |||
600 | pci_set_drvdata(dev, asd_ha); | ||
601 | |||
602 | err = asd_map_ha(asd_ha); | ||
603 | if (err) | ||
604 | goto Err_free; | ||
605 | |||
606 | err = asd_create_ha_caches(asd_ha); | ||
607 | if (err) | ||
608 | goto Err_unmap; | ||
609 | |||
610 | err = asd_init_hw(asd_ha); | ||
611 | if (err) | ||
612 | goto Err_free_cache; | ||
613 | |||
614 | asd_printk("device %s: SAS addr %llx, PCBA SN %s, %d phys, %d enabled " | ||
615 | "phys, flash %s, BIOS %s%d\n", | ||
616 | pci_name(dev), SAS_ADDR(asd_ha->hw_prof.sas_addr), | ||
617 | asd_ha->hw_prof.pcba_sn, asd_ha->hw_prof.max_phys, | ||
618 | asd_ha->hw_prof.num_phys, | ||
619 | asd_ha->hw_prof.flash.present ? "present" : "not present", | ||
620 | asd_ha->hw_prof.bios.present ? "build " : "not present", | ||
621 | asd_ha->hw_prof.bios.bld); | ||
622 | |||
623 | if (use_msi) | ||
624 | pci_enable_msi(asd_ha->pcidev); | ||
625 | |||
626 | err = request_irq(asd_ha->pcidev->irq, asd_hw_isr, SA_SHIRQ, | ||
627 | ASD_DRIVER_NAME, asd_ha); | ||
628 | if (err) { | ||
629 | asd_printk("couldn't get irq %d for %s\n", | ||
630 | asd_ha->pcidev->irq, pci_name(asd_ha->pcidev)); | ||
631 | goto Err_irq; | ||
632 | } | ||
633 | asd_enable_ints(asd_ha); | ||
634 | |||
635 | err = asd_init_post_escbs(asd_ha); | ||
636 | if (err) { | ||
637 | asd_printk("couldn't post escbs for %s\n", | ||
638 | pci_name(asd_ha->pcidev)); | ||
639 | goto Err_escbs; | ||
640 | } | ||
641 | ASD_DPRINTK("escbs posted\n"); | ||
642 | |||
643 | asd_create_dev_attrs(asd_ha); | ||
644 | |||
645 | err = asd_register_sas_ha(asd_ha); | ||
646 | if (err) | ||
647 | goto Err_reg_sas; | ||
648 | |||
649 | err = asd_enable_phys(asd_ha, asd_ha->hw_prof.enabled_phys); | ||
650 | if (err) { | ||
651 | asd_printk("coudln't enable phys, err:%d\n", err); | ||
652 | goto Err_en_phys; | ||
653 | } | ||
654 | ASD_DPRINTK("enabled phys\n"); | ||
655 | /* give the phy enabling interrupt event time to come in (1s | ||
656 | * is empirically about all it takes) */ | ||
657 | ssleep(1); | ||
658 | /* Wait for discovery to finish */ | ||
659 | scsi_flush_work(asd_ha->sas_ha.core.shost); | ||
660 | |||
661 | return 0; | ||
662 | Err_en_phys: | ||
663 | asd_unregister_sas_ha(asd_ha); | ||
664 | Err_reg_sas: | ||
665 | asd_remove_dev_attrs(asd_ha); | ||
666 | Err_escbs: | ||
667 | asd_disable_ints(asd_ha); | ||
668 | free_irq(dev->irq, asd_ha); | ||
669 | Err_irq: | ||
670 | if (use_msi) | ||
671 | pci_disable_msi(dev); | ||
672 | asd_chip_hardrst(asd_ha); | ||
673 | Err_free_cache: | ||
674 | asd_destroy_ha_caches(asd_ha); | ||
675 | Err_unmap: | ||
676 | asd_unmap_ha(asd_ha); | ||
677 | Err_free: | ||
678 | kfree(asd_ha); | ||
679 | scsi_remove_host(shost); | ||
680 | Err: | ||
681 | pci_disable_device(dev); | ||
682 | return err; | ||
683 | } | ||
684 | |||
685 | static void asd_free_queues(struct asd_ha_struct *asd_ha) | ||
686 | { | ||
687 | unsigned long flags; | ||
688 | LIST_HEAD(pending); | ||
689 | struct list_head *n, *pos; | ||
690 | |||
691 | spin_lock_irqsave(&asd_ha->seq.pend_q_lock, flags); | ||
692 | asd_ha->seq.pending = 0; | ||
693 | list_splice_init(&asd_ha->seq.pend_q, &pending); | ||
694 | spin_unlock_irqrestore(&asd_ha->seq.pend_q_lock, flags); | ||
695 | |||
696 | if (!list_empty(&pending)) | ||
697 | ASD_DPRINTK("Uh-oh! Pending is not empty!\n"); | ||
698 | |||
699 | list_for_each_safe(pos, n, &pending) { | ||
700 | struct asd_ascb *ascb = list_entry(pos, struct asd_ascb, list); | ||
701 | list_del_init(pos); | ||
702 | ASD_DPRINTK("freeing from pending\n"); | ||
703 | asd_ascb_free(ascb); | ||
704 | } | ||
705 | } | ||
706 | |||
707 | static void asd_turn_off_leds(struct asd_ha_struct *asd_ha) | ||
708 | { | ||
709 | u8 phy_mask = asd_ha->hw_prof.enabled_phys; | ||
710 | u8 i; | ||
711 | |||
712 | for_each_phy(phy_mask, phy_mask, i) { | ||
713 | asd_turn_led(asd_ha, i, 0); | ||
714 | asd_control_led(asd_ha, i, 0); | ||
715 | } | ||
716 | } | ||
717 | |||
718 | static void __devexit asd_pci_remove(struct pci_dev *dev) | ||
719 | { | ||
720 | struct asd_ha_struct *asd_ha = pci_get_drvdata(dev); | ||
721 | |||
722 | if (!asd_ha) | ||
723 | return; | ||
724 | |||
725 | asd_unregister_sas_ha(asd_ha); | ||
726 | |||
727 | asd_disable_ints(asd_ha); | ||
728 | |||
729 | asd_remove_dev_attrs(asd_ha); | ||
730 | |||
731 | /* XXX more here as needed */ | ||
732 | |||
733 | free_irq(dev->irq, asd_ha); | ||
734 | if (use_msi) | ||
735 | pci_disable_msi(asd_ha->pcidev); | ||
736 | asd_turn_off_leds(asd_ha); | ||
737 | asd_chip_hardrst(asd_ha); | ||
738 | asd_free_queues(asd_ha); | ||
739 | asd_destroy_ha_caches(asd_ha); | ||
740 | asd_unmap_ha(asd_ha); | ||
741 | kfree(asd_ha); | ||
742 | pci_disable_device(dev); | ||
743 | return; | ||
744 | } | ||
745 | |||
746 | static ssize_t asd_version_show(struct device_driver *driver, char *buf) | ||
747 | { | ||
748 | return snprintf(buf, PAGE_SIZE, "%s\n", ASD_DRIVER_VERSION); | ||
749 | } | ||
750 | static DRIVER_ATTR(version, S_IRUGO, asd_version_show, NULL); | ||
751 | |||
752 | static void asd_create_driver_attrs(struct device_driver *driver) | ||
753 | { | ||
754 | driver_create_file(driver, &driver_attr_version); | ||
755 | } | ||
756 | |||
757 | static void asd_remove_driver_attrs(struct device_driver *driver) | ||
758 | { | ||
759 | driver_remove_file(driver, &driver_attr_version); | ||
760 | } | ||
761 | |||
762 | static struct sas_domain_function_template aic94xx_transport_functions = { | ||
763 | .lldd_port_formed = asd_update_port_links, | ||
764 | |||
765 | .lldd_dev_found = asd_dev_found, | ||
766 | .lldd_dev_gone = asd_dev_gone, | ||
767 | |||
768 | .lldd_execute_task = asd_execute_task, | ||
769 | |||
770 | .lldd_abort_task = asd_abort_task, | ||
771 | .lldd_abort_task_set = asd_abort_task_set, | ||
772 | .lldd_clear_aca = asd_clear_aca, | ||
773 | .lldd_clear_task_set = asd_clear_task_set, | ||
774 | .lldd_I_T_nexus_reset = NULL, | ||
775 | .lldd_lu_reset = asd_lu_reset, | ||
776 | .lldd_query_task = asd_query_task, | ||
777 | |||
778 | .lldd_clear_nexus_port = asd_clear_nexus_port, | ||
779 | .lldd_clear_nexus_ha = asd_clear_nexus_ha, | ||
780 | |||
781 | .lldd_control_phy = asd_control_phy, | ||
782 | }; | ||
783 | |||
784 | static const struct pci_device_id aic94xx_pci_table[] __devinitdata = { | ||
785 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR10), | ||
786 | 0, 0, 1}, | ||
787 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR12), | ||
788 | 0, 0, 1}, | ||
789 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR1E), | ||
790 | 0, 0, 1}, | ||
791 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR30), | ||
792 | 0, 0, 2}, | ||
793 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR32), | ||
794 | 0, 0, 2}, | ||
795 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR3E), | ||
796 | 0, 0, 2}, | ||
797 | {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_RAZOR3F), | ||
798 | 0, 0, 2}, | ||
799 | {} | ||
800 | }; | ||
801 | |||
802 | MODULE_DEVICE_TABLE(pci, aic94xx_pci_table); | ||
803 | |||
804 | static struct pci_driver aic94xx_pci_driver = { | ||
805 | .name = ASD_DRIVER_NAME, | ||
806 | .id_table = aic94xx_pci_table, | ||
807 | .probe = asd_pci_probe, | ||
808 | .remove = __devexit_p(asd_pci_remove), | ||
809 | }; | ||
810 | |||
811 | static int __init aic94xx_init(void) | ||
812 | { | ||
813 | int err; | ||
814 | |||
815 | |||
816 | asd_printk("%s version %s loaded\n", ASD_DRIVER_DESCRIPTION, | ||
817 | ASD_DRIVER_VERSION); | ||
818 | |||
819 | err = asd_create_global_caches(); | ||
820 | if (err) | ||
821 | return err; | ||
822 | |||
823 | aic94xx_transport_template = | ||
824 | sas_domain_attach_transport(&aic94xx_transport_functions); | ||
825 | if (err) | ||
826 | goto out_destroy_caches; | ||
827 | |||
828 | err = pci_register_driver(&aic94xx_pci_driver); | ||
829 | if (err) | ||
830 | goto out_release_transport; | ||
831 | |||
832 | asd_create_driver_attrs(&aic94xx_pci_driver.driver); | ||
833 | |||
834 | return err; | ||
835 | |||
836 | out_release_transport: | ||
837 | sas_release_transport(aic94xx_transport_template); | ||
838 | out_destroy_caches: | ||
839 | asd_destroy_global_caches(); | ||
840 | |||
841 | return err; | ||
842 | } | ||
843 | |||
844 | static void __exit aic94xx_exit(void) | ||
845 | { | ||
846 | asd_remove_driver_attrs(&aic94xx_pci_driver.driver); | ||
847 | pci_unregister_driver(&aic94xx_pci_driver); | ||
848 | sas_release_transport(aic94xx_transport_template); | ||
849 | asd_destroy_global_caches(); | ||
850 | asd_printk("%s version %s unloaded\n", ASD_DRIVER_DESCRIPTION, | ||
851 | ASD_DRIVER_VERSION); | ||
852 | } | ||
853 | |||
854 | module_init(aic94xx_init); | ||
855 | module_exit(aic94xx_exit); | ||
856 | |||
857 | MODULE_AUTHOR("Luben Tuikov <luben_tuikov@adaptec.com>"); | ||
858 | MODULE_DESCRIPTION(ASD_DRIVER_DESCRIPTION); | ||
859 | MODULE_LICENSE("GPL v2"); | ||
860 | MODULE_VERSION(ASD_DRIVER_VERSION); | ||