Commit | Line | Data |
---|---|---|
6f231dda DW |
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. | |
4 | * | |
5 | * GPL LICENSE SUMMARY | |
6 | * | |
7 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. | |
8 | * | |
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. | |
12 | * | |
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. | |
17 | * | |
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. | |
23 | * | |
24 | * BSD LICENSE | |
25 | * | |
26 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. | |
27 | * All rights reserved. | |
28 | * | |
29 | * Redistribution and use in source and binary forms, with or without | |
30 | * modification, are permitted provided that the following conditions | |
31 | * are met: | |
32 | * | |
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. | |
42 | * | |
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. | |
54 | */ | |
55 | ||
56 | #include <linux/kernel.h> | |
57 | #include <linux/init.h> | |
58 | #include <linux/module.h> | |
59 | #include <asm/string.h> | |
60 | #include "isci.h" | |
61 | #include "task.h" | |
62 | #include "sci_controller_constants.h" | |
63 | #include "scic_remote_device.h" | |
64 | #include "sci_environment.h" | |
65 | ||
66 | static struct scsi_transport_template *isci_transport_template; | |
6f231dda DW |
67 | |
68 | static DEFINE_PCI_DEVICE_TABLE(isci_id_table) = { | |
69 | { PCI_VDEVICE(INTEL, 0x1D61),}, | |
70 | { PCI_VDEVICE(INTEL, 0x1D63),}, | |
71 | { PCI_VDEVICE(INTEL, 0x1D65),}, | |
72 | { PCI_VDEVICE(INTEL, 0x1D67),}, | |
73 | { PCI_VDEVICE(INTEL, 0x1D69),}, | |
74 | { PCI_VDEVICE(INTEL, 0x1D6B),}, | |
75 | { PCI_VDEVICE(INTEL, 0x1D60),}, | |
76 | { PCI_VDEVICE(INTEL, 0x1D62),}, | |
77 | { PCI_VDEVICE(INTEL, 0x1D64),}, | |
78 | { PCI_VDEVICE(INTEL, 0x1D66),}, | |
79 | { PCI_VDEVICE(INTEL, 0x1D68),}, | |
80 | { PCI_VDEVICE(INTEL, 0x1D6A),}, | |
81 | {} | |
82 | }; | |
83 | ||
858d4aa7 DJ |
84 | struct isci_firmware *isci_firmware; |
85 | ||
6f231dda DW |
86 | static int __devinit isci_pci_probe( |
87 | struct pci_dev *pdev, | |
88 | const struct pci_device_id *device_id_p); | |
89 | ||
90 | static void __devexit isci_pci_remove(struct pci_dev *pdev); | |
91 | ||
92 | MODULE_DEVICE_TABLE(pci, isci_id_table); | |
93 | ||
94 | static struct pci_driver isci_pci_driver = { | |
95 | .name = DRV_NAME, | |
96 | .id_table = isci_id_table, | |
97 | .probe = isci_pci_probe, | |
98 | .remove = __devexit_p(isci_pci_remove), | |
99 | }; | |
100 | ||
101 | /* linux isci specific settings */ | |
6f231dda DW |
102 | |
103 | #if defined(CONFIG_PBG_HBA_A0) | |
104 | int isci_si_rev = ISCI_SI_REVA0; | |
105 | #elif defined(CONFIG_PBG_HBA_A2) | |
106 | int isci_si_rev = ISCI_SI_REVA2; | |
107 | #else | |
108 | int isci_si_rev = ISCI_SI_REVB0; | |
109 | #endif | |
110 | module_param(isci_si_rev, int, S_IRUGO | S_IWUSR); | |
111 | MODULE_PARM_DESC(isci_si_rev, "override default si rev (0: A0 1: A2 2: B0)"); | |
112 | ||
113 | static struct scsi_host_template isci_sht = { | |
114 | ||
115 | .module = THIS_MODULE, | |
116 | .name = DRV_NAME, | |
92cd5115 | 117 | .proc_name = DRV_NAME, |
6f231dda DW |
118 | .queuecommand = sas_queuecommand, |
119 | .target_alloc = sas_target_alloc, | |
120 | .slave_configure = sas_slave_configure, | |
121 | .slave_destroy = sas_slave_destroy, | |
122 | .scan_finished = isci_host_scan_finished, | |
123 | .scan_start = isci_host_scan_start, | |
124 | .change_queue_depth = sas_change_queue_depth, | |
125 | .change_queue_type = sas_change_queue_type, | |
126 | .bios_param = sas_bios_param, | |
127 | .can_queue = ISCI_CAN_QUEUE_VAL, | |
128 | .cmd_per_lun = 1, | |
129 | .this_id = -1, | |
130 | .sg_tablesize = SG_ALL, | |
131 | .max_sectors = SCSI_DEFAULT_MAX_SECTORS, | |
132 | .use_clustering = ENABLE_CLUSTERING, | |
133 | .eh_device_reset_handler = sas_eh_device_reset_handler, | |
134 | .eh_bus_reset_handler = isci_bus_reset_handler, | |
135 | .slave_alloc = sas_slave_alloc, | |
136 | .target_destroy = sas_target_destroy, | |
137 | .ioctl = sas_ioctl, | |
138 | }; | |
139 | ||
140 | static struct sas_domain_function_template isci_transport_ops = { | |
141 | ||
142 | /* The class calls these to notify the LLDD of an event. */ | |
143 | .lldd_port_formed = isci_port_formed, | |
144 | .lldd_port_deformed = isci_port_deformed, | |
145 | ||
146 | /* The class calls these when a device is found or gone. */ | |
147 | .lldd_dev_found = isci_remote_device_found, | |
148 | .lldd_dev_gone = isci_remote_device_gone, | |
149 | ||
150 | .lldd_execute_task = isci_task_execute_task, | |
151 | /* Task Management Functions. Must be called from process context. */ | |
152 | .lldd_abort_task = isci_task_abort_task, | |
153 | .lldd_abort_task_set = isci_task_abort_task_set, | |
154 | .lldd_clear_aca = isci_task_clear_aca, | |
155 | .lldd_clear_task_set = isci_task_clear_task_set, | |
156 | .lldd_I_T_nexus_reset = isci_task_I_T_nexus_reset, | |
157 | .lldd_lu_reset = isci_task_lu_reset, | |
158 | .lldd_query_task = isci_task_query_task, | |
159 | ||
160 | /* Port and Adapter management */ | |
161 | .lldd_clear_nexus_port = isci_task_clear_nexus_port, | |
162 | .lldd_clear_nexus_ha = isci_task_clear_nexus_ha, | |
163 | ||
164 | /* Phy management */ | |
165 | .lldd_control_phy = isci_phy_control, | |
166 | }; | |
167 | ||
168 | ||
169 | /****************************************************************************** | |
170 | * P R O T E C T E D M E T H O D S | |
171 | ******************************************************************************/ | |
172 | ||
173 | ||
174 | ||
175 | /** | |
176 | * isci_register_sas_ha() - This method initializes various lldd | |
177 | * specific members of the sas_ha struct and calls the libsas | |
178 | * sas_register_ha() function. | |
179 | * @isci_host: This parameter specifies the lldd specific wrapper for the | |
180 | * libsas sas_ha struct. | |
181 | * | |
182 | * This method returns an error code indicating sucess or failure. The user | |
183 | * should check for possible memory allocation error return otherwise, a zero | |
184 | * indicates success. | |
185 | */ | |
186 | static int isci_register_sas_ha(struct isci_host *isci_host) | |
187 | { | |
188 | int i; | |
189 | struct sas_ha_struct *sas_ha = &(isci_host->sas_ha); | |
190 | struct asd_sas_phy **sas_phys; | |
191 | struct asd_sas_port **sas_ports; | |
192 | ||
193 | sas_phys = devm_kzalloc(&isci_host->pdev->dev, | |
194 | SCI_MAX_PHYS * sizeof(void *), | |
195 | GFP_KERNEL); | |
196 | if (!sas_phys) | |
197 | return -ENOMEM; | |
198 | ||
199 | sas_ports = devm_kzalloc(&isci_host->pdev->dev, | |
200 | SCI_MAX_PORTS * sizeof(void *), | |
201 | GFP_KERNEL); | |
202 | if (!sas_ports) | |
203 | return -ENOMEM; | |
204 | ||
205 | /*----------------- Libsas Initialization Stuff---------------------- | |
206 | * Set various fields in the sas_ha struct: | |
207 | */ | |
208 | ||
209 | sas_ha->sas_ha_name = DRV_NAME; | |
210 | sas_ha->lldd_module = THIS_MODULE; | |
150fc6fc | 211 | sas_ha->sas_addr = &isci_host->phys[0].sas_addr[0]; |
6f231dda DW |
212 | |
213 | /* set the array of phy and port structs. */ | |
214 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
215 | sas_phys[i] = &(isci_host->phys[i].sas_phy); | |
216 | sas_ports[i] = &(isci_host->sas_ports[i]); | |
217 | } | |
218 | ||
219 | sas_ha->sas_phy = sas_phys; | |
220 | sas_ha->sas_port = sas_ports; | |
221 | sas_ha->num_phys = SCI_MAX_PHYS; | |
222 | ||
223 | sas_ha->lldd_queue_size = ISCI_CAN_QUEUE_VAL; | |
224 | sas_ha->lldd_max_execute_num = 1; | |
225 | sas_ha->strict_wide_ports = 1; | |
226 | ||
227 | sas_register_ha(sas_ha); | |
228 | ||
229 | return 0; | |
230 | } | |
231 | ||
232 | static void isci_unregister_sas_ha(struct isci_host *isci_host) | |
233 | { | |
234 | if (!isci_host) | |
235 | return; | |
236 | ||
237 | sas_unregister_ha(&(isci_host->sas_ha)); | |
238 | ||
239 | sas_remove_host(isci_host->shost); | |
240 | scsi_remove_host(isci_host->shost); | |
241 | scsi_host_put(isci_host->shost); | |
242 | } | |
243 | ||
244 | static int __devinit isci_pci_init(struct pci_dev *pdev) | |
245 | { | |
246 | int err, bar_num, bar_mask; | |
247 | void __iomem * const *iomap; | |
248 | ||
249 | err = pcim_enable_device(pdev); | |
250 | if (err) { | |
251 | dev_err(&pdev->dev, | |
252 | "failed enable PCI device %s!\n", | |
253 | pci_name(pdev)); | |
254 | return err; | |
255 | } | |
256 | ||
257 | for (bar_num = 0; bar_num < SCI_PCI_BAR_COUNT; bar_num++) | |
258 | bar_mask |= 1 << (bar_num * 2); | |
259 | ||
260 | err = pcim_iomap_regions(pdev, bar_mask, DRV_NAME); | |
261 | if (err) | |
262 | return err; | |
263 | ||
264 | iomap = pcim_iomap_table(pdev); | |
265 | if (!iomap) | |
266 | return -ENOMEM; | |
267 | ||
268 | pci_set_master(pdev); | |
269 | ||
270 | err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); | |
271 | if (err) { | |
272 | err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); | |
273 | if (err) | |
274 | return err; | |
275 | } | |
276 | ||
277 | err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); | |
278 | if (err) { | |
279 | err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); | |
280 | if (err) | |
281 | return err; | |
282 | } | |
283 | ||
284 | return 0; | |
285 | } | |
286 | ||
6f231dda DW |
287 | static int num_controllers(struct pci_dev *pdev) |
288 | { | |
289 | /* bar size alone can tell us if we are running with a dual controller | |
290 | * part, no need to trust revision ids that might be under broken firmware | |
291 | * control | |
292 | */ | |
293 | resource_size_t scu_bar_size = pci_resource_len(pdev, SCI_SCU_BAR*2); | |
294 | resource_size_t smu_bar_size = pci_resource_len(pdev, SCI_SMU_BAR*2); | |
295 | ||
296 | if (scu_bar_size >= SCI_SCU_BAR_SIZE*SCI_MAX_CONTROLLERS && | |
297 | smu_bar_size >= SCI_SMU_BAR_SIZE*SCI_MAX_CONTROLLERS) | |
298 | return SCI_MAX_CONTROLLERS; | |
299 | else | |
300 | return 1; | |
301 | } | |
302 | ||
303 | static int isci_setup_interrupts(struct pci_dev *pdev) | |
304 | { | |
305 | int err, i, num_msix; | |
306 | struct isci_pci_info *pci_info = to_pci_info(pdev); | |
307 | ||
308 | /* | |
309 | * Determine the number of vectors associated with this | |
310 | * PCI function. | |
311 | */ | |
312 | num_msix = num_controllers(pdev) * SCI_NUM_MSI_X_INT; | |
313 | ||
314 | for (i = 0; i < num_msix; i++) | |
315 | pci_info->msix_entries[i].entry = i; | |
316 | ||
317 | err = pci_enable_msix(pdev, pci_info->msix_entries, num_msix); | |
318 | if (err) | |
319 | goto intx; | |
320 | ||
321 | for (i = 0; i < num_msix; i++) { | |
322 | int id = i / SCI_NUM_MSI_X_INT; | |
323 | struct msix_entry *msix = &pci_info->msix_entries[i]; | |
b329aff1 | 324 | struct isci_host *isci_host = pci_info->hosts[id]; |
92f4f0f5 DW |
325 | irq_handler_t isr; |
326 | ||
327 | /* odd numbered vectors are error interrupts */ | |
328 | if (i & 1) | |
329 | isr = isci_error_isr; | |
330 | else | |
331 | isr = isci_msix_isr; | |
6f231dda DW |
332 | |
333 | BUG_ON(!isci_host); | |
334 | ||
92f4f0f5 | 335 | err = devm_request_irq(&pdev->dev, msix->vector, isr, 0, |
6f231dda DW |
336 | DRV_NAME"-msix", isci_host); |
337 | if (!err) | |
338 | continue; | |
339 | ||
340 | dev_info(&pdev->dev, "msix setup failed falling back to intx\n"); | |
341 | while (i--) { | |
342 | id = i / SCI_NUM_MSI_X_INT; | |
b329aff1 | 343 | isci_host = pci_info->hosts[id]; |
6f231dda DW |
344 | msix = &pci_info->msix_entries[i]; |
345 | devm_free_irq(&pdev->dev, msix->vector, isci_host); | |
346 | } | |
347 | pci_disable_msix(pdev); | |
348 | goto intx; | |
349 | } | |
350 | ||
351 | return 0; | |
352 | ||
353 | intx: | |
c7ef4031 | 354 | err = devm_request_irq(&pdev->dev, pdev->irq, isci_intx_isr, |
6f231dda DW |
355 | IRQF_SHARED, DRV_NAME"-intx", pdev); |
356 | ||
357 | return err; | |
358 | } | |
359 | ||
360 | /** | |
361 | * isci_parse_oem_parameters() - This method will take OEM parameters | |
362 | * from the module init parameters and copy them to oem_params. This will | |
363 | * only copy values that are not set to the module parameter default values | |
364 | * @oem_parameters: This parameter specifies the controller default OEM | |
365 | * parameters. It is expected that this has been initialized to the default | |
366 | * parameters for the controller | |
367 | * | |
368 | * | |
369 | */ | |
370 | enum sci_status isci_parse_oem_parameters(union scic_oem_parameters *oem_params, | |
371 | int scu_index, | |
372 | struct isci_firmware *fw) | |
373 | { | |
374 | int i; | |
375 | ||
376 | /* check for valid inputs */ | |
377 | if (!(scu_index >= 0 | |
378 | && scu_index < SCI_MAX_CONTROLLERS | |
379 | && oem_params != NULL)) { | |
380 | return SCI_FAILURE; | |
381 | } | |
382 | ||
383 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
384 | int array_idx = i + (SCI_MAX_PHYS * scu_index); | |
385 | u64 sas_addr = fw->sas_addrs[array_idx]; | |
386 | ||
387 | if (sas_addr != 0) { | |
388 | oem_params->sds1.phys[i].sas_address.low = | |
389 | (u32)(sas_addr & 0xffffffff); | |
390 | oem_params->sds1.phys[i].sas_address.high = | |
391 | (u32)((sas_addr >> 32) & 0xffffffff); | |
392 | } | |
393 | } | |
394 | ||
395 | for (i = 0; i < SCI_MAX_PORTS; i++) { | |
396 | int array_idx = i + (SCI_MAX_PORTS * scu_index); | |
397 | u32 pmask = fw->phy_masks[array_idx]; | |
398 | ||
399 | oem_params->sds1.ports[i].phy_mask = pmask; | |
400 | } | |
401 | ||
402 | return SCI_SUCCESS; | |
403 | } | |
404 | ||
405 | /** | |
406 | * isci_parse_user_parameters() - This method will take user parameters | |
407 | * from the module init parameters and copy them to user_params. This will | |
408 | * only copy values that are not set to the module parameter default values | |
409 | * @user_parameters: This parameter specifies the controller default user | |
410 | * parameters. It is expected that this has been initialized to the default | |
411 | * parameters for the controller | |
412 | * | |
413 | * | |
414 | */ | |
415 | enum sci_status isci_parse_user_parameters( | |
416 | union scic_user_parameters *user_params, | |
417 | int scu_index, | |
418 | struct isci_firmware *fw) | |
419 | { | |
420 | int i; | |
421 | ||
422 | if (!(scu_index >= 0 | |
423 | && scu_index < SCI_MAX_CONTROLLERS | |
424 | && user_params != NULL)) { | |
425 | return SCI_FAILURE; | |
426 | } | |
427 | ||
428 | for (i = 0; i < SCI_MAX_PORTS; i++) { | |
429 | int array_idx = i + (SCI_MAX_PORTS * scu_index); | |
430 | u32 gen = fw->phy_gens[array_idx]; | |
431 | ||
432 | user_params->sds1.phys[i].max_speed_generation = gen; | |
433 | ||
434 | } | |
435 | ||
436 | return SCI_SUCCESS; | |
437 | } | |
438 | ||
439 | static struct isci_host *isci_host_alloc(struct pci_dev *pdev, int id) | |
440 | { | |
441 | struct isci_host *isci_host; | |
442 | struct Scsi_Host *shost; | |
443 | int err; | |
444 | ||
d9c37390 DW |
445 | isci_host = devm_kzalloc(&pdev->dev, sizeof(*isci_host) + |
446 | SCI_MAX_REMOTE_DEVICES * | |
447 | (sizeof(struct isci_remote_device) + | |
448 | scic_remote_device_get_object_size()), GFP_KERNEL); | |
6f231dda DW |
449 | if (!isci_host) |
450 | return NULL; | |
451 | ||
452 | isci_host->pdev = pdev; | |
453 | isci_host->id = id; | |
454 | ||
455 | shost = scsi_host_alloc(&isci_sht, sizeof(void *)); | |
456 | if (!shost) | |
457 | return NULL; | |
458 | isci_host->shost = shost; | |
459 | ||
460 | err = isci_host_init(isci_host); | |
461 | if (err) | |
462 | goto err_shost; | |
463 | ||
464 | SHOST_TO_SAS_HA(shost) = &isci_host->sas_ha; | |
465 | isci_host->sas_ha.core.shost = shost; | |
466 | shost->transportt = isci_transport_template; | |
467 | ||
468 | shost->max_id = ~0; | |
469 | shost->max_lun = ~0; | |
470 | shost->max_cmd_len = MAX_COMMAND_SIZE; | |
471 | ||
472 | err = scsi_add_host(shost, &pdev->dev); | |
473 | if (err) | |
474 | goto err_shost; | |
475 | ||
476 | err = isci_register_sas_ha(isci_host); | |
477 | if (err) | |
478 | goto err_shost_remove; | |
479 | ||
480 | return isci_host; | |
481 | ||
482 | err_shost_remove: | |
483 | scsi_remove_host(shost); | |
484 | err_shost: | |
485 | scsi_host_put(shost); | |
486 | ||
487 | return NULL; | |
488 | } | |
489 | ||
490 | static void check_si_rev(struct pci_dev *pdev) | |
491 | { | |
492 | if (num_controllers(pdev) > 1) | |
493 | isci_si_rev = ISCI_SI_REVB0; | |
494 | else { | |
495 | switch (pdev->revision) { | |
496 | case 0: | |
497 | case 1: | |
498 | /* if the id is ambiguous don't update isci_si_rev */ | |
499 | break; | |
500 | case 3: | |
501 | isci_si_rev = ISCI_SI_REVA2; | |
502 | break; | |
503 | default: | |
504 | case 4: | |
505 | isci_si_rev = ISCI_SI_REVB0; | |
506 | break; | |
507 | } | |
508 | } | |
509 | ||
510 | dev_info(&pdev->dev, "driver configured for %s silicon (rev: %d)\n", | |
511 | isci_si_rev == ISCI_SI_REVA0 ? "A0" : | |
512 | isci_si_rev == ISCI_SI_REVA2 ? "A2" : "B0", pdev->revision); | |
513 | ||
514 | } | |
515 | ||
858d4aa7 DJ |
516 | static int isci_verify_firmware(const struct firmware *fw, |
517 | struct isci_firmware *isci_fw) | |
518 | { | |
519 | const u8 *tmp; | |
520 | ||
521 | if (fw->size < ISCI_FIRMWARE_MIN_SIZE) | |
522 | return -EINVAL; | |
523 | ||
524 | tmp = fw->data; | |
525 | ||
526 | /* 12th char should be the NULL terminate for the ID string */ | |
527 | if (tmp[11] != '\0') | |
528 | return -EINVAL; | |
529 | ||
530 | if (strncmp("#SCU MAGIC#", tmp, 11) != 0) | |
531 | return -EINVAL; | |
532 | ||
533 | isci_fw->id = tmp; | |
534 | isci_fw->version = fw->data[ISCI_FW_VER_OFS]; | |
535 | isci_fw->subversion = fw->data[ISCI_FW_SUBVER_OFS]; | |
536 | ||
537 | tmp = fw->data + ISCI_FW_DATA_OFS; | |
538 | ||
539 | while (*tmp != ISCI_FW_HDR_EOF) { | |
540 | switch (*tmp) { | |
541 | case ISCI_FW_HDR_PHYMASK: | |
542 | tmp++; | |
543 | isci_fw->phy_masks_size = *tmp; | |
544 | tmp++; | |
545 | isci_fw->phy_masks = (const u32 *)tmp; | |
546 | tmp += sizeof(u32) * isci_fw->phy_masks_size; | |
547 | break; | |
548 | ||
549 | case ISCI_FW_HDR_PHYGEN: | |
550 | tmp++; | |
551 | isci_fw->phy_gens_size = *tmp; | |
552 | tmp++; | |
553 | isci_fw->phy_gens = (const u32 *)tmp; | |
554 | tmp += sizeof(u32) * isci_fw->phy_gens_size; | |
555 | break; | |
556 | ||
557 | case ISCI_FW_HDR_SASADDR: | |
558 | tmp++; | |
559 | isci_fw->sas_addrs_size = *tmp; | |
560 | tmp++; | |
561 | isci_fw->sas_addrs = (const u64 *)tmp; | |
562 | tmp += sizeof(u64) * isci_fw->sas_addrs_size; | |
563 | break; | |
564 | ||
565 | default: | |
566 | pr_err("bad field in firmware binary blob\n"); | |
567 | return -EINVAL; | |
568 | } | |
569 | } | |
570 | ||
571 | pr_info("isci firmware v%u.%u loaded.\n", | |
572 | isci_fw->version, isci_fw->subversion); | |
573 | ||
574 | return SCI_SUCCESS; | |
575 | } | |
576 | ||
6f231dda DW |
577 | static int __devinit isci_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) |
578 | { | |
579 | struct isci_pci_info *pci_info; | |
580 | int err, i; | |
581 | struct isci_host *isci_host; | |
858d4aa7 | 582 | const struct firmware *fw = NULL; |
6f231dda DW |
583 | |
584 | check_si_rev(pdev); | |
585 | ||
586 | pci_info = devm_kzalloc(&pdev->dev, sizeof(*pci_info), GFP_KERNEL); | |
587 | if (!pci_info) | |
588 | return -ENOMEM; | |
589 | pci_set_drvdata(pdev, pci_info); | |
590 | ||
858d4aa7 DJ |
591 | err = request_firmware(&fw, ISCI_FW_NAME, &pdev->dev); |
592 | if (err) { | |
593 | dev_warn(&pdev->dev, | |
594 | "Loading firmware failed, using default values\n"); | |
595 | dev_warn(&pdev->dev, | |
596 | "Default OEM configuration being used:" | |
597 | " 4 narrow ports, and default SAS Addresses\n"); | |
598 | } else { | |
599 | isci_firmware = devm_kzalloc(&pdev->dev, | |
600 | sizeof(struct isci_firmware), | |
601 | GFP_KERNEL); | |
602 | if (isci_firmware) { | |
603 | err = isci_verify_firmware(fw, isci_firmware); | |
604 | if (err != SCI_SUCCESS) { | |
605 | dev_warn(&pdev->dev, | |
606 | "firmware verification failed\n"); | |
607 | dev_warn(&pdev->dev, | |
608 | "Default OEM configuration being used:" | |
609 | " 4 narrow ports, and default SAS " | |
610 | "Addresses\n"); | |
611 | devm_kfree(&pdev->dev, isci_firmware); | |
612 | isci_firmware = NULL; | |
613 | } | |
614 | } | |
615 | release_firmware(fw); | |
616 | } | |
617 | ||
6f231dda DW |
618 | err = isci_pci_init(pdev); |
619 | if (err) | |
620 | return err; | |
621 | ||
622 | for (i = 0; i < num_controllers(pdev); i++) { | |
623 | struct isci_host *h = isci_host_alloc(pdev, i); | |
624 | ||
625 | if (!h) { | |
626 | err = -ENOMEM; | |
627 | goto err_host_alloc; | |
628 | } | |
b329aff1 | 629 | pci_info->hosts[i] = h; |
6f231dda DW |
630 | } |
631 | ||
632 | err = isci_setup_interrupts(pdev); | |
633 | if (err) | |
634 | goto err_host_alloc; | |
635 | ||
b329aff1 | 636 | for_each_isci_host(i, isci_host, pdev) |
6f231dda DW |
637 | scsi_scan_host(isci_host->shost); |
638 | ||
639 | return 0; | |
640 | ||
641 | err_host_alloc: | |
b329aff1 | 642 | for_each_isci_host(i, isci_host, pdev) |
6f231dda DW |
643 | isci_unregister_sas_ha(isci_host); |
644 | return err; | |
645 | } | |
646 | ||
647 | static void __devexit isci_pci_remove(struct pci_dev *pdev) | |
648 | { | |
649 | struct isci_host *isci_host; | |
b329aff1 | 650 | int i; |
6f231dda | 651 | |
b329aff1 | 652 | for_each_isci_host(i, isci_host, pdev) { |
6f231dda DW |
653 | isci_unregister_sas_ha(isci_host); |
654 | isci_host_deinit(isci_host); | |
655 | scic_controller_disable_interrupts(isci_host->core_controller); | |
656 | } | |
657 | } | |
658 | ||
659 | static __init int isci_init(void) | |
660 | { | |
d9c37390 | 661 | int err; |
6f231dda DW |
662 | |
663 | pr_info("%s: Intel(R) C600 SAS Controller Driver\n", DRV_NAME); | |
664 | ||
6f231dda DW |
665 | isci_transport_template = sas_domain_attach_transport(&isci_transport_ops); |
666 | if (!isci_transport_template) | |
d9c37390 | 667 | return -ENOMEM; |
6f231dda DW |
668 | |
669 | err = pci_register_driver(&isci_pci_driver); | |
670 | if (err) | |
d9c37390 | 671 | sas_release_transport(isci_transport_template); |
6f231dda DW |
672 | |
673 | return err; | |
674 | } | |
675 | ||
676 | static __exit void isci_exit(void) | |
677 | { | |
678 | pci_unregister_driver(&isci_pci_driver); | |
679 | sas_release_transport(isci_transport_template); | |
6f231dda DW |
680 | } |
681 | ||
682 | MODULE_LICENSE("Dual BSD/GPL"); | |
683 | MODULE_FIRMWARE(ISCI_FW_NAME); | |
684 | module_init(isci_init); | |
685 | module_exit(isci_exit); |