1 /* 2 * PMC-Sierra SPC 8001 SAS/SATA based host adapters driver 3 * 4 * Copyright (c) 2008-2009 USI Co., Ltd. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions, and the following disclaimer, 12 * without modification. 13 * 2. Redistributions in binary form must reproduce at minimum a disclaimer 14 * substantially similar to the "NO WARRANTY" disclaimer below 15 * ("Disclaimer") and any redistribution must be conditioned upon 16 * including a substantially similar Disclaimer requirement for further 17 * binary redistribution. 18 * 3. Neither the names of the above-listed copyright holders nor the names 19 * of any contributors may be used to endorse or promote products derived 20 * from this software without specific prior written permission. 21 * 22 * Alternatively, this software may be distributed under the terms of the 23 * GNU General Public License ("GPL") version 2 as published by the Free 24 * Software Foundation. 25 * 26 * NO WARRANTY 27 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 28 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 29 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR 30 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 31 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 32 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 33 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 34 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 35 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING 36 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 37 * POSSIBILITY OF SUCH DAMAGES. 38 * 39 */ 40 41 #include <linux/slab.h> 42 #include "pm8001_sas.h" 43 #include "pm8001_chips.h" 44 45 static struct scsi_transport_template *pm8001_stt; 46 47 static const struct pm8001_chip_info pm8001_chips[] = { 48 [chip_8001] = { 8, &pm8001_8001_dispatch,}, 49 }; 50 static int pm8001_id; 51 52 LIST_HEAD(hba_list); 53 54 struct workqueue_struct *pm8001_wq; 55 56 /** 57 * The main structure which LLDD must register for scsi core. 58 */ 59 static struct scsi_host_template pm8001_sht = { 60 .module = THIS_MODULE, 61 .name = DRV_NAME, 62 .queuecommand = sas_queuecommand, 63 .target_alloc = sas_target_alloc, 64 .slave_configure = pm8001_slave_configure, 65 .slave_destroy = sas_slave_destroy, 66 .scan_finished = pm8001_scan_finished, 67 .scan_start = pm8001_scan_start, 68 .change_queue_depth = sas_change_queue_depth, 69 .change_queue_type = sas_change_queue_type, 70 .bios_param = sas_bios_param, 71 .can_queue = 1, 72 .cmd_per_lun = 1, 73 .this_id = -1, 74 .sg_tablesize = SG_ALL, 75 .max_sectors = SCSI_DEFAULT_MAX_SECTORS, 76 .use_clustering = ENABLE_CLUSTERING, 77 .eh_device_reset_handler = sas_eh_device_reset_handler, 78 .eh_bus_reset_handler = sas_eh_bus_reset_handler, 79 .slave_alloc = pm8001_slave_alloc, 80 .target_destroy = sas_target_destroy, 81 .ioctl = sas_ioctl, 82 .shost_attrs = pm8001_host_attrs, 83 }; 84 85 /** 86 * Sas layer call this function to execute specific task. 87 */ 88 static struct sas_domain_function_template pm8001_transport_ops = { 89 .lldd_dev_found = pm8001_dev_found, 90 .lldd_dev_gone = pm8001_dev_gone, 91 92 .lldd_execute_task = pm8001_queue_command, 93 .lldd_control_phy = pm8001_phy_control, 94 95 .lldd_abort_task = pm8001_abort_task, 96 .lldd_abort_task_set = pm8001_abort_task_set, 97 .lldd_clear_aca = pm8001_clear_aca, 98 .lldd_clear_task_set = pm8001_clear_task_set, 99 .lldd_I_T_nexus_reset = pm8001_I_T_nexus_reset, 100 .lldd_lu_reset = pm8001_lu_reset, 101 .lldd_query_task = pm8001_query_task, 102 }; 103 104 /** 105 *pm8001_phy_init - initiate our adapter phys 106 *@pm8001_ha: our hba structure. 107 *@phy_id: phy id. 108 */ 109 static void __devinit pm8001_phy_init(struct pm8001_hba_info *pm8001_ha, 110 int phy_id) 111 { 112 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id]; 113 struct asd_sas_phy *sas_phy = &phy->sas_phy; 114 phy->phy_state = 0; 115 phy->pm8001_ha = pm8001_ha; 116 sas_phy->enabled = (phy_id < pm8001_ha->chip->n_phy) ? 1 : 0; 117 sas_phy->class = SAS; 118 sas_phy->iproto = SAS_PROTOCOL_ALL; 119 sas_phy->tproto = 0; 120 sas_phy->type = PHY_TYPE_PHYSICAL; 121 sas_phy->role = PHY_ROLE_INITIATOR; 122 sas_phy->oob_mode = OOB_NOT_CONNECTED; 123 sas_phy->linkrate = SAS_LINK_RATE_UNKNOWN; 124 sas_phy->id = phy_id; 125 sas_phy->sas_addr = &pm8001_ha->sas_addr[0]; 126 sas_phy->frame_rcvd = &phy->frame_rcvd[0]; 127 sas_phy->ha = (struct sas_ha_struct *)pm8001_ha->shost->hostdata; 128 sas_phy->lldd_phy = phy; 129 } 130 131 /** 132 *pm8001_free - free hba 133 *@pm8001_ha: our hba structure. 134 * 135 */ 136 static void pm8001_free(struct pm8001_hba_info *pm8001_ha) 137 { 138 int i; 139 140 if (!pm8001_ha) 141 return; 142 143 for (i = 0; i < USI_MAX_MEMCNT; i++) { 144 if (pm8001_ha->memoryMap.region[i].virt_ptr != NULL) { 145 pci_free_consistent(pm8001_ha->pdev, 146 pm8001_ha->memoryMap.region[i].element_size, 147 pm8001_ha->memoryMap.region[i].virt_ptr, 148 pm8001_ha->memoryMap.region[i].phys_addr); 149 } 150 } 151 PM8001_CHIP_DISP->chip_iounmap(pm8001_ha); 152 if (pm8001_ha->shost) 153 scsi_host_put(pm8001_ha->shost); 154 flush_workqueue(pm8001_wq); 155 kfree(pm8001_ha->tags); 156 kfree(pm8001_ha); 157 } 158 159 #ifdef PM8001_USE_TASKLET 160 static void pm8001_tasklet(unsigned long opaque) 161 { 162 struct pm8001_hba_info *pm8001_ha; 163 pm8001_ha = (struct pm8001_hba_info *)opaque;; 164 if (unlikely(!pm8001_ha)) 165 BUG_ON(1); 166 PM8001_CHIP_DISP->isr(pm8001_ha); 167 } 168 #endif 169 170 171 /** 172 * pm8001_interrupt - when HBA originate a interrupt,we should invoke this 173 * dispatcher to handle each case. 174 * @irq: irq number. 175 * @opaque: the passed general host adapter struct 176 */ 177 static irqreturn_t pm8001_interrupt(int irq, void *opaque) 178 { 179 struct pm8001_hba_info *pm8001_ha; 180 irqreturn_t ret = IRQ_HANDLED; 181 struct sas_ha_struct *sha = opaque; 182 pm8001_ha = sha->lldd_ha; 183 if (unlikely(!pm8001_ha)) 184 return IRQ_NONE; 185 if (!PM8001_CHIP_DISP->is_our_interupt(pm8001_ha)) 186 return IRQ_NONE; 187 #ifdef PM8001_USE_TASKLET 188 tasklet_schedule(&pm8001_ha->tasklet); 189 #else 190 ret = PM8001_CHIP_DISP->isr(pm8001_ha); 191 #endif 192 return ret; 193 } 194 195 /** 196 * pm8001_alloc - initiate our hba structure and 6 DMAs area. 197 * @pm8001_ha:our hba structure. 198 * 199 */ 200 static int __devinit pm8001_alloc(struct pm8001_hba_info *pm8001_ha) 201 { 202 int i; 203 spin_lock_init(&pm8001_ha->lock); 204 for (i = 0; i < pm8001_ha->chip->n_phy; i++) { 205 pm8001_phy_init(pm8001_ha, i); 206 pm8001_ha->port[i].wide_port_phymap = 0; 207 pm8001_ha->port[i].port_attached = 0; 208 pm8001_ha->port[i].port_state = 0; 209 INIT_LIST_HEAD(&pm8001_ha->port[i].list); 210 } 211 212 pm8001_ha->tags = kzalloc(PM8001_MAX_CCB, GFP_KERNEL); 213 if (!pm8001_ha->tags) 214 goto err_out; 215 /* MPI Memory region 1 for AAP Event Log for fw */ 216 pm8001_ha->memoryMap.region[AAP1].num_elements = 1; 217 pm8001_ha->memoryMap.region[AAP1].element_size = PM8001_EVENT_LOG_SIZE; 218 pm8001_ha->memoryMap.region[AAP1].total_len = PM8001_EVENT_LOG_SIZE; 219 pm8001_ha->memoryMap.region[AAP1].alignment = 32; 220 221 /* MPI Memory region 2 for IOP Event Log for fw */ 222 pm8001_ha->memoryMap.region[IOP].num_elements = 1; 223 pm8001_ha->memoryMap.region[IOP].element_size = PM8001_EVENT_LOG_SIZE; 224 pm8001_ha->memoryMap.region[IOP].total_len = PM8001_EVENT_LOG_SIZE; 225 pm8001_ha->memoryMap.region[IOP].alignment = 32; 226 227 /* MPI Memory region 3 for consumer Index of inbound queues */ 228 pm8001_ha->memoryMap.region[CI].num_elements = 1; 229 pm8001_ha->memoryMap.region[CI].element_size = 4; 230 pm8001_ha->memoryMap.region[CI].total_len = 4; 231 pm8001_ha->memoryMap.region[CI].alignment = 4; 232 233 /* MPI Memory region 4 for producer Index of outbound queues */ 234 pm8001_ha->memoryMap.region[PI].num_elements = 1; 235 pm8001_ha->memoryMap.region[PI].element_size = 4; 236 pm8001_ha->memoryMap.region[PI].total_len = 4; 237 pm8001_ha->memoryMap.region[PI].alignment = 4; 238 239 /* MPI Memory region 5 inbound queues */ 240 pm8001_ha->memoryMap.region[IB].num_elements = 256; 241 pm8001_ha->memoryMap.region[IB].element_size = 64; 242 pm8001_ha->memoryMap.region[IB].total_len = 256 * 64; 243 pm8001_ha->memoryMap.region[IB].alignment = 64; 244 245 /* MPI Memory region 6 inbound queues */ 246 pm8001_ha->memoryMap.region[OB].num_elements = 256; 247 pm8001_ha->memoryMap.region[OB].element_size = 64; 248 pm8001_ha->memoryMap.region[OB].total_len = 256 * 64; 249 pm8001_ha->memoryMap.region[OB].alignment = 64; 250 251 /* Memory region write DMA*/ 252 pm8001_ha->memoryMap.region[NVMD].num_elements = 1; 253 pm8001_ha->memoryMap.region[NVMD].element_size = 4096; 254 pm8001_ha->memoryMap.region[NVMD].total_len = 4096; 255 /* Memory region for devices*/ 256 pm8001_ha->memoryMap.region[DEV_MEM].num_elements = 1; 257 pm8001_ha->memoryMap.region[DEV_MEM].element_size = PM8001_MAX_DEVICES * 258 sizeof(struct pm8001_device); 259 pm8001_ha->memoryMap.region[DEV_MEM].total_len = PM8001_MAX_DEVICES * 260 sizeof(struct pm8001_device); 261 262 /* Memory region for ccb_info*/ 263 pm8001_ha->memoryMap.region[CCB_MEM].num_elements = 1; 264 pm8001_ha->memoryMap.region[CCB_MEM].element_size = PM8001_MAX_CCB * 265 sizeof(struct pm8001_ccb_info); 266 pm8001_ha->memoryMap.region[CCB_MEM].total_len = PM8001_MAX_CCB * 267 sizeof(struct pm8001_ccb_info); 268 269 for (i = 0; i < USI_MAX_MEMCNT; i++) { 270 if (pm8001_mem_alloc(pm8001_ha->pdev, 271 &pm8001_ha->memoryMap.region[i].virt_ptr, 272 &pm8001_ha->memoryMap.region[i].phys_addr, 273 &pm8001_ha->memoryMap.region[i].phys_addr_hi, 274 &pm8001_ha->memoryMap.region[i].phys_addr_lo, 275 pm8001_ha->memoryMap.region[i].total_len, 276 pm8001_ha->memoryMap.region[i].alignment) != 0) { 277 PM8001_FAIL_DBG(pm8001_ha, 278 pm8001_printk("Mem%d alloc failed\n", 279 i)); 280 goto err_out; 281 } 282 } 283 284 pm8001_ha->devices = pm8001_ha->memoryMap.region[DEV_MEM].virt_ptr; 285 for (i = 0; i < PM8001_MAX_DEVICES; i++) { 286 pm8001_ha->devices[i].dev_type = NO_DEVICE; 287 pm8001_ha->devices[i].id = i; 288 pm8001_ha->devices[i].device_id = PM8001_MAX_DEVICES; 289 pm8001_ha->devices[i].running_req = 0; 290 } 291 pm8001_ha->ccb_info = pm8001_ha->memoryMap.region[CCB_MEM].virt_ptr; 292 for (i = 0; i < PM8001_MAX_CCB; i++) { 293 pm8001_ha->ccb_info[i].ccb_dma_handle = 294 pm8001_ha->memoryMap.region[CCB_MEM].phys_addr + 295 i * sizeof(struct pm8001_ccb_info); 296 pm8001_ha->ccb_info[i].task = NULL; 297 pm8001_ha->ccb_info[i].ccb_tag = 0xffffffff; 298 pm8001_ha->ccb_info[i].device = NULL; 299 ++pm8001_ha->tags_num; 300 } 301 pm8001_ha->flags = PM8001F_INIT_TIME; 302 /* Initialize tags */ 303 pm8001_tag_init(pm8001_ha); 304 return 0; 305 err_out: 306 return 1; 307 } 308 309 /** 310 * pm8001_ioremap - remap the pci high physical address to kernal virtual 311 * address so that we can access them. 312 * @pm8001_ha:our hba structure. 313 */ 314 static int pm8001_ioremap(struct pm8001_hba_info *pm8001_ha) 315 { 316 u32 bar; 317 u32 logicalBar = 0; 318 struct pci_dev *pdev; 319 320 pdev = pm8001_ha->pdev; 321 /* map pci mem (PMC pci base 0-3)*/ 322 for (bar = 0; bar < 6; bar++) { 323 /* 324 ** logical BARs for SPC: 325 ** bar 0 and 1 - logical BAR0 326 ** bar 2 and 3 - logical BAR1 327 ** bar4 - logical BAR2 328 ** bar5 - logical BAR3 329 ** Skip the appropriate assignments: 330 */ 331 if ((bar == 1) || (bar == 3)) 332 continue; 333 if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) { 334 pm8001_ha->io_mem[logicalBar].membase = 335 pci_resource_start(pdev, bar); 336 pm8001_ha->io_mem[logicalBar].membase &= 337 (u32)PCI_BASE_ADDRESS_MEM_MASK; 338 pm8001_ha->io_mem[logicalBar].memsize = 339 pci_resource_len(pdev, bar); 340 pm8001_ha->io_mem[logicalBar].memvirtaddr = 341 ioremap(pm8001_ha->io_mem[logicalBar].membase, 342 pm8001_ha->io_mem[logicalBar].memsize); 343 PM8001_INIT_DBG(pm8001_ha, 344 pm8001_printk("PCI: bar %d, logicalBar %d " 345 "virt_addr=%lx,len=%d\n", bar, logicalBar, 346 (unsigned long) 347 pm8001_ha->io_mem[logicalBar].memvirtaddr, 348 pm8001_ha->io_mem[logicalBar].memsize)); 349 } else { 350 pm8001_ha->io_mem[logicalBar].membase = 0; 351 pm8001_ha->io_mem[logicalBar].memsize = 0; 352 pm8001_ha->io_mem[logicalBar].memvirtaddr = 0; 353 } 354 logicalBar++; 355 } 356 return 0; 357 } 358 359 /** 360 * pm8001_pci_alloc - initialize our ha card structure 361 * @pdev: pci device. 362 * @ent: ent 363 * @shost: scsi host struct which has been initialized before. 364 */ 365 static struct pm8001_hba_info *__devinit 366 pm8001_pci_alloc(struct pci_dev *pdev, u32 chip_id, struct Scsi_Host *shost) 367 { 368 struct pm8001_hba_info *pm8001_ha; 369 struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost); 370 371 372 pm8001_ha = sha->lldd_ha; 373 if (!pm8001_ha) 374 return NULL; 375 376 pm8001_ha->pdev = pdev; 377 pm8001_ha->dev = &pdev->dev; 378 pm8001_ha->chip_id = chip_id; 379 pm8001_ha->chip = &pm8001_chips[pm8001_ha->chip_id]; 380 pm8001_ha->irq = pdev->irq; 381 pm8001_ha->sas = sha; 382 pm8001_ha->shost = shost; 383 pm8001_ha->id = pm8001_id++; 384 pm8001_ha->logging_level = 0x01; 385 sprintf(pm8001_ha->name, "%s%d", DRV_NAME, pm8001_ha->id); 386 #ifdef PM8001_USE_TASKLET 387 tasklet_init(&pm8001_ha->tasklet, pm8001_tasklet, 388 (unsigned long)pm8001_ha); 389 #endif 390 pm8001_ioremap(pm8001_ha); 391 if (!pm8001_alloc(pm8001_ha)) 392 return pm8001_ha; 393 pm8001_free(pm8001_ha); 394 return NULL; 395 } 396 397 /** 398 * pci_go_44 - pm8001 specified, its DMA is 44 bit rather than 64 bit 399 * @pdev: pci device. 400 */ 401 static int pci_go_44(struct pci_dev *pdev) 402 { 403 int rc; 404 405 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(44))) { 406 rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(44)); 407 if (rc) { 408 rc = pci_set_consistent_dma_mask(pdev, 409 DMA_BIT_MASK(32)); 410 if (rc) { 411 dev_printk(KERN_ERR, &pdev->dev, 412 "44-bit DMA enable failed\n"); 413 return rc; 414 } 415 } 416 } else { 417 rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 418 if (rc) { 419 dev_printk(KERN_ERR, &pdev->dev, 420 "32-bit DMA enable failed\n"); 421 return rc; 422 } 423 rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); 424 if (rc) { 425 dev_printk(KERN_ERR, &pdev->dev, 426 "32-bit consistent DMA enable failed\n"); 427 return rc; 428 } 429 } 430 return rc; 431 } 432 433 /** 434 * pm8001_prep_sas_ha_init - allocate memory in general hba struct && init them. 435 * @shost: scsi host which has been allocated outside. 436 * @chip_info: our ha struct. 437 */ 438 static int __devinit pm8001_prep_sas_ha_init(struct Scsi_Host * shost, 439 const struct pm8001_chip_info *chip_info) 440 { 441 int phy_nr, port_nr; 442 struct asd_sas_phy **arr_phy; 443 struct asd_sas_port **arr_port; 444 struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost); 445 446 phy_nr = chip_info->n_phy; 447 port_nr = phy_nr; 448 memset(sha, 0x00, sizeof(*sha)); 449 arr_phy = kcalloc(phy_nr, sizeof(void *), GFP_KERNEL); 450 if (!arr_phy) 451 goto exit; 452 arr_port = kcalloc(port_nr, sizeof(void *), GFP_KERNEL); 453 if (!arr_port) 454 goto exit_free2; 455 456 sha->sas_phy = arr_phy; 457 sha->sas_port = arr_port; 458 sha->lldd_ha = kzalloc(sizeof(struct pm8001_hba_info), GFP_KERNEL); 459 if (!sha->lldd_ha) 460 goto exit_free1; 461 462 shost->transportt = pm8001_stt; 463 shost->max_id = PM8001_MAX_DEVICES; 464 shost->max_lun = 8; 465 shost->max_channel = 0; 466 shost->unique_id = pm8001_id; 467 shost->max_cmd_len = 16; 468 shost->can_queue = PM8001_CAN_QUEUE; 469 shost->cmd_per_lun = 32; 470 return 0; 471 exit_free1: 472 kfree(arr_port); 473 exit_free2: 474 kfree(arr_phy); 475 exit: 476 return -1; 477 } 478 479 /** 480 * pm8001_post_sas_ha_init - initialize general hba struct defined in libsas 481 * @shost: scsi host which has been allocated outside 482 * @chip_info: our ha struct. 483 */ 484 static void __devinit pm8001_post_sas_ha_init(struct Scsi_Host *shost, 485 const struct pm8001_chip_info *chip_info) 486 { 487 int i = 0; 488 struct pm8001_hba_info *pm8001_ha; 489 struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost); 490 491 pm8001_ha = sha->lldd_ha; 492 for (i = 0; i < chip_info->n_phy; i++) { 493 sha->sas_phy[i] = &pm8001_ha->phy[i].sas_phy; 494 sha->sas_port[i] = &pm8001_ha->port[i].sas_port; 495 } 496 sha->sas_ha_name = DRV_NAME; 497 sha->dev = pm8001_ha->dev; 498 499 sha->lldd_module = THIS_MODULE; 500 sha->sas_addr = &pm8001_ha->sas_addr[0]; 501 sha->num_phys = chip_info->n_phy; 502 sha->lldd_max_execute_num = 1; 503 sha->lldd_queue_size = PM8001_CAN_QUEUE; 504 sha->core.shost = shost; 505 } 506 507 /** 508 * pm8001_init_sas_add - initialize sas address 509 * @chip_info: our ha struct. 510 * 511 * Currently we just set the fixed SAS address to our HBA,for manufacture, 512 * it should read from the EEPROM 513 */ 514 static void pm8001_init_sas_add(struct pm8001_hba_info *pm8001_ha) 515 { 516 u8 i; 517 #ifdef PM8001_READ_VPD 518 DECLARE_COMPLETION_ONSTACK(completion); 519 struct pm8001_ioctl_payload payload; 520 pm8001_ha->nvmd_completion = &completion; 521 payload.minor_function = 0; 522 payload.length = 128; 523 payload.func_specific = kzalloc(128, GFP_KERNEL); 524 PM8001_CHIP_DISP->get_nvmd_req(pm8001_ha, &payload); 525 wait_for_completion(&completion); 526 for (i = 0; i < pm8001_ha->chip->n_phy; i++) { 527 memcpy(&pm8001_ha->phy[i].dev_sas_addr, pm8001_ha->sas_addr, 528 SAS_ADDR_SIZE); 529 PM8001_INIT_DBG(pm8001_ha, 530 pm8001_printk("phy %d sas_addr = %016llx \n", i, 531 pm8001_ha->phy[i].dev_sas_addr)); 532 } 533 #else 534 for (i = 0; i < pm8001_ha->chip->n_phy; i++) { 535 pm8001_ha->phy[i].dev_sas_addr = 0x50010c600047f9d0ULL; 536 pm8001_ha->phy[i].dev_sas_addr = 537 cpu_to_be64((u64) 538 (*(u64 *)&pm8001_ha->phy[i].dev_sas_addr)); 539 } 540 memcpy(pm8001_ha->sas_addr, &pm8001_ha->phy[0].dev_sas_addr, 541 SAS_ADDR_SIZE); 542 #endif 543 } 544 545 #ifdef PM8001_USE_MSIX 546 /** 547 * pm8001_setup_msix - enable MSI-X interrupt 548 * @chip_info: our ha struct. 549 * @irq_handler: irq_handler 550 */ 551 static u32 pm8001_setup_msix(struct pm8001_hba_info *pm8001_ha, 552 irq_handler_t irq_handler) 553 { 554 u32 i = 0, j = 0; 555 u32 number_of_intr = 1; 556 int flag = 0; 557 u32 max_entry; 558 int rc; 559 max_entry = sizeof(pm8001_ha->msix_entries) / 560 sizeof(pm8001_ha->msix_entries[0]); 561 flag |= IRQF_DISABLED; 562 for (i = 0; i < max_entry ; i++) 563 pm8001_ha->msix_entries[i].entry = i; 564 rc = pci_enable_msix(pm8001_ha->pdev, pm8001_ha->msix_entries, 565 number_of_intr); 566 pm8001_ha->number_of_intr = number_of_intr; 567 if (!rc) { 568 for (i = 0; i < number_of_intr; i++) { 569 if (request_irq(pm8001_ha->msix_entries[i].vector, 570 irq_handler, flag, DRV_NAME, 571 SHOST_TO_SAS_HA(pm8001_ha->shost))) { 572 for (j = 0; j < i; j++) 573 free_irq( 574 pm8001_ha->msix_entries[j].vector, 575 SHOST_TO_SAS_HA(pm8001_ha->shost)); 576 pci_disable_msix(pm8001_ha->pdev); 577 break; 578 } 579 } 580 } 581 return rc; 582 } 583 #endif 584 585 /** 586 * pm8001_request_irq - register interrupt 587 * @chip_info: our ha struct. 588 */ 589 static u32 pm8001_request_irq(struct pm8001_hba_info *pm8001_ha) 590 { 591 struct pci_dev *pdev; 592 irq_handler_t irq_handler = pm8001_interrupt; 593 int rc; 594 595 pdev = pm8001_ha->pdev; 596 597 #ifdef PM8001_USE_MSIX 598 if (pci_find_capability(pdev, PCI_CAP_ID_MSIX)) 599 return pm8001_setup_msix(pm8001_ha, irq_handler); 600 else 601 goto intx; 602 #endif 603 604 intx: 605 /* initialize the INT-X interrupt */ 606 rc = request_irq(pdev->irq, irq_handler, IRQF_SHARED, DRV_NAME, 607 SHOST_TO_SAS_HA(pm8001_ha->shost)); 608 return rc; 609 } 610 611 /** 612 * pm8001_pci_probe - probe supported device 613 * @pdev: pci device which kernel has been prepared for. 614 * @ent: pci device id 615 * 616 * This function is the main initialization function, when register a new 617 * pci driver it is invoked, all struct an hardware initilization should be done 618 * here, also, register interrupt 619 */ 620 static int __devinit pm8001_pci_probe(struct pci_dev *pdev, 621 const struct pci_device_id *ent) 622 { 623 unsigned int rc; 624 u32 pci_reg; 625 struct pm8001_hba_info *pm8001_ha; 626 struct Scsi_Host *shost = NULL; 627 const struct pm8001_chip_info *chip; 628 629 dev_printk(KERN_INFO, &pdev->dev, 630 "pm8001: driver version %s\n", DRV_VERSION); 631 rc = pci_enable_device(pdev); 632 if (rc) 633 goto err_out_enable; 634 pci_set_master(pdev); 635 /* 636 * Enable pci slot busmaster by setting pci command register. 637 * This is required by FW for Cyclone card. 638 */ 639 640 pci_read_config_dword(pdev, PCI_COMMAND, &pci_reg); 641 pci_reg |= 0x157; 642 pci_write_config_dword(pdev, PCI_COMMAND, pci_reg); 643 rc = pci_request_regions(pdev, DRV_NAME); 644 if (rc) 645 goto err_out_disable; 646 rc = pci_go_44(pdev); 647 if (rc) 648 goto err_out_regions; 649 650 shost = scsi_host_alloc(&pm8001_sht, sizeof(void *)); 651 if (!shost) { 652 rc = -ENOMEM; 653 goto err_out_regions; 654 } 655 chip = &pm8001_chips[ent->driver_data]; 656 SHOST_TO_SAS_HA(shost) = 657 kzalloc(sizeof(struct sas_ha_struct), GFP_KERNEL); 658 if (!SHOST_TO_SAS_HA(shost)) { 659 rc = -ENOMEM; 660 goto err_out_free_host; 661 } 662 663 rc = pm8001_prep_sas_ha_init(shost, chip); 664 if (rc) { 665 rc = -ENOMEM; 666 goto err_out_free; 667 } 668 pci_set_drvdata(pdev, SHOST_TO_SAS_HA(shost)); 669 pm8001_ha = pm8001_pci_alloc(pdev, chip_8001, shost); 670 if (!pm8001_ha) { 671 rc = -ENOMEM; 672 goto err_out_free; 673 } 674 list_add_tail(&pm8001_ha->list, &hba_list); 675 PM8001_CHIP_DISP->chip_soft_rst(pm8001_ha, 0x252acbcd); 676 rc = PM8001_CHIP_DISP->chip_init(pm8001_ha); 677 if (rc) 678 goto err_out_ha_free; 679 680 rc = scsi_add_host(shost, &pdev->dev); 681 if (rc) 682 goto err_out_ha_free; 683 rc = pm8001_request_irq(pm8001_ha); 684 if (rc) 685 goto err_out_shost; 686 687 PM8001_CHIP_DISP->interrupt_enable(pm8001_ha); 688 pm8001_init_sas_add(pm8001_ha); 689 pm8001_post_sas_ha_init(shost, chip); 690 rc = sas_register_ha(SHOST_TO_SAS_HA(shost)); 691 if (rc) 692 goto err_out_shost; 693 scsi_scan_host(pm8001_ha->shost); 694 return 0; 695 696 err_out_shost: 697 scsi_remove_host(pm8001_ha->shost); 698 err_out_ha_free: 699 pm8001_free(pm8001_ha); 700 err_out_free: 701 kfree(SHOST_TO_SAS_HA(shost)); 702 err_out_free_host: 703 kfree(shost); 704 err_out_regions: 705 pci_release_regions(pdev); 706 err_out_disable: 707 pci_disable_device(pdev); 708 err_out_enable: 709 return rc; 710 } 711 712 static void __devexit pm8001_pci_remove(struct pci_dev *pdev) 713 { 714 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 715 struct pm8001_hba_info *pm8001_ha; 716 int i; 717 pm8001_ha = sha->lldd_ha; 718 pci_set_drvdata(pdev, NULL); 719 sas_unregister_ha(sha); 720 sas_remove_host(pm8001_ha->shost); 721 list_del(&pm8001_ha->list); 722 scsi_remove_host(pm8001_ha->shost); 723 PM8001_CHIP_DISP->interrupt_disable(pm8001_ha); 724 PM8001_CHIP_DISP->chip_soft_rst(pm8001_ha, 0x252acbcd); 725 726 #ifdef PM8001_USE_MSIX 727 for (i = 0; i < pm8001_ha->number_of_intr; i++) 728 synchronize_irq(pm8001_ha->msix_entries[i].vector); 729 for (i = 0; i < pm8001_ha->number_of_intr; i++) 730 free_irq(pm8001_ha->msix_entries[i].vector, sha); 731 pci_disable_msix(pdev); 732 #else 733 free_irq(pm8001_ha->irq, sha); 734 #endif 735 #ifdef PM8001_USE_TASKLET 736 tasklet_kill(&pm8001_ha->tasklet); 737 #endif 738 pm8001_free(pm8001_ha); 739 kfree(sha->sas_phy); 740 kfree(sha->sas_port); 741 kfree(sha); 742 pci_release_regions(pdev); 743 pci_disable_device(pdev); 744 } 745 746 /** 747 * pm8001_pci_suspend - power management suspend main entry point 748 * @pdev: PCI device struct 749 * @state: PM state change to (usually PCI_D3) 750 * 751 * Returns 0 success, anything else error. 752 */ 753 static int pm8001_pci_suspend(struct pci_dev *pdev, pm_message_t state) 754 { 755 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 756 struct pm8001_hba_info *pm8001_ha; 757 int i , pos; 758 u32 device_state; 759 pm8001_ha = sha->lldd_ha; 760 flush_workqueue(pm8001_wq); 761 scsi_block_requests(pm8001_ha->shost); 762 pos = pci_find_capability(pdev, PCI_CAP_ID_PM); 763 if (pos == 0) { 764 printk(KERN_ERR " PCI PM not supported\n"); 765 return -ENODEV; 766 } 767 PM8001_CHIP_DISP->interrupt_disable(pm8001_ha); 768 PM8001_CHIP_DISP->chip_soft_rst(pm8001_ha, 0x252acbcd); 769 #ifdef PM8001_USE_MSIX 770 for (i = 0; i < pm8001_ha->number_of_intr; i++) 771 synchronize_irq(pm8001_ha->msix_entries[i].vector); 772 for (i = 0; i < pm8001_ha->number_of_intr; i++) 773 free_irq(pm8001_ha->msix_entries[i].vector, sha); 774 pci_disable_msix(pdev); 775 #else 776 free_irq(pm8001_ha->irq, sha); 777 #endif 778 #ifdef PM8001_USE_TASKLET 779 tasklet_kill(&pm8001_ha->tasklet); 780 #endif 781 device_state = pci_choose_state(pdev, state); 782 pm8001_printk("pdev=0x%p, slot=%s, entering " 783 "operating state [D%d]\n", pdev, 784 pm8001_ha->name, device_state); 785 pci_save_state(pdev); 786 pci_disable_device(pdev); 787 pci_set_power_state(pdev, device_state); 788 return 0; 789 } 790 791 /** 792 * pm8001_pci_resume - power management resume main entry point 793 * @pdev: PCI device struct 794 * 795 * Returns 0 success, anything else error. 796 */ 797 static int pm8001_pci_resume(struct pci_dev *pdev) 798 { 799 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 800 struct pm8001_hba_info *pm8001_ha; 801 int rc; 802 u32 device_state; 803 pm8001_ha = sha->lldd_ha; 804 device_state = pdev->current_state; 805 806 pm8001_printk("pdev=0x%p, slot=%s, resuming from previous " 807 "operating state [D%d]\n", pdev, pm8001_ha->name, device_state); 808 809 pci_set_power_state(pdev, PCI_D0); 810 pci_enable_wake(pdev, PCI_D0, 0); 811 pci_restore_state(pdev); 812 rc = pci_enable_device(pdev); 813 if (rc) { 814 pm8001_printk("slot=%s Enable device failed during resume\n", 815 pm8001_ha->name); 816 goto err_out_enable; 817 } 818 819 pci_set_master(pdev); 820 rc = pci_go_44(pdev); 821 if (rc) 822 goto err_out_disable; 823 824 PM8001_CHIP_DISP->chip_soft_rst(pm8001_ha, 0x252acbcd); 825 rc = PM8001_CHIP_DISP->chip_init(pm8001_ha); 826 if (rc) 827 goto err_out_disable; 828 PM8001_CHIP_DISP->interrupt_disable(pm8001_ha); 829 rc = pm8001_request_irq(pm8001_ha); 830 if (rc) 831 goto err_out_disable; 832 #ifdef PM8001_USE_TASKLET 833 tasklet_init(&pm8001_ha->tasklet, pm8001_tasklet, 834 (unsigned long)pm8001_ha); 835 #endif 836 PM8001_CHIP_DISP->interrupt_enable(pm8001_ha); 837 scsi_unblock_requests(pm8001_ha->shost); 838 return 0; 839 840 err_out_disable: 841 scsi_remove_host(pm8001_ha->shost); 842 pci_disable_device(pdev); 843 err_out_enable: 844 return rc; 845 } 846 847 static struct pci_device_id __devinitdata pm8001_pci_table[] = { 848 { 849 PCI_VDEVICE(PMC_Sierra, 0x8001), chip_8001 850 }, 851 { 852 PCI_DEVICE(0x117c, 0x0042), 853 .driver_data = chip_8001 854 }, 855 {} /* terminate list */ 856 }; 857 858 static struct pci_driver pm8001_pci_driver = { 859 .name = DRV_NAME, 860 .id_table = pm8001_pci_table, 861 .probe = pm8001_pci_probe, 862 .remove = __devexit_p(pm8001_pci_remove), 863 .suspend = pm8001_pci_suspend, 864 .resume = pm8001_pci_resume, 865 }; 866 867 /** 868 * pm8001_init - initialize scsi transport template 869 */ 870 static int __init pm8001_init(void) 871 { 872 int rc = -ENOMEM; 873 874 pm8001_wq = alloc_workqueue("pm8001", 0, 0); 875 if (!pm8001_wq) 876 goto err; 877 878 pm8001_id = 0; 879 pm8001_stt = sas_domain_attach_transport(&pm8001_transport_ops); 880 if (!pm8001_stt) 881 goto err_wq; 882 rc = pci_register_driver(&pm8001_pci_driver); 883 if (rc) 884 goto err_tp; 885 return 0; 886 887 err_tp: 888 sas_release_transport(pm8001_stt); 889 err_wq: 890 destroy_workqueue(pm8001_wq); 891 err: 892 return rc; 893 } 894 895 static void __exit pm8001_exit(void) 896 { 897 pci_unregister_driver(&pm8001_pci_driver); 898 sas_release_transport(pm8001_stt); 899 destroy_workqueue(pm8001_wq); 900 } 901 902 module_init(pm8001_init); 903 module_exit(pm8001_exit); 904 905 MODULE_AUTHOR("Jack Wang <jack_wang@usish.com>"); 906 MODULE_DESCRIPTION("PMC-Sierra PM8001 SAS/SATA controller driver"); 907 MODULE_VERSION(DRV_VERSION); 908 MODULE_LICENSE("GPL"); 909 MODULE_DEVICE_TABLE(pci, pm8001_pci_table); 910 911