treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / scsi / isci / init.c
blobb48aac8dfcb82d0ff69644c74e74e774f4bb5e5f
1 /*
2 * This file is provided under a dual BSD/GPLv2 license. When using or
3 * redistributing this file, you may do so under either license.
5 * GPL LICENSE SUMMARY
7 * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of version 2 of the GNU General Public License as
11 * published by the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
21 * The full GNU General Public License is included in this distribution
22 * in the file called LICENSE.GPL.
24 * BSD LICENSE
26 * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
27 * All rights reserved.
29 * Redistribution and use in source and binary forms, with or without
30 * modification, are permitted provided that the following conditions
31 * are met:
33 * * Redistributions of source code must retain the above copyright
34 * notice, this list of conditions and the following disclaimer.
35 * * Redistributions in binary form must reproduce the above copyright
36 * notice, this list of conditions and the following disclaimer in
37 * the documentation and/or other materials provided with the
38 * distribution.
39 * * Neither the name of Intel Corporation nor the names of its
40 * contributors may be used to endorse or promote products derived
41 * from this software without specific prior written permission.
43 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
44 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
45 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
46 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
47 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
48 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
49 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
50 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
51 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
52 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
53 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
56 #include <linux/kernel.h>
57 #include <linux/init.h>
58 #include <linux/module.h>
59 #include <linux/firmware.h>
60 #include <linux/efi.h>
61 #include <asm/string.h>
62 #include <scsi/scsi_host.h>
63 #include "host.h"
64 #include "isci.h"
65 #include "task.h"
66 #include "probe_roms.h"
68 #define MAJ 1
69 #define MIN 2
70 #define BUILD 0
71 #define DRV_VERSION __stringify(MAJ) "." __stringify(MIN) "." \
72 __stringify(BUILD)
74 MODULE_VERSION(DRV_VERSION);
76 static struct scsi_transport_template *isci_transport_template;
78 static const struct pci_device_id isci_id_table[] = {
79 { PCI_VDEVICE(INTEL, 0x1D61),},
80 { PCI_VDEVICE(INTEL, 0x1D63),},
81 { PCI_VDEVICE(INTEL, 0x1D65),},
82 { PCI_VDEVICE(INTEL, 0x1D67),},
83 { PCI_VDEVICE(INTEL, 0x1D69),},
84 { PCI_VDEVICE(INTEL, 0x1D6B),},
85 { PCI_VDEVICE(INTEL, 0x1D60),},
86 { PCI_VDEVICE(INTEL, 0x1D62),},
87 { PCI_VDEVICE(INTEL, 0x1D64),},
88 { PCI_VDEVICE(INTEL, 0x1D66),},
89 { PCI_VDEVICE(INTEL, 0x1D68),},
90 { PCI_VDEVICE(INTEL, 0x1D6A),},
94 MODULE_DEVICE_TABLE(pci, isci_id_table);
96 /* linux isci specific settings */
98 unsigned char no_outbound_task_to = 2;
99 module_param(no_outbound_task_to, byte, 0);
100 MODULE_PARM_DESC(no_outbound_task_to, "No Outbound Task Timeout (1us incr)");
102 u16 ssp_max_occ_to = 20;
103 module_param(ssp_max_occ_to, ushort, 0);
104 MODULE_PARM_DESC(ssp_max_occ_to, "SSP Max occupancy timeout (100us incr)");
106 u16 stp_max_occ_to = 5;
107 module_param(stp_max_occ_to, ushort, 0);
108 MODULE_PARM_DESC(stp_max_occ_to, "STP Max occupancy timeout (100us incr)");
110 u16 ssp_inactive_to = 5;
111 module_param(ssp_inactive_to, ushort, 0);
112 MODULE_PARM_DESC(ssp_inactive_to, "SSP inactivity timeout (100us incr)");
114 u16 stp_inactive_to = 5;
115 module_param(stp_inactive_to, ushort, 0);
116 MODULE_PARM_DESC(stp_inactive_to, "STP inactivity timeout (100us incr)");
118 unsigned char phy_gen = SCIC_SDS_PARM_GEN2_SPEED;
119 module_param(phy_gen, byte, 0);
120 MODULE_PARM_DESC(phy_gen, "PHY generation (1: 1.5Gbps 2: 3.0Gbps 3: 6.0Gbps)");
122 unsigned char max_concurr_spinup;
123 module_param(max_concurr_spinup, byte, 0);
124 MODULE_PARM_DESC(max_concurr_spinup, "Max concurrent device spinup");
126 uint cable_selection_override = CABLE_OVERRIDE_DISABLED;
127 module_param(cable_selection_override, uint, 0);
129 MODULE_PARM_DESC(cable_selection_override,
130 "This field indicates length of the SAS/SATA cable between "
131 "host and device. If any bits > 15 are set (default) "
132 "indicates \"use platform defaults\"");
134 static ssize_t isci_show_id(struct device *dev, struct device_attribute *attr, char *buf)
136 struct Scsi_Host *shost = container_of(dev, typeof(*shost), shost_dev);
137 struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
138 struct isci_host *ihost = container_of(sas_ha, typeof(*ihost), sas_ha);
140 return snprintf(buf, PAGE_SIZE, "%d\n", ihost->id);
143 static DEVICE_ATTR(isci_id, S_IRUGO, isci_show_id, NULL);
145 struct device_attribute *isci_host_attrs[] = {
146 &dev_attr_isci_id,
147 NULL
150 static struct scsi_host_template isci_sht = {
152 .module = THIS_MODULE,
153 .name = DRV_NAME,
154 .proc_name = DRV_NAME,
155 .queuecommand = sas_queuecommand,
156 .target_alloc = sas_target_alloc,
157 .slave_configure = sas_slave_configure,
158 .scan_finished = isci_host_scan_finished,
159 .scan_start = isci_host_start,
160 .change_queue_depth = sas_change_queue_depth,
161 .bios_param = sas_bios_param,
162 .can_queue = ISCI_CAN_QUEUE_VAL,
163 .this_id = -1,
164 .sg_tablesize = SG_ALL,
165 .max_sectors = SCSI_DEFAULT_MAX_SECTORS,
166 .eh_abort_handler = sas_eh_abort_handler,
167 .eh_device_reset_handler = sas_eh_device_reset_handler,
168 .eh_target_reset_handler = sas_eh_target_reset_handler,
169 .target_destroy = sas_target_destroy,
170 .ioctl = sas_ioctl,
171 #ifdef CONFIG_COMPAT
172 .compat_ioctl = sas_ioctl,
173 #endif
174 .shost_attrs = isci_host_attrs,
175 .track_queue_depth = 1,
178 static struct sas_domain_function_template isci_transport_ops = {
180 /* The class calls these to notify the LLDD of an event. */
181 .lldd_port_formed = isci_port_formed,
182 .lldd_port_deformed = isci_port_deformed,
184 /* The class calls these when a device is found or gone. */
185 .lldd_dev_found = isci_remote_device_found,
186 .lldd_dev_gone = isci_remote_device_gone,
188 .lldd_execute_task = isci_task_execute_task,
189 /* Task Management Functions. Must be called from process context. */
190 .lldd_abort_task = isci_task_abort_task,
191 .lldd_abort_task_set = isci_task_abort_task_set,
192 .lldd_clear_aca = isci_task_clear_aca,
193 .lldd_clear_task_set = isci_task_clear_task_set,
194 .lldd_I_T_nexus_reset = isci_task_I_T_nexus_reset,
195 .lldd_lu_reset = isci_task_lu_reset,
196 .lldd_query_task = isci_task_query_task,
198 /* ata recovery called from ata-eh */
199 .lldd_ata_check_ready = isci_ata_check_ready,
201 /* Port and Adapter management */
202 .lldd_clear_nexus_port = isci_task_clear_nexus_port,
203 .lldd_clear_nexus_ha = isci_task_clear_nexus_ha,
205 /* Phy management */
206 .lldd_control_phy = isci_phy_control,
208 /* GPIO support */
209 .lldd_write_gpio = isci_gpio_write,
213 /******************************************************************************
214 * P R O T E C T E D M E T H O D S
215 ******************************************************************************/
220 * isci_register_sas_ha() - This method initializes various lldd
221 * specific members of the sas_ha struct and calls the libsas
222 * sas_register_ha() function.
223 * @isci_host: This parameter specifies the lldd specific wrapper for the
224 * libsas sas_ha struct.
226 * This method returns an error code indicating success or failure. The user
227 * should check for possible memory allocation error return otherwise, a zero
228 * indicates success.
230 static int isci_register_sas_ha(struct isci_host *isci_host)
232 int i;
233 struct sas_ha_struct *sas_ha = &(isci_host->sas_ha);
234 struct asd_sas_phy **sas_phys;
235 struct asd_sas_port **sas_ports;
237 sas_phys = devm_kcalloc(&isci_host->pdev->dev,
238 SCI_MAX_PHYS, sizeof(void *),
239 GFP_KERNEL);
240 if (!sas_phys)
241 return -ENOMEM;
243 sas_ports = devm_kcalloc(&isci_host->pdev->dev,
244 SCI_MAX_PORTS, sizeof(void *),
245 GFP_KERNEL);
246 if (!sas_ports)
247 return -ENOMEM;
249 sas_ha->sas_ha_name = DRV_NAME;
250 sas_ha->lldd_module = THIS_MODULE;
251 sas_ha->sas_addr = &isci_host->phys[0].sas_addr[0];
253 for (i = 0; i < SCI_MAX_PHYS; i++) {
254 sas_phys[i] = &isci_host->phys[i].sas_phy;
255 sas_ports[i] = &isci_host->sas_ports[i];
258 sas_ha->sas_phy = sas_phys;
259 sas_ha->sas_port = sas_ports;
260 sas_ha->num_phys = SCI_MAX_PHYS;
262 sas_ha->strict_wide_ports = 1;
264 sas_register_ha(sas_ha);
266 return 0;
269 static void isci_unregister(struct isci_host *isci_host)
271 struct Scsi_Host *shost;
273 if (!isci_host)
274 return;
276 shost = to_shost(isci_host);
277 sas_unregister_ha(&isci_host->sas_ha);
279 sas_remove_host(shost);
280 scsi_host_put(shost);
283 static int isci_pci_init(struct pci_dev *pdev)
285 int err, bar_num, bar_mask = 0;
286 void __iomem * const *iomap;
288 err = pcim_enable_device(pdev);
289 if (err) {
290 dev_err(&pdev->dev,
291 "failed enable PCI device %s!\n",
292 pci_name(pdev));
293 return err;
296 for (bar_num = 0; bar_num < SCI_PCI_BAR_COUNT; bar_num++)
297 bar_mask |= 1 << (bar_num * 2);
299 err = pcim_iomap_regions(pdev, bar_mask, DRV_NAME);
300 if (err)
301 return err;
303 iomap = pcim_iomap_table(pdev);
304 if (!iomap)
305 return -ENOMEM;
307 pci_set_master(pdev);
309 err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
310 if (err)
311 err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
312 return err;
315 static int num_controllers(struct pci_dev *pdev)
317 /* bar size alone can tell us if we are running with a dual controller
318 * part, no need to trust revision ids that might be under broken firmware
319 * control
321 resource_size_t scu_bar_size = pci_resource_len(pdev, SCI_SCU_BAR*2);
322 resource_size_t smu_bar_size = pci_resource_len(pdev, SCI_SMU_BAR*2);
324 if (scu_bar_size >= SCI_SCU_BAR_SIZE*SCI_MAX_CONTROLLERS &&
325 smu_bar_size >= SCI_SMU_BAR_SIZE*SCI_MAX_CONTROLLERS)
326 return SCI_MAX_CONTROLLERS;
327 else
328 return 1;
331 static int isci_setup_interrupts(struct pci_dev *pdev)
333 int err, i, num_msix;
334 struct isci_host *ihost;
335 struct isci_pci_info *pci_info = to_pci_info(pdev);
338 * Determine the number of vectors associated with this
339 * PCI function.
341 num_msix = num_controllers(pdev) * SCI_NUM_MSI_X_INT;
343 err = pci_alloc_irq_vectors(pdev, num_msix, num_msix, PCI_IRQ_MSIX);
344 if (err < 0)
345 goto intx;
347 for (i = 0; i < num_msix; i++) {
348 int id = i / SCI_NUM_MSI_X_INT;
349 irq_handler_t isr;
351 ihost = pci_info->hosts[id];
352 /* odd numbered vectors are error interrupts */
353 if (i & 1)
354 isr = isci_error_isr;
355 else
356 isr = isci_msix_isr;
358 err = devm_request_irq(&pdev->dev, pci_irq_vector(pdev, i),
359 isr, 0, DRV_NAME"-msix", ihost);
360 if (!err)
361 continue;
363 dev_info(&pdev->dev, "msix setup failed falling back to intx\n");
364 while (i--) {
365 id = i / SCI_NUM_MSI_X_INT;
366 ihost = pci_info->hosts[id];
367 devm_free_irq(&pdev->dev, pci_irq_vector(pdev, i),
368 ihost);
370 pci_free_irq_vectors(pdev);
371 goto intx;
373 return 0;
375 intx:
376 for_each_isci_host(i, ihost, pdev) {
377 err = devm_request_irq(&pdev->dev, pci_irq_vector(pdev, 0),
378 isci_intx_isr, IRQF_SHARED, DRV_NAME"-intx",
379 ihost);
380 if (err)
381 break;
383 return err;
386 static void isci_user_parameters_get(struct sci_user_parameters *u)
388 int i;
390 for (i = 0; i < SCI_MAX_PHYS; i++) {
391 struct sci_phy_user_params *u_phy = &u->phys[i];
393 u_phy->max_speed_generation = phy_gen;
395 /* we are not exporting these for now */
396 u_phy->align_insertion_frequency = 0x7f;
397 u_phy->in_connection_align_insertion_frequency = 0xff;
398 u_phy->notify_enable_spin_up_insertion_frequency = 0x33;
401 u->stp_inactivity_timeout = stp_inactive_to;
402 u->ssp_inactivity_timeout = ssp_inactive_to;
403 u->stp_max_occupancy_timeout = stp_max_occ_to;
404 u->ssp_max_occupancy_timeout = ssp_max_occ_to;
405 u->no_outbound_task_timeout = no_outbound_task_to;
406 u->max_concurr_spinup = max_concurr_spinup;
409 static enum sci_status sci_user_parameters_set(struct isci_host *ihost,
410 struct sci_user_parameters *sci_parms)
412 u16 index;
415 * Validate the user parameters. If they are not legal, then
416 * return a failure.
418 for (index = 0; index < SCI_MAX_PHYS; index++) {
419 struct sci_phy_user_params *u;
421 u = &sci_parms->phys[index];
423 if (!((u->max_speed_generation <= SCIC_SDS_PARM_MAX_SPEED) &&
424 (u->max_speed_generation > SCIC_SDS_PARM_NO_SPEED)))
425 return SCI_FAILURE_INVALID_PARAMETER_VALUE;
427 if ((u->in_connection_align_insertion_frequency < 3) ||
428 (u->align_insertion_frequency == 0) ||
429 (u->notify_enable_spin_up_insertion_frequency == 0))
430 return SCI_FAILURE_INVALID_PARAMETER_VALUE;
433 if ((sci_parms->stp_inactivity_timeout == 0) ||
434 (sci_parms->ssp_inactivity_timeout == 0) ||
435 (sci_parms->stp_max_occupancy_timeout == 0) ||
436 (sci_parms->ssp_max_occupancy_timeout == 0) ||
437 (sci_parms->no_outbound_task_timeout == 0))
438 return SCI_FAILURE_INVALID_PARAMETER_VALUE;
440 memcpy(&ihost->user_parameters, sci_parms, sizeof(*sci_parms));
442 return SCI_SUCCESS;
445 static void sci_oem_defaults(struct isci_host *ihost)
447 /* these defaults are overridden by the platform / firmware */
448 struct sci_user_parameters *user = &ihost->user_parameters;
449 struct sci_oem_params *oem = &ihost->oem_parameters;
450 int i;
452 /* Default to APC mode. */
453 oem->controller.mode_type = SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE;
455 /* Default to APC mode. */
456 oem->controller.max_concurr_spin_up = 1;
458 /* Default to no SSC operation. */
459 oem->controller.do_enable_ssc = false;
461 /* Default to short cables on all phys. */
462 oem->controller.cable_selection_mask = 0;
464 /* Initialize all of the port parameter information to narrow ports. */
465 for (i = 0; i < SCI_MAX_PORTS; i++)
466 oem->ports[i].phy_mask = 0;
468 /* Initialize all of the phy parameter information. */
469 for (i = 0; i < SCI_MAX_PHYS; i++) {
470 /* Default to 3G (i.e. Gen 2). */
471 user->phys[i].max_speed_generation = SCIC_SDS_PARM_GEN2_SPEED;
473 /* the frequencies cannot be 0 */
474 user->phys[i].align_insertion_frequency = 0x7f;
475 user->phys[i].in_connection_align_insertion_frequency = 0xff;
476 user->phys[i].notify_enable_spin_up_insertion_frequency = 0x33;
478 /* Previous Vitesse based expanders had a arbitration issue that
479 * is worked around by having the upper 32-bits of SAS address
480 * with a value greater then the Vitesse company identifier.
481 * Hence, usage of 0x5FCFFFFF.
483 oem->phys[i].sas_address.low = 0x1 + ihost->id;
484 oem->phys[i].sas_address.high = 0x5FCFFFFF;
487 user->stp_inactivity_timeout = 5;
488 user->ssp_inactivity_timeout = 5;
489 user->stp_max_occupancy_timeout = 5;
490 user->ssp_max_occupancy_timeout = 20;
491 user->no_outbound_task_timeout = 2;
494 static struct isci_host *isci_host_alloc(struct pci_dev *pdev, int id)
496 struct isci_orom *orom = to_pci_info(pdev)->orom;
497 struct sci_user_parameters sci_user_params;
498 u8 oem_version = ISCI_ROM_VER_1_0;
499 struct isci_host *ihost;
500 struct Scsi_Host *shost;
501 int err, i;
503 ihost = devm_kzalloc(&pdev->dev, sizeof(*ihost), GFP_KERNEL);
504 if (!ihost)
505 return NULL;
507 ihost->pdev = pdev;
508 ihost->id = id;
509 spin_lock_init(&ihost->scic_lock);
510 init_waitqueue_head(&ihost->eventq);
511 ihost->sas_ha.dev = &ihost->pdev->dev;
512 ihost->sas_ha.lldd_ha = ihost;
513 tasklet_init(&ihost->completion_tasklet,
514 isci_host_completion_routine, (unsigned long)ihost);
516 /* validate module parameters */
517 /* TODO: kill struct sci_user_parameters and reference directly */
518 sci_oem_defaults(ihost);
519 isci_user_parameters_get(&sci_user_params);
520 if (sci_user_parameters_set(ihost, &sci_user_params)) {
521 dev_warn(&pdev->dev,
522 "%s: sci_user_parameters_set failed\n", __func__);
523 return NULL;
526 /* sanity check platform (or 'firmware') oem parameters */
527 if (orom) {
528 if (id < 0 || id >= SCI_MAX_CONTROLLERS || id > orom->hdr.num_elements) {
529 dev_warn(&pdev->dev, "parsing firmware oem parameters failed\n");
530 return NULL;
532 ihost->oem_parameters = orom->ctrl[id];
533 oem_version = orom->hdr.version;
536 /* validate oem parameters (platform, firmware, or built-in defaults) */
537 if (sci_oem_parameters_validate(&ihost->oem_parameters, oem_version)) {
538 dev_warn(&pdev->dev, "oem parameter validation failed\n");
539 return NULL;
542 for (i = 0; i < SCI_MAX_PORTS; i++) {
543 struct isci_port *iport = &ihost->ports[i];
545 INIT_LIST_HEAD(&iport->remote_dev_list);
546 iport->isci_host = ihost;
549 for (i = 0; i < SCI_MAX_PHYS; i++)
550 isci_phy_init(&ihost->phys[i], ihost, i);
552 for (i = 0; i < SCI_MAX_REMOTE_DEVICES; i++) {
553 struct isci_remote_device *idev = &ihost->devices[i];
555 INIT_LIST_HEAD(&idev->node);
558 shost = scsi_host_alloc(&isci_sht, sizeof(void *));
559 if (!shost)
560 return NULL;
562 dev_info(&pdev->dev, "%sSCU controller %d: phy 3-0 cables: "
563 "{%s, %s, %s, %s}\n",
564 (is_cable_select_overridden() ? "* " : ""), ihost->id,
565 lookup_cable_names(decode_cable_selection(ihost, 3)),
566 lookup_cable_names(decode_cable_selection(ihost, 2)),
567 lookup_cable_names(decode_cable_selection(ihost, 1)),
568 lookup_cable_names(decode_cable_selection(ihost, 0)));
570 err = isci_host_init(ihost);
571 if (err)
572 goto err_shost;
574 SHOST_TO_SAS_HA(shost) = &ihost->sas_ha;
575 ihost->sas_ha.core.shost = shost;
576 shost->transportt = isci_transport_template;
578 shost->max_id = ~0;
579 shost->max_lun = ~0;
580 shost->max_cmd_len = MAX_COMMAND_SIZE;
582 /* turn on DIF support */
583 scsi_host_set_prot(shost,
584 SHOST_DIF_TYPE1_PROTECTION |
585 SHOST_DIF_TYPE2_PROTECTION |
586 SHOST_DIF_TYPE3_PROTECTION);
587 scsi_host_set_guard(shost, SHOST_DIX_GUARD_CRC);
589 err = scsi_add_host(shost, &pdev->dev);
590 if (err)
591 goto err_shost;
593 err = isci_register_sas_ha(ihost);
594 if (err)
595 goto err_shost_remove;
597 return ihost;
599 err_shost_remove:
600 scsi_remove_host(shost);
601 err_shost:
602 scsi_host_put(shost);
604 return NULL;
607 static int isci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
609 struct isci_pci_info *pci_info;
610 int err, i;
611 struct isci_host *isci_host;
612 const struct firmware *fw = NULL;
613 struct isci_orom *orom = NULL;
614 char *source = "(platform)";
616 dev_info(&pdev->dev, "driver configured for rev: %d silicon\n",
617 pdev->revision);
619 pci_info = devm_kzalloc(&pdev->dev, sizeof(*pci_info), GFP_KERNEL);
620 if (!pci_info)
621 return -ENOMEM;
622 pci_set_drvdata(pdev, pci_info);
624 if (efi_enabled(EFI_RUNTIME_SERVICES))
625 orom = isci_get_efi_var(pdev);
627 if (!orom)
628 orom = isci_request_oprom(pdev);
630 for (i = 0; orom && i < num_controllers(pdev); i++) {
631 if (sci_oem_parameters_validate(&orom->ctrl[i],
632 orom->hdr.version)) {
633 dev_warn(&pdev->dev,
634 "[%d]: invalid oem parameters detected, falling back to firmware\n", i);
635 orom = NULL;
636 break;
640 if (!orom) {
641 source = "(firmware)";
642 orom = isci_request_firmware(pdev, fw);
643 if (!orom) {
644 /* TODO convert this to WARN_TAINT_ONCE once the
645 * orom/efi parameter support is widely available
647 dev_warn(&pdev->dev,
648 "Loading user firmware failed, using default "
649 "values\n");
650 dev_warn(&pdev->dev,
651 "Default OEM configuration being used: 4 "
652 "narrow ports, and default SAS Addresses\n");
656 if (orom)
657 dev_info(&pdev->dev,
658 "OEM SAS parameters (version: %u.%u) loaded %s\n",
659 (orom->hdr.version & 0xf0) >> 4,
660 (orom->hdr.version & 0xf), source);
662 pci_info->orom = orom;
664 err = isci_pci_init(pdev);
665 if (err)
666 return err;
668 for (i = 0; i < num_controllers(pdev); i++) {
669 struct isci_host *h = isci_host_alloc(pdev, i);
671 if (!h) {
672 err = -ENOMEM;
673 goto err_host_alloc;
675 pci_info->hosts[i] = h;
678 err = isci_setup_interrupts(pdev);
679 if (err)
680 goto err_host_alloc;
682 for_each_isci_host(i, isci_host, pdev)
683 scsi_scan_host(to_shost(isci_host));
685 return 0;
687 err_host_alloc:
688 for_each_isci_host(i, isci_host, pdev)
689 isci_unregister(isci_host);
690 return err;
693 static void isci_pci_remove(struct pci_dev *pdev)
695 struct isci_host *ihost;
696 int i;
698 for_each_isci_host(i, ihost, pdev) {
699 wait_for_start(ihost);
700 isci_unregister(ihost);
701 isci_host_deinit(ihost);
705 #ifdef CONFIG_PM_SLEEP
706 static int isci_suspend(struct device *dev)
708 struct pci_dev *pdev = to_pci_dev(dev);
709 struct isci_host *ihost;
710 int i;
712 for_each_isci_host(i, ihost, pdev) {
713 sas_suspend_ha(&ihost->sas_ha);
714 isci_host_deinit(ihost);
717 pci_save_state(pdev);
718 pci_disable_device(pdev);
719 pci_set_power_state(pdev, PCI_D3hot);
721 return 0;
724 static int isci_resume(struct device *dev)
726 struct pci_dev *pdev = to_pci_dev(dev);
727 struct isci_host *ihost;
728 int rc, i;
730 pci_set_power_state(pdev, PCI_D0);
731 pci_restore_state(pdev);
733 rc = pcim_enable_device(pdev);
734 if (rc) {
735 dev_err(&pdev->dev,
736 "enabling device failure after resume(%d)\n", rc);
737 return rc;
740 pci_set_master(pdev);
742 for_each_isci_host(i, ihost, pdev) {
743 sas_prep_resume_ha(&ihost->sas_ha);
745 isci_host_init(ihost);
746 isci_host_start(ihost->sas_ha.core.shost);
747 wait_for_start(ihost);
749 sas_resume_ha(&ihost->sas_ha);
752 return 0;
754 #endif
756 static SIMPLE_DEV_PM_OPS(isci_pm_ops, isci_suspend, isci_resume);
758 static struct pci_driver isci_pci_driver = {
759 .name = DRV_NAME,
760 .id_table = isci_id_table,
761 .probe = isci_pci_probe,
762 .remove = isci_pci_remove,
763 .driver.pm = &isci_pm_ops,
766 static __init int isci_init(void)
768 int err;
770 pr_info("%s: Intel(R) C600 SAS Controller Driver - version %s\n",
771 DRV_NAME, DRV_VERSION);
773 isci_transport_template = sas_domain_attach_transport(&isci_transport_ops);
774 if (!isci_transport_template)
775 return -ENOMEM;
777 err = pci_register_driver(&isci_pci_driver);
778 if (err)
779 sas_release_transport(isci_transport_template);
781 return err;
784 static __exit void isci_exit(void)
786 pci_unregister_driver(&isci_pci_driver);
787 sas_release_transport(isci_transport_template);
790 MODULE_LICENSE("Dual BSD/GPL");
791 MODULE_FIRMWARE(ISCI_FW_NAME);
792 module_init(isci_init);
793 module_exit(isci_exit);