projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ARM: at91: fix board-rm9200-dt after sys_timer conversion
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / scsi / aic94xx / aic94xx_init.c
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/module.h>
28 #include <linux/init.h>
29 #include <linux/kernel.h>
30 #include <linux/pci.h>
31 #include <linux/delay.h>
32 #include <linux/firmware.h>
33 #include <linux/slab.h>
34
35 #include <scsi/scsi_host.h>
36
37 #include "aic94xx.h"
38 #include "aic94xx_reg.h"
39 #include "aic94xx_hwi.h"
40 #include "aic94xx_seq.h"
41 #include "aic94xx_sds.h"
42
43 /* The format is "version.release.patchlevel" */
44 #define ASD_DRIVER_VERSION "1.0.3"
45
46 static int use_msi = 0;
47 module_param_named(use_msi, use_msi, int, S_IRUGO);
48 MODULE_PARM_DESC(use_msi, "\n"
49 "\tEnable(1) or disable(0) using PCI MSI.\n"
50 "\tDefault: 0");
51
52 static int lldd_max_execute_num = 0;
53 module_param_named(collector, lldd_max_execute_num, int, S_IRUGO);
54 MODULE_PARM_DESC(collector, "\n"
55 "\tIf greater than one, tells the SAS Layer to run in Task Collector\n"
56 "\tMode. If 1 or 0, tells the SAS Layer to run in Direct Mode.\n"
57 "\tThe aic94xx SAS LLDD supports both modes.\n"
58 "\tDefault: 0 (Direct Mode).\n");
59
60 static struct scsi_transport_template *aic94xx_transport_template;
61 static int asd_scan_finished(struct Scsi_Host *, unsigned long);
62 static void asd_scan_start(struct Scsi_Host *);
63
64 static struct scsi_host_template aic94xx_sht = {
65 .module = THIS_MODULE,
66 /* .name is initialized */
67 .name = "aic94xx",
68 .queuecommand = sas_queuecommand,
69 .target_alloc = sas_target_alloc,
70 .slave_configure = sas_slave_configure,
71 .scan_finished = asd_scan_finished,
72 .scan_start = asd_scan_start,
73 .change_queue_depth = sas_change_queue_depth,
74 .change_queue_type = sas_change_queue_type,
75 .bios_param = sas_bios_param,
76 .can_queue = 1,
77 .cmd_per_lun = 1,
78 .this_id = -1,
79 .sg_tablesize = SG_ALL,
80 .max_sectors = SCSI_DEFAULT_MAX_SECTORS,
81 .use_clustering = ENABLE_CLUSTERING,
82 .eh_device_reset_handler = sas_eh_device_reset_handler,
83 .eh_bus_reset_handler = sas_eh_bus_reset_handler,
84 .target_destroy = sas_target_destroy,
85 .ioctl = sas_ioctl,
86 };
87
88 static int __devinit asd_map_memio(struct asd_ha_struct *asd_ha)
89 {
90 int err, i;
91 struct asd_ha_addrspace *io_handle;
92
93 asd_ha->iospace = 0;
94 for (i = 0; i < 3; i += 2) {
95 io_handle = &asd_ha->io_handle[i==0?0:1];
96 io_handle->start = pci_resource_start(asd_ha->pcidev, i);
97 io_handle->len = pci_resource_len(asd_ha->pcidev, i);
98 io_handle->flags = pci_resource_flags(asd_ha->pcidev, i);
99 err = -ENODEV;
100 if (!io_handle->start || !io_handle->len) {
101 asd_printk("MBAR%d start or length for %s is 0.\n",
102 i==0?0:1, pci_name(asd_ha->pcidev));
103 goto Err;
104 }
105 err = pci_request_region(asd_ha->pcidev, i, ASD_DRIVER_NAME);
106 if (err) {
107 asd_printk("couldn't reserve memory region for %s\n",
108 pci_name(asd_ha->pcidev));
109 goto Err;
110 }
111 if (io_handle->flags & IORESOURCE_CACHEABLE)
112 io_handle->addr = ioremap(io_handle->start,
113 io_handle->len);
114 else
115 io_handle->addr = ioremap_nocache(io_handle->start,
116 io_handle->len);
117 if (!io_handle->addr) {
118 asd_printk("couldn't map MBAR%d of %s\n", i==0?0:1,
119 pci_name(asd_ha->pcidev));
120 goto Err_unreq;
121 }
122 }
123
124 return 0;
125 Err_unreq:
126 pci_release_region(asd_ha->pcidev, i);
127 Err:
128 if (i > 0) {
129 io_handle = &asd_ha->io_handle[0];
130 iounmap(io_handle->addr);
131 pci_release_region(asd_ha->pcidev, 0);
132 }
133 return err;
134 }
135
136 static void asd_unmap_memio(struct asd_ha_struct *asd_ha)
137 {
138 struct asd_ha_addrspace *io_handle;
139
140 io_handle = &asd_ha->io_handle[1];
141 iounmap(io_handle->addr);
142 pci_release_region(asd_ha->pcidev, 2);
143
144 io_handle = &asd_ha->io_handle[0];
145 iounmap(io_handle->addr);
146 pci_release_region(asd_ha->pcidev, 0);
147 }
148
149 static int __devinit asd_map_ioport(struct asd_ha_struct *asd_ha)
150 {
151 int i = PCI_IOBAR_OFFSET, err;
152 struct asd_ha_addrspace *io_handle = &asd_ha->io_handle[0];
153
154 asd_ha->iospace = 1;
155 io_handle->start = pci_resource_start(asd_ha->pcidev, i);
156 io_handle->len = pci_resource_len(asd_ha->pcidev, i);
157 io_handle->flags = pci_resource_flags(asd_ha->pcidev, i);
158 io_handle->addr = (void __iomem *) io_handle->start;
159 if (!io_handle->start || !io_handle->len) {
160 asd_printk("couldn't get IO ports for %s\n",
161 pci_name(asd_ha->pcidev));
162 return -ENODEV;
163 }
164 err = pci_request_region(asd_ha->pcidev, i, ASD_DRIVER_NAME);
165 if (err) {
166 asd_printk("couldn't reserve io space for %s\n",
167 pci_name(asd_ha->pcidev));
168 }
169
170 return err;
171 }
172
173 static void asd_unmap_ioport(struct asd_ha_struct *asd_ha)
174 {
175 pci_release_region(asd_ha->pcidev, PCI_IOBAR_OFFSET);
176 }
177
178 static int __devinit asd_map_ha(struct asd_ha_struct *asd_ha)
179 {
180 int err;
181 u16 cmd_reg;
182
183 err = pci_read_config_word(asd_ha->pcidev, PCI_COMMAND, &cmd_reg);
184 if (err) {
185 asd_printk("couldn't read command register of %s\n",
186 pci_name(asd_ha->pcidev));
187 goto Err;
188 }
189
190 err = -ENODEV;
191 if (cmd_reg & PCI_COMMAND_MEMORY) {
192 if ((err = asd_map_memio(asd_ha)))
193 goto Err;
194 } else if (cmd_reg & PCI_COMMAND_IO) {
195 if ((err = asd_map_ioport(asd_ha)))
196 goto Err;
197 asd_printk("%s ioport mapped -- upgrade your hardware\n",
198 pci_name(asd_ha->pcidev));
199 } else {
200 asd_printk("no proper device access to %s\n",
201 pci_name(asd_ha->pcidev));
202 goto Err;
203 }
204
205 return 0;
206 Err:
207 return err;
208 }
209
210 static void asd_unmap_ha(struct asd_ha_struct *asd_ha)
211 {
212 if (asd_ha->iospace)
213 asd_unmap_ioport(asd_ha);
214 else
215 asd_unmap_memio(asd_ha);
216 }
217
218 static const char *asd_dev_rev[30] = {
219 [0] = "A0",
220 [1] = "A1",
221 [8] = "B0",
222 };
223
224 static int __devinit asd_common_setup(struct asd_ha_struct *asd_ha)
225 {
226 int err, i;
227
228 asd_ha->revision_id = asd_ha->pcidev->revision;
229
230 err = -ENODEV;
231 if (asd_ha->revision_id < AIC9410_DEV_REV_B0) {
232 asd_printk("%s is revision %s (%X), which is not supported\n",
233 pci_name(asd_ha->pcidev),
234 asd_dev_rev[asd_ha->revision_id],
235 asd_ha->revision_id);
236 goto Err;
237 }
238 /* Provide some sane default values. */
239 asd_ha->hw_prof.max_scbs = 512;
240 asd_ha->hw_prof.max_ddbs = ASD_MAX_DDBS;
241 asd_ha->hw_prof.num_phys = ASD_MAX_PHYS;
242 /* All phys are enabled, by default. */
243 asd_ha->hw_prof.enabled_phys = 0xFF;
244 for (i = 0; i < ASD_MAX_PHYS; i++) {
245 asd_ha->hw_prof.phy_desc[i].max_sas_lrate =
246 SAS_LINK_RATE_3_0_GBPS;
247 asd_ha->hw_prof.phy_desc[i].min_sas_lrate =
248 SAS_LINK_RATE_1_5_GBPS;
249 asd_ha->hw_prof.phy_desc[i].max_sata_lrate =
250 SAS_LINK_RATE_1_5_GBPS;
251 asd_ha->hw_prof.phy_desc[i].min_sata_lrate =
252 SAS_LINK_RATE_1_5_GBPS;
253 }
254
255 return 0;
256 Err:
257 return err;
258 }
259
260 static int __devinit asd_aic9410_setup(struct asd_ha_struct *asd_ha)
261 {
262 int err = asd_common_setup(asd_ha);
263
264 if (err)
265 return err;
266
267 asd_ha->hw_prof.addr_range = 8;
268 asd_ha->hw_prof.port_name_base = 0;
269 asd_ha->hw_prof.dev_name_base = 8;
270 asd_ha->hw_prof.sata_name_base = 16;
271
272 return 0;
273 }
274
275 static int __devinit asd_aic9405_setup(struct asd_ha_struct *asd_ha)
276 {
277 int err = asd_common_setup(asd_ha);
278
279 if (err)
280 return err;
281
282 asd_ha->hw_prof.addr_range = 4;
283 asd_ha->hw_prof.port_name_base = 0;
284 asd_ha->hw_prof.dev_name_base = 4;
285 asd_ha->hw_prof.sata_name_base = 8;
286
287 return 0;
288 }
289
290 static ssize_t asd_show_dev_rev(struct device *dev,
291 struct device_attribute *attr, char *buf)
292 {
293 struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev);
294 return snprintf(buf, PAGE_SIZE, "%s\n",
295 asd_dev_rev[asd_ha->revision_id]);
296 }
297 static DEVICE_ATTR(revision, S_IRUGO, asd_show_dev_rev, NULL);
298
299 static ssize_t asd_show_dev_bios_build(struct device *dev,
300 struct device_attribute *attr,char *buf)
301 {
302 struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev);
303 return snprintf(buf, PAGE_SIZE, "%d\n", asd_ha->hw_prof.bios.bld);
304 }
305 static DEVICE_ATTR(bios_build, S_IRUGO, asd_show_dev_bios_build, NULL);
306
307 static ssize_t asd_show_dev_pcba_sn(struct device *dev,
308 struct device_attribute *attr, char *buf)
309 {
310 struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev);
311 return snprintf(buf, PAGE_SIZE, "%s\n", asd_ha->hw_prof.pcba_sn);
312 }
313 static DEVICE_ATTR(pcba_sn, S_IRUGO, asd_show_dev_pcba_sn, NULL);
314
315 #define FLASH_CMD_NONE 0x00
316 #define FLASH_CMD_UPDATE 0x01
317 #define FLASH_CMD_VERIFY 0x02
318
319 struct flash_command {
320 u8 command[8];
321 int code;
322 };
323
324 static struct flash_command flash_command_table[] =
325 {
326 {"verify", FLASH_CMD_VERIFY},
327 {"update", FLASH_CMD_UPDATE},
328 {"", FLASH_CMD_NONE} /* Last entry should be NULL. */
329 };
330
331 struct error_bios {
332 char *reason;
333 int err_code;
334 };
335
336 static struct error_bios flash_error_table[] =
337 {
338 {"Failed to open bios image file", FAIL_OPEN_BIOS_FILE},
339 {"PCI ID mismatch", FAIL_CHECK_PCI_ID},
340 {"Checksum mismatch", FAIL_CHECK_SUM},
341 {"Unknown Error", FAIL_UNKNOWN},
342 {"Failed to verify.", FAIL_VERIFY},
343 {"Failed to reset flash chip.", FAIL_RESET_FLASH},
344 {"Failed to find flash chip type.", FAIL_FIND_FLASH_ID},
345 {"Failed to erash flash chip.", FAIL_ERASE_FLASH},
346 {"Failed to program flash chip.", FAIL_WRITE_FLASH},
347 {"Flash in progress", FLASH_IN_PROGRESS},
348 {"Image file size Error", FAIL_FILE_SIZE},
349 {"Input parameter error", FAIL_PARAMETERS},
350 {"Out of memory", FAIL_OUT_MEMORY},
351 {"OK", 0} /* Last entry err_code = 0. */
352 };
353
354 static ssize_t asd_store_update_bios(struct device *dev,
355 struct device_attribute *attr,
356 const char *buf, size_t count)
357 {
358 struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev);
359 char *cmd_ptr, *filename_ptr;
360 struct bios_file_header header, *hdr_ptr;
361 int res, i;
362 u32 csum = 0;
363 int flash_command = FLASH_CMD_NONE;
364 int err = 0;
365
366 cmd_ptr = kzalloc(count*2, GFP_KERNEL);
367
368 if (!cmd_ptr) {
369 err = FAIL_OUT_MEMORY;
370 goto out;
371 }
372
373 filename_ptr = cmd_ptr + count;
374 res = sscanf(buf, "%s %s", cmd_ptr, filename_ptr);
375 if (res != 2) {
376 err = FAIL_PARAMETERS;
377 goto out1;
378 }
379
380 for (i = 0; flash_command_table[i].code != FLASH_CMD_NONE; i++) {
381 if (!memcmp(flash_command_table[i].command,
382 cmd_ptr, strlen(cmd_ptr))) {
383 flash_command = flash_command_table[i].code;
384 break;
385 }
386 }
387 if (flash_command == FLASH_CMD_NONE) {
388 err = FAIL_PARAMETERS;
389 goto out1;
390 }
391
392 if (asd_ha->bios_status == FLASH_IN_PROGRESS) {
393 err = FLASH_IN_PROGRESS;
394 goto out1;
395 }
396 err = request_firmware(&asd_ha->bios_image,
397 filename_ptr,
398 &asd_ha->pcidev->dev);
399 if (err) {
400 asd_printk("Failed to load bios image file %s, error %d\n",
401 filename_ptr, err);
402 err = FAIL_OPEN_BIOS_FILE;
403 goto out1;
404 }
405
406 hdr_ptr = (struct bios_file_header *)asd_ha->bios_image->data;
407
408 if ((hdr_ptr->contrl_id.vendor != asd_ha->pcidev->vendor ||
409 hdr_ptr->contrl_id.device != asd_ha->pcidev->device) &&
410 (hdr_ptr->contrl_id.sub_vendor != asd_ha->pcidev->vendor ||
411 hdr_ptr->contrl_id.sub_device != asd_ha->pcidev->device)) {
412
413 ASD_DPRINTK("The PCI vendor or device id does not match\n");
414 ASD_DPRINTK("vendor=%x dev=%x sub_vendor=%x sub_dev=%x"
415 " pci vendor=%x pci dev=%x\n",
416 hdr_ptr->contrl_id.vendor,
417 hdr_ptr->contrl_id.device,
418 hdr_ptr->contrl_id.sub_vendor,
419 hdr_ptr->contrl_id.sub_device,
420 asd_ha->pcidev->vendor,
421 asd_ha->pcidev->device);
422 err = FAIL_CHECK_PCI_ID;
423 goto out2;
424 }
425
426 if (hdr_ptr->filelen != asd_ha->bios_image->size) {
427 err = FAIL_FILE_SIZE;
428 goto out2;
429 }
430
431 /* calculate checksum */
432 for (i = 0; i < hdr_ptr->filelen; i++)
433 csum += asd_ha->bios_image->data[i];
434
435 if ((csum & 0x0000ffff) != hdr_ptr->checksum) {
436 ASD_DPRINTK("BIOS file checksum mismatch\n");
437 err = FAIL_CHECK_SUM;
438 goto out2;
439 }
440 if (flash_command == FLASH_CMD_UPDATE) {
441 asd_ha->bios_status = FLASH_IN_PROGRESS;
442 err = asd_write_flash_seg(asd_ha,
443 &asd_ha->bios_image->data[sizeof(*hdr_ptr)],
444 0, hdr_ptr->filelen-sizeof(*hdr_ptr));
445 if (!err)
446 err = asd_verify_flash_seg(asd_ha,
447 &asd_ha->bios_image->data[sizeof(*hdr_ptr)],
448 0, hdr_ptr->filelen-sizeof(*hdr_ptr));
449 } else {
450 asd_ha->bios_status = FLASH_IN_PROGRESS;
451 err = asd_verify_flash_seg(asd_ha,
452 &asd_ha->bios_image->data[sizeof(header)],
453 0, hdr_ptr->filelen-sizeof(header));
454 }
455
456 out2:
457 release_firmware(asd_ha->bios_image);
458 out1:
459 kfree(cmd_ptr);
460 out:
461 asd_ha->bios_status = err;
462
463 if (!err)
464 return count;
465 else
466 return -err;
467 }
468
469 static ssize_t asd_show_update_bios(struct device *dev,
470 struct device_attribute *attr, char *buf)
471 {
472 int i;
473 struct asd_ha_struct *asd_ha = dev_to_asd_ha(dev);
474
475 for (i = 0; flash_error_table[i].err_code != 0; i++) {
476 if (flash_error_table[i].err_code == asd_ha->bios_status)
477 break;
478 }
479 if (asd_ha->bios_status != FLASH_IN_PROGRESS)
480 asd_ha->bios_status = FLASH_OK;
481
482 return snprintf(buf, PAGE_SIZE, "status=%x %s\n",
483 flash_error_table[i].err_code,
484 flash_error_table[i].reason);
485 }
486
487 static DEVICE_ATTR(update_bios, S_IRUGO|S_IWUSR,
488 asd_show_update_bios, asd_store_update_bios);
489
490 static int asd_create_dev_attrs(struct asd_ha_struct *asd_ha)
491 {
492 int err;
493
494 err = device_create_file(&asd_ha->pcidev->dev, &dev_attr_revision);
495 if (err)
496 return err;
497
498 err = device_create_file(&asd_ha->pcidev->dev, &dev_attr_bios_build);
499 if (err)
500 goto err_rev;
501
502 err = device_create_file(&asd_ha->pcidev->dev, &dev_attr_pcba_sn);
503 if (err)
504 goto err_biosb;
505 err = device_create_file(&asd_ha->pcidev->dev, &dev_attr_update_bios);
506 if (err)
507 goto err_update_bios;
508
509 return 0;
510
511 err_update_bios:
512 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_pcba_sn);
513 err_biosb:
514 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_bios_build);
515 err_rev:
516 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_revision);
517 return err;
518 }
519
520 static void asd_remove_dev_attrs(struct asd_ha_struct *asd_ha)
521 {
522 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_revision);
523 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_bios_build);
524 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_pcba_sn);
525 device_remove_file(&asd_ha->pcidev->dev, &dev_attr_update_bios);
526 }
527
528 /* The first entry, 0, is used for dynamic ids, the rest for devices
529 * we know about.
530 */
531 static const struct asd_pcidev_struct {
532 const char * name;
533 int (*setup)(struct asd_ha_struct *asd_ha);
534 } asd_pcidev_data[] __devinitconst = {
535 /* Id 0 is used for dynamic ids. */
536 { .name = "Adaptec AIC-94xx SAS/SATA Host Adapter",
537 .setup = asd_aic9410_setup
538 },
539 { .name = "Adaptec AIC-9410W SAS/SATA Host Adapter",
540 .setup = asd_aic9410_setup
541 },
542 { .name = "Adaptec AIC-9405W SAS/SATA Host Adapter",
543 .setup = asd_aic9405_setup
544 },
545 };
546
547 static int asd_create_ha_caches(struct asd_ha_struct *asd_ha)
548 {
549 asd_ha->scb_pool = dma_pool_create(ASD_DRIVER_NAME "_scb_pool",
550 &asd_ha->pcidev->dev,
551 sizeof(struct scb),
552 8, 0);
553 if (!asd_ha->scb_pool) {
554 asd_printk("couldn't create scb pool\n");
555 return -ENOMEM;
556 }
557
558 return 0;
559 }
560
561 /**
562 * asd_free_edbs -- free empty data buffers
563 * asd_ha: pointer to host adapter structure
564 */
565 static void asd_free_edbs(struct asd_ha_struct *asd_ha)
566 {
567 struct asd_seq_data *seq = &asd_ha->seq;
568 int i;
569
570 for (i = 0; i < seq->num_edbs; i++)
571 asd_free_coherent(asd_ha, seq->edb_arr[i]);
572 kfree(seq->edb_arr);
573 seq->edb_arr = NULL;
574 }
575
576 static void asd_free_escbs(struct asd_ha_struct *asd_ha)
577 {
578 struct asd_seq_data *seq = &asd_ha->seq;
579 int i;
580
581 for (i = 0; i < seq->num_escbs; i++) {
582 if (!list_empty(&seq->escb_arr[i]->list))
583 list_del_init(&seq->escb_arr[i]->list);
584
585 asd_ascb_free(seq->escb_arr[i]);
586 }
587 kfree(seq->escb_arr);
588 seq->escb_arr = NULL;
589 }
590
591 static void asd_destroy_ha_caches(struct asd_ha_struct *asd_ha)
592 {
593 int i;
594
595 if (asd_ha->hw_prof.ddb_ext)
596 asd_free_coherent(asd_ha, asd_ha->hw_prof.ddb_ext);
597 if (asd_ha->hw_prof.scb_ext)
598 asd_free_coherent(asd_ha, asd_ha->hw_prof.scb_ext);
599
600 if (asd_ha->hw_prof.ddb_bitmap)
601 kfree(asd_ha->hw_prof.ddb_bitmap);
602 asd_ha->hw_prof.ddb_bitmap = NULL;
603
604 for (i = 0; i < ASD_MAX_PHYS; i++) {
605 struct asd_phy *phy = &asd_ha->phys[i];
606
607 asd_free_coherent(asd_ha, phy->id_frm_tok);
608 }
609 if (asd_ha->seq.escb_arr)
610 asd_free_escbs(asd_ha);
611 if (asd_ha->seq.edb_arr)
612 asd_free_edbs(asd_ha);
613 if (asd_ha->hw_prof.ue.area) {
614 kfree(asd_ha->hw_prof.ue.area);
615 asd_ha->hw_prof.ue.area = NULL;
616 }
617 if (asd_ha->seq.tc_index_array) {
618 kfree(asd_ha->seq.tc_index_array);
619 kfree(asd_ha->seq.tc_index_bitmap);
620 asd_ha->seq.tc_index_array = NULL;
621 asd_ha->seq.tc_index_bitmap = NULL;
622 }
623 if (asd_ha->seq.actual_dl) {
624 asd_free_coherent(asd_ha, asd_ha->seq.actual_dl);
625 asd_ha->seq.actual_dl = NULL;
626 asd_ha->seq.dl = NULL;
627 }
628 if (asd_ha->seq.next_scb.vaddr) {
629 dma_pool_free(asd_ha->scb_pool, asd_ha->seq.next_scb.vaddr,
630 asd_ha->seq.next_scb.dma_handle);
631 asd_ha->seq.next_scb.vaddr = NULL;
632 }
633 dma_pool_destroy(asd_ha->scb_pool);
634 asd_ha->scb_pool = NULL;
635 }
636
637 struct kmem_cache *asd_dma_token_cache;
638 struct kmem_cache *asd_ascb_cache;
639
640 static int asd_create_global_caches(void)
641 {
642 if (!asd_dma_token_cache) {
643 asd_dma_token_cache
644 = kmem_cache_create(ASD_DRIVER_NAME "_dma_token",
645 sizeof(struct asd_dma_tok),
646 0,
647 SLAB_HWCACHE_ALIGN,
648 NULL);
649 if (!asd_dma_token_cache) {
650 asd_printk("couldn't create dma token cache\n");
651 return -ENOMEM;
652 }
653 }
654
655 if (!asd_ascb_cache) {
656 asd_ascb_cache = kmem_cache_create(ASD_DRIVER_NAME "_ascb",
657 sizeof(struct asd_ascb),
658 0,
659 SLAB_HWCACHE_ALIGN,
660 NULL);
661 if (!asd_ascb_cache) {
662 asd_printk("couldn't create ascb cache\n");
663 goto Err;
664 }
665 }
666
667 return 0;
668 Err:
669 kmem_cache_destroy(asd_dma_token_cache);
670 asd_dma_token_cache = NULL;
671 return -ENOMEM;
672 }
673
674 static void asd_destroy_global_caches(void)
675 {
676 if (asd_dma_token_cache)
677 kmem_cache_destroy(asd_dma_token_cache);
678 asd_dma_token_cache = NULL;
679
680 if (asd_ascb_cache)
681 kmem_cache_destroy(asd_ascb_cache);
682 asd_ascb_cache = NULL;
683 }
684
685 static int asd_register_sas_ha(struct asd_ha_struct *asd_ha)
686 {
687 int i;
688 struct asd_sas_phy **sas_phys =
689 kcalloc(ASD_MAX_PHYS, sizeof(*sas_phys), GFP_KERNEL);
690 struct asd_sas_port **sas_ports =
691 kcalloc(ASD_MAX_PHYS, sizeof(*sas_ports), GFP_KERNEL);
692
693 if (!sas_phys || !sas_ports) {
694 kfree(sas_phys);
695 kfree(sas_ports);
696 return -ENOMEM;
697 }
698
699 asd_ha->sas_ha.sas_ha_name = (char *) asd_ha->name;
700 asd_ha->sas_ha.lldd_module = THIS_MODULE;
701 asd_ha->sas_ha.sas_addr = &asd_ha->hw_prof.sas_addr[0];
702
703 for (i = 0; i < ASD_MAX_PHYS; i++) {
704 sas_phys[i] = &asd_ha->phys[i].sas_phy;
705 sas_ports[i] = &asd_ha->ports[i];
706 }
707
708 asd_ha->sas_ha.sas_phy = sas_phys;
709 asd_ha->sas_ha.sas_port= sas_ports;
710 asd_ha->sas_ha.num_phys= ASD_MAX_PHYS;
711
712 asd_ha->sas_ha.lldd_queue_size = asd_ha->seq.can_queue;
713 asd_ha->sas_ha.lldd_max_execute_num = lldd_max_execute_num;
714
715 return sas_register_ha(&asd_ha->sas_ha);
716 }
717
718 static int asd_unregister_sas_ha(struct asd_ha_struct *asd_ha)
719 {
720 int err;
721
722 err = sas_unregister_ha(&asd_ha->sas_ha);
723
724 sas_remove_host(asd_ha->sas_ha.core.shost);
725 scsi_remove_host(asd_ha->sas_ha.core.shost);
726 scsi_host_put(asd_ha->sas_ha.core.shost);
727
728 kfree(asd_ha->sas_ha.sas_phy);
729 kfree(asd_ha->sas_ha.sas_port);
730
731 return err;
732 }
733
734 static int __devinit asd_pci_probe(struct pci_dev *dev,
735 const struct pci_device_id *id)
736 {
737 const struct asd_pcidev_struct *asd_dev;
738 unsigned asd_id = (unsigned) id->driver_data;
739 struct asd_ha_struct *asd_ha;
740 struct Scsi_Host *shost;
741 int err;
742
743 if (asd_id >= ARRAY_SIZE(asd_pcidev_data)) {
744 asd_printk("wrong driver_data in PCI table\n");
745 return -ENODEV;
746 }
747
748 if ((err = pci_enable_device(dev))) {
749 asd_printk("couldn't enable device %s\n", pci_name(dev));
750 return err;
751 }
752
753 pci_set_master(dev);
754
755 err = -ENOMEM;
756
757 shost = scsi_host_alloc(&aic94xx_sht, sizeof(void *));
758 if (!shost)
759 goto Err;
760
761 asd_dev = &asd_pcidev_data[asd_id];
762
763 asd_ha = kzalloc(sizeof(*asd_ha), GFP_KERNEL);
764 if (!asd_ha) {
765 asd_printk("out of memory\n");
766 goto Err_put;
767 }
768 asd_ha->pcidev = dev;
769 asd_ha->sas_ha.dev = &asd_ha->pcidev->dev;
770 asd_ha->sas_ha.lldd_ha = asd_ha;
771
772 asd_ha->bios_status = FLASH_OK;
773 asd_ha->name = asd_dev->name;
774 asd_printk("found %s, device %s\n", asd_ha->name, pci_name(dev));
775
776 SHOST_TO_SAS_HA(shost) = &asd_ha->sas_ha;
777 asd_ha->sas_ha.core.shost = shost;
778 shost->transportt = aic94xx_transport_template;
779 shost->max_id = ~0;
780 shost->max_lun = ~0;
781 shost->max_cmd_len = 16;
782
783 err = scsi_add_host(shost, &dev->dev);
784 if (err)
785 goto Err_free;
786
787 err = asd_dev->setup(asd_ha);
788 if (err)
789 goto Err_remove;
790
791 err = -ENODEV;
792 if (!pci_set_dma_mask(dev, DMA_BIT_MASK(64))
793 && !pci_set_consistent_dma_mask(dev, DMA_BIT_MASK(64)))
794 ;
795 else if (!pci_set_dma_mask(dev, DMA_BIT_MASK(32))
796 && !pci_set_consistent_dma_mask(dev, DMA_BIT_MASK(32)))
797 ;
798 else {
799 asd_printk("no suitable DMA mask for %s\n", pci_name(dev));
800 goto Err_remove;
801 }
802
803 pci_set_drvdata(dev, asd_ha);
804
805 err = asd_map_ha(asd_ha);
806 if (err)
807 goto Err_remove;
808
809 err = asd_create_ha_caches(asd_ha);
810 if (err)
811 goto Err_unmap;
812
813 err = asd_init_hw(asd_ha);
814 if (err)
815 goto Err_free_cache;
816
817 asd_printk("device %s: SAS addr %llx, PCBA SN %s, %d phys, %d enabled "
818 "phys, flash %s, BIOS %s%d\n",
819 pci_name(dev), SAS_ADDR(asd_ha->hw_prof.sas_addr),
820 asd_ha->hw_prof.pcba_sn, asd_ha->hw_prof.max_phys,
821 asd_ha->hw_prof.num_phys,
822 asd_ha->hw_prof.flash.present ? "present" : "not present",
823 asd_ha->hw_prof.bios.present ? "build " : "not present",
824 asd_ha->hw_prof.bios.bld);
825
826 shost->can_queue = asd_ha->seq.can_queue;
827
828 if (use_msi)
829 pci_enable_msi(asd_ha->pcidev);
830
831 err = request_irq(asd_ha->pcidev->irq, asd_hw_isr, IRQF_SHARED,
832 ASD_DRIVER_NAME, asd_ha);
833 if (err) {
834 asd_printk("couldn't get irq %d for %s\n",
835 asd_ha->pcidev->irq, pci_name(asd_ha->pcidev));
836 goto Err_irq;
837 }
838 asd_enable_ints(asd_ha);
839
840 err = asd_init_post_escbs(asd_ha);
841 if (err) {
842 asd_printk("couldn't post escbs for %s\n",
843 pci_name(asd_ha->pcidev));
844 goto Err_escbs;
845 }
846 ASD_DPRINTK("escbs posted\n");
847
848 err = asd_create_dev_attrs(asd_ha);
849 if (err)
850 goto Err_dev_attrs;
851
852 err = asd_register_sas_ha(asd_ha);
853 if (err)
854 goto Err_reg_sas;
855
856 scsi_scan_host(shost);
857
858 return 0;
859
860 Err_reg_sas:
861 asd_remove_dev_attrs(asd_ha);
862 Err_dev_attrs:
863 Err_escbs:
864 asd_disable_ints(asd_ha);
865 free_irq(dev->irq, asd_ha);
866 Err_irq:
867 if (use_msi)
868 pci_disable_msi(dev);
869 asd_chip_hardrst(asd_ha);
870 Err_free_cache:
871 asd_destroy_ha_caches(asd_ha);
872 Err_unmap:
873 asd_unmap_ha(asd_ha);
874 Err_remove:
875 scsi_remove_host(shost);
876 Err_free:
877 kfree(asd_ha);
878 Err_put:
879 scsi_host_put(shost);
880 Err:
881 pci_disable_device(dev);
882 return err;
883 }
884
885 static void asd_free_queues(struct asd_ha_struct *asd_ha)
886 {
887 unsigned long flags;
888 LIST_HEAD(pending);
889 struct list_head *n, *pos;
890
891 spin_lock_irqsave(&asd_ha->seq.pend_q_lock, flags);
892 asd_ha->seq.pending = 0;
893 list_splice_init(&asd_ha->seq.pend_q, &pending);
894 spin_unlock_irqrestore(&asd_ha->seq.pend_q_lock, flags);
895
896 if (!list_empty(&pending))
897 ASD_DPRINTK("Uh-oh! Pending is not empty!\n");
898
899 list_for_each_safe(pos, n, &pending) {
900 struct asd_ascb *ascb = list_entry(pos, struct asd_ascb, list);
901 /*
902 * Delete unexpired ascb timers. This may happen if we issue
903 * a CONTROL PHY scb to an adapter and rmmod before the scb
904 * times out. Apparently we don't wait for the CONTROL PHY
905 * to complete, so it doesn't matter if we kill the timer.
906 */
907 del_timer_sync(&ascb->timer);
908 WARN_ON(ascb->scb->header.opcode != CONTROL_PHY);
909
910 list_del_init(pos);
911 ASD_DPRINTK("freeing from pending\n");
912 asd_ascb_free(ascb);
913 }
914 }
915
916 static void asd_turn_off_leds(struct asd_ha_struct *asd_ha)
917 {
918 u8 phy_mask = asd_ha->hw_prof.enabled_phys;
919 u8 i;
920
921 for_each_phy(phy_mask, phy_mask, i) {
922 asd_turn_led(asd_ha, i, 0);
923 asd_control_led(asd_ha, i, 0);
924 }
925 }
926
927 static void __devexit asd_pci_remove(struct pci_dev *dev)
928 {
929 struct asd_ha_struct *asd_ha = pci_get_drvdata(dev);
930
931 if (!asd_ha)
932 return;
933
934 asd_unregister_sas_ha(asd_ha);
935
936 asd_disable_ints(asd_ha);
937
938 asd_remove_dev_attrs(asd_ha);
939
940 /* XXX more here as needed */
941
942 free_irq(dev->irq, asd_ha);
943 if (use_msi)
944 pci_disable_msi(asd_ha->pcidev);
945 asd_turn_off_leds(asd_ha);
946 asd_chip_hardrst(asd_ha);
947 asd_free_queues(asd_ha);
948 asd_destroy_ha_caches(asd_ha);
949 asd_unmap_ha(asd_ha);
950 kfree(asd_ha);
951 pci_disable_device(dev);
952 return;
953 }
954
955 static void asd_scan_start(struct Scsi_Host *shost)
956 {
957 struct asd_ha_struct *asd_ha;
958 int err;
959
960 asd_ha = SHOST_TO_SAS_HA(shost)->lldd_ha;
961 err = asd_enable_phys(asd_ha, asd_ha->hw_prof.enabled_phys);
962 if (err)
963 asd_printk("Couldn't enable phys, err:%d\n", err);
964 }
965
966 static int asd_scan_finished(struct Scsi_Host *shost, unsigned long time)
967 {
968 /* give the phy enabling interrupt event time to come in (1s
969 * is empirically about all it takes) */
970 if (time < HZ)
971 return 0;
972 /* Wait for discovery to finish */
973 sas_drain_work(SHOST_TO_SAS_HA(shost));
974 return 1;
975 }
976
977 static ssize_t asd_version_show(struct device_driver *driver, char *buf)
978 {
979 return snprintf(buf, PAGE_SIZE, "%s\n", ASD_DRIVER_VERSION);
980 }
981 static DRIVER_ATTR(version, S_IRUGO, asd_version_show, NULL);
982
983 static int asd_create_driver_attrs(struct device_driver *driver)
984 {
985 return driver_create_file(driver, &driver_attr_version);
986 }
987
988 static void asd_remove_driver_attrs(struct device_driver *driver)
989 {
990 driver_remove_file(driver, &driver_attr_version);
991 }
992
993 static struct sas_domain_function_template aic94xx_transport_functions = {
994 .lldd_dev_found = asd_dev_found,
995 .lldd_dev_gone = asd_dev_gone,
996
997 .lldd_execute_task = asd_execute_task,
998
999 .lldd_abort_task = asd_abort_task,
1000 .lldd_abort_task_set = asd_abort_task_set,
1001 .lldd_clear_aca = asd_clear_aca,
1002 .lldd_clear_task_set = asd_clear_task_set,
1003 .lldd_I_T_nexus_reset = asd_I_T_nexus_reset,
1004 .lldd_lu_reset = asd_lu_reset,
1005 .lldd_query_task = asd_query_task,
1006
1007 .lldd_clear_nexus_port = asd_clear_nexus_port,
1008 .lldd_clear_nexus_ha = asd_clear_nexus_ha,
1009
1010 .lldd_control_phy = asd_control_phy,
1011
1012 .lldd_ata_set_dmamode = asd_set_dmamode,
1013 };
1014
1015 static const struct pci_device_id aic94xx_pci_table[] __devinitconst = {
1016 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x410),0, 0, 1},
1017 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x412),0, 0, 1},
1018 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x416),0, 0, 1},
1019 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x41E),0, 0, 1},
1020 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x41F),0, 0, 1},
1021 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x430),0, 0, 2},
1022 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x432),0, 0, 2},
1023 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x43E),0, 0, 2},
1024 {PCI_DEVICE(PCI_VENDOR_ID_ADAPTEC2, 0x43F),0, 0, 2},
1025 {}
1026 };
1027
1028 MODULE_DEVICE_TABLE(pci, aic94xx_pci_table);
1029
1030 static struct pci_driver aic94xx_pci_driver = {
1031 .name = ASD_DRIVER_NAME,
1032 .id_table = aic94xx_pci_table,
1033 .probe = asd_pci_probe,
1034 .remove = __devexit_p(asd_pci_remove),
1035 };
1036
1037 static int __init aic94xx_init(void)
1038 {
1039 int err;
1040
1041
1042 asd_printk("%s version %s loaded\n", ASD_DRIVER_DESCRIPTION,
1043 ASD_DRIVER_VERSION);
1044
1045 err = asd_create_global_caches();
1046 if (err)
1047 return err;
1048
1049 aic94xx_transport_template =
1050 sas_domain_attach_transport(&aic94xx_transport_functions);
1051 if (!aic94xx_transport_template)
1052 goto out_destroy_caches;
1053
1054 err = pci_register_driver(&aic94xx_pci_driver);
1055 if (err)
1056 goto out_release_transport;
1057
1058 err = asd_create_driver_attrs(&aic94xx_pci_driver.driver);
1059 if (err)
1060 goto out_unregister_pcidrv;
1061
1062 return err;
1063
1064 out_unregister_pcidrv:
1065 pci_unregister_driver(&aic94xx_pci_driver);
1066 out_release_transport:
1067 sas_release_transport(aic94xx_transport_template);
1068 out_destroy_caches:
1069 asd_destroy_global_caches();
1070
1071 return err;
1072 }
1073
1074 static void __exit aic94xx_exit(void)
1075 {
1076 asd_remove_driver_attrs(&aic94xx_pci_driver.driver);
1077 pci_unregister_driver(&aic94xx_pci_driver);
1078 sas_release_transport(aic94xx_transport_template);
1079 asd_release_firmware();
1080 asd_destroy_global_caches();
1081 asd_printk("%s version %s unloaded\n", ASD_DRIVER_DESCRIPTION,
1082 ASD_DRIVER_VERSION);
1083 }
1084
1085 module_init(aic94xx_init);
1086 module_exit(aic94xx_exit);
1087
1088 MODULE_AUTHOR("Luben Tuikov <luben_tuikov@adaptec.com>");
1089 MODULE_DESCRIPTION(ASD_DRIVER_DESCRIPTION);
1090 MODULE_LICENSE("GPL v2");
1091 MODULE_VERSION(ASD_DRIVER_VERSION);
kernel source for telekom puls (alcatel/mediatek)