drivers/scsi/pm8001/pm8001_init.c

   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