drivers/scsi/lpfc/lpfc_init.c

   1 /*******************************************************************
   2  * This file is part of the Emulex Linux Device Driver for         *
   3  * Fibre Channel Host Bus Adapters.                                *
   4  * Copyright (C) 2004-2012 Emulex.  All rights reserved.           *
   5  * EMULEX and SLI are trademarks of Emulex.                        *
   6  * www.emulex.com                                                  *
   7  * Portions Copyright (C) 2004-2005 Christoph Hellwig              *
   8  *                                                                 *
   9  * This program is free software; you can redistribute it and/or   *
  10  * modify it under the terms of version 2 of the GNU General       *
  11  * Public License as published by the Free Software Foundation.    *
  12  * This program is distributed in the hope that it will be useful. *
  13  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
  14  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
  15  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
  16  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
  17  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
  18  * more details, a copy of which can be found in the file COPYING  *
  19  * included with this package.                                     *
  20  *******************************************************************/
  21
  22 #include <linux/blkdev.h>
  23 #include <linux/delay.h>
  24 #include <linux/dma-mapping.h>
  25 #include <linux/idr.h>
  26 #include <linux/interrupt.h>
  27 #include <linux/module.h>
  28 #include <linux/kthread.h>
  29 #include <linux/pci.h>
  30 #include <linux/spinlock.h>
  31 #include <linux/ctype.h>
  32 #include <linux/aer.h>
  33 #include <linux/slab.h>
  34 #include <linux/firmware.h>
  35 #include <linux/miscdevice.h>
  36
  37 #include <scsi/scsi.h>
  38 #include <scsi/scsi_device.h>
  39 #include <scsi/scsi_host.h>
  40 #include <scsi/scsi_transport_fc.h>
  41
  42 #include "lpfc_hw4.h"
  43 #include "lpfc_hw.h"
  44 #include "lpfc_sli.h"
  45 #include "lpfc_sli4.h"
  46 #include "lpfc_nl.h"
  47 #include "lpfc_disc.h"
  48 #include "lpfc_scsi.h"
  49 #include "lpfc.h"
  50 #include "lpfc_logmsg.h"
  51 #include "lpfc_crtn.h"
  52 #include "lpfc_vport.h"
  53 #include "lpfc_version.h"
  54
  55 char *_dump_buf_data;
  56 unsigned long _dump_buf_data_order;
  57 char *_dump_buf_dif;
  58 unsigned long _dump_buf_dif_order;
  59 spinlock_t _dump_buf_lock;
  60
  61 static void lpfc_get_hba_model_desc(struct lpfc_hba *, uint8_t *, uint8_t *);
  62 static int lpfc_post_rcv_buf(struct lpfc_hba *);
  63 static int lpfc_sli4_queue_verify(struct lpfc_hba *);
  64 static int lpfc_create_bootstrap_mbox(struct lpfc_hba *);
  65 static int lpfc_setup_endian_order(struct lpfc_hba *);
  66 static void lpfc_destroy_bootstrap_mbox(struct lpfc_hba *);
  67 static void lpfc_free_els_sgl_list(struct lpfc_hba *);
  68 static void lpfc_init_sgl_list(struct lpfc_hba *);
  69 static int lpfc_init_active_sgl_array(struct lpfc_hba *);
  70 static void lpfc_free_active_sgl(struct lpfc_hba *);
  71 static int lpfc_hba_down_post_s3(struct lpfc_hba *phba);
  72 static int lpfc_hba_down_post_s4(struct lpfc_hba *phba);
  73 static int lpfc_sli4_cq_event_pool_create(struct lpfc_hba *);
  74 static void lpfc_sli4_cq_event_pool_destroy(struct lpfc_hba *);
  75 static void lpfc_sli4_cq_event_release_all(struct lpfc_hba *);
  76 static void lpfc_sli4_disable_intr(struct lpfc_hba *);
  77 static uint32_t lpfc_sli4_enable_intr(struct lpfc_hba *, uint32_t);
  78
  79 static struct scsi_transport_template *lpfc_transport_template = NULL;
  80 static struct scsi_transport_template *lpfc_vport_transport_template = NULL;
  81 static DEFINE_IDR(lpfc_hba_index);
  82
  83 /**
  84  * lpfc_config_port_prep - Perform lpfc initialization prior to config port
  85  * @phba: pointer to lpfc hba data structure.
  86  *
  87  * This routine will do LPFC initialization prior to issuing the CONFIG_PORT
  88  * mailbox command. It retrieves the revision information from the HBA and
  89  * collects the Vital Product Data (VPD) about the HBA for preparing the
  90  * configuration of the HBA.
  91  *
  92  * Return codes:
  93  *   0 - success.
  94  *   -ERESTART - requests the SLI layer to reset the HBA and try again.
  95  *   Any other value - indicates an error.
  96  **/
  97 int
  98 lpfc_config_port_prep(struct lpfc_hba *phba)
  99 {
 100         lpfc_vpd_t *vp = &phba->vpd;
 101         int i = 0, rc;
 102         LPFC_MBOXQ_t *pmb;
 103         MAILBOX_t *mb;
 104         char *lpfc_vpd_data = NULL;
 105         uint16_t offset = 0;
 106         static char licensed[56] =
 107                     "key unlock for use with gnu public licensed code only\0";
 108         static int init_key = 1;
 109
 110         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 111         if (!pmb) {
 112                 phba->link_state = LPFC_HBA_ERROR;
 113                 return -ENOMEM;
 114         }
 115
 116         mb = &pmb->u.mb;
 117         phba->link_state = LPFC_INIT_MBX_CMDS;
 118
 119         if (lpfc_is_LC_HBA(phba->pcidev->device)) {
 120                 if (init_key) {
 121                         uint32_t *ptext = (uint32_t *) licensed;
 122
 123                         for (i = 0; i < 56; i += sizeof (uint32_t), ptext++)
 124                                 *ptext = cpu_to_be32(*ptext);
 125                         init_key = 0;
 126                 }
 127
 128                 lpfc_read_nv(phba, pmb);
 129                 memset((char*)mb->un.varRDnvp.rsvd3, 0,
 130                         sizeof (mb->un.varRDnvp.rsvd3));
 131                 memcpy((char*)mb->un.varRDnvp.rsvd3, licensed,
 132                          sizeof (licensed));
 133
 134                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
 135
 136                 if (rc != MBX_SUCCESS) {
 137                         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
 138                                         "0324 Config Port initialization "
 139                                         "error, mbxCmd x%x READ_NVPARM, "
 140                                         "mbxStatus x%x\n",
 141                                         mb->mbxCommand, mb->mbxStatus);
 142                         mempool_free(pmb, phba->mbox_mem_pool);
 143                         return -ERESTART;
 144                 }
 145                 memcpy(phba->wwnn, (char *)mb->un.varRDnvp.nodename,
 146                        sizeof(phba->wwnn));
 147                 memcpy(phba->wwpn, (char *)mb->un.varRDnvp.portname,
 148                        sizeof(phba->wwpn));
 149         }
 150
 151         phba->sli3_options = 0x0;
 152
 153         /* Setup and issue mailbox READ REV command */
 154         lpfc_read_rev(phba, pmb);
 155         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
 156         if (rc != MBX_SUCCESS) {
 157                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 158                                 "0439 Adapter failed to init, mbxCmd x%x "
 159                                 "READ_REV, mbxStatus x%x\n",
 160                                 mb->mbxCommand, mb->mbxStatus);
 161                 mempool_free( pmb, phba->mbox_mem_pool);
 162                 return -ERESTART;
 163         }
 164
 165
 166         /*
 167          * The value of rr must be 1 since the driver set the cv field to 1.
 168          * This setting requires the FW to set all revision fields.
 169          */
 170         if (mb->un.varRdRev.rr == 0) {
 171                 vp->rev.rBit = 0;
 172                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 173                                 "0440 Adapter failed to init, READ_REV has "
 174                                 "missing revision information.\n");
 175                 mempool_free(pmb, phba->mbox_mem_pool);
 176                 return -ERESTART;
 177         }
 178
 179         if (phba->sli_rev == 3 && !mb->un.varRdRev.v3rsp) {
 180                 mempool_free(pmb, phba->mbox_mem_pool);
 181                 return -EINVAL;
 182         }
 183
 184         /* Save information as VPD data */
 185         vp->rev.rBit = 1;
 186         memcpy(&vp->sli3Feat, &mb->un.varRdRev.sli3Feat, sizeof(uint32_t));
 187         vp->rev.sli1FwRev = mb->un.varRdRev.sli1FwRev;
 188         memcpy(vp->rev.sli1FwName, (char*) mb->un.varRdRev.sli1FwName, 16);
 189         vp->rev.sli2FwRev = mb->un.varRdRev.sli2FwRev;
 190         memcpy(vp->rev.sli2FwName, (char *) mb->un.varRdRev.sli2FwName, 16);
 191         vp->rev.biuRev = mb->un.varRdRev.biuRev;
 192         vp->rev.smRev = mb->un.varRdRev.smRev;
 193         vp->rev.smFwRev = mb->un.varRdRev.un.smFwRev;
 194         vp->rev.endecRev = mb->un.varRdRev.endecRev;
 195         vp->rev.fcphHigh = mb->un.varRdRev.fcphHigh;
 196         vp->rev.fcphLow = mb->un.varRdRev.fcphLow;
 197         vp->rev.feaLevelHigh = mb->un.varRdRev.feaLevelHigh;
 198         vp->rev.feaLevelLow = mb->un.varRdRev.feaLevelLow;
 199         vp->rev.postKernRev = mb->un.varRdRev.postKernRev;
 200         vp->rev.opFwRev = mb->un.varRdRev.opFwRev;
 201
 202         /* If the sli feature level is less then 9, we must
 203          * tear down all RPIs and VPIs on link down if NPIV
 204          * is enabled.
 205          */
 206         if (vp->rev.feaLevelHigh < 9)
 207                 phba->sli3_options |= LPFC_SLI3_VPORT_TEARDOWN;
 208
 209         if (lpfc_is_LC_HBA(phba->pcidev->device))
 210                 memcpy(phba->RandomData, (char *)&mb->un.varWords[24],
 211                                                 sizeof (phba->RandomData));
 212
 213         /* Get adapter VPD information */
 214         lpfc_vpd_data = kmalloc(DMP_VPD_SIZE, GFP_KERNEL);
 215         if (!lpfc_vpd_data)
 216                 goto out_free_mbox;
 217         do {
 218                 lpfc_dump_mem(phba, pmb, offset, DMP_REGION_VPD);
 219                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
 220
 221                 if (rc != MBX_SUCCESS) {
 222                         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
 223                                         "0441 VPD not present on adapter, "
 224                                         "mbxCmd x%x DUMP VPD, mbxStatus x%x\n",
 225                                         mb->mbxCommand, mb->mbxStatus);
 226                         mb->un.varDmp.word_cnt = 0;
 227                 }
 228                 /* dump mem may return a zero when finished or we got a
 229                  * mailbox error, either way we are done.
 230                  */
 231                 if (mb->un.varDmp.word_cnt == 0)
 232                         break;
 233                 if (mb->un.varDmp.word_cnt > DMP_VPD_SIZE - offset)
 234                         mb->un.varDmp.word_cnt = DMP_VPD_SIZE - offset;
 235                 lpfc_sli_pcimem_bcopy(((uint8_t *)mb) + DMP_RSP_OFFSET,
 236                                       lpfc_vpd_data + offset,
 237                                       mb->un.varDmp.word_cnt);
 238                 offset += mb->un.varDmp.word_cnt;
 239         } while (mb->un.varDmp.word_cnt && offset < DMP_VPD_SIZE);
 240         lpfc_parse_vpd(phba, lpfc_vpd_data, offset);
 241
 242         kfree(lpfc_vpd_data);
 243 out_free_mbox:
 244         mempool_free(pmb, phba->mbox_mem_pool);
 245         return 0;
 246 }
 247
 248 /**
 249  * lpfc_config_async_cmpl - Completion handler for config async event mbox cmd
 250  * @phba: pointer to lpfc hba data structure.
 251  * @pmboxq: pointer to the driver internal queue element for mailbox command.
 252  *
 253  * This is the completion handler for driver's configuring asynchronous event
 254  * mailbox command to the device. If the mailbox command returns successfully,
 255  * it will set internal async event support flag to 1; otherwise, it will
 256  * set internal async event support flag to 0.
 257  **/
 258 static void
 259 lpfc_config_async_cmpl(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmboxq)
 260 {
 261         if (pmboxq->u.mb.mbxStatus == MBX_SUCCESS)
 262                 phba->temp_sensor_support = 1;
 263         else
 264                 phba->temp_sensor_support = 0;
 265         mempool_free(pmboxq, phba->mbox_mem_pool);
 266         return;
 267 }
 268
 269 /**
 270  * lpfc_dump_wakeup_param_cmpl - dump memory mailbox command completion handler
 271  * @phba: pointer to lpfc hba data structure.
 272  * @pmboxq: pointer to the driver internal queue element for mailbox command.
 273  *
 274  * This is the completion handler for dump mailbox command for getting
 275  * wake up parameters. When this command complete, the response contain
 276  * Option rom version of the HBA. This function translate the version number
 277  * into a human readable string and store it in OptionROMVersion.
 278  **/
 279 static void
 280 lpfc_dump_wakeup_param_cmpl(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmboxq)
 281 {
 282         struct prog_id *prg;
 283         uint32_t prog_id_word;
 284         char dist = ' ';
 285         /* character array used for decoding dist type. */
 286         char dist_char[] = "nabx";
 287
 288         if (pmboxq->u.mb.mbxStatus != MBX_SUCCESS) {
 289                 mempool_free(pmboxq, phba->mbox_mem_pool);
 290                 return;
 291         }
 292
 293         prg = (struct prog_id *) &prog_id_word;
 294
 295         /* word 7 contain option rom version */
 296         prog_id_word = pmboxq->u.mb.un.varWords[7];
 297
 298         /* Decode the Option rom version word to a readable string */
 299         if (prg->dist < 4)
 300                 dist = dist_char[prg->dist];
 301
 302         if ((prg->dist == 3) && (prg->num == 0))
 303                 sprintf(phba->OptionROMVersion, "%d.%d%d",
 304                         prg->ver, prg->rev, prg->lev);
 305         else
 306                 sprintf(phba->OptionROMVersion, "%d.%d%d%c%d",
 307                         prg->ver, prg->rev, prg->lev,
 308                         dist, prg->num);
 309         mempool_free(pmboxq, phba->mbox_mem_pool);
 310         return;
 311 }
 312
 313 /**
 314  * lpfc_update_vport_wwn - Updates the fc_nodename, fc_portname,
 315  *      cfg_soft_wwnn, cfg_soft_wwpn
 316  * @vport: pointer to lpfc vport data structure.
 317  *
 318  *
 319  * Return codes
 320  *   None.
 321  **/
 322 void
 323 lpfc_update_vport_wwn(struct lpfc_vport *vport)
 324 {
 325         /* If the soft name exists then update it using the service params */
 326         if (vport->phba->cfg_soft_wwnn)
 327                 u64_to_wwn(vport->phba->cfg_soft_wwnn,
 328                            vport->fc_sparam.nodeName.u.wwn);
 329         if (vport->phba->cfg_soft_wwpn)
 330                 u64_to_wwn(vport->phba->cfg_soft_wwpn,
 331                            vport->fc_sparam.portName.u.wwn);
 332
 333         /*
 334          * If the name is empty or there exists a soft name
 335          * then copy the service params name, otherwise use the fc name
 336          */
 337         if (vport->fc_nodename.u.wwn[0] == 0 || vport->phba->cfg_soft_wwnn)
 338                 memcpy(&vport->fc_nodename, &vport->fc_sparam.nodeName,
 339                         sizeof(struct lpfc_name));
 340         else
 341                 memcpy(&vport->fc_sparam.nodeName, &vport->fc_nodename,
 342                         sizeof(struct lpfc_name));
 343
 344         if (vport->fc_portname.u.wwn[0] == 0 || vport->phba->cfg_soft_wwpn)
 345                 memcpy(&vport->fc_portname, &vport->fc_sparam.portName,
 346                         sizeof(struct lpfc_name));
 347         else
 348                 memcpy(&vport->fc_sparam.portName, &vport->fc_portname,
 349                         sizeof(struct lpfc_name));
 350 }
 351
 352 /**
 353  * lpfc_config_port_post - Perform lpfc initialization after config port
 354  * @phba: pointer to lpfc hba data structure.
 355  *
 356  * This routine will do LPFC initialization after the CONFIG_PORT mailbox
 357  * command call. It performs all internal resource and state setups on the
 358  * port: post IOCB buffers, enable appropriate host interrupt attentions,
 359  * ELS ring timers, etc.
 360  *
 361  * Return codes
 362  *   0 - success.
 363  *   Any other value - error.
 364  **/
 365 int
 366 lpfc_config_port_post(struct lpfc_hba *phba)
 367 {
 368         struct lpfc_vport *vport = phba->pport;
 369         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
 370         LPFC_MBOXQ_t *pmb;
 371         MAILBOX_t *mb;
 372         struct lpfc_dmabuf *mp;
 373         struct lpfc_sli *psli = &phba->sli;
 374         uint32_t status, timeout;
 375         int i, j;
 376         int rc;
 377
 378         spin_lock_irq(&phba->hbalock);
 379         /*
 380          * If the Config port completed correctly the HBA is not
 381          * over heated any more.
 382          */
 383         if (phba->over_temp_state == HBA_OVER_TEMP)
 384                 phba->over_temp_state = HBA_NORMAL_TEMP;
 385         spin_unlock_irq(&phba->hbalock);
 386
 387         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 388         if (!pmb) {
 389                 phba->link_state = LPFC_HBA_ERROR;
 390                 return -ENOMEM;
 391         }
 392         mb = &pmb->u.mb;
 393
 394         /* Get login parameters for NID.  */
 395         rc = lpfc_read_sparam(phba, pmb, 0);
 396         if (rc) {
 397                 mempool_free(pmb, phba->mbox_mem_pool);
 398                 return -ENOMEM;
 399         }
 400
 401         pmb->vport = vport;
 402         if (lpfc_sli_issue_mbox(phba, pmb, MBX_POLL) != MBX_SUCCESS) {
 403                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 404                                 "0448 Adapter failed init, mbxCmd x%x "
 405                                 "READ_SPARM mbxStatus x%x\n",
 406                                 mb->mbxCommand, mb->mbxStatus);
 407                 phba->link_state = LPFC_HBA_ERROR;
 408                 mp = (struct lpfc_dmabuf *) pmb->context1;
 409                 mempool_free(pmb, phba->mbox_mem_pool);
 410                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
 411                 kfree(mp);
 412                 return -EIO;
 413         }
 414
 415         mp = (struct lpfc_dmabuf *) pmb->context1;
 416
 417         memcpy(&vport->fc_sparam, mp->virt, sizeof (struct serv_parm));
 418         lpfc_mbuf_free(phba, mp->virt, mp->phys);
 419         kfree(mp);
 420         pmb->context1 = NULL;
 421         lpfc_update_vport_wwn(vport);
 422
 423         /* Update the fc_host data structures with new wwn. */
 424         fc_host_node_name(shost) = wwn_to_u64(vport->fc_nodename.u.wwn);
 425         fc_host_port_name(shost) = wwn_to_u64(vport->fc_portname.u.wwn);
 426         fc_host_max_npiv_vports(shost) = phba->max_vpi;
 427
 428         /* If no serial number in VPD data, use low 6 bytes of WWNN */
 429         /* This should be consolidated into parse_vpd ? - mr */
 430         if (phba->SerialNumber[0] == 0) {
 431                 uint8_t *outptr;
 432
 433                 outptr = &vport->fc_nodename.u.s.IEEE[0];
 434                 for (i = 0; i < 12; i++) {
 435                         status = *outptr++;
 436                         j = ((status & 0xf0) >> 4);
 437                         if (j <= 9)
 438                                 phba->SerialNumber[i] =
 439                                     (char)((uint8_t) 0x30 + (uint8_t) j);
 440                         else
 441                                 phba->SerialNumber[i] =
 442                                     (char)((uint8_t) 0x61 + (uint8_t) (j - 10));
 443                         i++;
 444                         j = (status & 0xf);
 445                         if (j <= 9)
 446                                 phba->SerialNumber[i] =
 447                                     (char)((uint8_t) 0x30 + (uint8_t) j);
 448                         else
 449                                 phba->SerialNumber[i] =
 450                                     (char)((uint8_t) 0x61 + (uint8_t) (j - 10));
 451                 }
 452         }
 453
 454         lpfc_read_config(phba, pmb);
 455         pmb->vport = vport;
 456         if (lpfc_sli_issue_mbox(phba, pmb, MBX_POLL) != MBX_SUCCESS) {
 457                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 458                                 "0453 Adapter failed to init, mbxCmd x%x "
 459                                 "READ_CONFIG, mbxStatus x%x\n",
 460                                 mb->mbxCommand, mb->mbxStatus);
 461                 phba->link_state = LPFC_HBA_ERROR;
 462                 mempool_free( pmb, phba->mbox_mem_pool);
 463                 return -EIO;
 464         }
 465
 466         /* Check if the port is disabled */
 467         lpfc_sli_read_link_ste(phba);
 468
 469         /* Reset the DFT_HBA_Q_DEPTH to the max xri  */
 470         if (phba->cfg_hba_queue_depth > (mb->un.varRdConfig.max_xri+1))
 471                 phba->cfg_hba_queue_depth =
 472                         (mb->un.varRdConfig.max_xri + 1) -
 473                                         lpfc_sli4_get_els_iocb_cnt(phba);
 474
 475         phba->lmt = mb->un.varRdConfig.lmt;
 476
 477         /* Get the default values for Model Name and Description */
 478         lpfc_get_hba_model_desc(phba, phba->ModelName, phba->ModelDesc);
 479
 480         phba->link_state = LPFC_LINK_DOWN;
 481
 482         /* Only process IOCBs on ELS ring till hba_state is READY */
 483         if (psli->ring[psli->extra_ring].sli.sli3.cmdringaddr)
 484                 psli->ring[psli->extra_ring].flag |= LPFC_STOP_IOCB_EVENT;
 485         if (psli->ring[psli->fcp_ring].sli.sli3.cmdringaddr)
 486                 psli->ring[psli->fcp_ring].flag |= LPFC_STOP_IOCB_EVENT;
 487         if (psli->ring[psli->next_ring].sli.sli3.cmdringaddr)
 488                 psli->ring[psli->next_ring].flag |= LPFC_STOP_IOCB_EVENT;
 489
 490         /* Post receive buffers for desired rings */
 491         if (phba->sli_rev != 3)
 492                 lpfc_post_rcv_buf(phba);
 493
 494         /*
 495          * Configure HBA MSI-X attention conditions to messages if MSI-X mode
 496          */
 497         if (phba->intr_type == MSIX) {
 498                 rc = lpfc_config_msi(phba, pmb);
 499                 if (rc) {
 500                         mempool_free(pmb, phba->mbox_mem_pool);
 501                         return -EIO;
 502                 }
 503                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
 504                 if (rc != MBX_SUCCESS) {
 505                         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
 506                                         "0352 Config MSI mailbox command "
 507                                         "failed, mbxCmd x%x, mbxStatus x%x\n",
 508                                         pmb->u.mb.mbxCommand,
 509                                         pmb->u.mb.mbxStatus);
 510                         mempool_free(pmb, phba->mbox_mem_pool);
 511                         return -EIO;
 512                 }
 513         }
 514
 515         spin_lock_irq(&phba->hbalock);
 516         /* Initialize ERATT handling flag */
 517         phba->hba_flag &= ~HBA_ERATT_HANDLED;
 518
 519         /* Enable appropriate host interrupts */
 520         if (lpfc_readl(phba->HCregaddr, &status)) {
 521                 spin_unlock_irq(&phba->hbalock);
 522                 return -EIO;
 523         }
 524         status |= HC_MBINT_ENA | HC_ERINT_ENA | HC_LAINT_ENA;
 525         if (psli->num_rings > 0)
 526                 status |= HC_R0INT_ENA;
 527         if (psli->num_rings > 1)
 528                 status |= HC_R1INT_ENA;
 529         if (psli->num_rings > 2)
 530                 status |= HC_R2INT_ENA;
 531         if (psli->num_rings > 3)
 532                 status |= HC_R3INT_ENA;
 533
 534         if ((phba->cfg_poll & ENABLE_FCP_RING_POLLING) &&
 535             (phba->cfg_poll & DISABLE_FCP_RING_INT))
 536                 status &= ~(HC_R0INT_ENA);
 537
 538         writel(status, phba->HCregaddr);
 539         readl(phba->HCregaddr); /* flush */
 540         spin_unlock_irq(&phba->hbalock);
 541
 542         /* Set up ring-0 (ELS) timer */
 543         timeout = phba->fc_ratov * 2;
 544         mod_timer(&vport->els_tmofunc, jiffies + HZ * timeout);
 545         /* Set up heart beat (HB) timer */
 546         mod_timer(&phba->hb_tmofunc, jiffies + HZ * LPFC_HB_MBOX_INTERVAL);
 547         phba->hb_outstanding = 0;
 548         phba->last_completion_time = jiffies;
 549         /* Set up error attention (ERATT) polling timer */
 550         mod_timer(&phba->eratt_poll, jiffies + HZ * LPFC_ERATT_POLL_INTERVAL);
 551
 552         if (phba->hba_flag & LINK_DISABLED) {
 553                 lpfc_printf_log(phba,
 554                         KERN_ERR, LOG_INIT,
 555                         "2598 Adapter Link is disabled.\n");
 556                 lpfc_down_link(phba, pmb);
 557                 pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 558                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
 559                 if ((rc != MBX_SUCCESS) && (rc != MBX_BUSY)) {
 560                         lpfc_printf_log(phba,
 561                         KERN_ERR, LOG_INIT,
 562                         "2599 Adapter failed to issue DOWN_LINK"
 563                         " mbox command rc 0x%x\n", rc);
 564
 565                         mempool_free(pmb, phba->mbox_mem_pool);
 566                         return -EIO;
 567                 }
 568         } else if (phba->cfg_suppress_link_up == LPFC_INITIALIZE_LINK) {
 569                 mempool_free(pmb, phba->mbox_mem_pool);
 570                 rc = phba->lpfc_hba_init_link(phba, MBX_NOWAIT);
 571                 if (rc)
 572                         return rc;
 573         }
 574         /* MBOX buffer will be freed in mbox compl */
 575         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 576         if (!pmb) {
 577                 phba->link_state = LPFC_HBA_ERROR;
 578                 return -ENOMEM;
 579         }
 580
 581         lpfc_config_async(phba, pmb, LPFC_ELS_RING);
 582         pmb->mbox_cmpl = lpfc_config_async_cmpl;
 583         pmb->vport = phba->pport;
 584         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
 585
 586         if ((rc != MBX_BUSY) && (rc != MBX_SUCCESS)) {
 587                 lpfc_printf_log(phba,
 588                                 KERN_ERR,
 589                                 LOG_INIT,
 590                                 "0456 Adapter failed to issue "
 591                                 "ASYNCEVT_ENABLE mbox status x%x\n",
 592                                 rc);
 593                 mempool_free(pmb, phba->mbox_mem_pool);
 594         }
 595
 596         /* Get Option rom version */
 597         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 598         if (!pmb) {
 599                 phba->link_state = LPFC_HBA_ERROR;
 600                 return -ENOMEM;
 601         }
 602
 603         lpfc_dump_wakeup_param(phba, pmb);
 604         pmb->mbox_cmpl = lpfc_dump_wakeup_param_cmpl;
 605         pmb->vport = phba->pport;
 606         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
 607
 608         if ((rc != MBX_BUSY) && (rc != MBX_SUCCESS)) {
 609                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT, "0435 Adapter failed "
 610                                 "to get Option ROM version status x%x\n", rc);
 611                 mempool_free(pmb, phba->mbox_mem_pool);
 612         }
 613
 614         return 0;
 615 }
 616
 617 /**
 618  * lpfc_hba_init_link - Initialize the FC link
 619  * @phba: pointer to lpfc hba data structure.
 620  * @flag: mailbox command issue mode - either MBX_POLL or MBX_NOWAIT
 621  *
 622  * This routine will issue the INIT_LINK mailbox command call.
 623  * It is available to other drivers through the lpfc_hba data
 624  * structure for use as a delayed link up mechanism with the
 625  * module parameter lpfc_suppress_link_up.
 626  *
 627  * Return code
 628  *              0 - success
 629  *              Any other value - error
 630  **/
 631 int
 632 lpfc_hba_init_link(struct lpfc_hba *phba, uint32_t flag)
 633 {
 634         return lpfc_hba_init_link_fc_topology(phba, phba->cfg_topology, flag);
 635 }
 636
 637 /**
 638  * lpfc_hba_init_link_fc_topology - Initialize FC link with desired topology
 639  * @phba: pointer to lpfc hba data structure.
 640  * @fc_topology: desired fc topology.
 641  * @flag: mailbox command issue mode - either MBX_POLL or MBX_NOWAIT
 642  *
 643  * This routine will issue the INIT_LINK mailbox command call.
 644  * It is available to other drivers through the lpfc_hba data
 645  * structure for use as a delayed link up mechanism with the
 646  * module parameter lpfc_suppress_link_up.
 647  *
 648  * Return code
 649  *              0 - success
 650  *              Any other value - error
 651  **/
 652 int
 653 lpfc_hba_init_link_fc_topology(struct lpfc_hba *phba, uint32_t fc_topology,
 654                                uint32_t flag)
 655 {
 656         struct lpfc_vport *vport = phba->pport;
 657         LPFC_MBOXQ_t *pmb;
 658         MAILBOX_t *mb;
 659         int rc;
 660
 661         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 662         if (!pmb) {
 663                 phba->link_state = LPFC_HBA_ERROR;
 664                 return -ENOMEM;
 665         }
 666         mb = &pmb->u.mb;
 667         pmb->vport = vport;
 668
 669         if ((phba->cfg_link_speed > LPFC_USER_LINK_SPEED_MAX) ||
 670             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_1G) &&
 671              !(phba->lmt & LMT_1Gb)) ||
 672             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_2G) &&
 673              !(phba->lmt & LMT_2Gb)) ||
 674             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_4G) &&
 675              !(phba->lmt & LMT_4Gb)) ||
 676             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_8G) &&
 677              !(phba->lmt & LMT_8Gb)) ||
 678             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_10G) &&
 679              !(phba->lmt & LMT_10Gb)) ||
 680             ((phba->cfg_link_speed == LPFC_USER_LINK_SPEED_16G) &&
 681              !(phba->lmt & LMT_16Gb))) {
 682                 /* Reset link speed to auto */
 683                 lpfc_printf_log(phba, KERN_ERR, LOG_LINK_EVENT,
 684                         "1302 Invalid speed for this board:%d "
 685                         "Reset link speed to auto.\n",
 686                         phba->cfg_link_speed);
 687                         phba->cfg_link_speed = LPFC_USER_LINK_SPEED_AUTO;
 688         }
 689         lpfc_init_link(phba, pmb, fc_topology, phba->cfg_link_speed);
 690         pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 691         if (phba->sli_rev < LPFC_SLI_REV4)
 692                 lpfc_set_loopback_flag(phba);
 693         rc = lpfc_sli_issue_mbox(phba, pmb, flag);
 694         if ((rc != MBX_BUSY) && (rc != MBX_SUCCESS)) {
 695                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
 696                         "0498 Adapter failed to init, mbxCmd x%x "
 697                         "INIT_LINK, mbxStatus x%x\n",
 698                         mb->mbxCommand, mb->mbxStatus);
 699                 if (phba->sli_rev <= LPFC_SLI_REV3) {
 700                         /* Clear all interrupt enable conditions */
 701                         writel(0, phba->HCregaddr);
 702                         readl(phba->HCregaddr); /* flush */
 703                         /* Clear all pending interrupts */
 704                         writel(0xffffffff, phba->HAregaddr);
 705                         readl(phba->HAregaddr); /* flush */
 706                 }
 707                 phba->link_state = LPFC_HBA_ERROR;
 708                 if (rc != MBX_BUSY || flag == MBX_POLL)
 709                         mempool_free(pmb, phba->mbox_mem_pool);
 710                 return -EIO;
 711         }
 712         phba->cfg_suppress_link_up = LPFC_INITIALIZE_LINK;
 713         if (flag == MBX_POLL)
 714                 mempool_free(pmb, phba->mbox_mem_pool);
 715
 716         return 0;
 717 }
 718
 719 /**
 720  * lpfc_hba_down_link - this routine downs the FC link
 721  * @phba: pointer to lpfc hba data structure.
 722  * @flag: mailbox command issue mode - either MBX_POLL or MBX_NOWAIT
 723  *
 724  * This routine will issue the DOWN_LINK mailbox command call.
 725  * It is available to other drivers through the lpfc_hba data
 726  * structure for use to stop the link.
 727  *
 728  * Return code
 729  *              0 - success
 730  *              Any other value - error
 731  **/
 732 int
 733 lpfc_hba_down_link(struct lpfc_hba *phba, uint32_t flag)
 734 {
 735         LPFC_MBOXQ_t *pmb;
 736         int rc;
 737
 738         pmb = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 739         if (!pmb) {
 740                 phba->link_state = LPFC_HBA_ERROR;
 741                 return -ENOMEM;
 742         }
 743
 744         lpfc_printf_log(phba,
 745                 KERN_ERR, LOG_INIT,
 746                 "0491 Adapter Link is disabled.\n");
 747         lpfc_down_link(phba, pmb);
 748         pmb->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 749         rc = lpfc_sli_issue_mbox(phba, pmb, flag);
 750         if ((rc != MBX_SUCCESS) && (rc != MBX_BUSY)) {
 751                 lpfc_printf_log(phba,
 752                 KERN_ERR, LOG_INIT,
 753                 "2522 Adapter failed to issue DOWN_LINK"
 754                 " mbox command rc 0x%x\n", rc);
 755
 756                 mempool_free(pmb, phba->mbox_mem_pool);
 757                 return -EIO;
 758         }
 759         if (flag == MBX_POLL)
 760                 mempool_free(pmb, phba->mbox_mem_pool);
 761
 762         return 0;
 763 }
 764
 765 /**
 766  * lpfc_hba_down_prep - Perform lpfc uninitialization prior to HBA reset
 767  * @phba: pointer to lpfc HBA data structure.
 768  *
 769  * This routine will do LPFC uninitialization before the HBA is reset when
 770  * bringing down the SLI Layer.
 771  *
 772  * Return codes
 773  *   0 - success.
 774  *   Any other value - error.
 775  **/
 776 int
 777 lpfc_hba_down_prep(struct lpfc_hba *phba)
 778 {
 779         struct lpfc_vport **vports;
 780         int i;
 781
 782         if (phba->sli_rev <= LPFC_SLI_REV3) {
 783                 /* Disable interrupts */
 784                 writel(0, phba->HCregaddr);
 785                 readl(phba->HCregaddr); /* flush */
 786         }
 787
 788         if (phba->pport->load_flag & FC_UNLOADING)
 789                 lpfc_cleanup_discovery_resources(phba->pport);
 790         else {
 791                 vports = lpfc_create_vport_work_array(phba);
 792                 if (vports != NULL)
 793                         for (i = 0; i <= phba->max_vports &&
 794                                 vports[i] != NULL; i++)
 795                                 lpfc_cleanup_discovery_resources(vports[i]);
 796                 lpfc_destroy_vport_work_array(phba, vports);
 797         }
 798         return 0;
 799 }
 800
 801 /**
 802  * lpfc_hba_down_post_s3 - Perform lpfc uninitialization after HBA reset
 803  * @phba: pointer to lpfc HBA data structure.
 804  *
 805  * This routine will do uninitialization after the HBA is reset when bring
 806  * down the SLI Layer.
 807  *
 808  * Return codes
 809  *   0 - success.
 810  *   Any other value - error.
 811  **/
 812 static int
 813 lpfc_hba_down_post_s3(struct lpfc_hba *phba)
 814 {
 815         struct lpfc_sli *psli = &phba->sli;
 816         struct lpfc_sli_ring *pring;
 817         struct lpfc_dmabuf *mp, *next_mp;
 818         LIST_HEAD(completions);
 819         int i;
 820
 821         if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED)
 822                 lpfc_sli_hbqbuf_free_all(phba);
 823         else {
 824                 /* Cleanup preposted buffers on the ELS ring */
 825                 pring = &psli->ring[LPFC_ELS_RING];
 826                 list_for_each_entry_safe(mp, next_mp, &pring->postbufq, list) {
 827                         list_del(&mp->list);
 828                         pring->postbufq_cnt--;
 829                         lpfc_mbuf_free(phba, mp->virt, mp->phys);
 830                         kfree(mp);
 831                 }
 832         }
 833
 834         spin_lock_irq(&phba->hbalock);
 835         for (i = 0; i < psli->num_rings; i++) {
 836                 pring = &psli->ring[i];
 837
 838                 /* At this point in time the HBA is either reset or DOA. Either
 839                  * way, nothing should be on txcmplq as it will NEVER complete.
 840                  */
 841                 list_splice_init(&pring->txcmplq, &completions);
 842                 pring->txcmplq_cnt = 0;
 843                 spin_unlock_irq(&phba->hbalock);
 844
 845                 /* Cancel all the IOCBs from the completions list */
 846                 lpfc_sli_cancel_iocbs(phba, &completions, IOSTAT_LOCAL_REJECT,
 847                                       IOERR_SLI_ABORTED);
 848
 849                 lpfc_sli_abort_iocb_ring(phba, pring);
 850                 spin_lock_irq(&phba->hbalock);
 851         }
 852         spin_unlock_irq(&phba->hbalock);
 853
 854         return 0;
 855 }
 856
 857 /**
 858  * lpfc_hba_down_post_s4 - Perform lpfc uninitialization after HBA reset
 859  * @phba: pointer to lpfc HBA data structure.
 860  *
 861  * This routine will do uninitialization after the HBA is reset when bring
 862  * down the SLI Layer.
 863  *
 864  * Return codes
 865  *   0 - success.
 866  *   Any other value - error.
 867  **/
 868 static int
 869 lpfc_hba_down_post_s4(struct lpfc_hba *phba)
 870 {
 871         struct lpfc_scsi_buf *psb, *psb_next;
 872         LIST_HEAD(aborts);
 873         int ret;
 874         unsigned long iflag = 0;
 875         struct lpfc_sglq *sglq_entry = NULL;
 876
 877         ret = lpfc_hba_down_post_s3(phba);
 878         if (ret)
 879                 return ret;
 880         /* At this point in time the HBA is either reset or DOA. Either
 881          * way, nothing should be on lpfc_abts_els_sgl_list, it needs to be
 882          * on the lpfc_sgl_list so that it can either be freed if the
 883          * driver is unloading or reposted if the driver is restarting
 884          * the port.
 885          */
 886         spin_lock_irq(&phba->hbalock);  /* required for lpfc_sgl_list and */
 887                                         /* scsl_buf_list */
 888         /* abts_sgl_list_lock required because worker thread uses this
 889          * list.
 890          */
 891         spin_lock(&phba->sli4_hba.abts_sgl_list_lock);
 892         list_for_each_entry(sglq_entry,
 893                 &phba->sli4_hba.lpfc_abts_els_sgl_list, list)
 894                 sglq_entry->state = SGL_FREED;
 895
 896         list_splice_init(&phba->sli4_hba.lpfc_abts_els_sgl_list,
 897                         &phba->sli4_hba.lpfc_sgl_list);
 898         spin_unlock(&phba->sli4_hba.abts_sgl_list_lock);
 899         /* abts_scsi_buf_list_lock required because worker thread uses this
 900          * list.
 901          */
 902         spin_lock(&phba->sli4_hba.abts_scsi_buf_list_lock);
 903         list_splice_init(&phba->sli4_hba.lpfc_abts_scsi_buf_list,
 904                         &aborts);
 905         spin_unlock(&phba->sli4_hba.abts_scsi_buf_list_lock);
 906         spin_unlock_irq(&phba->hbalock);
 907
 908         list_for_each_entry_safe(psb, psb_next, &aborts, list) {
 909                 psb->pCmd = NULL;
 910                 psb->status = IOSTAT_SUCCESS;
 911         }
 912         spin_lock_irqsave(&phba->scsi_buf_list_lock, iflag);
 913         list_splice(&aborts, &phba->lpfc_scsi_buf_list);
 914         spin_unlock_irqrestore(&phba->scsi_buf_list_lock, iflag);
 915         return 0;
 916 }
 917
 918 /**
 919  * lpfc_hba_down_post - Wrapper func for hba down post routine
 920  * @phba: pointer to lpfc HBA data structure.
 921  *
 922  * This routine wraps the actual SLI3 or SLI4 routine for performing
 923  * uninitialization after the HBA is reset when bring down the SLI Layer.
 924  *
 925  * Return codes
 926  *   0 - success.
 927  *   Any other value - error.
 928  **/
 929 int
 930 lpfc_hba_down_post(struct lpfc_hba *phba)
 931 {
 932         return (*phba->lpfc_hba_down_post)(phba);
 933 }
 934
 935 /**
 936  * lpfc_hb_timeout - The HBA-timer timeout handler
 937  * @ptr: unsigned long holds the pointer to lpfc hba data structure.
 938  *
 939  * This is the HBA-timer timeout handler registered to the lpfc driver. When
 940  * this timer fires, a HBA timeout event shall be posted to the lpfc driver
 941  * work-port-events bitmap and the worker thread is notified. This timeout
 942  * event will be used by the worker thread to invoke the actual timeout
 943  * handler routine, lpfc_hb_timeout_handler. Any periodical operations will
 944  * be performed in the timeout handler and the HBA timeout event bit shall
 945  * be cleared by the worker thread after it has taken the event bitmap out.
 946  **/
 947 static void
 948 lpfc_hb_timeout(unsigned long ptr)
 949 {
 950         struct lpfc_hba *phba;
 951         uint32_t tmo_posted;
 952         unsigned long iflag;
 953
 954         phba = (struct lpfc_hba *)ptr;
 955
 956         /* Check for heart beat timeout conditions */
 957         spin_lock_irqsave(&phba->pport->work_port_lock, iflag);
 958         tmo_posted = phba->pport->work_port_events & WORKER_HB_TMO;
 959         if (!tmo_posted)
 960                 phba->pport->work_port_events |= WORKER_HB_TMO;
 961         spin_unlock_irqrestore(&phba->pport->work_port_lock, iflag);
 962
 963         /* Tell the worker thread there is work to do */
 964         if (!tmo_posted)
 965                 lpfc_worker_wake_up(phba);
 966         return;
 967 }
 968
 969 /**
 970  * lpfc_rrq_timeout - The RRQ-timer timeout handler
 971  * @ptr: unsigned long holds the pointer to lpfc hba data structure.
 972  *
 973  * This is the RRQ-timer timeout handler registered to the lpfc driver. When
 974  * this timer fires, a RRQ timeout event shall be posted to the lpfc driver
 975  * work-port-events bitmap and the worker thread is notified. This timeout
 976  * event will be used by the worker thread to invoke the actual timeout
 977  * handler routine, lpfc_rrq_handler. Any periodical operations will
 978  * be performed in the timeout handler and the RRQ timeout event bit shall
 979  * be cleared by the worker thread after it has taken the event bitmap out.
 980  **/
 981 static void
 982 lpfc_rrq_timeout(unsigned long ptr)
 983 {
 984         struct lpfc_hba *phba;
 985         unsigned long iflag;
 986
 987         phba = (struct lpfc_hba *)ptr;
 988         spin_lock_irqsave(&phba->pport->work_port_lock, iflag);
 989         phba->hba_flag |= HBA_RRQ_ACTIVE;
 990         spin_unlock_irqrestore(&phba->pport->work_port_lock, iflag);
 991         lpfc_worker_wake_up(phba);
 992 }
 993
 994 /**
 995  * lpfc_hb_mbox_cmpl - The lpfc heart-beat mailbox command callback function
 996  * @phba: pointer to lpfc hba data structure.
 997  * @pmboxq: pointer to the driver internal queue element for mailbox command.
 998  *
 999  * This is the callback function to the lpfc heart-beat mailbox command.
1000  * If configured, the lpfc driver issues the heart-beat mailbox command to
1001  * the HBA every LPFC_HB_MBOX_INTERVAL (current 5) seconds. At the time the
1002  * heart-beat mailbox command is issued, the driver shall set up heart-beat
1003  * timeout timer to LPFC_HB_MBOX_TIMEOUT (current 30) seconds and marks
1004  * heart-beat outstanding state. Once the mailbox command comes back and
1005  * no error conditions detected, the heart-beat mailbox command timer is
1006  * reset to LPFC_HB_MBOX_INTERVAL seconds and the heart-beat outstanding
1007  * state is cleared for the next heart-beat. If the timer expired with the
1008  * heart-beat outstanding state set, the driver will put the HBA offline.
1009  **/
1010 static void
1011 lpfc_hb_mbox_cmpl(struct lpfc_hba * phba, LPFC_MBOXQ_t * pmboxq)
1012 {
1013         unsigned long drvr_flag;
1014
1015         spin_lock_irqsave(&phba->hbalock, drvr_flag);
1016         phba->hb_outstanding = 0;
1017         spin_unlock_irqrestore(&phba->hbalock, drvr_flag);
1018
1019         /* Check and reset heart-beat timer is necessary */
1020         mempool_free(pmboxq, phba->mbox_mem_pool);
1021         if (!(phba->pport->fc_flag & FC_OFFLINE_MODE) &&
1022                 !(phba->link_state == LPFC_HBA_ERROR) &&
1023                 !(phba->pport->load_flag & FC_UNLOADING))
1024                 mod_timer(&phba->hb_tmofunc,
1025                         jiffies + HZ * LPFC_HB_MBOX_INTERVAL);
1026         return;
1027 }
1028
1029 /**
1030  * lpfc_hb_timeout_handler - The HBA-timer timeout handler
1031  * @phba: pointer to lpfc hba data structure.
1032  *
1033  * This is the actual HBA-timer timeout handler to be invoked by the worker
1034  * thread whenever the HBA timer fired and HBA-timeout event posted. This
1035  * handler performs any periodic operations needed for the device. If such
1036  * periodic event has already been attended to either in the interrupt handler
1037  * or by processing slow-ring or fast-ring events within the HBA-timer
1038  * timeout window (LPFC_HB_MBOX_INTERVAL), this handler just simply resets
1039  * the timer for the next timeout period. If lpfc heart-beat mailbox command
1040  * is configured and there is no heart-beat mailbox command outstanding, a
1041  * heart-beat mailbox is issued and timer set properly. Otherwise, if there
1042  * has been a heart-beat mailbox command outstanding, the HBA shall be put
1043  * to offline.
1044  **/
1045 void
1046 lpfc_hb_timeout_handler(struct lpfc_hba *phba)
1047 {
1048         struct lpfc_vport **vports;
1049         LPFC_MBOXQ_t *pmboxq;
1050         struct lpfc_dmabuf *buf_ptr;
1051         int retval, i;
1052         struct lpfc_sli *psli = &phba->sli;
1053         LIST_HEAD(completions);
1054
1055         vports = lpfc_create_vport_work_array(phba);
1056         if (vports != NULL)
1057                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++)
1058                         lpfc_rcv_seq_check_edtov(vports[i]);
1059         lpfc_destroy_vport_work_array(phba, vports);
1060
1061         if ((phba->link_state == LPFC_HBA_ERROR) ||
1062                 (phba->pport->load_flag & FC_UNLOADING) ||
1063                 (phba->pport->fc_flag & FC_OFFLINE_MODE))
1064                 return;
1065
1066         spin_lock_irq(&phba->pport->work_port_lock);
1067
1068         if (time_after(phba->last_completion_time + LPFC_HB_MBOX_INTERVAL * HZ,
1069                 jiffies)) {
1070                 spin_unlock_irq(&phba->pport->work_port_lock);
1071                 if (!phba->hb_outstanding)
1072                         mod_timer(&phba->hb_tmofunc,
1073                                 jiffies + HZ * LPFC_HB_MBOX_INTERVAL);
1074                 else
1075                         mod_timer(&phba->hb_tmofunc,
1076                                 jiffies + HZ * LPFC_HB_MBOX_TIMEOUT);
1077                 return;
1078         }
1079         spin_unlock_irq(&phba->pport->work_port_lock);
1080
1081         if (phba->elsbuf_cnt &&
1082                 (phba->elsbuf_cnt == phba->elsbuf_prev_cnt)) {
1083                 spin_lock_irq(&phba->hbalock);
1084                 list_splice_init(&phba->elsbuf, &completions);
1085                 phba->elsbuf_cnt = 0;
1086                 phba->elsbuf_prev_cnt = 0;
1087                 spin_unlock_irq(&phba->hbalock);
1088
1089                 while (!list_empty(&completions)) {
1090                         list_remove_head(&completions, buf_ptr,
1091                                 struct lpfc_dmabuf, list);
1092                         lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
1093                         kfree(buf_ptr);
1094                 }
1095         }
1096         phba->elsbuf_prev_cnt = phba->elsbuf_cnt;
1097
1098         /* If there is no heart beat outstanding, issue a heartbeat command */
1099         if (phba->cfg_enable_hba_heartbeat) {
1100                 if (!phba->hb_outstanding) {
1101                         if ((!(psli->sli_flag & LPFC_SLI_MBOX_ACTIVE)) &&
1102                                 (list_empty(&psli->mboxq))) {
1103                                 pmboxq = mempool_alloc(phba->mbox_mem_pool,
1104                                                         GFP_KERNEL);
1105                                 if (!pmboxq) {
1106                                         mod_timer(&phba->hb_tmofunc,
1107                                                  jiffies +
1108                                                  HZ * LPFC_HB_MBOX_INTERVAL);
1109                                         return;
1110                                 }
1111
1112                                 lpfc_heart_beat(phba, pmboxq);
1113                                 pmboxq->mbox_cmpl = lpfc_hb_mbox_cmpl;
1114                                 pmboxq->vport = phba->pport;
1115                                 retval = lpfc_sli_issue_mbox(phba, pmboxq,
1116                                                 MBX_NOWAIT);
1117
1118                                 if (retval != MBX_BUSY &&
1119                                         retval != MBX_SUCCESS) {
1120                                         mempool_free(pmboxq,
1121                                                         phba->mbox_mem_pool);
1122                                         mod_timer(&phba->hb_tmofunc,
1123                                                 jiffies +
1124                                                 HZ * LPFC_HB_MBOX_INTERVAL);
1125                                         return;
1126                                 }
1127                                 phba->skipped_hb = 0;
1128                                 phba->hb_outstanding = 1;
1129                         } else if (time_before_eq(phba->last_completion_time,
1130                                         phba->skipped_hb)) {
1131                                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
1132                                         "2857 Last completion time not "
1133                                         " updated in %d ms\n",
1134                                         jiffies_to_msecs(jiffies
1135                                                  - phba->last_completion_time));
1136                         } else
1137                                 phba->skipped_hb = jiffies;
1138
1139                         mod_timer(&phba->hb_tmofunc,
1140                                   jiffies + HZ * LPFC_HB_MBOX_TIMEOUT);
1141                         return;
1142                 } else {
1143                         /*
1144                         * If heart beat timeout called with hb_outstanding set
1145                         * we need to give the hb mailbox cmd a chance to
1146                         * complete or TMO.
1147                         */
1148                         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
1149                                         "0459 Adapter heartbeat still out"
1150                                         "standing:last compl time was %d ms.\n",
1151                                         jiffies_to_msecs(jiffies
1152                                                  - phba->last_completion_time));
1153                         mod_timer(&phba->hb_tmofunc,
1154                                   jiffies + HZ * LPFC_HB_MBOX_TIMEOUT);
1155                 }
1156         }
1157 }
1158
1159 /**
1160  * lpfc_offline_eratt - Bring lpfc offline on hardware error attention
1161  * @phba: pointer to lpfc hba data structure.
1162  *
1163  * This routine is called to bring the HBA offline when HBA hardware error
1164  * other than Port Error 6 has been detected.
1165  **/
1166 static void
1167 lpfc_offline_eratt(struct lpfc_hba *phba)
1168 {
1169         struct lpfc_sli   *psli = &phba->sli;
1170
1171         spin_lock_irq(&phba->hbalock);
1172         psli->sli_flag &= ~LPFC_SLI_ACTIVE;
1173         spin_unlock_irq(&phba->hbalock);
1174         lpfc_offline_prep(phba, LPFC_MBX_NO_WAIT);
1175
1176         lpfc_offline(phba);
1177         lpfc_reset_barrier(phba);
1178         spin_lock_irq(&phba->hbalock);
1179         lpfc_sli_brdreset(phba);
1180         spin_unlock_irq(&phba->hbalock);
1181         lpfc_hba_down_post(phba);
1182         lpfc_sli_brdready(phba, HS_MBRDY);
1183         lpfc_unblock_mgmt_io(phba);
1184         phba->link_state = LPFC_HBA_ERROR;
1185         return;
1186 }
1187
1188 /**
1189  * lpfc_sli4_offline_eratt - Bring lpfc offline on SLI4 hardware error attention
1190  * @phba: pointer to lpfc hba data structure.
1191  *
1192  * This routine is called to bring a SLI4 HBA offline when HBA hardware error
1193  * other than Port Error 6 has been detected.
1194  **/
1195 static void
1196 lpfc_sli4_offline_eratt(struct lpfc_hba *phba)
1197 {
1198         lpfc_offline_prep(phba, LPFC_MBX_NO_WAIT);
1199         lpfc_offline(phba);
1200         lpfc_sli4_brdreset(phba);
1201         lpfc_hba_down_post(phba);
1202         lpfc_sli4_post_status_check(phba);
1203         lpfc_unblock_mgmt_io(phba);
1204         phba->link_state = LPFC_HBA_ERROR;
1205 }
1206
1207 /**
1208  * lpfc_handle_deferred_eratt - The HBA hardware deferred error handler
1209  * @phba: pointer to lpfc hba data structure.
1210  *
1211  * This routine is invoked to handle the deferred HBA hardware error
1212  * conditions. This type of error is indicated by HBA by setting ER1
1213  * and another ER bit in the host status register. The driver will
1214  * wait until the ER1 bit clears before handling the error condition.
1215  **/
1216 static void
1217 lpfc_handle_deferred_eratt(struct lpfc_hba *phba)
1218 {
1219         uint32_t old_host_status = phba->work_hs;
1220         struct lpfc_sli_ring  *pring;
1221         struct lpfc_sli *psli = &phba->sli;
1222
1223         /* If the pci channel is offline, ignore possible errors,
1224          * since we cannot communicate with the pci card anyway.
1225          */
1226         if (pci_channel_offline(phba->pcidev)) {
1227                 spin_lock_irq(&phba->hbalock);
1228                 phba->hba_flag &= ~DEFER_ERATT;
1229                 spin_unlock_irq(&phba->hbalock);
1230                 return;
1231         }
1232
1233         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1234                 "0479 Deferred Adapter Hardware Error "
1235                 "Data: x%x x%x x%x\n",
1236                 phba->work_hs,
1237                 phba->work_status[0], phba->work_status[1]);
1238
1239         spin_lock_irq(&phba->hbalock);
1240         psli->sli_flag &= ~LPFC_SLI_ACTIVE;
1241         spin_unlock_irq(&phba->hbalock);
1242
1243
1244         /*
1245          * Firmware stops when it triggred erratt. That could cause the I/Os
1246          * dropped by the firmware. Error iocb (I/O) on txcmplq and let the
1247          * SCSI layer retry it after re-establishing link.
1248          */
1249         pring = &psli->ring[psli->fcp_ring];
1250         lpfc_sli_abort_iocb_ring(phba, pring);
1251
1252         /*
1253          * There was a firmware error. Take the hba offline and then
1254          * attempt to restart it.
1255          */
1256         lpfc_offline_prep(phba, LPFC_MBX_WAIT);
1257         lpfc_offline(phba);
1258
1259         /* Wait for the ER1 bit to clear.*/
1260         while (phba->work_hs & HS_FFER1) {
1261                 msleep(100);
1262                 if (lpfc_readl(phba->HSregaddr, &phba->work_hs)) {
1263                         phba->work_hs = UNPLUG_ERR ;
1264                         break;
1265                 }
1266                 /* If driver is unloading let the worker thread continue */
1267                 if (phba->pport->load_flag & FC_UNLOADING) {
1268                         phba->work_hs = 0;
1269                         break;
1270                 }
1271         }
1272
1273         /*
1274          * This is to ptrotect against a race condition in which
1275          * first write to the host attention register clear the
1276          * host status register.
1277          */
1278         if ((!phba->work_hs) && (!(phba->pport->load_flag & FC_UNLOADING)))
1279                 phba->work_hs = old_host_status & ~HS_FFER1;
1280
1281         spin_lock_irq(&phba->hbalock);
1282         phba->hba_flag &= ~DEFER_ERATT;
1283         spin_unlock_irq(&phba->hbalock);
1284         phba->work_status[0] = readl(phba->MBslimaddr + 0xa8);
1285         phba->work_status[1] = readl(phba->MBslimaddr + 0xac);
1286 }
1287
1288 static void
1289 lpfc_board_errevt_to_mgmt(struct lpfc_hba *phba)
1290 {
1291         struct lpfc_board_event_header board_event;
1292         struct Scsi_Host *shost;
1293
1294         board_event.event_type = FC_REG_BOARD_EVENT;
1295         board_event.subcategory = LPFC_EVENT_PORTINTERR;
1296         shost = lpfc_shost_from_vport(phba->pport);
1297         fc_host_post_vendor_event(shost, fc_get_event_number(),
1298                                   sizeof(board_event),
1299                                   (char *) &board_event,
1300                                   LPFC_NL_VENDOR_ID);
1301 }
1302
1303 /**
1304  * lpfc_handle_eratt_s3 - The SLI3 HBA hardware error handler
1305  * @phba: pointer to lpfc hba data structure.
1306  *
1307  * This routine is invoked to handle the following HBA hardware error
1308  * conditions:
1309  * 1 - HBA error attention interrupt
1310  * 2 - DMA ring index out of range
1311  * 3 - Mailbox command came back as unknown
1312  **/
1313 static void
1314 lpfc_handle_eratt_s3(struct lpfc_hba *phba)
1315 {
1316         struct lpfc_vport *vport = phba->pport;
1317         struct lpfc_sli   *psli = &phba->sli;
1318         struct lpfc_sli_ring  *pring;
1319         uint32_t event_data;
1320         unsigned long temperature;
1321         struct temp_event temp_event_data;
1322         struct Scsi_Host  *shost;
1323
1324         /* If the pci channel is offline, ignore possible errors,
1325          * since we cannot communicate with the pci card anyway.
1326          */
1327         if (pci_channel_offline(phba->pcidev)) {
1328                 spin_lock_irq(&phba->hbalock);
1329                 phba->hba_flag &= ~DEFER_ERATT;
1330                 spin_unlock_irq(&phba->hbalock);
1331                 return;
1332         }
1333
1334         /* If resets are disabled then leave the HBA alone and return */
1335         if (!phba->cfg_enable_hba_reset)
1336                 return;
1337
1338         /* Send an internal error event to mgmt application */
1339         lpfc_board_errevt_to_mgmt(phba);
1340
1341         if (phba->hba_flag & DEFER_ERATT)
1342                 lpfc_handle_deferred_eratt(phba);
1343
1344         if ((phba->work_hs & HS_FFER6) || (phba->work_hs & HS_FFER8)) {
1345                 if (phba->work_hs & HS_FFER6)
1346                         /* Re-establishing Link */
1347                         lpfc_printf_log(phba, KERN_INFO, LOG_LINK_EVENT,
1348                                         "1301 Re-establishing Link "
1349                                         "Data: x%x x%x x%x\n",
1350                                         phba->work_hs, phba->work_status[0],
1351                                         phba->work_status[1]);
1352                 if (phba->work_hs & HS_FFER8)
1353                         /* Device Zeroization */
1354                         lpfc_printf_log(phba, KERN_INFO, LOG_LINK_EVENT,
1355                                         "2861 Host Authentication device "
1356                                         "zeroization Data:x%x x%x x%x\n",
1357                                         phba->work_hs, phba->work_status[0],
1358                                         phba->work_status[1]);
1359
1360                 spin_lock_irq(&phba->hbalock);
1361                 psli->sli_flag &= ~LPFC_SLI_ACTIVE;
1362                 spin_unlock_irq(&phba->hbalock);
1363
1364                 /*
1365                 * Firmware stops when it triggled erratt with HS_FFER6.
1366                 * That could cause the I/Os dropped by the firmware.
1367                 * Error iocb (I/O) on txcmplq and let the SCSI layer
1368                 * retry it after re-establishing link.
1369                 */
1370                 pring = &psli->ring[psli->fcp_ring];
1371                 lpfc_sli_abort_iocb_ring(phba, pring);
1372
1373                 /*
1374                  * There was a firmware error.  Take the hba offline and then
1375                  * attempt to restart it.
1376                  */
1377                 lpfc_offline_prep(phba, LPFC_MBX_NO_WAIT);
1378                 lpfc_offline(phba);
1379                 lpfc_sli_brdrestart(phba);
1380                 if (lpfc_online(phba) == 0) {   /* Initialize the HBA */
1381                         lpfc_unblock_mgmt_io(phba);
1382                         return;
1383                 }
1384                 lpfc_unblock_mgmt_io(phba);
1385         } else if (phba->work_hs & HS_CRIT_TEMP) {
1386                 temperature = readl(phba->MBslimaddr + TEMPERATURE_OFFSET);
1387                 temp_event_data.event_type = FC_REG_TEMPERATURE_EVENT;
1388                 temp_event_data.event_code = LPFC_CRIT_TEMP;
1389                 temp_event_data.data = (uint32_t)temperature;
1390
1391                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1392                                 "0406 Adapter maximum temperature exceeded "
1393                                 "(%ld), taking this port offline "
1394                                 "Data: x%x x%x x%x\n",
1395                                 temperature, phba->work_hs,
1396                                 phba->work_status[0], phba->work_status[1]);
1397
1398                 shost = lpfc_shost_from_vport(phba->pport);
1399                 fc_host_post_vendor_event(shost, fc_get_event_number(),
1400                                           sizeof(temp_event_data),
1401                                           (char *) &temp_event_data,
1402                                           SCSI_NL_VID_TYPE_PCI
1403                                           | PCI_VENDOR_ID_EMULEX);
1404
1405                 spin_lock_irq(&phba->hbalock);
1406                 phba->over_temp_state = HBA_OVER_TEMP;
1407                 spin_unlock_irq(&phba->hbalock);
1408                 lpfc_offline_eratt(phba);
1409
1410         } else {
1411                 /* The if clause above forces this code path when the status
1412                  * failure is a value other than FFER6. Do not call the offline
1413                  * twice. This is the adapter hardware error path.
1414                  */
1415                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1416                                 "0457 Adapter Hardware Error "
1417                                 "Data: x%x x%x x%x\n",
1418                                 phba->work_hs,
1419                                 phba->work_status[0], phba->work_status[1]);
1420
1421                 event_data = FC_REG_DUMP_EVENT;
1422                 shost = lpfc_shost_from_vport(vport);
1423                 fc_host_post_vendor_event(shost, fc_get_event_number(),
1424                                 sizeof(event_data), (char *) &event_data,
1425                                 SCSI_NL_VID_TYPE_PCI | PCI_VENDOR_ID_EMULEX);
1426
1427                 lpfc_offline_eratt(phba);
1428         }
1429         return;
1430 }
1431
1432 /**
1433  * lpfc_sli4_port_sta_fn_reset - The SLI4 function reset due to port status reg
1434  * @phba: pointer to lpfc hba data structure.
1435  * @mbx_action: flag for mailbox shutdown action.
1436  *
1437  * This routine is invoked to perform an SLI4 port PCI function reset in
1438  * response to port status register polling attention. It waits for port
1439  * status register (ERR, RDY, RN) bits before proceeding with function reset.
1440  * During this process, interrupt vectors are freed and later requested
1441  * for handling possible port resource change.
1442  **/
1443 static int
1444 lpfc_sli4_port_sta_fn_reset(struct lpfc_hba *phba, int mbx_action)
1445 {
1446         int rc;
1447         uint32_t intr_mode;
1448
1449         /*
1450          * On error status condition, driver need to wait for port
1451          * ready before performing reset.
1452          */
1453         rc = lpfc_sli4_pdev_status_reg_wait(phba);
1454         if (!rc) {
1455                 /* need reset: attempt for port recovery */
1456                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1457                                 "2887 Reset Needed: Attempting Port "
1458                                 "Recovery...\n");
1459                 lpfc_offline_prep(phba, mbx_action);
1460                 lpfc_offline(phba);
1461                 /* release interrupt for possible resource change */
1462                 lpfc_sli4_disable_intr(phba);
1463                 lpfc_sli_brdrestart(phba);
1464                 /* request and enable interrupt */
1465                 intr_mode = lpfc_sli4_enable_intr(phba, phba->intr_mode);
1466                 if (intr_mode == LPFC_INTR_ERROR) {
1467                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1468                                         "3175 Failed to enable interrupt\n");
1469                         return -EIO;
1470                 } else {
1471                         phba->intr_mode = intr_mode;
1472                 }
1473                 rc = lpfc_online(phba);
1474                 if (rc == 0)
1475                         lpfc_unblock_mgmt_io(phba);
1476         }
1477         return rc;
1478 }
1479
1480 /**
1481  * lpfc_handle_eratt_s4 - The SLI4 HBA hardware error handler
1482  * @phba: pointer to lpfc hba data structure.
1483  *
1484  * This routine is invoked to handle the SLI4 HBA hardware error attention
1485  * conditions.
1486  **/
1487 static void
1488 lpfc_handle_eratt_s4(struct lpfc_hba *phba)
1489 {
1490         struct lpfc_vport *vport = phba->pport;
1491         uint32_t event_data;
1492         struct Scsi_Host *shost;
1493         uint32_t if_type;
1494         struct lpfc_register portstat_reg = {0};
1495         uint32_t reg_err1, reg_err2;
1496         uint32_t uerrlo_reg, uemasklo_reg;
1497         uint32_t pci_rd_rc1, pci_rd_rc2;
1498         int rc;
1499
1500         /* If the pci channel is offline, ignore possible errors, since
1501          * we cannot communicate with the pci card anyway.
1502          */
1503         if (pci_channel_offline(phba->pcidev))
1504                 return;
1505         /* If resets are disabled then leave the HBA alone and return */
1506         if (!phba->cfg_enable_hba_reset)
1507                 return;
1508
1509         if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
1510         switch (if_type) {
1511         case LPFC_SLI_INTF_IF_TYPE_0:
1512                 pci_rd_rc1 = lpfc_readl(
1513                                 phba->sli4_hba.u.if_type0.UERRLOregaddr,
1514                                 &uerrlo_reg);
1515                 pci_rd_rc2 = lpfc_readl(
1516                                 phba->sli4_hba.u.if_type0.UEMASKLOregaddr,
1517                                 &uemasklo_reg);
1518                 /* consider PCI bus read error as pci_channel_offline */
1519                 if (pci_rd_rc1 == -EIO && pci_rd_rc2 == -EIO)
1520                         return;
1521                 lpfc_sli4_offline_eratt(phba);
1522                 break;
1523         case LPFC_SLI_INTF_IF_TYPE_2:
1524                 pci_rd_rc1 = lpfc_readl(
1525                                 phba->sli4_hba.u.if_type2.STATUSregaddr,
1526                                 &portstat_reg.word0);
1527                 /* consider PCI bus read error as pci_channel_offline */
1528                 if (pci_rd_rc1 == -EIO) {
1529                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1530                                 "3151 PCI bus read access failure: x%x\n",
1531                                 readl(phba->sli4_hba.u.if_type2.STATUSregaddr));
1532                         return;
1533                 }
1534                 reg_err1 = readl(phba->sli4_hba.u.if_type2.ERR1regaddr);
1535                 reg_err2 = readl(phba->sli4_hba.u.if_type2.ERR2regaddr);
1536                 if (bf_get(lpfc_sliport_status_oti, &portstat_reg)) {
1537                         /* TODO: Register for Overtemp async events. */
1538                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1539                                 "2889 Port Overtemperature event, "
1540                                 "taking port offline\n");
1541                         spin_lock_irq(&phba->hbalock);
1542                         phba->over_temp_state = HBA_OVER_TEMP;
1543                         spin_unlock_irq(&phba->hbalock);
1544                         lpfc_sli4_offline_eratt(phba);
1545                         break;
1546                 }
1547                 if (reg_err1 == SLIPORT_ERR1_REG_ERR_CODE_2 &&
1548                     reg_err2 == SLIPORT_ERR2_REG_FW_RESTART)
1549                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1550                                         "3143 Port Down: Firmware Restarted\n");
1551                 else if (reg_err1 == SLIPORT_ERR1_REG_ERR_CODE_2 &&
1552                          reg_err2 == SLIPORT_ERR2_REG_FORCED_DUMP)
1553                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1554                                         "3144 Port Down: Debug Dump\n");
1555                 else if (reg_err1 == SLIPORT_ERR1_REG_ERR_CODE_2 &&
1556                          reg_err2 == SLIPORT_ERR2_REG_FUNC_PROVISON)
1557                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1558                                         "3145 Port Down: Provisioning\n");
1559
1560                 /* Check port status register for function reset */
1561                 rc = lpfc_sli4_port_sta_fn_reset(phba, LPFC_MBX_NO_WAIT);
1562                 if (rc == 0) {
1563                         /* don't report event on forced debug dump */
1564                         if (reg_err1 == SLIPORT_ERR1_REG_ERR_CODE_2 &&
1565                             reg_err2 == SLIPORT_ERR2_REG_FORCED_DUMP)
1566                                 return;
1567                         else
1568                                 break;
1569                 }
1570                 /* fall through for not able to recover */
1571                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
1572                                 "3152 Unrecoverable error, bring the port "
1573                                 "offline\n");
1574                 lpfc_sli4_offline_eratt(phba);
1575                 break;
1576         case LPFC_SLI_INTF_IF_TYPE_1:
1577         default:
1578                 break;
1579         }
1580         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
1581                         "3123 Report dump event to upper layer\n");
1582         /* Send an internal error event to mgmt application */
1583         lpfc_board_errevt_to_mgmt(phba);
1584
1585         event_data = FC_REG_DUMP_EVENT;
1586         shost = lpfc_shost_from_vport(vport);
1587         fc_host_post_vendor_event(shost, fc_get_event_number(),
1588                                   sizeof(event_data), (char *) &event_data,
1589                                   SCSI_NL_VID_TYPE_PCI | PCI_VENDOR_ID_EMULEX);
1590 }
1591
1592 /**
1593  * lpfc_handle_eratt - Wrapper func for handling hba error attention
1594  * @phba: pointer to lpfc HBA data structure.
1595  *
1596  * This routine wraps the actual SLI3 or SLI4 hba error attention handling
1597  * routine from the API jump table function pointer from the lpfc_hba struct.
1598  *
1599  * Return codes
1600  *   0 - success.
1601  *   Any other value - error.
1602  **/
1603 void
1604 lpfc_handle_eratt(struct lpfc_hba *phba)
1605 {
1606         (*phba->lpfc_handle_eratt)(phba);
1607 }
1608
1609 /**
1610  * lpfc_handle_latt - The HBA link event handler
1611  * @phba: pointer to lpfc hba data structure.
1612  *
1613  * This routine is invoked from the worker thread to handle a HBA host
1614  * attention link event.
1615  **/
1616 void
1617 lpfc_handle_latt(struct lpfc_hba *phba)
1618 {
1619         struct lpfc_vport *vport = phba->pport;
1620         struct lpfc_sli   *psli = &phba->sli;
1621         LPFC_MBOXQ_t *pmb;
1622         volatile uint32_t control;
1623         struct lpfc_dmabuf *mp;
1624         int rc = 0;
1625
1626         pmb = (LPFC_MBOXQ_t *)mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
1627         if (!pmb) {
1628                 rc = 1;
1629                 goto lpfc_handle_latt_err_exit;
1630         }
1631
1632         mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
1633         if (!mp) {
1634                 rc = 2;
1635                 goto lpfc_handle_latt_free_pmb;
1636         }
1637
1638         mp->virt = lpfc_mbuf_alloc(phba, 0, &mp->phys);
1639         if (!mp->virt) {
1640                 rc = 3;
1641                 goto lpfc_handle_latt_free_mp;
1642         }
1643
1644         /* Cleanup any outstanding ELS commands */
1645         lpfc_els_flush_all_cmd(phba);
1646
1647         psli->slistat.link_event++;
1648         lpfc_read_topology(phba, pmb, mp);
1649         pmb->mbox_cmpl = lpfc_mbx_cmpl_read_topology;
1650         pmb->vport = vport;
1651         /* Block ELS IOCBs until we have processed this mbox command */
1652         phba->sli.ring[LPFC_ELS_RING].flag |= LPFC_STOP_IOCB_EVENT;
1653         rc = lpfc_sli_issue_mbox (phba, pmb, MBX_NOWAIT);
1654         if (rc == MBX_NOT_FINISHED) {
1655                 rc = 4;
1656                 goto lpfc_handle_latt_free_mbuf;
1657         }
1658
1659         /* Clear Link Attention in HA REG */
1660         spin_lock_irq(&phba->hbalock);
1661         writel(HA_LATT, phba->HAregaddr);
1662         readl(phba->HAregaddr); /* flush */
1663         spin_unlock_irq(&phba->hbalock);
1664
1665         return;
1666
1667 lpfc_handle_latt_free_mbuf:
1668         phba->sli.ring[LPFC_ELS_RING].flag &= ~LPFC_STOP_IOCB_EVENT;
1669         lpfc_mbuf_free(phba, mp->virt, mp->phys);
1670 lpfc_handle_latt_free_mp:
1671         kfree(mp);
1672 lpfc_handle_latt_free_pmb:
1673         mempool_free(pmb, phba->mbox_mem_pool);
1674 lpfc_handle_latt_err_exit:
1675         /* Enable Link attention interrupts */
1676         spin_lock_irq(&phba->hbalock);
1677         psli->sli_flag |= LPFC_PROCESS_LA;
1678         control = readl(phba->HCregaddr);
1679         control |= HC_LAINT_ENA;
1680         writel(control, phba->HCregaddr);
1681         readl(phba->HCregaddr); /* flush */
1682
1683         /* Clear Link Attention in HA REG */
1684         writel(HA_LATT, phba->HAregaddr);
1685         readl(phba->HAregaddr); /* flush */
1686         spin_unlock_irq(&phba->hbalock);
1687         lpfc_linkdown(phba);
1688         phba->link_state = LPFC_HBA_ERROR;
1689
1690         lpfc_printf_log(phba, KERN_ERR, LOG_MBOX,
1691                      "0300 LATT: Cannot issue READ_LA: Data:%d\n", rc);
1692
1693         return;
1694 }
1695
1696 /**
1697  * lpfc_parse_vpd - Parse VPD (Vital Product Data)
1698  * @phba: pointer to lpfc hba data structure.
1699  * @vpd: pointer to the vital product data.
1700  * @len: length of the vital product data in bytes.
1701  *
1702  * This routine parses the Vital Product Data (VPD). The VPD is treated as
1703  * an array of characters. In this routine, the ModelName, ProgramType, and
1704  * ModelDesc, etc. fields of the phba data structure will be populated.
1705  *
1706  * Return codes
1707  *   0 - pointer to the VPD passed in is NULL
1708  *   1 - success
1709  **/
1710 int
1711 lpfc_parse_vpd(struct lpfc_hba *phba, uint8_t *vpd, int len)
1712 {
1713         uint8_t lenlo, lenhi;
1714         int Length;
1715         int i, j;
1716         int finished = 0;
1717         int index = 0;
1718
1719         if (!vpd)
1720                 return 0;
1721
1722         /* Vital Product */
1723         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
1724                         "0455 Vital Product Data: x%x x%x x%x x%x\n",
1725                         (uint32_t) vpd[0], (uint32_t) vpd[1], (uint32_t) vpd[2],
1726                         (uint32_t) vpd[3]);
1727         while (!finished && (index < (len - 4))) {
1728                 switch (vpd[index]) {
1729                 case 0x82:
1730                 case 0x91:
1731                         index += 1;
1732                         lenlo = vpd[index];
1733                         index += 1;
1734                         lenhi = vpd[index];
1735                         index += 1;
1736                         i = ((((unsigned short)lenhi) << 8) + lenlo);
1737                         index += i;
1738                         break;
1739                 case 0x90:
1740                         index += 1;
1741                         lenlo = vpd[index];
1742                         index += 1;
1743                         lenhi = vpd[index];
1744                         index += 1;
1745                         Length = ((((unsigned short)lenhi) << 8) + lenlo);
1746                         if (Length > len - index)
1747                                 Length = len - index;
1748                         while (Length > 0) {
1749                         /* Look for Serial Number */
1750                         if ((vpd[index] == 'S') && (vpd[index+1] == 'N')) {
1751                                 index += 2;
1752                                 i = vpd[index];
1753                                 index += 1;
1754                                 j = 0;
1755                                 Length -= (3+i);
1756                                 while(i--) {
1757                                         phba->SerialNumber[j++] = vpd[index++];
1758                                         if (j == 31)
1759                                                 break;
1760                                 }
1761                                 phba->SerialNumber[j] = 0;
1762                                 continue;
1763                         }
1764                         else if ((vpd[index] == 'V') && (vpd[index+1] == '1')) {
1765                                 phba->vpd_flag |= VPD_MODEL_DESC;
1766                                 index += 2;
1767                                 i = vpd[index];
1768                                 index += 1;
1769                                 j = 0;
1770                                 Length -= (3+i);
1771                                 while(i--) {
1772                                         phba->ModelDesc[j++] = vpd[index++];
1773                                         if (j == 255)
1774                                                 break;
1775                                 }
1776                                 phba->ModelDesc[j] = 0;
1777                                 continue;
1778                         }
1779                         else if ((vpd[index] == 'V') && (vpd[index+1] == '2')) {
1780                                 phba->vpd_flag |= VPD_MODEL_NAME;
1781                                 index += 2;
1782                                 i = vpd[index];
1783                                 index += 1;
1784                                 j = 0;
1785                                 Length -= (3+i);
1786                                 while(i--) {
1787                                         phba->ModelName[j++] = vpd[index++];
1788                                         if (j == 79)
1789                                                 break;
1790                                 }
1791                                 phba->ModelName[j] = 0;
1792                                 continue;
1793                         }
1794                         else if ((vpd[index] == 'V') && (vpd[index+1] == '3')) {
1795                                 phba->vpd_flag |= VPD_PROGRAM_TYPE;
1796                                 index += 2;
1797                                 i = vpd[index];
1798                                 index += 1;
1799                                 j = 0;
1800                                 Length -= (3+i);
1801                                 while(i--) {
1802                                         phba->ProgramType[j++] = vpd[index++];
1803                                         if (j == 255)
1804                                                 break;
1805                                 }
1806                                 phba->ProgramType[j] = 0;
1807                                 continue;
1808                         }
1809                         else if ((vpd[index] == 'V') && (vpd[index+1] == '4')) {
1810                                 phba->vpd_flag |= VPD_PORT;
1811                                 index += 2;
1812                                 i = vpd[index];
1813                                 index += 1;
1814                                 j = 0;
1815                                 Length -= (3+i);
1816                                 while(i--) {
1817                                         if ((phba->sli_rev == LPFC_SLI_REV4) &&
1818                                             (phba->sli4_hba.pport_name_sta ==
1819                                              LPFC_SLI4_PPNAME_GET)) {
1820                                                 j++;
1821                                                 index++;
1822                                         } else
1823                                                 phba->Port[j++] = vpd[index++];
1824                                         if (j == 19)
1825                                                 break;
1826                                 }
1827                                 if ((phba->sli_rev != LPFC_SLI_REV4) ||
1828                                     (phba->sli4_hba.pport_name_sta ==
1829                                      LPFC_SLI4_PPNAME_NON))
1830                                         phba->Port[j] = 0;
1831                                 continue;
1832                         }
1833                         else {
1834                                 index += 2;
1835                                 i = vpd[index];
1836                                 index += 1;
1837                                 index += i;
1838                                 Length -= (3 + i);
1839                         }
1840                 }
1841                 finished = 0;
1842                 break;
1843                 case 0x78:
1844                         finished = 1;
1845                         break;
1846                 default:
1847                         index ++;
1848                         break;
1849                 }
1850         }
1851
1852         return(1);
1853 }
1854
1855 /**
1856  * lpfc_get_hba_model_desc - Retrieve HBA device model name and description
1857  * @phba: pointer to lpfc hba data structure.
1858  * @mdp: pointer to the data structure to hold the derived model name.
1859  * @descp: pointer to the data structure to hold the derived description.
1860  *
1861  * This routine retrieves HBA's description based on its registered PCI device
1862  * ID. The @descp passed into this function points to an array of 256 chars. It
1863  * shall be returned with the model name, maximum speed, and the host bus type.
1864  * The @mdp passed into this function points to an array of 80 chars. When the
1865  * function returns, the @mdp will be filled with the model name.
1866  **/
1867 static void
1868 lpfc_get_hba_model_desc(struct lpfc_hba *phba, uint8_t *mdp, uint8_t *descp)
1869 {
1870         lpfc_vpd_t *vp;
1871         uint16_t dev_id = phba->pcidev->device;
1872         int max_speed;
1873         int GE = 0;
1874         int oneConnect = 0; /* default is not a oneConnect */
1875         struct {
1876                 char *name;
1877                 char *bus;
1878                 char *function;
1879         } m = {"<Unknown>", "", ""};
1880
1881         if (mdp && mdp[0] != '\0'
1882                 && descp && descp[0] != '\0')
1883                 return;
1884
1885         if (phba->lmt & LMT_16Gb)
1886                 max_speed = 16;
1887         else if (phba->lmt & LMT_10Gb)
1888                 max_speed = 10;
1889         else if (phba->lmt & LMT_8Gb)
1890                 max_speed = 8;
1891         else if (phba->lmt & LMT_4Gb)
1892                 max_speed = 4;
1893         else if (phba->lmt & LMT_2Gb)
1894                 max_speed = 2;
1895         else if (phba->lmt & LMT_1Gb)
1896                 max_speed = 1;
1897         else
1898                 max_speed = 0;
1899
1900         vp = &phba->vpd;
1901
1902         switch (dev_id) {
1903         case PCI_DEVICE_ID_FIREFLY:
1904                 m = (typeof(m)){"LP6000", "PCI", "Fibre Channel Adapter"};
1905                 break;
1906         case PCI_DEVICE_ID_SUPERFLY:
1907                 if (vp->rev.biuRev >= 1 && vp->rev.biuRev <= 3)
1908                         m = (typeof(m)){"LP7000", "PCI",
1909                                         "Fibre Channel Adapter"};
1910                 else
1911                         m = (typeof(m)){"LP7000E", "PCI",
1912                                         "Fibre Channel Adapter"};
1913                 break;
1914         case PCI_DEVICE_ID_DRAGONFLY:
1915                 m = (typeof(m)){"LP8000", "PCI",
1916                                 "Fibre Channel Adapter"};
1917                 break;
1918         case PCI_DEVICE_ID_CENTAUR:
1919                 if (FC_JEDEC_ID(vp->rev.biuRev) == CENTAUR_2G_JEDEC_ID)
1920                         m = (typeof(m)){"LP9002", "PCI",
1921                                         "Fibre Channel Adapter"};
1922                 else
1923                         m = (typeof(m)){"LP9000", "PCI",
1924                                         "Fibre Channel Adapter"};
1925                 break;
1926         case PCI_DEVICE_ID_RFLY:
1927                 m = (typeof(m)){"LP952", "PCI",
1928                                 "Fibre Channel Adapter"};
1929                 break;
1930         case PCI_DEVICE_ID_PEGASUS:
1931                 m = (typeof(m)){"LP9802", "PCI-X",
1932                                 "Fibre Channel Adapter"};
1933                 break;
1934         case PCI_DEVICE_ID_THOR:
1935                 m = (typeof(m)){"LP10000", "PCI-X",
1936                                 "Fibre Channel Adapter"};
1937                 break;
1938         case PCI_DEVICE_ID_VIPER:
1939                 m = (typeof(m)){"LPX1000",  "PCI-X",
1940                                 "Fibre Channel Adapter"};
1941                 break;
1942         case PCI_DEVICE_ID_PFLY:
1943                 m = (typeof(m)){"LP982", "PCI-X",
1944                                 "Fibre Channel Adapter"};
1945                 break;
1946         case PCI_DEVICE_ID_TFLY:
1947                 m = (typeof(m)){"LP1050", "PCI-X",
1948                                 "Fibre Channel Adapter"};
1949                 break;
1950         case PCI_DEVICE_ID_HELIOS:
1951                 m = (typeof(m)){"LP11000", "PCI-X2",
1952                                 "Fibre Channel Adapter"};
1953                 break;
1954         case PCI_DEVICE_ID_HELIOS_SCSP:
1955                 m = (typeof(m)){"LP11000-SP", "PCI-X2",
1956                                 "Fibre Channel Adapter"};
1957                 break;
1958         case PCI_DEVICE_ID_HELIOS_DCSP:
1959                 m = (typeof(m)){"LP11002-SP",  "PCI-X2",
1960                                 "Fibre Channel Adapter"};
1961                 break;
1962         case PCI_DEVICE_ID_NEPTUNE:
1963                 m = (typeof(m)){"LPe1000", "PCIe", "Fibre Channel Adapter"};
1964                 break;
1965         case PCI_DEVICE_ID_NEPTUNE_SCSP:
1966                 m = (typeof(m)){"LPe1000-SP", "PCIe", "Fibre Channel Adapter"};
1967                 break;
1968         case PCI_DEVICE_ID_NEPTUNE_DCSP:
1969                 m = (typeof(m)){"LPe1002-SP", "PCIe", "Fibre Channel Adapter"};
1970                 break;
1971         case PCI_DEVICE_ID_BMID:
1972                 m = (typeof(m)){"LP1150", "PCI-X2", "Fibre Channel Adapter"};
1973                 break;
1974         case PCI_DEVICE_ID_BSMB:
1975                 m = (typeof(m)){"LP111", "PCI-X2", "Fibre Channel Adapter"};
1976                 break;
1977         case PCI_DEVICE_ID_ZEPHYR:
1978                 m = (typeof(m)){"LPe11000", "PCIe", "Fibre Channel Adapter"};
1979                 break;
1980         case PCI_DEVICE_ID_ZEPHYR_SCSP:
1981                 m = (typeof(m)){"LPe11000", "PCIe", "Fibre Channel Adapter"};
1982                 break;
1983         case PCI_DEVICE_ID_ZEPHYR_DCSP:
1984                 m = (typeof(m)){"LP2105", "PCIe", "FCoE Adapter"};
1985                 GE = 1;
1986                 break;
1987         case PCI_DEVICE_ID_ZMID:
1988                 m = (typeof(m)){"LPe1150", "PCIe", "Fibre Channel Adapter"};
1989                 break;
1990         case PCI_DEVICE_ID_ZSMB:
1991                 m = (typeof(m)){"LPe111", "PCIe", "Fibre Channel Adapter"};
1992                 break;
1993         case PCI_DEVICE_ID_LP101:
1994                 m = (typeof(m)){"LP101", "PCI-X", "Fibre Channel Adapter"};
1995                 break;
1996         case PCI_DEVICE_ID_LP10000S:
1997                 m = (typeof(m)){"LP10000-S", "PCI", "Fibre Channel Adapter"};
1998                 break;
1999         case PCI_DEVICE_ID_LP11000S:
2000                 m = (typeof(m)){"LP11000-S", "PCI-X2", "Fibre Channel Adapter"};
2001                 break;
2002         case PCI_DEVICE_ID_LPE11000S:
2003                 m = (typeof(m)){"LPe11000-S", "PCIe", "Fibre Channel Adapter"};
2004                 break;
2005         case PCI_DEVICE_ID_SAT:
2006                 m = (typeof(m)){"LPe12000", "PCIe", "Fibre Channel Adapter"};
2007                 break;
2008         case PCI_DEVICE_ID_SAT_MID:
2009                 m = (typeof(m)){"LPe1250", "PCIe", "Fibre Channel Adapter"};
2010                 break;
2011         case PCI_DEVICE_ID_SAT_SMB:
2012                 m = (typeof(m)){"LPe121", "PCIe", "Fibre Channel Adapter"};
2013                 break;
2014         case PCI_DEVICE_ID_SAT_DCSP:
2015                 m = (typeof(m)){"LPe12002-SP", "PCIe", "Fibre Channel Adapter"};
2016                 break;
2017         case PCI_DEVICE_ID_SAT_SCSP:
2018                 m = (typeof(m)){"LPe12000-SP", "PCIe", "Fibre Channel Adapter"};
2019                 break;
2020         case PCI_DEVICE_ID_SAT_S:
2021                 m = (typeof(m)){"LPe12000-S", "PCIe", "Fibre Channel Adapter"};
2022                 break;
2023         case PCI_DEVICE_ID_HORNET:
2024                 m = (typeof(m)){"LP21000", "PCIe", "FCoE Adapter"};
2025                 GE = 1;
2026                 break;
2027         case PCI_DEVICE_ID_PROTEUS_VF:
2028                 m = (typeof(m)){"LPev12000", "PCIe IOV",
2029                                 "Fibre Channel Adapter"};
2030                 break;
2031         case PCI_DEVICE_ID_PROTEUS_PF:
2032                 m = (typeof(m)){"LPev12000", "PCIe IOV",
2033                                 "Fibre Channel Adapter"};
2034                 break;
2035         case PCI_DEVICE_ID_PROTEUS_S:
2036                 m = (typeof(m)){"LPemv12002-S", "PCIe IOV",
2037                                 "Fibre Channel Adapter"};
2038                 break;
2039         case PCI_DEVICE_ID_TIGERSHARK:
2040                 oneConnect = 1;
2041                 m = (typeof(m)){"OCe10100", "PCIe", "FCoE"};
2042                 break;
2043         case PCI_DEVICE_ID_TOMCAT:
2044                 oneConnect = 1;
2045                 m = (typeof(m)){"OCe11100", "PCIe", "FCoE"};
2046                 break;
2047         case PCI_DEVICE_ID_FALCON:
2048                 m = (typeof(m)){"LPSe12002-ML1-E", "PCIe",
2049                                 "EmulexSecure Fibre"};
2050                 break;
2051         case PCI_DEVICE_ID_BALIUS:
2052                 m = (typeof(m)){"LPVe12002", "PCIe Shared I/O",
2053                                 "Fibre Channel Adapter"};
2054                 break;
2055         case PCI_DEVICE_ID_LANCER_FC:
2056         case PCI_DEVICE_ID_LANCER_FC_VF:
2057                 m = (typeof(m)){"LPe16000", "PCIe", "Fibre Channel Adapter"};
2058                 break;
2059         case PCI_DEVICE_ID_LANCER_FCOE:
2060         case PCI_DEVICE_ID_LANCER_FCOE_VF:
2061                 oneConnect = 1;
2062                 m = (typeof(m)){"OCe15100", "PCIe", "FCoE"};
2063                 break;
2064         case PCI_DEVICE_ID_SKYHAWK:
2065         case PCI_DEVICE_ID_SKYHAWK_VF:
2066                 oneConnect = 1;
2067                 m = (typeof(m)){"OCe14000", "PCIe", "FCoE"};
2068                 break;
2069         default:
2070                 m = (typeof(m)){"Unknown", "", ""};
2071                 break;
2072         }
2073
2074         if (mdp && mdp[0] == '\0')
2075                 snprintf(mdp, 79,"%s", m.name);
2076         /*
2077          * oneConnect hba requires special processing, they are all initiators
2078          * and we put the port number on the end
2079          */
2080         if (descp && descp[0] == '\0') {
2081                 if (oneConnect)
2082                         snprintf(descp, 255,
2083                                 "Emulex OneConnect %s, %s Initiator %s",
2084                                 m.name, m.function,
2085                                 phba->Port);
2086                 else if (max_speed == 0)
2087                         snprintf(descp, 255,
2088                                 "Emulex %s %s %s ",
2089                                 m.name, m.bus, m.function);
2090                 else
2091                         snprintf(descp, 255,
2092                                 "Emulex %s %d%s %s %s",
2093                                 m.name, max_speed, (GE) ? "GE" : "Gb",
2094                                 m.bus, m.function);
2095         }
2096 }
2097
2098 /**
2099  * lpfc_post_buffer - Post IOCB(s) with DMA buffer descriptor(s) to a IOCB ring
2100  * @phba: pointer to lpfc hba data structure.
2101  * @pring: pointer to a IOCB ring.
2102  * @cnt: the number of IOCBs to be posted to the IOCB ring.
2103  *
2104  * This routine posts a given number of IOCBs with the associated DMA buffer
2105  * descriptors specified by the cnt argument to the given IOCB ring.
2106  *
2107  * Return codes
2108  *   The number of IOCBs NOT able to be posted to the IOCB ring.
2109  **/
2110 int
2111 lpfc_post_buffer(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, int cnt)
2112 {
2113         IOCB_t *icmd;
2114         struct lpfc_iocbq *iocb;
2115         struct lpfc_dmabuf *mp1, *mp2;
2116
2117         cnt += pring->missbufcnt;
2118
2119         /* While there are buffers to post */
2120         while (cnt > 0) {
2121                 /* Allocate buffer for  command iocb */
2122                 iocb = lpfc_sli_get_iocbq(phba);
2123                 if (iocb == NULL) {
2124                         pring->missbufcnt = cnt;
2125                         return cnt;
2126                 }
2127                 icmd = &iocb->iocb;
2128
2129                 /* 2 buffers can be posted per command */
2130                 /* Allocate buffer to post */
2131                 mp1 = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
2132                 if (mp1)
2133                     mp1->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &mp1->phys);
2134                 if (!mp1 || !mp1->virt) {
2135                         kfree(mp1);
2136                         lpfc_sli_release_iocbq(phba, iocb);
2137                         pring->missbufcnt = cnt;
2138                         return cnt;
2139                 }
2140
2141                 INIT_LIST_HEAD(&mp1->list);
2142                 /* Allocate buffer to post */
2143                 if (cnt > 1) {
2144                         mp2 = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
2145                         if (mp2)
2146                                 mp2->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
2147                                                             &mp2->phys);
2148                         if (!mp2 || !mp2->virt) {
2149                                 kfree(mp2);
2150                                 lpfc_mbuf_free(phba, mp1->virt, mp1->phys);
2151                                 kfree(mp1);
2152                                 lpfc_sli_release_iocbq(phba, iocb);
2153                                 pring->missbufcnt = cnt;
2154                                 return cnt;
2155                         }
2156
2157                         INIT_LIST_HEAD(&mp2->list);
2158                 } else {
2159                         mp2 = NULL;
2160                 }
2161
2162                 icmd->un.cont64[0].addrHigh = putPaddrHigh(mp1->phys);
2163                 icmd->un.cont64[0].addrLow = putPaddrLow(mp1->phys);
2164                 icmd->un.cont64[0].tus.f.bdeSize = FCELSSIZE;
2165                 icmd->ulpBdeCount = 1;
2166                 cnt--;
2167                 if (mp2) {
2168                         icmd->un.cont64[1].addrHigh = putPaddrHigh(mp2->phys);
2169                         icmd->un.cont64[1].addrLow = putPaddrLow(mp2->phys);
2170                         icmd->un.cont64[1].tus.f.bdeSize = FCELSSIZE;
2171                         cnt--;
2172                         icmd->ulpBdeCount = 2;
2173                 }
2174
2175                 icmd->ulpCommand = CMD_QUE_RING_BUF64_CN;
2176                 icmd->ulpLe = 1;
2177
2178                 if (lpfc_sli_issue_iocb(phba, pring->ringno, iocb, 0) ==
2179                     IOCB_ERROR) {
2180                         lpfc_mbuf_free(phba, mp1->virt, mp1->phys);
2181                         kfree(mp1);
2182                         cnt++;
2183                         if (mp2) {
2184                                 lpfc_mbuf_free(phba, mp2->virt, mp2->phys);
2185                                 kfree(mp2);
2186                                 cnt++;
2187                         }
2188                         lpfc_sli_release_iocbq(phba, iocb);
2189                         pring->missbufcnt = cnt;
2190                         return cnt;
2191                 }
2192                 lpfc_sli_ringpostbuf_put(phba, pring, mp1);
2193                 if (mp2)
2194                         lpfc_sli_ringpostbuf_put(phba, pring, mp2);
2195         }
2196         pring->missbufcnt = 0;
2197         return 0;
2198 }
2199
2200 /**
2201  * lpfc_post_rcv_buf - Post the initial receive IOCB buffers to ELS ring
2202  * @phba: pointer to lpfc hba data structure.
2203  *
2204  * This routine posts initial receive IOCB buffers to the ELS ring. The
2205  * current number of initial IOCB buffers specified by LPFC_BUF_RING0 is
2206  * set to 64 IOCBs.
2207  *
2208  * Return codes
2209  *   0 - success (currently always success)
2210  **/
2211 static int
2212 lpfc_post_rcv_buf(struct lpfc_hba *phba)
2213 {
2214         struct lpfc_sli *psli = &phba->sli;
2215
2216         /* Ring 0, ELS / CT buffers */
2217         lpfc_post_buffer(phba, &psli->ring[LPFC_ELS_RING], LPFC_BUF_RING0);
2218         /* Ring 2 - FCP no buffers needed */
2219
2220         return 0;
2221 }
2222
2223 #define S(N,V) (((V)<<(N))|((V)>>(32-(N))))
2224
2225 /**
2226  * lpfc_sha_init - Set up initial array of hash table entries
2227  * @HashResultPointer: pointer to an array as hash table.
2228  *
2229  * This routine sets up the initial values to the array of hash table entries
2230  * for the LC HBAs.
2231  **/
2232 static void
2233 lpfc_sha_init(uint32_t * HashResultPointer)
2234 {
2235         HashResultPointer[0] = 0x67452301;
2236         HashResultPointer[1] = 0xEFCDAB89;
2237         HashResultPointer[2] = 0x98BADCFE;
2238         HashResultPointer[3] = 0x10325476;
2239         HashResultPointer[4] = 0xC3D2E1F0;
2240 }
2241
2242 /**
2243  * lpfc_sha_iterate - Iterate initial hash table with the working hash table
2244  * @HashResultPointer: pointer to an initial/result hash table.
2245  * @HashWorkingPointer: pointer to an working hash table.
2246  *
2247  * This routine iterates an initial hash table pointed by @HashResultPointer
2248  * with the values from the working hash table pointeed by @HashWorkingPointer.
2249  * The results are putting back to the initial hash table, returned through
2250  * the @HashResultPointer as the result hash table.
2251  **/
2252 static void
2253 lpfc_sha_iterate(uint32_t * HashResultPointer, uint32_t * HashWorkingPointer)
2254 {
2255         int t;
2256         uint32_t TEMP;
2257         uint32_t A, B, C, D, E;
2258         t = 16;
2259         do {
2260                 HashWorkingPointer[t] =
2261                     S(1,
2262                       HashWorkingPointer[t - 3] ^ HashWorkingPointer[t -
2263                                                                      8] ^
2264                       HashWorkingPointer[t - 14] ^ HashWorkingPointer[t - 16]);
2265         } while (++t <= 79);
2266         t = 0;
2267         A = HashResultPointer[0];
2268         B = HashResultPointer[1];
2269         C = HashResultPointer[2];
2270         D = HashResultPointer[3];
2271         E = HashResultPointer[4];
2272
2273         do {
2274                 if (t < 20) {
2275                         TEMP = ((B & C) | ((~B) & D)) + 0x5A827999;
2276                 } else if (t < 40) {
2277                         TEMP = (B ^ C ^ D) + 0x6ED9EBA1;
2278                 } else if (t < 60) {
2279                         TEMP = ((B & C) | (B & D) | (C & D)) + 0x8F1BBCDC;
2280                 } else {
2281                         TEMP = (B ^ C ^ D) + 0xCA62C1D6;
2282                 }
2283                 TEMP += S(5, A) + E + HashWorkingPointer[t];
2284                 E = D;
2285                 D = C;
2286                 C = S(30, B);
2287                 B = A;
2288                 A = TEMP;
2289         } while (++t <= 79);
2290
2291         HashResultPointer[0] += A;
2292         HashResultPointer[1] += B;
2293         HashResultPointer[2] += C;
2294         HashResultPointer[3] += D;
2295         HashResultPointer[4] += E;
2296
2297 }
2298
2299 /**
2300  * lpfc_challenge_key - Create challenge key based on WWPN of the HBA
2301  * @RandomChallenge: pointer to the entry of host challenge random number array.
2302  * @HashWorking: pointer to the entry of the working hash array.
2303  *
2304  * This routine calculates the working hash array referred by @HashWorking
2305  * from the challenge random numbers associated with the host, referred by
2306  * @RandomChallenge. The result is put into the entry of the working hash
2307  * array and returned by reference through @HashWorking.
2308  **/
2309 static void
2310 lpfc_challenge_key(uint32_t * RandomChallenge, uint32_t * HashWorking)
2311 {
2312         *HashWorking = (*RandomChallenge ^ *HashWorking);
2313 }
2314
2315 /**
2316  * lpfc_hba_init - Perform special handling for LC HBA initialization
2317  * @phba: pointer to lpfc hba data structure.
2318  * @hbainit: pointer to an array of unsigned 32-bit integers.
2319  *
2320  * This routine performs the special handling for LC HBA initialization.
2321  **/
2322 void
2323 lpfc_hba_init(struct lpfc_hba *phba, uint32_t *hbainit)
2324 {
2325         int t;
2326         uint32_t *HashWorking;
2327         uint32_t *pwwnn = (uint32_t *) phba->wwnn;
2328
2329         HashWorking = kcalloc(80, sizeof(uint32_t), GFP_KERNEL);
2330         if (!HashWorking)
2331                 return;
2332
2333         HashWorking[0] = HashWorking[78] = *pwwnn++;
2334         HashWorking[1] = HashWorking[79] = *pwwnn;
2335
2336         for (t = 0; t < 7; t++)
2337                 lpfc_challenge_key(phba->RandomData + t, HashWorking + t);
2338
2339         lpfc_sha_init(hbainit);
2340         lpfc_sha_iterate(hbainit, HashWorking);
2341         kfree(HashWorking);
2342 }
2343
2344 /**
2345  * lpfc_cleanup - Performs vport cleanups before deleting a vport
2346  * @vport: pointer to a virtual N_Port data structure.
2347  *
2348  * This routine performs the necessary cleanups before deleting the @vport.
2349  * It invokes the discovery state machine to perform necessary state
2350  * transitions and to release the ndlps associated with the @vport. Note,
2351  * the physical port is treated as @vport 0.
2352  **/
2353 void
2354 lpfc_cleanup(struct lpfc_vport *vport)
2355 {
2356         struct lpfc_hba   *phba = vport->phba;
2357         struct lpfc_nodelist *ndlp, *next_ndlp;
2358         int i = 0;
2359
2360         if (phba->link_state > LPFC_LINK_DOWN)
2361                 lpfc_port_link_failure(vport);
2362
2363         list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
2364                 if (!NLP_CHK_NODE_ACT(ndlp)) {
2365                         ndlp = lpfc_enable_node(vport, ndlp,
2366                                                 NLP_STE_UNUSED_NODE);
2367                         if (!ndlp)
2368                                 continue;
2369                         spin_lock_irq(&phba->ndlp_lock);
2370                         NLP_SET_FREE_REQ(ndlp);
2371                         spin_unlock_irq(&phba->ndlp_lock);
2372                         /* Trigger the release of the ndlp memory */
2373                         lpfc_nlp_put(ndlp);
2374                         continue;
2375                 }
2376                 spin_lock_irq(&phba->ndlp_lock);
2377                 if (NLP_CHK_FREE_REQ(ndlp)) {
2378                         /* The ndlp should not be in memory free mode already */
2379                         spin_unlock_irq(&phba->ndlp_lock);
2380                         continue;
2381                 } else
2382                         /* Indicate request for freeing ndlp memory */
2383                         NLP_SET_FREE_REQ(ndlp);
2384                 spin_unlock_irq(&phba->ndlp_lock);
2385
2386                 if (vport->port_type != LPFC_PHYSICAL_PORT &&
2387                     ndlp->nlp_DID == Fabric_DID) {
2388                         /* Just free up ndlp with Fabric_DID for vports */
2389                         lpfc_nlp_put(ndlp);
2390                         continue;
2391                 }
2392
2393                 /* take care of nodes in unused state before the state
2394                  * machine taking action.
2395                  */
2396                 if (ndlp->nlp_state == NLP_STE_UNUSED_NODE) {
2397                         lpfc_nlp_put(ndlp);
2398                         continue;
2399                 }
2400
2401                 if (ndlp->nlp_type & NLP_FABRIC)
2402                         lpfc_disc_state_machine(vport, ndlp, NULL,
2403                                         NLP_EVT_DEVICE_RECOVERY);
2404
2405                 lpfc_disc_state_machine(vport, ndlp, NULL,
2406                                              NLP_EVT_DEVICE_RM);
2407         }
2408
2409         /* At this point, ALL ndlp's should be gone
2410          * because of the previous NLP_EVT_DEVICE_RM.
2411          * Lets wait for this to happen, if needed.
2412          */
2413         while (!list_empty(&vport->fc_nodes)) {
2414                 if (i++ > 3000) {
2415                         lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
2416                                 "0233 Nodelist not empty\n");
2417                         list_for_each_entry_safe(ndlp, next_ndlp,
2418                                                 &vport->fc_nodes, nlp_listp) {
2419                                 lpfc_printf_vlog(ndlp->vport, KERN_ERR,
2420                                                 LOG_NODE,
2421                                                 "0282 did:x%x ndlp:x%p "
2422                                                 "usgmap:x%x refcnt:%d\n",
2423                                                 ndlp->nlp_DID, (void *)ndlp,
2424                                                 ndlp->nlp_usg_map,
2425                                                 atomic_read(
2426                                                         &ndlp->kref.refcount));
2427                         }
2428                         break;
2429                 }
2430
2431                 /* Wait for any activity on ndlps to settle */
2432                 msleep(10);
2433         }
2434         lpfc_cleanup_vports_rrqs(vport, NULL);
2435 }
2436
2437 /**
2438  * lpfc_stop_vport_timers - Stop all the timers associated with a vport
2439  * @vport: pointer to a virtual N_Port data structure.
2440  *
2441  * This routine stops all the timers associated with a @vport. This function
2442  * is invoked before disabling or deleting a @vport. Note that the physical
2443  * port is treated as @vport 0.
2444  **/
2445 void
2446 lpfc_stop_vport_timers(struct lpfc_vport *vport)
2447 {
2448         del_timer_sync(&vport->els_tmofunc);
2449         del_timer_sync(&vport->fc_fdmitmo);
2450         del_timer_sync(&vport->delayed_disc_tmo);
2451         lpfc_can_disctmo(vport);
2452         return;
2453 }
2454
2455 /**
2456  * __lpfc_sli4_stop_fcf_redisc_wait_timer - Stop FCF rediscovery wait timer
2457  * @phba: pointer to lpfc hba data structure.
2458  *
2459  * This routine stops the SLI4 FCF rediscover wait timer if it's on. The
2460  * caller of this routine should already hold the host lock.
2461  **/
2462 void
2463 __lpfc_sli4_stop_fcf_redisc_wait_timer(struct lpfc_hba *phba)
2464 {
2465         /* Clear pending FCF rediscovery wait flag */
2466         phba->fcf.fcf_flag &= ~FCF_REDISC_PEND;
2467
2468         /* Now, try to stop the timer */
2469         del_timer(&phba->fcf.redisc_wait);
2470 }
2471
2472 /**
2473  * lpfc_sli4_stop_fcf_redisc_wait_timer - Stop FCF rediscovery wait timer
2474  * @phba: pointer to lpfc hba data structure.
2475  *
2476  * This routine stops the SLI4 FCF rediscover wait timer if it's on. It
2477  * checks whether the FCF rediscovery wait timer is pending with the host
2478  * lock held before proceeding with disabling the timer and clearing the
2479  * wait timer pendig flag.
2480  **/
2481 void
2482 lpfc_sli4_stop_fcf_redisc_wait_timer(struct lpfc_hba *phba)
2483 {
2484         spin_lock_irq(&phba->hbalock);
2485         if (!(phba->fcf.fcf_flag & FCF_REDISC_PEND)) {
2486                 /* FCF rediscovery timer already fired or stopped */
2487                 spin_unlock_irq(&phba->hbalock);
2488                 return;
2489         }
2490         __lpfc_sli4_stop_fcf_redisc_wait_timer(phba);
2491         /* Clear failover in progress flags */
2492         phba->fcf.fcf_flag &= ~(FCF_DEAD_DISC | FCF_ACVL_DISC);
2493         spin_unlock_irq(&phba->hbalock);
2494 }
2495
2496 /**
2497  * lpfc_stop_hba_timers - Stop all the timers associated with an HBA
2498  * @phba: pointer to lpfc hba data structure.
2499  *
2500  * This routine stops all the timers associated with a HBA. This function is
2501  * invoked before either putting a HBA offline or unloading the driver.
2502  **/
2503 void
2504 lpfc_stop_hba_timers(struct lpfc_hba *phba)
2505 {
2506         lpfc_stop_vport_timers(phba->pport);
2507         del_timer_sync(&phba->sli.mbox_tmo);
2508         del_timer_sync(&phba->fabric_block_timer);
2509         del_timer_sync(&phba->eratt_poll);
2510         del_timer_sync(&phba->hb_tmofunc);
2511         if (phba->sli_rev == LPFC_SLI_REV4) {
2512                 del_timer_sync(&phba->rrq_tmr);
2513                 phba->hba_flag &= ~HBA_RRQ_ACTIVE;
2514         }
2515         phba->hb_outstanding = 0;
2516
2517         switch (phba->pci_dev_grp) {
2518         case LPFC_PCI_DEV_LP:
2519                 /* Stop any LightPulse device specific driver timers */
2520                 del_timer_sync(&phba->fcp_poll_timer);
2521                 break;
2522         case LPFC_PCI_DEV_OC:
2523                 /* Stop any OneConnect device sepcific driver timers */
2524                 lpfc_sli4_stop_fcf_redisc_wait_timer(phba);
2525                 break;
2526         default:
2527                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
2528                                 "0297 Invalid device group (x%x)\n",
2529                                 phba->pci_dev_grp);
2530                 break;
2531         }
2532         return;
2533 }
2534
2535 /**
2536  * lpfc_block_mgmt_io - Mark a HBA's management interface as blocked
2537  * @phba: pointer to lpfc hba data structure.
2538  *
2539  * This routine marks a HBA's management interface as blocked. Once the HBA's
2540  * management interface is marked as blocked, all the user space access to
2541  * the HBA, whether they are from sysfs interface or libdfc interface will
2542  * all be blocked. The HBA is set to block the management interface when the
2543  * driver prepares the HBA interface for online or offline.
2544  **/
2545 static void
2546 lpfc_block_mgmt_io(struct lpfc_hba *phba, int mbx_action)
2547 {
2548         unsigned long iflag;
2549         uint8_t actcmd = MBX_HEARTBEAT;
2550         unsigned long timeout;
2551
2552         spin_lock_irqsave(&phba->hbalock, iflag);
2553         phba->sli.sli_flag |= LPFC_BLOCK_MGMT_IO;
2554         spin_unlock_irqrestore(&phba->hbalock, iflag);
2555         if (mbx_action == LPFC_MBX_NO_WAIT)
2556                 return;
2557         timeout = msecs_to_jiffies(LPFC_MBOX_TMO * 1000) + jiffies;
2558         spin_lock_irqsave(&phba->hbalock, iflag);
2559         if (phba->sli.mbox_active) {
2560                 actcmd = phba->sli.mbox_active->u.mb.mbxCommand;
2561                 /* Determine how long we might wait for the active mailbox
2562                  * command to be gracefully completed by firmware.
2563                  */
2564                 timeout = msecs_to_jiffies(lpfc_mbox_tmo_val(phba,
2565                                 phba->sli.mbox_active) * 1000) + jiffies;
2566         }
2567         spin_unlock_irqrestore(&phba->hbalock, iflag);
2568
2569         /* Wait for the outstnading mailbox command to complete */
2570         while (phba->sli.mbox_active) {
2571                 /* Check active mailbox complete status every 2ms */
2572                 msleep(2);
2573                 if (time_after(jiffies, timeout)) {
2574                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
2575                                 "2813 Mgmt IO is Blocked %x "
2576                                 "- mbox cmd %x still active\n",
2577                                 phba->sli.sli_flag, actcmd);
2578                         break;
2579                 }
2580         }
2581 }
2582
2583 /**
2584  * lpfc_sli4_node_prep - Assign RPIs for active nodes.
2585  * @phba: pointer to lpfc hba data structure.
2586  *
2587  * Allocate RPIs for all active remote nodes. This is needed whenever
2588  * an SLI4 adapter is reset and the driver is not unloading. Its purpose
2589  * is to fixup the temporary rpi assignments.
2590  **/
2591 void
2592 lpfc_sli4_node_prep(struct lpfc_hba *phba)
2593 {
2594         struct lpfc_nodelist  *ndlp, *next_ndlp;
2595         struct lpfc_vport **vports;
2596         int i;
2597
2598         if (phba->sli_rev != LPFC_SLI_REV4)
2599                 return;
2600
2601         vports = lpfc_create_vport_work_array(phba);
2602         if (vports != NULL) {
2603                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
2604                         if (vports[i]->load_flag & FC_UNLOADING)
2605                                 continue;
2606
2607                         list_for_each_entry_safe(ndlp, next_ndlp,
2608                                                  &vports[i]->fc_nodes,
2609                                                  nlp_listp) {
2610                                 if (NLP_CHK_NODE_ACT(ndlp))
2611                                         ndlp->nlp_rpi =
2612                                                 lpfc_sli4_alloc_rpi(phba);
2613                         }
2614                 }
2615         }
2616         lpfc_destroy_vport_work_array(phba, vports);
2617 }
2618
2619 /**
2620  * lpfc_online - Initialize and bring a HBA online
2621  * @phba: pointer to lpfc hba data structure.
2622  *
2623  * This routine initializes the HBA and brings a HBA online. During this
2624  * process, the management interface is blocked to prevent user space access
2625  * to the HBA interfering with the driver initialization.
2626  *
2627  * Return codes
2628  *   0 - successful
2629  *   1 - failed
2630  **/
2631 int
2632 lpfc_online(struct lpfc_hba *phba)
2633 {
2634         struct lpfc_vport *vport;
2635         struct lpfc_vport **vports;
2636         int i;
2637
2638         if (!phba)
2639                 return 0;
2640         vport = phba->pport;
2641
2642         if (!(vport->fc_flag & FC_OFFLINE_MODE))
2643                 return 0;
2644
2645         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
2646                         "0458 Bring Adapter online\n");
2647
2648         lpfc_block_mgmt_io(phba, LPFC_MBX_WAIT);
2649
2650         if (!lpfc_sli_queue_setup(phba)) {
2651                 lpfc_unblock_mgmt_io(phba);
2652                 return 1;
2653         }
2654
2655         if (phba->sli_rev == LPFC_SLI_REV4) {
2656                 if (lpfc_sli4_hba_setup(phba)) { /* Initialize SLI4 HBA */
2657                         lpfc_unblock_mgmt_io(phba);
2658                         return 1;
2659                 }
2660         } else {
2661                 if (lpfc_sli_hba_setup(phba)) { /* Initialize SLI2/SLI3 HBA */
2662                         lpfc_unblock_mgmt_io(phba);
2663                         return 1;
2664                 }
2665         }
2666
2667         vports = lpfc_create_vport_work_array(phba);
2668         if (vports != NULL)
2669                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
2670                         struct Scsi_Host *shost;
2671                         shost = lpfc_shost_from_vport(vports[i]);
2672                         spin_lock_irq(shost->host_lock);
2673                         vports[i]->fc_flag &= ~FC_OFFLINE_MODE;
2674                         if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED)
2675                                 vports[i]->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
2676                         if (phba->sli_rev == LPFC_SLI_REV4)
2677                                 vports[i]->fc_flag |= FC_VPORT_NEEDS_INIT_VPI;
2678                         spin_unlock_irq(shost->host_lock);
2679                 }
2680                 lpfc_destroy_vport_work_array(phba, vports);
2681
2682         lpfc_unblock_mgmt_io(phba);
2683         return 0;
2684 }
2685
2686 /**
2687  * lpfc_unblock_mgmt_io - Mark a HBA's management interface to be not blocked
2688  * @phba: pointer to lpfc hba data structure.
2689  *
2690  * This routine marks a HBA's management interface as not blocked. Once the
2691  * HBA's management interface is marked as not blocked, all the user space
2692  * access to the HBA, whether they are from sysfs interface or libdfc
2693  * interface will be allowed. The HBA is set to block the management interface
2694  * when the driver prepares the HBA interface for online or offline and then
2695  * set to unblock the management interface afterwards.
2696  **/
2697 void
2698 lpfc_unblock_mgmt_io(struct lpfc_hba * phba)
2699 {
2700         unsigned long iflag;
2701
2702         spin_lock_irqsave(&phba->hbalock, iflag);
2703         phba->sli.sli_flag &= ~LPFC_BLOCK_MGMT_IO;
2704         spin_unlock_irqrestore(&phba->hbalock, iflag);
2705 }
2706
2707 /**
2708  * lpfc_offline_prep - Prepare a HBA to be brought offline
2709  * @phba: pointer to lpfc hba data structure.
2710  *
2711  * This routine is invoked to prepare a HBA to be brought offline. It performs
2712  * unregistration login to all the nodes on all vports and flushes the mailbox
2713  * queue to make it ready to be brought offline.
2714  **/
2715 void
2716 lpfc_offline_prep(struct lpfc_hba *phba, int mbx_action)
2717 {
2718         struct lpfc_vport *vport = phba->pport;
2719         struct lpfc_nodelist  *ndlp, *next_ndlp;
2720         struct lpfc_vport **vports;
2721         struct Scsi_Host *shost;
2722         int i;
2723
2724         if (vport->fc_flag & FC_OFFLINE_MODE)
2725                 return;
2726
2727         lpfc_block_mgmt_io(phba, mbx_action);
2728
2729         lpfc_linkdown(phba);
2730
2731         /* Issue an unreg_login to all nodes on all vports */
2732         vports = lpfc_create_vport_work_array(phba);
2733         if (vports != NULL) {
2734                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
2735                         if (vports[i]->load_flag & FC_UNLOADING)
2736                                 continue;
2737                         shost = lpfc_shost_from_vport(vports[i]);
2738                         spin_lock_irq(shost->host_lock);
2739                         vports[i]->vpi_state &= ~LPFC_VPI_REGISTERED;
2740                         vports[i]->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
2741                         vports[i]->fc_flag &= ~FC_VFI_REGISTERED;
2742                         spin_unlock_irq(shost->host_lock);
2743
2744                         shost = lpfc_shost_from_vport(vports[i]);
2745                         list_for_each_entry_safe(ndlp, next_ndlp,
2746                                                  &vports[i]->fc_nodes,
2747                                                  nlp_listp) {
2748                                 if (!NLP_CHK_NODE_ACT(ndlp))
2749                                         continue;
2750                                 if (ndlp->nlp_state == NLP_STE_UNUSED_NODE)
2751                                         continue;
2752                                 if (ndlp->nlp_type & NLP_FABRIC) {
2753                                         lpfc_disc_state_machine(vports[i], ndlp,
2754                                                 NULL, NLP_EVT_DEVICE_RECOVERY);
2755                                         lpfc_disc_state_machine(vports[i], ndlp,
2756                                                 NULL, NLP_EVT_DEVICE_RM);
2757                                 }
2758                                 spin_lock_irq(shost->host_lock);
2759                                 ndlp->nlp_flag &= ~NLP_NPR_ADISC;
2760                                 spin_unlock_irq(shost->host_lock);
2761                                 /*
2762                                  * Whenever an SLI4 port goes offline, free the
2763                                  * RPI. Get a new RPI when the adapter port
2764                                  * comes back online.
2765                                  */
2766                                 if (phba->sli_rev == LPFC_SLI_REV4)
2767                                         lpfc_sli4_free_rpi(phba, ndlp->nlp_rpi);
2768                                 lpfc_unreg_rpi(vports[i], ndlp);
2769                         }
2770                 }
2771         }
2772         lpfc_destroy_vport_work_array(phba, vports);
2773
2774         lpfc_sli_mbox_sys_shutdown(phba, mbx_action);
2775 }
2776
2777 /**
2778  * lpfc_offline - Bring a HBA offline
2779  * @phba: pointer to lpfc hba data structure.
2780  *
2781  * This routine actually brings a HBA offline. It stops all the timers
2782  * associated with the HBA, brings down the SLI layer, and eventually
2783  * marks the HBA as in offline state for the upper layer protocol.
2784  **/
2785 void
2786 lpfc_offline(struct lpfc_hba *phba)
2787 {
2788         struct Scsi_Host  *shost;
2789         struct lpfc_vport **vports;
2790         int i;
2791
2792         if (phba->pport->fc_flag & FC_OFFLINE_MODE)
2793                 return;
2794
2795         /* stop port and all timers associated with this hba */
2796         lpfc_stop_port(phba);
2797         vports = lpfc_create_vport_work_array(phba);
2798         if (vports != NULL)
2799                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++)
2800                         lpfc_stop_vport_timers(vports[i]);
2801         lpfc_destroy_vport_work_array(phba, vports);
2802         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
2803                         "0460 Bring Adapter offline\n");
2804         /* Bring down the SLI Layer and cleanup.  The HBA is offline
2805            now.  */
2806         lpfc_sli_hba_down(phba);
2807         spin_lock_irq(&phba->hbalock);
2808         phba->work_ha = 0;
2809         spin_unlock_irq(&phba->hbalock);
2810         vports = lpfc_create_vport_work_array(phba);
2811         if (vports != NULL)
2812                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
2813                         shost = lpfc_shost_from_vport(vports[i]);
2814                         spin_lock_irq(shost->host_lock);
2815                         vports[i]->work_port_events = 0;
2816                         vports[i]->fc_flag |= FC_OFFLINE_MODE;
2817                         spin_unlock_irq(shost->host_lock);
2818                 }
2819         lpfc_destroy_vport_work_array(phba, vports);
2820 }
2821
2822 /**
2823  * lpfc_scsi_free - Free all the SCSI buffers and IOCBs from driver lists
2824  * @phba: pointer to lpfc hba data structure.
2825  *
2826  * This routine is to free all the SCSI buffers and IOCBs from the driver
2827  * list back to kernel. It is called from lpfc_pci_remove_one to free
2828  * the internal resources before the device is removed from the system.
2829  **/
2830 static void
2831 lpfc_scsi_free(struct lpfc_hba *phba)
2832 {
2833         struct lpfc_scsi_buf *sb, *sb_next;
2834         struct lpfc_iocbq *io, *io_next;
2835
2836         spin_lock_irq(&phba->hbalock);
2837         /* Release all the lpfc_scsi_bufs maintained by this host. */
2838         spin_lock(&phba->scsi_buf_list_lock);
2839         list_for_each_entry_safe(sb, sb_next, &phba->lpfc_scsi_buf_list, list) {
2840                 list_del(&sb->list);
2841                 pci_pool_free(phba->lpfc_scsi_dma_buf_pool, sb->data,
2842                               sb->dma_handle);
2843                 kfree(sb);
2844                 phba->total_scsi_bufs--;
2845         }
2846         spin_unlock(&phba->scsi_buf_list_lock);
2847
2848         /* Release all the lpfc_iocbq entries maintained by this host. */
2849         list_for_each_entry_safe(io, io_next, &phba->lpfc_iocb_list, list) {
2850                 list_del(&io->list);
2851                 kfree(io);
2852                 phba->total_iocbq_bufs--;
2853         }
2854
2855         spin_unlock_irq(&phba->hbalock);
2856 }
2857
2858 /**
2859  * lpfc_sli4_xri_sgl_update - update xri-sgl sizing and mapping
2860  * @phba: pointer to lpfc hba data structure.
2861  *
2862  * This routine first calculates the sizes of the current els and allocated
2863  * scsi sgl lists, and then goes through all sgls to updates the physical
2864  * XRIs assigned due to port function reset. During port initialization, the
2865  * current els and allocated scsi sgl lists are 0s.
2866  *
2867  * Return codes
2868  *   0 - successful (for now, it always returns 0)
2869  **/
2870 int
2871 lpfc_sli4_xri_sgl_update(struct lpfc_hba *phba)
2872 {
2873         struct lpfc_sglq *sglq_entry = NULL, *sglq_entry_next = NULL;
2874         struct lpfc_scsi_buf *psb = NULL, *psb_next = NULL;
2875         uint16_t i, lxri, xri_cnt, els_xri_cnt, scsi_xri_cnt;
2876         LIST_HEAD(els_sgl_list);
2877         LIST_HEAD(scsi_sgl_list);
2878         int rc;
2879
2880         /*
2881          * update on pci function's els xri-sgl list
2882          */
2883         els_xri_cnt = lpfc_sli4_get_els_iocb_cnt(phba);
2884         if (els_xri_cnt > phba->sli4_hba.els_xri_cnt) {
2885                 /* els xri-sgl expanded */
2886                 xri_cnt = els_xri_cnt - phba->sli4_hba.els_xri_cnt;
2887                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2888                                 "3157 ELS xri-sgl count increased from "
2889                                 "%d to %d\n", phba->sli4_hba.els_xri_cnt,
2890                                 els_xri_cnt);
2891                 /* allocate the additional els sgls */
2892                 for (i = 0; i < xri_cnt; i++) {
2893                         sglq_entry = kzalloc(sizeof(struct lpfc_sglq),
2894                                              GFP_KERNEL);
2895                         if (sglq_entry == NULL) {
2896                                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
2897                                                 "2562 Failure to allocate an "
2898                                                 "ELS sgl entry:%d\n", i);
2899                                 rc = -ENOMEM;
2900                                 goto out_free_mem;
2901                         }
2902                         sglq_entry->buff_type = GEN_BUFF_TYPE;
2903                         sglq_entry->virt = lpfc_mbuf_alloc(phba, 0,
2904                                                            &sglq_entry->phys);
2905                         if (sglq_entry->virt == NULL) {
2906                                 kfree(sglq_entry);
2907                                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
2908                                                 "2563 Failure to allocate an "
2909                                                 "ELS mbuf:%d\n", i);
2910                                 rc = -ENOMEM;
2911                                 goto out_free_mem;
2912                         }
2913                         sglq_entry->sgl = sglq_entry->virt;
2914                         memset(sglq_entry->sgl, 0, LPFC_BPL_SIZE);
2915                         sglq_entry->state = SGL_FREED;
2916                         list_add_tail(&sglq_entry->list, &els_sgl_list);
2917                 }
2918                 spin_lock(&phba->hbalock);
2919                 list_splice_init(&els_sgl_list, &phba->sli4_hba.lpfc_sgl_list);
2920                 spin_unlock(&phba->hbalock);
2921         } else if (els_xri_cnt < phba->sli4_hba.els_xri_cnt) {
2922                 /* els xri-sgl shrinked */
2923                 xri_cnt = phba->sli4_hba.els_xri_cnt - els_xri_cnt;
2924                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2925                                 "3158 ELS xri-sgl count decreased from "
2926                                 "%d to %d\n", phba->sli4_hba.els_xri_cnt,
2927                                 els_xri_cnt);
2928                 spin_lock_irq(&phba->hbalock);
2929                 list_splice_init(&phba->sli4_hba.lpfc_sgl_list, &els_sgl_list);
2930                 spin_unlock_irq(&phba->hbalock);
2931                 /* release extra els sgls from list */
2932                 for (i = 0; i < xri_cnt; i++) {
2933                         list_remove_head(&els_sgl_list,
2934                                          sglq_entry, struct lpfc_sglq, list);
2935                         if (sglq_entry) {
2936                                 lpfc_mbuf_free(phba, sglq_entry->virt,
2937                                                sglq_entry->phys);
2938                                 kfree(sglq_entry);
2939                         }
2940                 }
2941                 spin_lock_irq(&phba->hbalock);
2942                 list_splice_init(&els_sgl_list, &phba->sli4_hba.lpfc_sgl_list);
2943                 spin_unlock_irq(&phba->hbalock);
2944         } else
2945                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2946                                 "3163 ELS xri-sgl count unchanged: %d\n",
2947                                 els_xri_cnt);
2948         phba->sli4_hba.els_xri_cnt = els_xri_cnt;
2949
2950         /* update xris to els sgls on the list */
2951         sglq_entry = NULL;
2952         sglq_entry_next = NULL;
2953         list_for_each_entry_safe(sglq_entry, sglq_entry_next,
2954                                  &phba->sli4_hba.lpfc_sgl_list, list) {
2955                 lxri = lpfc_sli4_next_xritag(phba);
2956                 if (lxri == NO_XRI) {
2957                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
2958                                         "2400 Failed to allocate xri for "
2959                                         "ELS sgl\n");
2960                         rc = -ENOMEM;
2961                         goto out_free_mem;
2962                 }
2963                 sglq_entry->sli4_lxritag = lxri;
2964                 sglq_entry->sli4_xritag = phba->sli4_hba.xri_ids[lxri];
2965         }
2966
2967         /*
2968          * update on pci function's allocated scsi xri-sgl list
2969          */
2970         phba->total_scsi_bufs = 0;
2971
2972         /* maximum number of xris available for scsi buffers */
2973         phba->sli4_hba.scsi_xri_max = phba->sli4_hba.max_cfg_param.max_xri -
2974                                       els_xri_cnt;
2975
2976         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
2977                         "2401 Current allocated SCSI xri-sgl count:%d, "
2978                         "maximum  SCSI xri count:%d\n",
2979                         phba->sli4_hba.scsi_xri_cnt,
2980                         phba->sli4_hba.scsi_xri_max);
2981
2982         spin_lock_irq(&phba->scsi_buf_list_lock);
2983         list_splice_init(&phba->lpfc_scsi_buf_list, &scsi_sgl_list);
2984         spin_unlock_irq(&phba->scsi_buf_list_lock);
2985
2986         if (phba->sli4_hba.scsi_xri_cnt > phba->sli4_hba.scsi_xri_max) {
2987                 /* max scsi xri shrinked below the allocated scsi buffers */
2988                 scsi_xri_cnt = phba->sli4_hba.scsi_xri_cnt -
2989                                         phba->sli4_hba.scsi_xri_max;
2990                 /* release the extra allocated scsi buffers */
2991                 for (i = 0; i < scsi_xri_cnt; i++) {
2992                         list_remove_head(&scsi_sgl_list, psb,
2993                                          struct lpfc_scsi_buf, list);
2994                         pci_pool_free(phba->lpfc_scsi_dma_buf_pool, psb->data,
2995                                       psb->dma_handle);
2996                         kfree(psb);
2997                 }
2998                 spin_lock_irq(&phba->scsi_buf_list_lock);
2999                 phba->sli4_hba.scsi_xri_cnt -= scsi_xri_cnt;
3000                 spin_unlock_irq(&phba->scsi_buf_list_lock);
3001         }
3002
3003         /* update xris associated to remaining allocated scsi buffers */
3004         psb = NULL;
3005         psb_next = NULL;
3006         list_for_each_entry_safe(psb, psb_next, &scsi_sgl_list, list) {
3007                 lxri = lpfc_sli4_next_xritag(phba);
3008                 if (lxri == NO_XRI) {
3009                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3010                                         "2560 Failed to allocate xri for "
3011                                         "scsi buffer\n");
3012                         rc = -ENOMEM;
3013                         goto out_free_mem;
3014                 }
3015                 psb->cur_iocbq.sli4_lxritag = lxri;
3016                 psb->cur_iocbq.sli4_xritag = phba->sli4_hba.xri_ids[lxri];
3017         }
3018         spin_lock(&phba->scsi_buf_list_lock);
3019         list_splice_init(&scsi_sgl_list, &phba->lpfc_scsi_buf_list);
3020         spin_unlock(&phba->scsi_buf_list_lock);
3021
3022         return 0;
3023
3024 out_free_mem:
3025         lpfc_free_els_sgl_list(phba);
3026         lpfc_scsi_free(phba);
3027         return rc;
3028 }
3029
3030 /**
3031  * lpfc_create_port - Create an FC port
3032  * @phba: pointer to lpfc hba data structure.
3033  * @instance: a unique integer ID to this FC port.
3034  * @dev: pointer to the device data structure.
3035  *
3036  * This routine creates a FC port for the upper layer protocol. The FC port
3037  * can be created on top of either a physical port or a virtual port provided
3038  * by the HBA. This routine also allocates a SCSI host data structure (shost)
3039  * and associates the FC port created before adding the shost into the SCSI
3040  * layer.
3041  *
3042  * Return codes
3043  *   @vport - pointer to the virtual N_Port data structure.
3044  *   NULL - port create failed.
3045  **/
3046 struct lpfc_vport *
3047 lpfc_create_port(struct lpfc_hba *phba, int instance, struct device *dev)
3048 {
3049         struct lpfc_vport *vport;
3050         struct Scsi_Host  *shost;
3051         int error = 0;
3052
3053         if (dev != &phba->pcidev->dev)
3054                 shost = scsi_host_alloc(&lpfc_vport_template,
3055                                         sizeof(struct lpfc_vport));
3056         else
3057                 shost = scsi_host_alloc(&lpfc_template,
3058                                         sizeof(struct lpfc_vport));
3059         if (!shost)
3060                 goto out;
3061
3062         vport = (struct lpfc_vport *) shost->hostdata;
3063         vport->phba = phba;
3064         vport->load_flag |= FC_LOADING;
3065         vport->fc_flag |= FC_VPORT_NEEDS_REG_VPI;
3066         vport->fc_rscn_flush = 0;
3067
3068         lpfc_get_vport_cfgparam(vport);
3069         shost->unique_id = instance;
3070         shost->max_id = LPFC_MAX_TARGET;
3071         shost->max_lun = vport->cfg_max_luns;
3072         shost->this_id = -1;
3073         shost->max_cmd_len = 16;
3074         if (phba->sli_rev == LPFC_SLI_REV4) {
3075                 shost->dma_boundary =
3076                         phba->sli4_hba.pc_sli4_params.sge_supp_len-1;
3077                 shost->sg_tablesize = phba->cfg_sg_seg_cnt;
3078         }
3079
3080         /*
3081          * Set initial can_queue value since 0 is no longer supported and
3082          * scsi_add_host will fail. This will be adjusted later based on the
3083          * max xri value determined in hba setup.
3084          */
3085         shost->can_queue = phba->cfg_hba_queue_depth - 10;
3086         if (dev != &phba->pcidev->dev) {
3087                 shost->transportt = lpfc_vport_transport_template;
3088                 vport->port_type = LPFC_NPIV_PORT;
3089         } else {
3090                 shost->transportt = lpfc_transport_template;
3091                 vport->port_type = LPFC_PHYSICAL_PORT;
3092         }
3093
3094         /* Initialize all internally managed lists. */
3095         INIT_LIST_HEAD(&vport->fc_nodes);
3096         INIT_LIST_HEAD(&vport->rcv_buffer_list);
3097         spin_lock_init(&vport->work_port_lock);
3098
3099         init_timer(&vport->fc_disctmo);
3100         vport->fc_disctmo.function = lpfc_disc_timeout;
3101         vport->fc_disctmo.data = (unsigned long)vport;
3102
3103         init_timer(&vport->fc_fdmitmo);
3104         vport->fc_fdmitmo.function = lpfc_fdmi_tmo;
3105         vport->fc_fdmitmo.data = (unsigned long)vport;
3106
3107         init_timer(&vport->els_tmofunc);
3108         vport->els_tmofunc.function = lpfc_els_timeout;
3109         vport->els_tmofunc.data = (unsigned long)vport;
3110
3111         init_timer(&vport->delayed_disc_tmo);
3112         vport->delayed_disc_tmo.function = lpfc_delayed_disc_tmo;
3113         vport->delayed_disc_tmo.data = (unsigned long)vport;
3114
3115         error = scsi_add_host_with_dma(shost, dev, &phba->pcidev->dev);
3116         if (error)
3117                 goto out_put_shost;
3118
3119         spin_lock_irq(&phba->hbalock);
3120         list_add_tail(&vport->listentry, &phba->port_list);
3121         spin_unlock_irq(&phba->hbalock);
3122         return vport;
3123
3124 out_put_shost:
3125         scsi_host_put(shost);
3126 out:
3127         return NULL;
3128 }
3129
3130 /**
3131  * destroy_port -  destroy an FC port
3132  * @vport: pointer to an lpfc virtual N_Port data structure.
3133  *
3134  * This routine destroys a FC port from the upper layer protocol. All the
3135  * resources associated with the port are released.
3136  **/
3137 void
3138 destroy_port(struct lpfc_vport *vport)
3139 {
3140         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
3141         struct lpfc_hba  *phba = vport->phba;
3142
3143         lpfc_debugfs_terminate(vport);
3144         fc_remove_host(shost);
3145         scsi_remove_host(shost);
3146
3147         spin_lock_irq(&phba->hbalock);
3148         list_del_init(&vport->listentry);
3149         spin_unlock_irq(&phba->hbalock);
3150
3151         lpfc_cleanup(vport);
3152         return;
3153 }
3154
3155 /**
3156  * lpfc_get_instance - Get a unique integer ID
3157  *
3158  * This routine allocates a unique integer ID from lpfc_hba_index pool. It
3159  * uses the kernel idr facility to perform the task.
3160  *
3161  * Return codes:
3162  *   instance - a unique integer ID allocated as the new instance.
3163  *   -1 - lpfc get instance failed.
3164  **/
3165 int
3166 lpfc_get_instance(void)
3167 {
3168         int ret;
3169
3170         ret = idr_alloc(&lpfc_hba_index, NULL, 0, 0, GFP_KERNEL);
3171         return ret < 0 ? -1 : ret;
3172 }
3173
3174 /**
3175  * lpfc_scan_finished - method for SCSI layer to detect whether scan is done
3176  * @shost: pointer to SCSI host data structure.
3177  * @time: elapsed time of the scan in jiffies.
3178  *
3179  * This routine is called by the SCSI layer with a SCSI host to determine
3180  * whether the scan host is finished.
3181  *
3182  * Note: there is no scan_start function as adapter initialization will have
3183  * asynchronously kicked off the link initialization.
3184  *
3185  * Return codes
3186  *   0 - SCSI host scan is not over yet.
3187  *   1 - SCSI host scan is over.
3188  **/
3189 int lpfc_scan_finished(struct Scsi_Host *shost, unsigned long time)
3190 {
3191         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
3192         struct lpfc_hba   *phba = vport->phba;
3193         int stat = 0;
3194
3195         spin_lock_irq(shost->host_lock);
3196
3197         if (vport->load_flag & FC_UNLOADING) {
3198                 stat = 1;
3199                 goto finished;
3200         }
3201         if (time >= 30 * HZ) {
3202                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
3203                                 "0461 Scanning longer than 30 "
3204                                 "seconds.  Continuing initialization\n");
3205                 stat = 1;
3206                 goto finished;
3207         }
3208         if (time >= 15 * HZ && phba->link_state <= LPFC_LINK_DOWN) {
3209                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
3210                                 "0465 Link down longer than 15 "
3211                                 "seconds.  Continuing initialization\n");
3212                 stat = 1;
3213                 goto finished;
3214         }
3215
3216         if (vport->port_state != LPFC_VPORT_READY)
3217                 goto finished;
3218         if (vport->num_disc_nodes || vport->fc_prli_sent)
3219                 goto finished;
3220         if (vport->fc_map_cnt == 0 && time < 2 * HZ)
3221                 goto finished;
3222         if ((phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE) != 0)
3223                 goto finished;
3224
3225         stat = 1;
3226
3227 finished:
3228         spin_unlock_irq(shost->host_lock);
3229         return stat;
3230 }
3231
3232 /**
3233  * lpfc_host_attrib_init - Initialize SCSI host attributes on a FC port
3234  * @shost: pointer to SCSI host data structure.
3235  *
3236  * This routine initializes a given SCSI host attributes on a FC port. The
3237  * SCSI host can be either on top of a physical port or a virtual port.
3238  **/
3239 void lpfc_host_attrib_init(struct Scsi_Host *shost)
3240 {
3241         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
3242         struct lpfc_hba   *phba = vport->phba;
3243         /*
3244          * Set fixed host attributes.  Must done after lpfc_sli_hba_setup().
3245          */
3246
3247         fc_host_node_name(shost) = wwn_to_u64(vport->fc_nodename.u.wwn);
3248         fc_host_port_name(shost) = wwn_to_u64(vport->fc_portname.u.wwn);
3249         fc_host_supported_classes(shost) = FC_COS_CLASS3;
3250
3251         memset(fc_host_supported_fc4s(shost), 0,
3252                sizeof(fc_host_supported_fc4s(shost)));
3253         fc_host_supported_fc4s(shost)[2] = 1;
3254         fc_host_supported_fc4s(shost)[7] = 1;
3255
3256         lpfc_vport_symbolic_node_name(vport, fc_host_symbolic_name(shost),
3257                                  sizeof fc_host_symbolic_name(shost));
3258
3259         fc_host_supported_speeds(shost) = 0;
3260         if (phba->lmt & LMT_16Gb)
3261                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_16GBIT;
3262         if (phba->lmt & LMT_10Gb)
3263                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_10GBIT;
3264         if (phba->lmt & LMT_8Gb)
3265                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_8GBIT;
3266         if (phba->lmt & LMT_4Gb)
3267                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_4GBIT;
3268         if (phba->lmt & LMT_2Gb)
3269                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_2GBIT;
3270         if (phba->lmt & LMT_1Gb)
3271                 fc_host_supported_speeds(shost) |= FC_PORTSPEED_1GBIT;
3272
3273         fc_host_maxframe_size(shost) =
3274                 (((uint32_t) vport->fc_sparam.cmn.bbRcvSizeMsb & 0x0F) << 8) |
3275                 (uint32_t) vport->fc_sparam.cmn.bbRcvSizeLsb;
3276
3277         fc_host_dev_loss_tmo(shost) = vport->cfg_devloss_tmo;
3278
3279         /* This value is also unchanging */
3280         memset(fc_host_active_fc4s(shost), 0,
3281                sizeof(fc_host_active_fc4s(shost)));
3282         fc_host_active_fc4s(shost)[2] = 1;
3283         fc_host_active_fc4s(shost)[7] = 1;
3284
3285         fc_host_max_npiv_vports(shost) = phba->max_vpi;
3286         spin_lock_irq(shost->host_lock);
3287         vport->load_flag &= ~FC_LOADING;
3288         spin_unlock_irq(shost->host_lock);
3289 }
3290
3291 /**
3292  * lpfc_stop_port_s3 - Stop SLI3 device port
3293  * @phba: pointer to lpfc hba data structure.
3294  *
3295  * This routine is invoked to stop an SLI3 device port, it stops the device
3296  * from generating interrupts and stops the device driver's timers for the
3297  * device.
3298  **/
3299 static void
3300 lpfc_stop_port_s3(struct lpfc_hba *phba)
3301 {
3302         /* Clear all interrupt enable conditions */
3303         writel(0, phba->HCregaddr);
3304         readl(phba->HCregaddr); /* flush */
3305         /* Clear all pending interrupts */
3306         writel(0xffffffff, phba->HAregaddr);
3307         readl(phba->HAregaddr); /* flush */
3308
3309         /* Reset some HBA SLI setup states */
3310         lpfc_stop_hba_timers(phba);
3311         phba->pport->work_port_events = 0;
3312 }
3313
3314 /**
3315  * lpfc_stop_port_s4 - Stop SLI4 device port
3316  * @phba: pointer to lpfc hba data structure.
3317  *
3318  * This routine is invoked to stop an SLI4 device port, it stops the device
3319  * from generating interrupts and stops the device driver's timers for the
3320  * device.
3321  **/
3322 static void
3323 lpfc_stop_port_s4(struct lpfc_hba *phba)
3324 {
3325         /* Reset some HBA SLI4 setup states */
3326         lpfc_stop_hba_timers(phba);
3327         phba->pport->work_port_events = 0;
3328         phba->sli4_hba.intr_enable = 0;
3329 }
3330
3331 /**
3332  * lpfc_stop_port - Wrapper function for stopping hba port
3333  * @phba: Pointer to HBA context object.
3334  *
3335  * This routine wraps the actual SLI3 or SLI4 hba stop port routine from
3336  * the API jump table function pointer from the lpfc_hba struct.
3337  **/
3338 void
3339 lpfc_stop_port(struct lpfc_hba *phba)
3340 {
3341         phba->lpfc_stop_port(phba);
3342 }
3343
3344 /**
3345  * lpfc_fcf_redisc_wait_start_timer - Start fcf rediscover wait timer
3346  * @phba: Pointer to hba for which this call is being executed.
3347  *
3348  * This routine starts the timer waiting for the FCF rediscovery to complete.
3349  **/
3350 void
3351 lpfc_fcf_redisc_wait_start_timer(struct lpfc_hba *phba)
3352 {
3353         unsigned long fcf_redisc_wait_tmo =
3354                 (jiffies + msecs_to_jiffies(LPFC_FCF_REDISCOVER_WAIT_TMO));
3355         /* Start fcf rediscovery wait period timer */
3356         mod_timer(&phba->fcf.redisc_wait, fcf_redisc_wait_tmo);
3357         spin_lock_irq(&phba->hbalock);
3358         /* Allow action to new fcf asynchronous event */
3359         phba->fcf.fcf_flag &= ~(FCF_AVAILABLE | FCF_SCAN_DONE);
3360         /* Mark the FCF rediscovery pending state */
3361         phba->fcf.fcf_flag |= FCF_REDISC_PEND;
3362         spin_unlock_irq(&phba->hbalock);
3363 }
3364
3365 /**
3366  * lpfc_sli4_fcf_redisc_wait_tmo - FCF table rediscover wait timeout
3367  * @ptr: Map to lpfc_hba data structure pointer.
3368  *
3369  * This routine is invoked when waiting for FCF table rediscover has been
3370  * timed out. If new FCF record(s) has (have) been discovered during the
3371  * wait period, a new FCF event shall be added to the FCOE async event
3372  * list, and then worker thread shall be waked up for processing from the
3373  * worker thread context.
3374  **/
3375 void
3376 lpfc_sli4_fcf_redisc_wait_tmo(unsigned long ptr)
3377 {
3378         struct lpfc_hba *phba = (struct lpfc_hba *)ptr;
3379
3380         /* Don't send FCF rediscovery event if timer cancelled */
3381         spin_lock_irq(&phba->hbalock);
3382         if (!(phba->fcf.fcf_flag & FCF_REDISC_PEND)) {
3383                 spin_unlock_irq(&phba->hbalock);
3384                 return;
3385         }
3386         /* Clear FCF rediscovery timer pending flag */
3387         phba->fcf.fcf_flag &= ~FCF_REDISC_PEND;
3388         /* FCF rediscovery event to worker thread */
3389         phba->fcf.fcf_flag |= FCF_REDISC_EVT;
3390         spin_unlock_irq(&phba->hbalock);
3391         lpfc_printf_log(phba, KERN_INFO, LOG_FIP,
3392                         "2776 FCF rediscover quiescent timer expired\n");
3393         /* wake up worker thread */
3394         lpfc_worker_wake_up(phba);
3395 }
3396
3397 /**
3398  * lpfc_sli4_parse_latt_fault - Parse sli4 link-attention link fault code
3399  * @phba: pointer to lpfc hba data structure.
3400  * @acqe_link: pointer to the async link completion queue entry.
3401  *
3402  * This routine is to parse the SLI4 link-attention link fault code and
3403  * translate it into the base driver's read link attention mailbox command
3404  * status.
3405  *
3406  * Return: Link-attention status in terms of base driver's coding.
3407  **/
3408 static uint16_t
3409 lpfc_sli4_parse_latt_fault(struct lpfc_hba *phba,
3410                            struct lpfc_acqe_link *acqe_link)
3411 {
3412         uint16_t latt_fault;
3413
3414         switch (bf_get(lpfc_acqe_link_fault, acqe_link)) {
3415         case LPFC_ASYNC_LINK_FAULT_NONE:
3416         case LPFC_ASYNC_LINK_FAULT_LOCAL:
3417         case LPFC_ASYNC_LINK_FAULT_REMOTE:
3418                 latt_fault = 0;
3419                 break;
3420         default:
3421                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
3422                                 "0398 Invalid link fault code: x%x\n",
3423                                 bf_get(lpfc_acqe_link_fault, acqe_link));
3424                 latt_fault = MBXERR_ERROR;
3425                 break;
3426         }
3427         return latt_fault;
3428 }
3429
3430 /**
3431  * lpfc_sli4_parse_latt_type - Parse sli4 link attention type
3432  * @phba: pointer to lpfc hba data structure.
3433  * @acqe_link: pointer to the async link completion queue entry.
3434  *
3435  * This routine is to parse the SLI4 link attention type and translate it
3436  * into the base driver's link attention type coding.
3437  *
3438  * Return: Link attention type in terms of base driver's coding.
3439  **/
3440 static uint8_t
3441 lpfc_sli4_parse_latt_type(struct lpfc_hba *phba,
3442                           struct lpfc_acqe_link *acqe_link)
3443 {
3444         uint8_t att_type;
3445
3446         switch (bf_get(lpfc_acqe_link_status, acqe_link)) {
3447         case LPFC_ASYNC_LINK_STATUS_DOWN:
3448         case LPFC_ASYNC_LINK_STATUS_LOGICAL_DOWN:
3449                 att_type = LPFC_ATT_LINK_DOWN;
3450                 break;
3451         case LPFC_ASYNC_LINK_STATUS_UP:
3452                 /* Ignore physical link up events - wait for logical link up */
3453                 att_type = LPFC_ATT_RESERVED;
3454                 break;
3455         case LPFC_ASYNC_LINK_STATUS_LOGICAL_UP:
3456                 att_type = LPFC_ATT_LINK_UP;
3457                 break;
3458         default:
3459                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
3460                                 "0399 Invalid link attention type: x%x\n",
3461                                 bf_get(lpfc_acqe_link_status, acqe_link));
3462                 att_type = LPFC_ATT_RESERVED;
3463                 break;
3464         }
3465         return att_type;
3466 }
3467
3468 /**
3469  * lpfc_sli4_parse_latt_link_speed - Parse sli4 link-attention link speed
3470  * @phba: pointer to lpfc hba data structure.
3471  * @acqe_link: pointer to the async link completion queue entry.
3472  *
3473  * This routine is to parse the SLI4 link-attention link speed and translate
3474  * it into the base driver's link-attention link speed coding.
3475  *
3476  * Return: Link-attention link speed in terms of base driver's coding.
3477  **/
3478 static uint8_t
3479 lpfc_sli4_parse_latt_link_speed(struct lpfc_hba *phba,
3480                                 struct lpfc_acqe_link *acqe_link)
3481 {
3482         uint8_t link_speed;
3483
3484         switch (bf_get(lpfc_acqe_link_speed, acqe_link)) {
3485         case LPFC_ASYNC_LINK_SPEED_ZERO:
3486         case LPFC_ASYNC_LINK_SPEED_10MBPS:
3487         case LPFC_ASYNC_LINK_SPEED_100MBPS:
3488                 link_speed = LPFC_LINK_SPEED_UNKNOWN;
3489                 break;
3490         case LPFC_ASYNC_LINK_SPEED_1GBPS:
3491                 link_speed = LPFC_LINK_SPEED_1GHZ;
3492                 break;
3493         case LPFC_ASYNC_LINK_SPEED_10GBPS:
3494                 link_speed = LPFC_LINK_SPEED_10GHZ;
3495                 break;
3496         default:
3497                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
3498                                 "0483 Invalid link-attention link speed: x%x\n",
3499                                 bf_get(lpfc_acqe_link_speed, acqe_link));
3500                 link_speed = LPFC_LINK_SPEED_UNKNOWN;
3501                 break;
3502         }
3503         return link_speed;
3504 }
3505
3506 /**
3507  * lpfc_sli_port_speed_get - Get sli3 link speed code to link speed
3508  * @phba: pointer to lpfc hba data structure.
3509  *
3510  * This routine is to get an SLI3 FC port's link speed in Mbps.
3511  *
3512  * Return: link speed in terms of Mbps.
3513  **/
3514 uint32_t
3515 lpfc_sli_port_speed_get(struct lpfc_hba *phba)
3516 {
3517         uint32_t link_speed;
3518
3519         if (!lpfc_is_link_up(phba))
3520                 return 0;
3521
3522         switch (phba->fc_linkspeed) {
3523         case LPFC_LINK_SPEED_1GHZ:
3524                 link_speed = 1000;
3525                 break;
3526         case LPFC_LINK_SPEED_2GHZ:
3527                 link_speed = 2000;
3528                 break;
3529         case LPFC_LINK_SPEED_4GHZ:
3530                 link_speed = 4000;
3531                 break;
3532         case LPFC_LINK_SPEED_8GHZ:
3533                 link_speed = 8000;
3534                 break;
3535         case LPFC_LINK_SPEED_10GHZ:
3536                 link_speed = 10000;
3537                 break;
3538         case LPFC_LINK_SPEED_16GHZ:
3539                 link_speed = 16000;
3540                 break;
3541         default:
3542                 link_speed = 0;
3543         }
3544         return link_speed;
3545 }
3546
3547 /**
3548  * lpfc_sli4_port_speed_parse - Parse async evt link speed code to link speed
3549  * @phba: pointer to lpfc hba data structure.
3550  * @evt_code: asynchronous event code.
3551  * @speed_code: asynchronous event link speed code.
3552  *
3553  * This routine is to parse the giving SLI4 async event link speed code into
3554  * value of Mbps for the link speed.
3555  *
3556  * Return: link speed in terms of Mbps.
3557  **/
3558 static uint32_t
3559 lpfc_sli4_port_speed_parse(struct lpfc_hba *phba, uint32_t evt_code,
3560                            uint8_t speed_code)
3561 {
3562         uint32_t port_speed;
3563
3564         switch (evt_code) {
3565         case LPFC_TRAILER_CODE_LINK:
3566                 switch (speed_code) {
3567                 case LPFC_EVT_CODE_LINK_NO_LINK:
3568                         port_speed = 0;
3569                         break;
3570                 case LPFC_EVT_CODE_LINK_10_MBIT:
3571                         port_speed = 10;
3572                         break;
3573                 case LPFC_EVT_CODE_LINK_100_MBIT:
3574                         port_speed = 100;
3575                         break;
3576                 case LPFC_EVT_CODE_LINK_1_GBIT:
3577                         port_speed = 1000;
3578                         break;
3579                 case LPFC_EVT_CODE_LINK_10_GBIT:
3580                         port_speed = 10000;
3581                         break;
3582                 default:
3583                         port_speed = 0;
3584                 }
3585                 break;
3586         case LPFC_TRAILER_CODE_FC:
3587                 switch (speed_code) {
3588                 case LPFC_EVT_CODE_FC_NO_LINK:
3589                         port_speed = 0;
3590                         break;
3591                 case LPFC_EVT_CODE_FC_1_GBAUD:
3592                         port_speed = 1000;
3593                         break;
3594                 case LPFC_EVT_CODE_FC_2_GBAUD:
3595                         port_speed = 2000;
3596                         break;
3597                 case LPFC_EVT_CODE_FC_4_GBAUD:
3598                         port_speed = 4000;
3599                         break;
3600                 case LPFC_EVT_CODE_FC_8_GBAUD:
3601                         port_speed = 8000;
3602                         break;
3603                 case LPFC_EVT_CODE_FC_10_GBAUD:
3604                         port_speed = 10000;
3605                         break;
3606                 case LPFC_EVT_CODE_FC_16_GBAUD:
3607                         port_speed = 16000;
3608                         break;
3609                 default:
3610                         port_speed = 0;
3611                 }
3612                 break;
3613         default:
3614                 port_speed = 0;
3615         }
3616         return port_speed;
3617 }
3618
3619 /**
3620  * lpfc_sli4_async_link_evt - Process the asynchronous FCoE link event
3621  * @phba: pointer to lpfc hba data structure.
3622  * @acqe_link: pointer to the async link completion queue entry.
3623  *
3624  * This routine is to handle the SLI4 asynchronous FCoE link event.
3625  **/
3626 static void
3627 lpfc_sli4_async_link_evt(struct lpfc_hba *phba,
3628                          struct lpfc_acqe_link *acqe_link)
3629 {
3630         struct lpfc_dmabuf *mp;
3631         LPFC_MBOXQ_t *pmb;
3632         MAILBOX_t *mb;
3633         struct lpfc_mbx_read_top *la;
3634         uint8_t att_type;
3635         int rc;
3636
3637         att_type = lpfc_sli4_parse_latt_type(phba, acqe_link);
3638         if (att_type != LPFC_ATT_LINK_DOWN && att_type != LPFC_ATT_LINK_UP)
3639                 return;
3640         phba->fcoe_eventtag = acqe_link->event_tag;
3641         pmb = (LPFC_MBOXQ_t *)mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
3642         if (!pmb) {
3643                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3644                                 "0395 The mboxq allocation failed\n");
3645                 return;
3646         }
3647         mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
3648         if (!mp) {
3649                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3650                                 "0396 The lpfc_dmabuf allocation failed\n");
3651                 goto out_free_pmb;
3652         }
3653         mp->virt = lpfc_mbuf_alloc(phba, 0, &mp->phys);
3654         if (!mp->virt) {
3655                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3656                                 "0397 The mbuf allocation failed\n");
3657                 goto out_free_dmabuf;
3658         }
3659
3660         /* Cleanup any outstanding ELS commands */
3661         lpfc_els_flush_all_cmd(phba);
3662
3663         /* Block ELS IOCBs until we have done process link event */
3664         phba->sli.ring[LPFC_ELS_RING].flag |= LPFC_STOP_IOCB_EVENT;
3665
3666         /* Update link event statistics */
3667         phba->sli.slistat.link_event++;
3668
3669         /* Create lpfc_handle_latt mailbox command from link ACQE */
3670         lpfc_read_topology(phba, pmb, mp);
3671         pmb->mbox_cmpl = lpfc_mbx_cmpl_read_topology;
3672         pmb->vport = phba->pport;
3673
3674         /* Keep the link status for extra SLI4 state machine reference */
3675         phba->sli4_hba.link_state.speed =
3676                         lpfc_sli4_port_speed_parse(phba, LPFC_TRAILER_CODE_LINK,
3677                                 bf_get(lpfc_acqe_link_speed, acqe_link));
3678         phba->sli4_hba.link_state.duplex =
3679                                 bf_get(lpfc_acqe_link_duplex, acqe_link);
3680         phba->sli4_hba.link_state.status =
3681                                 bf_get(lpfc_acqe_link_status, acqe_link);
3682         phba->sli4_hba.link_state.type =
3683                                 bf_get(lpfc_acqe_link_type, acqe_link);
3684         phba->sli4_hba.link_state.number =
3685                                 bf_get(lpfc_acqe_link_number, acqe_link);
3686         phba->sli4_hba.link_state.fault =
3687                                 bf_get(lpfc_acqe_link_fault, acqe_link);
3688         phba->sli4_hba.link_state.logical_speed =
3689                         bf_get(lpfc_acqe_logical_link_speed, acqe_link) * 10;
3690
3691         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
3692                         "2900 Async FC/FCoE Link event - Speed:%dGBit "
3693                         "duplex:x%x LA Type:x%x Port Type:%d Port Number:%d "
3694                         "Logical speed:%dMbps Fault:%d\n",
3695                         phba->sli4_hba.link_state.speed,
3696                         phba->sli4_hba.link_state.topology,
3697                         phba->sli4_hba.link_state.status,
3698                         phba->sli4_hba.link_state.type,
3699                         phba->sli4_hba.link_state.number,
3700                         phba->sli4_hba.link_state.logical_speed,
3701                         phba->sli4_hba.link_state.fault);
3702         /*
3703          * For FC Mode: issue the READ_TOPOLOGY mailbox command to fetch
3704          * topology info. Note: Optional for non FC-AL ports.
3705          */
3706         if (!(phba->hba_flag & HBA_FCOE_MODE)) {
3707                 rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
3708                 if (rc == MBX_NOT_FINISHED)
3709                         goto out_free_dmabuf;
3710                 return;
3711         }
3712         /*
3713          * For FCoE Mode: fill in all the topology information we need and call
3714          * the READ_TOPOLOGY completion routine to continue without actually
3715          * sending the READ_TOPOLOGY mailbox command to the port.
3716          */
3717         /* Parse and translate status field */
3718         mb = &pmb->u.mb;
3719         mb->mbxStatus = lpfc_sli4_parse_latt_fault(phba, acqe_link);
3720
3721         /* Parse and translate link attention fields */
3722         la = (struct lpfc_mbx_read_top *) &pmb->u.mb.un.varReadTop;
3723         la->eventTag = acqe_link->event_tag;
3724         bf_set(lpfc_mbx_read_top_att_type, la, att_type);
3725         bf_set(lpfc_mbx_read_top_link_spd, la,
3726                lpfc_sli4_parse_latt_link_speed(phba, acqe_link));
3727
3728         /* Fake the the following irrelvant fields */
3729         bf_set(lpfc_mbx_read_top_topology, la, LPFC_TOPOLOGY_PT_PT);
3730         bf_set(lpfc_mbx_read_top_alpa_granted, la, 0);
3731         bf_set(lpfc_mbx_read_top_il, la, 0);
3732         bf_set(lpfc_mbx_read_top_pb, la, 0);
3733         bf_set(lpfc_mbx_read_top_fa, la, 0);
3734         bf_set(lpfc_mbx_read_top_mm, la, 0);
3735
3736         /* Invoke the lpfc_handle_latt mailbox command callback function */
3737         lpfc_mbx_cmpl_read_topology(phba, pmb);
3738
3739         return;
3740
3741 out_free_dmabuf:
3742         kfree(mp);
3743 out_free_pmb:
3744         mempool_free(pmb, phba->mbox_mem_pool);
3745 }
3746
3747 /**
3748  * lpfc_sli4_async_fc_evt - Process the asynchronous FC link event
3749  * @phba: pointer to lpfc hba data structure.
3750  * @acqe_fc: pointer to the async fc completion queue entry.
3751  *
3752  * This routine is to handle the SLI4 asynchronous FC event. It will simply log
3753  * that the event was received and then issue a read_topology mailbox command so
3754  * that the rest of the driver will treat it the same as SLI3.
3755  **/
3756 static void
3757 lpfc_sli4_async_fc_evt(struct lpfc_hba *phba, struct lpfc_acqe_fc_la *acqe_fc)
3758 {
3759         struct lpfc_dmabuf *mp;
3760         LPFC_MBOXQ_t *pmb;
3761         int rc;
3762
3763         if (bf_get(lpfc_trailer_type, acqe_fc) !=
3764             LPFC_FC_LA_EVENT_TYPE_FC_LINK) {
3765                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3766                                 "2895 Non FC link Event detected.(%d)\n",
3767                                 bf_get(lpfc_trailer_type, acqe_fc));
3768                 return;
3769         }
3770         /* Keep the link status for extra SLI4 state machine reference */
3771         phba->sli4_hba.link_state.speed =
3772                         lpfc_sli4_port_speed_parse(phba, LPFC_TRAILER_CODE_FC,
3773                                 bf_get(lpfc_acqe_fc_la_speed, acqe_fc));
3774         phba->sli4_hba.link_state.duplex = LPFC_ASYNC_LINK_DUPLEX_FULL;
3775         phba->sli4_hba.link_state.topology =
3776                                 bf_get(lpfc_acqe_fc_la_topology, acqe_fc);
3777         phba->sli4_hba.link_state.status =
3778                                 bf_get(lpfc_acqe_fc_la_att_type, acqe_fc);
3779         phba->sli4_hba.link_state.type =
3780                                 bf_get(lpfc_acqe_fc_la_port_type, acqe_fc);
3781         phba->sli4_hba.link_state.number =
3782                                 bf_get(lpfc_acqe_fc_la_port_number, acqe_fc);
3783         phba->sli4_hba.link_state.fault =
3784                                 bf_get(lpfc_acqe_link_fault, acqe_fc);
3785         phba->sli4_hba.link_state.logical_speed =
3786                                 bf_get(lpfc_acqe_fc_la_llink_spd, acqe_fc) * 10;
3787         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
3788                         "2896 Async FC event - Speed:%dGBaud Topology:x%x "
3789                         "LA Type:x%x Port Type:%d Port Number:%d Logical speed:"
3790                         "%dMbps Fault:%d\n",
3791                         phba->sli4_hba.link_state.speed,
3792                         phba->sli4_hba.link_state.topology,
3793                         phba->sli4_hba.link_state.status,
3794                         phba->sli4_hba.link_state.type,
3795                         phba->sli4_hba.link_state.number,
3796                         phba->sli4_hba.link_state.logical_speed,
3797                         phba->sli4_hba.link_state.fault);
3798         pmb = (LPFC_MBOXQ_t *)mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
3799         if (!pmb) {
3800                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3801                                 "2897 The mboxq allocation failed\n");
3802                 return;
3803         }
3804         mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
3805         if (!mp) {
3806                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3807                                 "2898 The lpfc_dmabuf allocation failed\n");
3808                 goto out_free_pmb;
3809         }
3810         mp->virt = lpfc_mbuf_alloc(phba, 0, &mp->phys);
3811         if (!mp->virt) {
3812                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3813                                 "2899 The mbuf allocation failed\n");
3814                 goto out_free_dmabuf;
3815         }
3816
3817         /* Cleanup any outstanding ELS commands */
3818         lpfc_els_flush_all_cmd(phba);
3819
3820         /* Block ELS IOCBs until we have done process link event */
3821         phba->sli.ring[LPFC_ELS_RING].flag |= LPFC_STOP_IOCB_EVENT;
3822
3823         /* Update link event statistics */
3824         phba->sli.slistat.link_event++;
3825
3826         /* Create lpfc_handle_latt mailbox command from link ACQE */
3827         lpfc_read_topology(phba, pmb, mp);
3828         pmb->mbox_cmpl = lpfc_mbx_cmpl_read_topology;
3829         pmb->vport = phba->pport;
3830
3831         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_NOWAIT);
3832         if (rc == MBX_NOT_FINISHED)
3833                 goto out_free_dmabuf;
3834         return;
3835
3836 out_free_dmabuf:
3837         kfree(mp);
3838 out_free_pmb:
3839         mempool_free(pmb, phba->mbox_mem_pool);
3840 }
3841
3842 /**
3843  * lpfc_sli4_async_sli_evt - Process the asynchronous SLI link event
3844  * @phba: pointer to lpfc hba data structure.
3845  * @acqe_fc: pointer to the async SLI completion queue entry.
3846  *
3847  * This routine is to handle the SLI4 asynchronous SLI events.
3848  **/
3849 static void
3850 lpfc_sli4_async_sli_evt(struct lpfc_hba *phba, struct lpfc_acqe_sli *acqe_sli)
3851 {
3852         char port_name;
3853         char message[128];
3854         uint8_t status;
3855         struct lpfc_acqe_misconfigured_event *misconfigured;
3856
3857         /* special case misconfigured event as it contains data for all ports */
3858         if ((bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) !=
3859                  LPFC_SLI_INTF_IF_TYPE_2) ||
3860                 (bf_get(lpfc_trailer_type, acqe_sli) !=
3861                         LPFC_SLI_EVENT_TYPE_MISCONFIGURED)) {
3862                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
3863                                 "2901 Async SLI event - Event Data1:x%08x Event Data2:"
3864                                 "x%08x SLI Event Type:%d\n",
3865                                 acqe_sli->event_data1, acqe_sli->event_data2,
3866                                 bf_get(lpfc_trailer_type, acqe_sli));
3867                 return;
3868         }
3869
3870         port_name = phba->Port[0];
3871         if (port_name == 0x00)
3872                 port_name = '?'; /* get port name is empty */
3873
3874         misconfigured = (struct lpfc_acqe_misconfigured_event *)
3875                                         &acqe_sli->event_data1;
3876
3877         /* fetch the status for this port */
3878         switch (phba->sli4_hba.lnk_info.lnk_no) {
3879         case LPFC_LINK_NUMBER_0:
3880                 status = bf_get(lpfc_sli_misconfigured_port0,
3881                                         &misconfigured->theEvent);
3882                 break;
3883         case LPFC_LINK_NUMBER_1:
3884                 status = bf_get(lpfc_sli_misconfigured_port1,
3885                                         &misconfigured->theEvent);
3886                 break;
3887         case LPFC_LINK_NUMBER_2:
3888                 status = bf_get(lpfc_sli_misconfigured_port2,
3889                                         &misconfigured->theEvent);
3890                 break;
3891         case LPFC_LINK_NUMBER_3:
3892                 status = bf_get(lpfc_sli_misconfigured_port3,
3893                                         &misconfigured->theEvent);
3894                 break;
3895         default:
3896                 status = ~LPFC_SLI_EVENT_STATUS_VALID;
3897                 break;
3898         }
3899
3900         switch (status) {
3901         case LPFC_SLI_EVENT_STATUS_VALID:
3902                 return; /* no message if the sfp is okay */
3903         case LPFC_SLI_EVENT_STATUS_NOT_PRESENT:
3904                 sprintf(message, "Optics faulted/incorrectly installed/not " \
3905                                 "installed - Reseat optics, if issue not "
3906                                 "resolved, replace.");
3907                 break;
3908         case LPFC_SLI_EVENT_STATUS_WRONG_TYPE:
3909                 sprintf(message,
3910                         "Optics of two types installed - Remove one optic or " \
3911                         "install matching pair of optics.");
3912                 break;
3913         case LPFC_SLI_EVENT_STATUS_UNSUPPORTED:
3914                 sprintf(message, "Incompatible optics - Replace with " \
3915                                 "compatible optics for card to function.");
3916                 break;
3917         default:
3918                 /* firmware is reporting a status we don't know about */
3919                 sprintf(message, "Unknown event status x%02x", status);
3920                 break;
3921         }
3922
3923         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
3924                         "3176 Misconfigured Physical Port - "
3925                         "Port Name %c %s\n", port_name, message);
3926 }
3927
3928 /**
3929  * lpfc_sli4_perform_vport_cvl - Perform clear virtual link on a vport
3930  * @vport: pointer to vport data structure.
3931  *
3932  * This routine is to perform Clear Virtual Link (CVL) on a vport in
3933  * response to a CVL event.
3934  *
3935  * Return the pointer to the ndlp with the vport if successful, otherwise
3936  * return NULL.
3937  **/
3938 static struct lpfc_nodelist *
3939 lpfc_sli4_perform_vport_cvl(struct lpfc_vport *vport)
3940 {
3941         struct lpfc_nodelist *ndlp;
3942         struct Scsi_Host *shost;
3943         struct lpfc_hba *phba;
3944
3945         if (!vport)
3946                 return NULL;
3947         phba = vport->phba;
3948         if (!phba)
3949                 return NULL;
3950         ndlp = lpfc_findnode_did(vport, Fabric_DID);
3951         if (!ndlp) {
3952                 /* Cannot find existing Fabric ndlp, so allocate a new one */
3953                 ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
3954                 if (!ndlp)
3955                         return 0;
3956                 lpfc_nlp_init(vport, ndlp, Fabric_DID);
3957                 /* Set the node type */
3958                 ndlp->nlp_type |= NLP_FABRIC;
3959                 /* Put ndlp onto node list */
3960                 lpfc_enqueue_node(vport, ndlp);
3961         } else if (!NLP_CHK_NODE_ACT(ndlp)) {
3962                 /* re-setup ndlp without removing from node list */
3963                 ndlp = lpfc_enable_node(vport, ndlp, NLP_STE_UNUSED_NODE);
3964                 if (!ndlp)
3965                         return 0;
3966         }
3967         if ((phba->pport->port_state < LPFC_FLOGI) &&
3968                 (phba->pport->port_state != LPFC_VPORT_FAILED))
3969                 return NULL;
3970         /* If virtual link is not yet instantiated ignore CVL */
3971         if ((vport != phba->pport) && (vport->port_state < LPFC_FDISC)
3972                 && (vport->port_state != LPFC_VPORT_FAILED))
3973                 return NULL;
3974         shost = lpfc_shost_from_vport(vport);
3975         if (!shost)
3976                 return NULL;
3977         lpfc_linkdown_port(vport);
3978         lpfc_cleanup_pending_mbox(vport);
3979         spin_lock_irq(shost->host_lock);
3980         vport->fc_flag |= FC_VPORT_CVL_RCVD;
3981         spin_unlock_irq(shost->host_lock);
3982
3983         return ndlp;
3984 }
3985
3986 /**
3987  * lpfc_sli4_perform_all_vport_cvl - Perform clear virtual link on all vports
3988  * @vport: pointer to lpfc hba data structure.
3989  *
3990  * This routine is to perform Clear Virtual Link (CVL) on all vports in
3991  * response to a FCF dead event.
3992  **/
3993 static void
3994 lpfc_sli4_perform_all_vport_cvl(struct lpfc_hba *phba)
3995 {
3996         struct lpfc_vport **vports;
3997         int i;
3998
3999         vports = lpfc_create_vport_work_array(phba);
4000         if (vports)
4001                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++)
4002                         lpfc_sli4_perform_vport_cvl(vports[i]);
4003         lpfc_destroy_vport_work_array(phba, vports);
4004 }
4005
4006 /**
4007  * lpfc_sli4_async_fip_evt - Process the asynchronous FCoE FIP event
4008  * @phba: pointer to lpfc hba data structure.
4009  * @acqe_link: pointer to the async fcoe completion queue entry.
4010  *
4011  * This routine is to handle the SLI4 asynchronous fcoe event.
4012  **/
4013 static void
4014 lpfc_sli4_async_fip_evt(struct lpfc_hba *phba,
4015                         struct lpfc_acqe_fip *acqe_fip)
4016 {
4017         uint8_t event_type = bf_get(lpfc_trailer_type, acqe_fip);
4018         int rc;
4019         struct lpfc_vport *vport;
4020         struct lpfc_nodelist *ndlp;
4021         struct Scsi_Host  *shost;
4022         int active_vlink_present;
4023         struct lpfc_vport **vports;
4024         int i;
4025
4026         phba->fc_eventTag = acqe_fip->event_tag;
4027         phba->fcoe_eventtag = acqe_fip->event_tag;
4028         switch (event_type) {
4029         case LPFC_FIP_EVENT_TYPE_NEW_FCF:
4030         case LPFC_FIP_EVENT_TYPE_FCF_PARAM_MOD:
4031                 if (event_type == LPFC_FIP_EVENT_TYPE_NEW_FCF)
4032                         lpfc_printf_log(phba, KERN_ERR, LOG_FIP |
4033                                         LOG_DISCOVERY,
4034                                         "2546 New FCF event, evt_tag:x%x, "
4035                                         "index:x%x\n",
4036                                         acqe_fip->event_tag,
4037                                         acqe_fip->index);
4038                 else
4039                         lpfc_printf_log(phba, KERN_WARNING, LOG_FIP |
4040                                         LOG_DISCOVERY,
4041                                         "2788 FCF param modified event, "
4042                                         "evt_tag:x%x, index:x%x\n",
4043                                         acqe_fip->event_tag,
4044                                         acqe_fip->index);
4045                 if (phba->fcf.fcf_flag & FCF_DISCOVERY) {
4046                         /*
4047                          * During period of FCF discovery, read the FCF
4048                          * table record indexed by the event to update
4049                          * FCF roundrobin failover eligible FCF bmask.
4050                          */
4051                         lpfc_printf_log(phba, KERN_INFO, LOG_FIP |
4052                                         LOG_DISCOVERY,
4053                                         "2779 Read FCF (x%x) for updating "
4054                                         "roundrobin FCF failover bmask\n",
4055                                         acqe_fip->index);
4056                         rc = lpfc_sli4_read_fcf_rec(phba, acqe_fip->index);
4057                 }
4058
4059                 /* If the FCF discovery is in progress, do nothing. */
4060                 spin_lock_irq(&phba->hbalock);
4061                 if (phba->hba_flag & FCF_TS_INPROG) {
4062                         spin_unlock_irq(&phba->hbalock);
4063                         break;
4064                 }
4065                 /* If fast FCF failover rescan event is pending, do nothing */
4066                 if (phba->fcf.fcf_flag & FCF_REDISC_EVT) {
4067                         spin_unlock_irq(&phba->hbalock);
4068                         break;
4069                 }
4070
4071                 /* If the FCF has been in discovered state, do nothing. */
4072                 if (phba->fcf.fcf_flag & FCF_SCAN_DONE) {
4073                         spin_unlock_irq(&phba->hbalock);
4074                         break;
4075                 }
4076                 spin_unlock_irq(&phba->hbalock);
4077
4078                 /* Otherwise, scan the entire FCF table and re-discover SAN */
4079                 lpfc_printf_log(phba, KERN_INFO, LOG_FIP | LOG_DISCOVERY,
4080                                 "2770 Start FCF table scan per async FCF "
4081                                 "event, evt_tag:x%x, index:x%x\n",
4082                                 acqe_fip->event_tag, acqe_fip->index);
4083                 rc = lpfc_sli4_fcf_scan_read_fcf_rec(phba,
4084                                                      LPFC_FCOE_FCF_GET_FIRST);
4085                 if (rc)
4086                         lpfc_printf_log(phba, KERN_ERR, LOG_FIP | LOG_DISCOVERY,
4087                                         "2547 Issue FCF scan read FCF mailbox "
4088                                         "command failed (x%x)\n", rc);
4089                 break;
4090
4091         case LPFC_FIP_EVENT_TYPE_FCF_TABLE_FULL:
4092                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
4093                         "2548 FCF Table full count 0x%x tag 0x%x\n",
4094                         bf_get(lpfc_acqe_fip_fcf_count, acqe_fip),
4095                         acqe_fip->event_tag);
4096                 break;
4097
4098         case LPFC_FIP_EVENT_TYPE_FCF_DEAD:
4099                 phba->fcoe_cvl_eventtag = acqe_fip->event_tag;
4100                 lpfc_printf_log(phba, KERN_ERR, LOG_FIP | LOG_DISCOVERY,
4101                         "2549 FCF (x%x) disconnected from network, "
4102                         "tag:x%x\n", acqe_fip->index, acqe_fip->event_tag);
4103                 /*
4104                  * If we are in the middle of FCF failover process, clear
4105                  * the corresponding FCF bit in the roundrobin bitmap.
4106                  */
4107                 spin_lock_irq(&phba->hbalock);
4108                 if (phba->fcf.fcf_flag & FCF_DISCOVERY) {
4109                         spin_unlock_irq(&phba->hbalock);
4110                         /* Update FLOGI FCF failover eligible FCF bmask */
4111                         lpfc_sli4_fcf_rr_index_clear(phba, acqe_fip->index);
4112                         break;
4113                 }
4114                 spin_unlock_irq(&phba->hbalock);
4115
4116                 /* If the event is not for currently used fcf do nothing */
4117                 if (phba->fcf.current_rec.fcf_indx != acqe_fip->index)
4118                         break;
4119
4120                 /*
4121                  * Otherwise, request the port to rediscover the entire FCF
4122                  * table for a fast recovery from case that the current FCF
4123                  * is no longer valid as we are not in the middle of FCF
4124                  * failover process already.
4125                  */
4126                 spin_lock_irq(&phba->hbalock);
4127                 /* Mark the fast failover process in progress */
4128                 phba->fcf.fcf_flag |= FCF_DEAD_DISC;
4129                 spin_unlock_irq(&phba->hbalock);
4130
4131                 lpfc_printf_log(phba, KERN_INFO, LOG_FIP | LOG_DISCOVERY,
4132                                 "2771 Start FCF fast failover process due to "
4133                                 "FCF DEAD event: evt_tag:x%x, fcf_index:x%x "
4134                                 "\n", acqe_fip->event_tag, acqe_fip->index);
4135                 rc = lpfc_sli4_redisc_fcf_table(phba);
4136                 if (rc) {
4137                         lpfc_printf_log(phba, KERN_ERR, LOG_FIP |
4138                                         LOG_DISCOVERY,
4139                                         "2772 Issue FCF rediscover mabilbox "
4140                                         "command failed, fail through to FCF "
4141                                         "dead event\n");
4142                         spin_lock_irq(&phba->hbalock);
4143                         phba->fcf.fcf_flag &= ~FCF_DEAD_DISC;
4144                         spin_unlock_irq(&phba->hbalock);
4145                         /*
4146                          * Last resort will fail over by treating this
4147                          * as a link down to FCF registration.
4148                          */
4149                         lpfc_sli4_fcf_dead_failthrough(phba);
4150                 } else {
4151                         /* Reset FCF roundrobin bmask for new discovery */
4152                         lpfc_sli4_clear_fcf_rr_bmask(phba);
4153                         /*
4154                          * Handling fast FCF failover to a DEAD FCF event is
4155                          * considered equalivant to receiving CVL to all vports.
4156                          */
4157                         lpfc_sli4_perform_all_vport_cvl(phba);
4158                 }
4159                 break;
4160         case LPFC_FIP_EVENT_TYPE_CVL:
4161                 phba->fcoe_cvl_eventtag = acqe_fip->event_tag;
4162                 lpfc_printf_log(phba, KERN_ERR, LOG_FIP | LOG_DISCOVERY,
4163                         "2718 Clear Virtual Link Received for VPI 0x%x"
4164                         " tag 0x%x\n", acqe_fip->index, acqe_fip->event_tag);
4165
4166                 vport = lpfc_find_vport_by_vpid(phba,
4167                                                 acqe_fip->index);
4168                 ndlp = lpfc_sli4_perform_vport_cvl(vport);
4169                 if (!ndlp)
4170                         break;
4171                 active_vlink_present = 0;
4172
4173                 vports = lpfc_create_vport_work_array(phba);
4174                 if (vports) {
4175                         for (i = 0; i <= phba->max_vports && vports[i] != NULL;
4176                                         i++) {
4177                                 if ((!(vports[i]->fc_flag &
4178                                         FC_VPORT_CVL_RCVD)) &&
4179                                         (vports[i]->port_state > LPFC_FDISC)) {
4180                                         active_vlink_present = 1;
4181                                         break;
4182                                 }
4183                         }
4184                         lpfc_destroy_vport_work_array(phba, vports);
4185                 }
4186
4187                 if (active_vlink_present) {
4188                         /*
4189                          * If there are other active VLinks present,
4190                          * re-instantiate the Vlink using FDISC.
4191                          */
4192                         mod_timer(&ndlp->nlp_delayfunc, jiffies + HZ);
4193                         shost = lpfc_shost_from_vport(vport);
4194                         spin_lock_irq(shost->host_lock);
4195                         ndlp->nlp_flag |= NLP_DELAY_TMO;
4196                         spin_unlock_irq(shost->host_lock);
4197                         ndlp->nlp_last_elscmd = ELS_CMD_FDISC;
4198                         vport->port_state = LPFC_FDISC;
4199                 } else {
4200                         /*
4201                          * Otherwise, we request port to rediscover
4202                          * the entire FCF table for a fast recovery
4203                          * from possible case that the current FCF
4204                          * is no longer valid if we are not already
4205                          * in the FCF failover process.
4206                          */
4207                         spin_lock_irq(&phba->hbalock);
4208                         if (phba->fcf.fcf_flag & FCF_DISCOVERY) {
4209                                 spin_unlock_irq(&phba->hbalock);
4210                                 break;
4211                         }
4212                         /* Mark the fast failover process in progress */
4213                         phba->fcf.fcf_flag |= FCF_ACVL_DISC;
4214                         spin_unlock_irq(&phba->hbalock);
4215                         lpfc_printf_log(phba, KERN_INFO, LOG_FIP |
4216                                         LOG_DISCOVERY,
4217                                         "2773 Start FCF failover per CVL, "
4218                                         "evt_tag:x%x\n", acqe_fip->event_tag);
4219                         rc = lpfc_sli4_redisc_fcf_table(phba);
4220                         if (rc) {
4221                                 lpfc_printf_log(phba, KERN_ERR, LOG_FIP |
4222                                                 LOG_DISCOVERY,
4223                                                 "2774 Issue FCF rediscover "
4224                                                 "mabilbox command failed, "
4225                                                 "through to CVL event\n");
4226                                 spin_lock_irq(&phba->hbalock);
4227                                 phba->fcf.fcf_flag &= ~FCF_ACVL_DISC;
4228                                 spin_unlock_irq(&phba->hbalock);
4229                                 /*
4230                                  * Last resort will be re-try on the
4231                                  * the current registered FCF entry.
4232                                  */
4233                                 lpfc_retry_pport_discovery(phba);
4234                         } else
4235                                 /*
4236                                  * Reset FCF roundrobin bmask for new
4237                                  * discovery.
4238                                  */
4239                                 lpfc_sli4_clear_fcf_rr_bmask(phba);
4240                 }
4241                 break;
4242         default:
4243                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
4244                         "0288 Unknown FCoE event type 0x%x event tag "
4245                         "0x%x\n", event_type, acqe_fip->event_tag);
4246                 break;
4247         }
4248 }
4249
4250 /**
4251  * lpfc_sli4_async_dcbx_evt - Process the asynchronous dcbx event
4252  * @phba: pointer to lpfc hba data structure.
4253  * @acqe_link: pointer to the async dcbx completion queue entry.
4254  *
4255  * This routine is to handle the SLI4 asynchronous dcbx event.
4256  **/
4257 static void
4258 lpfc_sli4_async_dcbx_evt(struct lpfc_hba *phba,
4259                          struct lpfc_acqe_dcbx *acqe_dcbx)
4260 {
4261         phba->fc_eventTag = acqe_dcbx->event_tag;
4262         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
4263                         "0290 The SLI4 DCBX asynchronous event is not "
4264                         "handled yet\n");
4265 }
4266
4267 /**
4268  * lpfc_sli4_async_grp5_evt - Process the asynchronous group5 event
4269  * @phba: pointer to lpfc hba data structure.
4270  * @acqe_link: pointer to the async grp5 completion queue entry.
4271  *
4272  * This routine is to handle the SLI4 asynchronous grp5 event. A grp5 event
4273  * is an asynchronous notified of a logical link speed change.  The Port
4274  * reports the logical link speed in units of 10Mbps.
4275  **/
4276 static void
4277 lpfc_sli4_async_grp5_evt(struct lpfc_hba *phba,
4278                          struct lpfc_acqe_grp5 *acqe_grp5)
4279 {
4280         uint16_t prev_ll_spd;
4281
4282         phba->fc_eventTag = acqe_grp5->event_tag;
4283         phba->fcoe_eventtag = acqe_grp5->event_tag;
4284         prev_ll_spd = phba->sli4_hba.link_state.logical_speed;
4285         phba->sli4_hba.link_state.logical_speed =
4286                 (bf_get(lpfc_acqe_grp5_llink_spd, acqe_grp5)) * 10;
4287         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
4288                         "2789 GRP5 Async Event: Updating logical link speed "
4289                         "from %dMbps to %dMbps\n", prev_ll_spd,
4290                         phba->sli4_hba.link_state.logical_speed);
4291 }
4292
4293 /**
4294  * lpfc_sli4_async_event_proc - Process all the pending asynchronous event
4295  * @phba: pointer to lpfc hba data structure.
4296  *
4297  * This routine is invoked by the worker thread to process all the pending
4298  * SLI4 asynchronous events.
4299  **/
4300 void lpfc_sli4_async_event_proc(struct lpfc_hba *phba)
4301 {
4302         struct lpfc_cq_event *cq_event;
4303
4304         /* First, declare the async event has been handled */
4305         spin_lock_irq(&phba->hbalock);
4306         phba->hba_flag &= ~ASYNC_EVENT;
4307         spin_unlock_irq(&phba->hbalock);
4308         /* Now, handle all the async events */
4309         while (!list_empty(&phba->sli4_hba.sp_asynce_work_queue)) {
4310                 /* Get the first event from the head of the event queue */
4311                 spin_lock_irq(&phba->hbalock);
4312                 list_remove_head(&phba->sli4_hba.sp_asynce_work_queue,
4313                                  cq_event, struct lpfc_cq_event, list);
4314                 spin_unlock_irq(&phba->hbalock);
4315                 /* Process the asynchronous event */
4316                 switch (bf_get(lpfc_trailer_code, &cq_event->cqe.mcqe_cmpl)) {
4317                 case LPFC_TRAILER_CODE_LINK:
4318                         lpfc_sli4_async_link_evt(phba,
4319                                                  &cq_event->cqe.acqe_link);
4320                         break;
4321                 case LPFC_TRAILER_CODE_FCOE:
4322                         lpfc_sli4_async_fip_evt(phba, &cq_event->cqe.acqe_fip);
4323                         break;
4324                 case LPFC_TRAILER_CODE_DCBX:
4325                         lpfc_sli4_async_dcbx_evt(phba,
4326                                                  &cq_event->cqe.acqe_dcbx);
4327                         break;
4328                 case LPFC_TRAILER_CODE_GRP5:
4329                         lpfc_sli4_async_grp5_evt(phba,
4330                                                  &cq_event->cqe.acqe_grp5);
4331                         break;
4332                 case LPFC_TRAILER_CODE_FC:
4333                         lpfc_sli4_async_fc_evt(phba, &cq_event->cqe.acqe_fc);
4334                         break;
4335                 case LPFC_TRAILER_CODE_SLI:
4336                         lpfc_sli4_async_sli_evt(phba, &cq_event->cqe.acqe_sli);
4337                         break;
4338                 default:
4339                         lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
4340                                         "1804 Invalid asynchrous event code: "
4341                                         "x%x\n", bf_get(lpfc_trailer_code,
4342                                         &cq_event->cqe.mcqe_cmpl));
4343                         break;
4344                 }
4345                 /* Free the completion event processed to the free pool */
4346                 lpfc_sli4_cq_event_release(phba, cq_event);
4347         }
4348 }
4349
4350 /**
4351  * lpfc_sli4_fcf_redisc_event_proc - Process fcf table rediscovery event
4352  * @phba: pointer to lpfc hba data structure.
4353  *
4354  * This routine is invoked by the worker thread to process FCF table
4355  * rediscovery pending completion event.
4356  **/
4357 void lpfc_sli4_fcf_redisc_event_proc(struct lpfc_hba *phba)
4358 {
4359         int rc;
4360
4361         spin_lock_irq(&phba->hbalock);
4362         /* Clear FCF rediscovery timeout event */
4363         phba->fcf.fcf_flag &= ~FCF_REDISC_EVT;
4364         /* Clear driver fast failover FCF record flag */
4365         phba->fcf.failover_rec.flag = 0;
4366         /* Set state for FCF fast failover */
4367         phba->fcf.fcf_flag |= FCF_REDISC_FOV;
4368         spin_unlock_irq(&phba->hbalock);
4369
4370         /* Scan FCF table from the first entry to re-discover SAN */
4371         lpfc_printf_log(phba, KERN_INFO, LOG_FIP | LOG_DISCOVERY,
4372                         "2777 Start post-quiescent FCF table scan\n");
4373         rc = lpfc_sli4_fcf_scan_read_fcf_rec(phba, LPFC_FCOE_FCF_GET_FIRST);
4374         if (rc)
4375                 lpfc_printf_log(phba, KERN_ERR, LOG_FIP | LOG_DISCOVERY,
4376                                 "2747 Issue FCF scan read FCF mailbox "
4377                                 "command failed 0x%x\n", rc);
4378 }
4379
4380 /**
4381  * lpfc_api_table_setup - Set up per hba pci-device group func api jump table
4382  * @phba: pointer to lpfc hba data structure.
4383  * @dev_grp: The HBA PCI-Device group number.
4384  *
4385  * This routine is invoked to set up the per HBA PCI-Device group function
4386  * API jump table entries.
4387  *
4388  * Return: 0 if success, otherwise -ENODEV
4389  **/
4390 int
4391 lpfc_api_table_setup(struct lpfc_hba *phba, uint8_t dev_grp)
4392 {
4393         int rc;
4394
4395         /* Set up lpfc PCI-device group */
4396         phba->pci_dev_grp = dev_grp;
4397
4398         /* The LPFC_PCI_DEV_OC uses SLI4 */
4399         if (dev_grp == LPFC_PCI_DEV_OC)
4400                 phba->sli_rev = LPFC_SLI_REV4;
4401
4402         /* Set up device INIT API function jump table */
4403         rc = lpfc_init_api_table_setup(phba, dev_grp);
4404         if (rc)
4405                 return -ENODEV;
4406         /* Set up SCSI API function jump table */
4407         rc = lpfc_scsi_api_table_setup(phba, dev_grp);
4408         if (rc)
4409                 return -ENODEV;
4410         /* Set up SLI API function jump table */
4411         rc = lpfc_sli_api_table_setup(phba, dev_grp);
4412         if (rc)
4413                 return -ENODEV;
4414         /* Set up MBOX API function jump table */
4415         rc = lpfc_mbox_api_table_setup(phba, dev_grp);
4416         if (rc)
4417                 return -ENODEV;
4418
4419         return 0;
4420 }
4421
4422 /**
4423  * lpfc_log_intr_mode - Log the active interrupt mode
4424  * @phba: pointer to lpfc hba data structure.
4425  * @intr_mode: active interrupt mode adopted.
4426  *
4427  * This routine it invoked to log the currently used active interrupt mode
4428  * to the device.
4429  **/
4430 static void lpfc_log_intr_mode(struct lpfc_hba *phba, uint32_t intr_mode)
4431 {
4432         switch (intr_mode) {
4433         case 0:
4434                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
4435                                 "0470 Enable INTx interrupt mode.\n");
4436                 break;
4437         case 1:
4438                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
4439                                 "0481 Enabled MSI interrupt mode.\n");
4440                 break;
4441         case 2:
4442                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
4443                                 "0480 Enabled MSI-X interrupt mode.\n");
4444                 break;
4445         default:
4446                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
4447                                 "0482 Illegal interrupt mode.\n");
4448                 break;
4449         }
4450         return;
4451 }
4452
4453 /**
4454  * lpfc_enable_pci_dev - Enable a generic PCI device.
4455  * @phba: pointer to lpfc hba data structure.
4456  *
4457  * This routine is invoked to enable the PCI device that is common to all
4458  * PCI devices.
4459  *
4460  * Return codes
4461  *      0 - successful
4462  *      other values - error
4463  **/
4464 static int
4465 lpfc_enable_pci_dev(struct lpfc_hba *phba)
4466 {
4467         struct pci_dev *pdev;
4468         int bars = 0;
4469
4470         /* Obtain PCI device reference */
4471         if (!phba->pcidev)
4472                 goto out_error;
4473         else
4474                 pdev = phba->pcidev;
4475         /* Select PCI BARs */
4476         bars = pci_select_bars(pdev, IORESOURCE_MEM);
4477         /* Enable PCI device */
4478         if (pci_enable_device_mem(pdev))
4479                 goto out_error;
4480         /* Request PCI resource for the device */
4481         if (pci_request_selected_regions(pdev, bars, LPFC_DRIVER_NAME))
4482                 goto out_disable_device;
4483         /* Set up device as PCI master and save state for EEH */
4484         pci_set_master(pdev);
4485         pci_try_set_mwi(pdev);
4486         pci_save_state(pdev);
4487
4488         /* PCIe EEH recovery on powerpc platforms needs fundamental reset */
4489         if (pci_find_capability(pdev, PCI_CAP_ID_EXP))
4490                 pdev->needs_freset = 1;
4491
4492         return 0;
4493
4494 out_disable_device:
4495         pci_disable_device(pdev);
4496 out_error:
4497         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
4498                         "1401 Failed to enable pci device, bars:x%x\n", bars);
4499         return -ENODEV;
4500 }
4501
4502 /**
4503  * lpfc_disable_pci_dev - Disable a generic PCI device.
4504  * @phba: pointer to lpfc hba data structure.
4505  *
4506  * This routine is invoked to disable the PCI device that is common to all
4507  * PCI devices.
4508  **/
4509 static void
4510 lpfc_disable_pci_dev(struct lpfc_hba *phba)
4511 {
4512         struct pci_dev *pdev;
4513         int bars;
4514
4515         /* Obtain PCI device reference */
4516         if (!phba->pcidev)
4517                 return;
4518         else
4519                 pdev = phba->pcidev;
4520         /* Select PCI BARs */
4521         bars = pci_select_bars(pdev, IORESOURCE_MEM);
4522         /* Release PCI resource and disable PCI device */
4523         pci_release_selected_regions(pdev, bars);
4524         pci_disable_device(pdev);
4525         /* Null out PCI private reference to driver */
4526         pci_set_drvdata(pdev, NULL);
4527
4528         return;
4529 }
4530
4531 /**
4532  * lpfc_reset_hba - Reset a hba
4533  * @phba: pointer to lpfc hba data structure.
4534  *
4535  * This routine is invoked to reset a hba device. It brings the HBA
4536  * offline, performs a board restart, and then brings the board back
4537  * online. The lpfc_offline calls lpfc_sli_hba_down which will clean up
4538  * on outstanding mailbox commands.
4539  **/
4540 void
4541 lpfc_reset_hba(struct lpfc_hba *phba)
4542 {
4543         /* If resets are disabled then set error state and return. */
4544         if (!phba->cfg_enable_hba_reset) {
4545                 phba->link_state = LPFC_HBA_ERROR;
4546                 return;
4547         }
4548         lpfc_offline_prep(phba, LPFC_MBX_WAIT);
4549         lpfc_offline(phba);
4550         lpfc_sli_brdrestart(phba);
4551         lpfc_online(phba);
4552         lpfc_unblock_mgmt_io(phba);
4553 }
4554
4555 /**
4556  * lpfc_sli_sriov_nr_virtfn_get - Get the number of sr-iov virtual functions
4557  * @phba: pointer to lpfc hba data structure.
4558  *
4559  * This function enables the PCI SR-IOV virtual functions to a physical
4560  * function. It invokes the PCI SR-IOV api with the @nr_vfn provided to
4561  * enable the number of virtual functions to the physical function. As
4562  * not all devices support SR-IOV, the return code from the pci_enable_sriov()
4563  * API call does not considered as an error condition for most of the device.
4564  **/
4565 uint16_t
4566 lpfc_sli_sriov_nr_virtfn_get(struct lpfc_hba *phba)
4567 {
4568         struct pci_dev *pdev = phba->pcidev;
4569         uint16_t nr_virtfn;
4570         int pos;
4571
4572         pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_SRIOV);
4573         if (pos == 0)
4574                 return 0;
4575
4576         pci_read_config_word(pdev, pos + PCI_SRIOV_TOTAL_VF, &nr_virtfn);
4577         return nr_virtfn;
4578 }
4579
4580 /**
4581  * lpfc_sli_probe_sriov_nr_virtfn - Enable a number of sr-iov virtual functions
4582  * @phba: pointer to lpfc hba data structure.
4583  * @nr_vfn: number of virtual functions to be enabled.
4584  *
4585  * This function enables the PCI SR-IOV virtual functions to a physical
4586  * function. It invokes the PCI SR-IOV api with the @nr_vfn provided to
4587  * enable the number of virtual functions to the physical function. As
4588  * not all devices support SR-IOV, the return code from the pci_enable_sriov()
4589  * API call does not considered as an error condition for most of the device.
4590  **/
4591 int
4592 lpfc_sli_probe_sriov_nr_virtfn(struct lpfc_hba *phba, int nr_vfn)
4593 {
4594         struct pci_dev *pdev = phba->pcidev;
4595         uint16_t max_nr_vfn;
4596         int rc;
4597
4598         max_nr_vfn = lpfc_sli_sriov_nr_virtfn_get(phba);
4599         if (nr_vfn > max_nr_vfn) {
4600                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
4601                                 "3057 Requested vfs (%d) greater than "
4602                                 "supported vfs (%d)", nr_vfn, max_nr_vfn);
4603                 return -EINVAL;
4604         }
4605
4606         rc = pci_enable_sriov(pdev, nr_vfn);
4607         if (rc) {
4608                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
4609                                 "2806 Failed to enable sriov on this device "
4610                                 "with vfn number nr_vf:%d, rc:%d\n",
4611                                 nr_vfn, rc);
4612         } else
4613                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
4614                                 "2807 Successful enable sriov on this device "
4615                                 "with vfn number nr_vf:%d\n", nr_vfn);
4616         return rc;
4617 }
4618
4619 /**
4620  * lpfc_sli_driver_resource_setup - Setup driver internal resources for SLI3 dev.
4621  * @phba: pointer to lpfc hba data structure.
4622  *
4623  * This routine is invoked to set up the driver internal resources specific to
4624  * support the SLI-3 HBA device it attached to.
4625  *
4626  * Return codes
4627  *      0 - successful
4628  *      other values - error
4629  **/
4630 static int
4631 lpfc_sli_driver_resource_setup(struct lpfc_hba *phba)
4632 {
4633         struct lpfc_sli *psli;
4634         int rc;
4635
4636         /*
4637          * Initialize timers used by driver
4638          */
4639
4640         /* Heartbeat timer */
4641         init_timer(&phba->hb_tmofunc);
4642         phba->hb_tmofunc.function = lpfc_hb_timeout;
4643         phba->hb_tmofunc.data = (unsigned long)phba;
4644
4645         psli = &phba->sli;
4646         /* MBOX heartbeat timer */
4647         init_timer(&psli->mbox_tmo);
4648         psli->mbox_tmo.function = lpfc_mbox_timeout;
4649         psli->mbox_tmo.data = (unsigned long) phba;
4650         /* FCP polling mode timer */
4651         init_timer(&phba->fcp_poll_timer);
4652         phba->fcp_poll_timer.function = lpfc_poll_timeout;
4653         phba->fcp_poll_timer.data = (unsigned long) phba;
4654         /* Fabric block timer */
4655         init_timer(&phba->fabric_block_timer);
4656         phba->fabric_block_timer.function = lpfc_fabric_block_timeout;
4657         phba->fabric_block_timer.data = (unsigned long) phba;
4658         /* EA polling mode timer */
4659         init_timer(&phba->eratt_poll);
4660         phba->eratt_poll.function = lpfc_poll_eratt;
4661         phba->eratt_poll.data = (unsigned long) phba;
4662
4663         /* Host attention work mask setup */
4664         phba->work_ha_mask = (HA_ERATT | HA_MBATT | HA_LATT);
4665         phba->work_ha_mask |= (HA_RXMASK << (LPFC_ELS_RING * 4));
4666
4667         /* Get all the module params for configuring this host */
4668         lpfc_get_cfgparam(phba);
4669         if (phba->pcidev->device == PCI_DEVICE_ID_HORNET) {
4670                 phba->menlo_flag |= HBA_MENLO_SUPPORT;
4671                 /* check for menlo minimum sg count */
4672                 if (phba->cfg_sg_seg_cnt < LPFC_DEFAULT_MENLO_SG_SEG_CNT)
4673                         phba->cfg_sg_seg_cnt = LPFC_DEFAULT_MENLO_SG_SEG_CNT;
4674         }
4675
4676         if (!phba->sli.ring)
4677                 phba->sli.ring = (struct lpfc_sli_ring *)
4678                         kzalloc(LPFC_SLI3_MAX_RING *
4679                         sizeof(struct lpfc_sli_ring), GFP_KERNEL);
4680         if (!phba->sli.ring)
4681                 return -ENOMEM;
4682
4683         /*
4684          * Since the sg_tablesize is module parameter, the sg_dma_buf_size
4685          * used to create the sg_dma_buf_pool must be dynamically calculated.
4686          * 2 segments are added since the IOCB needs a command and response bde.
4687          */
4688         phba->cfg_sg_dma_buf_size = sizeof(struct fcp_cmnd) +
4689                 sizeof(struct fcp_rsp) +
4690                         ((phba->cfg_sg_seg_cnt + 2) * sizeof(struct ulp_bde64));
4691
4692         if (phba->cfg_enable_bg) {
4693                 phba->cfg_sg_seg_cnt = LPFC_MAX_SG_SEG_CNT;
4694                 phba->cfg_sg_dma_buf_size +=
4695                         phba->cfg_prot_sg_seg_cnt * sizeof(struct ulp_bde64);
4696         }
4697
4698         /* Also reinitialize the host templates with new values. */
4699         lpfc_vport_template.sg_tablesize = phba->cfg_sg_seg_cnt;
4700         lpfc_template.sg_tablesize = phba->cfg_sg_seg_cnt;
4701
4702         phba->max_vpi = LPFC_MAX_VPI;
4703         /* This will be set to correct value after config_port mbox */
4704         phba->max_vports = 0;
4705
4706         /*
4707          * Initialize the SLI Layer to run with lpfc HBAs.
4708          */
4709         lpfc_sli_setup(phba);
4710         lpfc_sli_queue_setup(phba);
4711
4712         /* Allocate device driver memory */
4713         if (lpfc_mem_alloc(phba, BPL_ALIGN_SZ))
4714                 return -ENOMEM;
4715
4716         /*
4717          * Enable sr-iov virtual functions if supported and configured
4718          * through the module parameter.
4719          */
4720         if (phba->cfg_sriov_nr_virtfn > 0) {
4721                 rc = lpfc_sli_probe_sriov_nr_virtfn(phba,
4722                                                  phba->cfg_sriov_nr_virtfn);
4723                 if (rc) {
4724                         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
4725                                         "2808 Requested number of SR-IOV "
4726                                         "virtual functions (%d) is not "
4727                                         "supported\n",
4728                                         phba->cfg_sriov_nr_virtfn);
4729                         phba->cfg_sriov_nr_virtfn = 0;
4730                 }
4731         }
4732
4733         return 0;
4734 }
4735
4736 /**
4737  * lpfc_sli_driver_resource_unset - Unset drvr internal resources for SLI3 dev
4738  * @phba: pointer to lpfc hba data structure.
4739  *
4740  * This routine is invoked to unset the driver internal resources set up
4741  * specific for supporting the SLI-3 HBA device it attached to.
4742  **/
4743 static void
4744 lpfc_sli_driver_resource_unset(struct lpfc_hba *phba)
4745 {
4746         /* Free device driver memory allocated */
4747         lpfc_mem_free_all(phba);
4748
4749         return;
4750 }
4751
4752 /**
4753  * lpfc_sli4_driver_resource_setup - Setup drvr internal resources for SLI4 dev
4754  * @phba: pointer to lpfc hba data structure.
4755  *
4756  * This routine is invoked to set up the driver internal resources specific to
4757  * support the SLI-4 HBA device it attached to.
4758  *
4759  * Return codes
4760  *      0 - successful
4761  *      other values - error
4762  **/
4763 static int
4764 lpfc_sli4_driver_resource_setup(struct lpfc_hba *phba)
4765 {
4766         struct lpfc_sli *psli;
4767         LPFC_MBOXQ_t *mboxq;
4768         int rc, i, hbq_count, buf_size, dma_buf_size, max_buf_size;
4769         uint8_t pn_page[LPFC_MAX_SUPPORTED_PAGES] = {0};
4770         struct lpfc_mqe *mqe;
4771         int longs, sli_family;
4772         int sges_per_segment;
4773
4774         /* Before proceed, wait for POST done and device ready */
4775         rc = lpfc_sli4_post_status_check(phba);
4776         if (rc)
4777                 return -ENODEV;
4778
4779         /*
4780          * Initialize timers used by driver
4781          */
4782
4783         /* Heartbeat timer */
4784         init_timer(&phba->hb_tmofunc);
4785         phba->hb_tmofunc.function = lpfc_hb_timeout;
4786         phba->hb_tmofunc.data = (unsigned long)phba;
4787         init_timer(&phba->rrq_tmr);
4788         phba->rrq_tmr.function = lpfc_rrq_timeout;
4789         phba->rrq_tmr.data = (unsigned long)phba;
4790
4791         psli = &phba->sli;
4792         /* MBOX heartbeat timer */
4793         init_timer(&psli->mbox_tmo);
4794         psli->mbox_tmo.function = lpfc_mbox_timeout;
4795         psli->mbox_tmo.data = (unsigned long) phba;
4796         /* Fabric block timer */
4797         init_timer(&phba->fabric_block_timer);
4798         phba->fabric_block_timer.function = lpfc_fabric_block_timeout;
4799         phba->fabric_block_timer.data = (unsigned long) phba;
4800         /* EA polling mode timer */
4801         init_timer(&phba->eratt_poll);
4802         phba->eratt_poll.function = lpfc_poll_eratt;
4803         phba->eratt_poll.data = (unsigned long) phba;
4804         /* FCF rediscover timer */
4805         init_timer(&phba->fcf.redisc_wait);
4806         phba->fcf.redisc_wait.function = lpfc_sli4_fcf_redisc_wait_tmo;
4807         phba->fcf.redisc_wait.data = (unsigned long)phba;
4808
4809         /*
4810          * Control structure for handling external multi-buffer mailbox
4811          * command pass-through.
4812          */
4813         memset((uint8_t *)&phba->mbox_ext_buf_ctx, 0,
4814                 sizeof(struct lpfc_mbox_ext_buf_ctx));
4815         INIT_LIST_HEAD(&phba->mbox_ext_buf_ctx.ext_dmabuf_list);
4816
4817         /*
4818          * We need to do a READ_CONFIG mailbox command here before
4819          * calling lpfc_get_cfgparam. For VFs this will report the
4820          * MAX_XRI, MAX_VPI, MAX_RPI, MAX_IOCB, and MAX_VFI settings.
4821          * All of the resources allocated
4822          * for this Port are tied to these values.
4823          */
4824         /* Get all the module params for configuring this host */
4825         lpfc_get_cfgparam(phba);
4826         phba->max_vpi = LPFC_MAX_VPI;
4827
4828         /* Eventually cfg_fcp_eq_count / cfg_fcp_wq_count will be depricated */
4829         phba->cfg_fcp_io_channel = phba->cfg_fcp_eq_count;
4830
4831         /* This will be set to correct value after the read_config mbox */
4832         phba->max_vports = 0;
4833
4834         /* Program the default value of vlan_id and fc_map */
4835         phba->valid_vlan = 0;
4836         phba->fc_map[0] = LPFC_FCOE_FCF_MAP0;
4837         phba->fc_map[1] = LPFC_FCOE_FCF_MAP1;
4838         phba->fc_map[2] = LPFC_FCOE_FCF_MAP2;
4839
4840         /* With BlockGuard we can have multiple SGEs per Data Segemnt */
4841         sges_per_segment = 1;
4842         if (phba->cfg_enable_bg)
4843                 sges_per_segment = 2;
4844
4845         /*
4846          * For SLI4, instead of using ring 0 (LPFC_FCP_RING) for FCP commands
4847          * we will associate a new ring, for each FCP fastpath EQ/CQ/WQ tuple.
4848          */
4849         if (!phba->sli.ring)
4850                 phba->sli.ring = kzalloc(
4851                         (LPFC_SLI3_MAX_RING + phba->cfg_fcp_io_channel) *
4852                         sizeof(struct lpfc_sli_ring), GFP_KERNEL);
4853         if (!phba->sli.ring)
4854                 return -ENOMEM;
4855         /*
4856          * Since the sg_tablesize is module parameter, the sg_dma_buf_size
4857          * used to create the sg_dma_buf_pool must be dynamically calculated.
4858          * 2 segments are added since the IOCB needs a command and response bde.
4859          * To insure that the scsi sgl does not cross a 4k page boundary only
4860          * sgl sizes of must be a power of 2.
4861          */
4862         buf_size = (sizeof(struct fcp_cmnd) + sizeof(struct fcp_rsp) +
4863                     (((phba->cfg_sg_seg_cnt * sges_per_segment) + 2) *
4864                     sizeof(struct sli4_sge)));
4865
4866         sli_family = bf_get(lpfc_sli_intf_sli_family, &phba->sli4_hba.sli_intf);
4867         max_buf_size = LPFC_SLI4_MAX_BUF_SIZE;
4868         switch (sli_family) {
4869         case LPFC_SLI_INTF_FAMILY_BE2:
4870         case LPFC_SLI_INTF_FAMILY_BE3:
4871                 /* There is a single hint for BE - 2 pages per BPL. */
4872                 if (bf_get(lpfc_sli_intf_sli_hint1, &phba->sli4_hba.sli_intf) ==
4873                     LPFC_SLI_INTF_SLI_HINT1_1)
4874                         max_buf_size = LPFC_SLI4_FL1_MAX_BUF_SIZE;
4875                 break;
4876         case LPFC_SLI_INTF_FAMILY_LNCR_A0:
4877         case LPFC_SLI_INTF_FAMILY_LNCR_B0:
4878         default:
4879                 break;
4880         }
4881
4882         for (dma_buf_size = LPFC_SLI4_MIN_BUF_SIZE;
4883              dma_buf_size < max_buf_size && buf_size > dma_buf_size;
4884              dma_buf_size = dma_buf_size << 1)
4885                 ;
4886         if (dma_buf_size == max_buf_size)
4887                 phba->cfg_sg_seg_cnt = (dma_buf_size -
4888                         sizeof(struct fcp_cmnd) - sizeof(struct fcp_rsp) -
4889                         (2 * sizeof(struct sli4_sge))) /
4890                                 sizeof(struct sli4_sge);
4891         phba->cfg_sg_dma_buf_size = dma_buf_size;
4892
4893         /* Initialize buffer queue management fields */
4894         hbq_count = lpfc_sli_hbq_count();
4895         for (i = 0; i < hbq_count; ++i)
4896                 INIT_LIST_HEAD(&phba->hbqs[i].hbq_buffer_list);
4897         INIT_LIST_HEAD(&phba->rb_pend_list);
4898         phba->hbqs[LPFC_ELS_HBQ].hbq_alloc_buffer = lpfc_sli4_rb_alloc;
4899         phba->hbqs[LPFC_ELS_HBQ].hbq_free_buffer = lpfc_sli4_rb_free;
4900
4901         /*
4902          * Initialize the SLI Layer to run with lpfc SLI4 HBAs.
4903          */
4904         /* Initialize the Abort scsi buffer list used by driver */
4905         spin_lock_init(&phba->sli4_hba.abts_scsi_buf_list_lock);
4906         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_abts_scsi_buf_list);
4907         /* This abort list used by worker thread */
4908         spin_lock_init(&phba->sli4_hba.abts_sgl_list_lock);
4909
4910         /*
4911          * Initialize driver internal slow-path work queues
4912          */
4913
4914         /* Driver internel slow-path CQ Event pool */
4915         INIT_LIST_HEAD(&phba->sli4_hba.sp_cqe_event_pool);
4916         /* Response IOCB work queue list */
4917         INIT_LIST_HEAD(&phba->sli4_hba.sp_queue_event);
4918         /* Asynchronous event CQ Event work queue list */
4919         INIT_LIST_HEAD(&phba->sli4_hba.sp_asynce_work_queue);
4920         /* Fast-path XRI aborted CQ Event work queue list */
4921         INIT_LIST_HEAD(&phba->sli4_hba.sp_fcp_xri_aborted_work_queue);
4922         /* Slow-path XRI aborted CQ Event work queue list */
4923         INIT_LIST_HEAD(&phba->sli4_hba.sp_els_xri_aborted_work_queue);
4924         /* Receive queue CQ Event work queue list */
4925         INIT_LIST_HEAD(&phba->sli4_hba.sp_unsol_work_queue);
4926
4927         /* Initialize extent block lists. */
4928         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_rpi_blk_list);
4929         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_xri_blk_list);
4930         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_vfi_blk_list);
4931         INIT_LIST_HEAD(&phba->lpfc_vpi_blk_list);
4932
4933         /* Initialize the driver internal SLI layer lists. */
4934         lpfc_sli_setup(phba);
4935         lpfc_sli_queue_setup(phba);
4936
4937         /* Allocate device driver memory */
4938         rc = lpfc_mem_alloc(phba, SGL_ALIGN_SZ);
4939         if (rc)
4940                 return -ENOMEM;
4941
4942         /* IF Type 2 ports get initialized now. */
4943         if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) ==
4944             LPFC_SLI_INTF_IF_TYPE_2) {
4945                 rc = lpfc_pci_function_reset(phba);
4946                 if (unlikely(rc))
4947                         return -ENODEV;
4948         }
4949
4950         /* Create the bootstrap mailbox command */
4951         rc = lpfc_create_bootstrap_mbox(phba);
4952         if (unlikely(rc))
4953                 goto out_free_mem;
4954
4955         /* Set up the host's endian order with the device. */
4956         rc = lpfc_setup_endian_order(phba);
4957         if (unlikely(rc))
4958                 goto out_free_bsmbx;
4959
4960         /* Set up the hba's configuration parameters. */
4961         rc = lpfc_sli4_read_config(phba);
4962         if (unlikely(rc))
4963                 goto out_free_bsmbx;
4964
4965         /* IF Type 0 ports get initialized now. */
4966         if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) ==
4967             LPFC_SLI_INTF_IF_TYPE_0) {
4968                 rc = lpfc_pci_function_reset(phba);
4969                 if (unlikely(rc))
4970                         goto out_free_bsmbx;
4971         }
4972
4973         mboxq = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool,
4974                                                        GFP_KERNEL);
4975         if (!mboxq) {
4976                 rc = -ENOMEM;
4977                 goto out_free_bsmbx;
4978         }
4979
4980         /* Get the Supported Pages if PORT_CAPABILITIES is supported by port. */
4981         lpfc_supported_pages(mboxq);
4982         rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
4983         if (!rc) {
4984                 mqe = &mboxq->u.mqe;
4985                 memcpy(&pn_page[0], ((uint8_t *)&mqe->un.supp_pages.word3),
4986                        LPFC_MAX_SUPPORTED_PAGES);
4987                 for (i = 0; i < LPFC_MAX_SUPPORTED_PAGES; i++) {
4988                         switch (pn_page[i]) {
4989                         case LPFC_SLI4_PARAMETERS:
4990                                 phba->sli4_hba.pc_sli4_params.supported = 1;
4991                                 break;
4992                         default:
4993                                 break;
4994                         }
4995                 }
4996                 /* Read the port's SLI4 Parameters capabilities if supported. */
4997                 if (phba->sli4_hba.pc_sli4_params.supported)
4998                         rc = lpfc_pc_sli4_params_get(phba, mboxq);
4999                 if (rc) {
5000                         mempool_free(mboxq, phba->mbox_mem_pool);
5001                         rc = -EIO;
5002                         goto out_free_bsmbx;
5003                 }
5004         }
5005         /*
5006          * Get sli4 parameters that override parameters from Port capabilities.
5007          * If this call fails, it isn't critical unless the SLI4 parameters come
5008          * back in conflict.
5009          */
5010         rc = lpfc_get_sli4_parameters(phba, mboxq);
5011         if (rc) {
5012                 if (phba->sli4_hba.extents_in_use &&
5013                     phba->sli4_hba.rpi_hdrs_in_use) {
5014                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5015                                 "2999 Unsupported SLI4 Parameters "
5016                                 "Extents and RPI headers enabled.\n");
5017                         goto out_free_bsmbx;
5018                 }
5019         }
5020         mempool_free(mboxq, phba->mbox_mem_pool);
5021         /* Verify all the SLI4 queues */
5022         rc = lpfc_sli4_queue_verify(phba);
5023         if (rc)
5024                 goto out_free_bsmbx;
5025
5026         /* Create driver internal CQE event pool */
5027         rc = lpfc_sli4_cq_event_pool_create(phba);
5028         if (rc)
5029                 goto out_free_bsmbx;
5030
5031         /* Initialize sgl lists per host */
5032         lpfc_init_sgl_list(phba);
5033
5034         /* Allocate and initialize active sgl array */
5035         rc = lpfc_init_active_sgl_array(phba);
5036         if (rc) {
5037                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5038                                 "1430 Failed to initialize sgl list.\n");
5039                 goto out_destroy_cq_event_pool;
5040         }
5041         rc = lpfc_sli4_init_rpi_hdrs(phba);
5042         if (rc) {
5043                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5044                                 "1432 Failed to initialize rpi headers.\n");
5045                 goto out_free_active_sgl;
5046         }
5047
5048         /* Allocate eligible FCF bmask memory for FCF roundrobin failover */
5049         longs = (LPFC_SLI4_FCF_TBL_INDX_MAX + BITS_PER_LONG - 1)/BITS_PER_LONG;
5050         phba->fcf.fcf_rr_bmask = kzalloc(longs * sizeof(unsigned long),
5051                                          GFP_KERNEL);
5052         if (!phba->fcf.fcf_rr_bmask) {
5053                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5054                                 "2759 Failed allocate memory for FCF round "
5055                                 "robin failover bmask\n");
5056                 rc = -ENOMEM;
5057                 goto out_remove_rpi_hdrs;
5058         }
5059
5060         phba->sli4_hba.fcp_eq_hdl =
5061                         kzalloc((sizeof(struct lpfc_fcp_eq_hdl) *
5062                             phba->cfg_fcp_io_channel), GFP_KERNEL);
5063         if (!phba->sli4_hba.fcp_eq_hdl) {
5064                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5065                                 "2572 Failed allocate memory for "
5066                                 "fast-path per-EQ handle array\n");
5067                 rc = -ENOMEM;
5068                 goto out_free_fcf_rr_bmask;
5069         }
5070
5071         phba->sli4_hba.msix_entries = kzalloc((sizeof(struct msix_entry) *
5072                                       phba->cfg_fcp_io_channel), GFP_KERNEL);
5073         if (!phba->sli4_hba.msix_entries) {
5074                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5075                                 "2573 Failed allocate memory for msi-x "
5076                                 "interrupt vector entries\n");
5077                 rc = -ENOMEM;
5078                 goto out_free_fcp_eq_hdl;
5079         }
5080
5081         /*
5082          * Enable sr-iov virtual functions if supported and configured
5083          * through the module parameter.
5084          */
5085         if (phba->cfg_sriov_nr_virtfn > 0) {
5086                 rc = lpfc_sli_probe_sriov_nr_virtfn(phba,
5087                                                  phba->cfg_sriov_nr_virtfn);
5088                 if (rc) {
5089                         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
5090                                         "3020 Requested number of SR-IOV "
5091                                         "virtual functions (%d) is not "
5092                                         "supported\n",
5093                                         phba->cfg_sriov_nr_virtfn);
5094                         phba->cfg_sriov_nr_virtfn = 0;
5095                 }
5096         }
5097
5098         return 0;
5099
5100 out_free_fcp_eq_hdl:
5101         kfree(phba->sli4_hba.fcp_eq_hdl);
5102 out_free_fcf_rr_bmask:
5103         kfree(phba->fcf.fcf_rr_bmask);
5104 out_remove_rpi_hdrs:
5105         lpfc_sli4_remove_rpi_hdrs(phba);
5106 out_free_active_sgl:
5107         lpfc_free_active_sgl(phba);
5108 out_destroy_cq_event_pool:
5109         lpfc_sli4_cq_event_pool_destroy(phba);
5110 out_free_bsmbx:
5111         lpfc_destroy_bootstrap_mbox(phba);
5112 out_free_mem:
5113         lpfc_mem_free(phba);
5114         return rc;
5115 }
5116
5117 /**
5118  * lpfc_sli4_driver_resource_unset - Unset drvr internal resources for SLI4 dev
5119  * @phba: pointer to lpfc hba data structure.
5120  *
5121  * This routine is invoked to unset the driver internal resources set up
5122  * specific for supporting the SLI-4 HBA device it attached to.
5123  **/
5124 static void
5125 lpfc_sli4_driver_resource_unset(struct lpfc_hba *phba)
5126 {
5127         struct lpfc_fcf_conn_entry *conn_entry, *next_conn_entry;
5128
5129         /* Free memory allocated for msi-x interrupt vector entries */
5130         kfree(phba->sli4_hba.msix_entries);
5131
5132         /* Free memory allocated for fast-path work queue handles */
5133         kfree(phba->sli4_hba.fcp_eq_hdl);
5134
5135         /* Free the allocated rpi headers. */
5136         lpfc_sli4_remove_rpi_hdrs(phba);
5137         lpfc_sli4_remove_rpis(phba);
5138
5139         /* Free eligible FCF index bmask */
5140         kfree(phba->fcf.fcf_rr_bmask);
5141
5142         /* Free the ELS sgl list */
5143         lpfc_free_active_sgl(phba);
5144         lpfc_free_els_sgl_list(phba);
5145
5146         /* Free the completion queue EQ event pool */
5147         lpfc_sli4_cq_event_release_all(phba);
5148         lpfc_sli4_cq_event_pool_destroy(phba);
5149
5150         /* Release resource identifiers. */
5151         lpfc_sli4_dealloc_resource_identifiers(phba);
5152
5153         /* Free the bsmbx region. */
5154         lpfc_destroy_bootstrap_mbox(phba);
5155
5156         /* Free the SLI Layer memory with SLI4 HBAs */
5157         lpfc_mem_free_all(phba);
5158
5159         /* Free the current connect table */
5160         list_for_each_entry_safe(conn_entry, next_conn_entry,
5161                 &phba->fcf_conn_rec_list, list) {
5162                 list_del_init(&conn_entry->list);
5163                 kfree(conn_entry);
5164         }
5165
5166         return;
5167 }
5168
5169 /**
5170  * lpfc_init_api_table_setup - Set up init api function jump table
5171  * @phba: The hba struct for which this call is being executed.
5172  * @dev_grp: The HBA PCI-Device group number.
5173  *
5174  * This routine sets up the device INIT interface API function jump table
5175  * in @phba struct.
5176  *
5177  * Returns: 0 - success, -ENODEV - failure.
5178  **/
5179 int
5180 lpfc_init_api_table_setup(struct lpfc_hba *phba, uint8_t dev_grp)
5181 {
5182         phba->lpfc_hba_init_link = lpfc_hba_init_link;
5183         phba->lpfc_hba_down_link = lpfc_hba_down_link;
5184         phba->lpfc_selective_reset = lpfc_selective_reset;
5185         switch (dev_grp) {
5186         case LPFC_PCI_DEV_LP:
5187                 phba->lpfc_hba_down_post = lpfc_hba_down_post_s3;
5188                 phba->lpfc_handle_eratt = lpfc_handle_eratt_s3;
5189                 phba->lpfc_stop_port = lpfc_stop_port_s3;
5190                 break;
5191         case LPFC_PCI_DEV_OC:
5192                 phba->lpfc_hba_down_post = lpfc_hba_down_post_s4;
5193                 phba->lpfc_handle_eratt = lpfc_handle_eratt_s4;
5194                 phba->lpfc_stop_port = lpfc_stop_port_s4;
5195                 break;
5196         default:
5197                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5198                                 "1431 Invalid HBA PCI-device group: 0x%x\n",
5199                                 dev_grp);
5200                 return -ENODEV;
5201                 break;
5202         }
5203         return 0;
5204 }
5205
5206 /**
5207  * lpfc_setup_driver_resource_phase1 - Phase1 etup driver internal resources.
5208  * @phba: pointer to lpfc hba data structure.
5209  *
5210  * This routine is invoked to set up the driver internal resources before the
5211  * device specific resource setup to support the HBA device it attached to.
5212  *
5213  * Return codes
5214  *      0 - successful
5215  *      other values - error
5216  **/
5217 static int
5218 lpfc_setup_driver_resource_phase1(struct lpfc_hba *phba)
5219 {
5220         /*
5221          * Driver resources common to all SLI revisions
5222          */
5223         atomic_set(&phba->fast_event_count, 0);
5224         spin_lock_init(&phba->hbalock);
5225
5226         /* Initialize ndlp management spinlock */
5227         spin_lock_init(&phba->ndlp_lock);
5228
5229         INIT_LIST_HEAD(&phba->port_list);
5230         INIT_LIST_HEAD(&phba->work_list);
5231         init_waitqueue_head(&phba->wait_4_mlo_m_q);
5232
5233         /* Initialize the wait queue head for the kernel thread */
5234         init_waitqueue_head(&phba->work_waitq);
5235
5236         /* Initialize the scsi buffer list used by driver for scsi IO */
5237         spin_lock_init(&phba->scsi_buf_list_lock);
5238         INIT_LIST_HEAD(&phba->lpfc_scsi_buf_list);
5239
5240         /* Initialize the fabric iocb list */
5241         INIT_LIST_HEAD(&phba->fabric_iocb_list);
5242
5243         /* Initialize list to save ELS buffers */
5244         INIT_LIST_HEAD(&phba->elsbuf);
5245
5246         /* Initialize FCF connection rec list */
5247         INIT_LIST_HEAD(&phba->fcf_conn_rec_list);
5248
5249         return 0;
5250 }
5251
5252 /**
5253  * lpfc_setup_driver_resource_phase2 - Phase2 setup driver internal resources.
5254  * @phba: pointer to lpfc hba data structure.
5255  *
5256  * This routine is invoked to set up the driver internal resources after the
5257  * device specific resource setup to support the HBA device it attached to.
5258  *
5259  * Return codes
5260  *      0 - successful
5261  *      other values - error
5262  **/
5263 static int
5264 lpfc_setup_driver_resource_phase2(struct lpfc_hba *phba)
5265 {
5266         int error;
5267
5268         /* Startup the kernel thread for this host adapter. */
5269         phba->worker_thread = kthread_run(lpfc_do_work, phba,
5270                                           "lpfc_worker_%d", phba->brd_no);
5271         if (IS_ERR(phba->worker_thread)) {
5272                 error = PTR_ERR(phba->worker_thread);
5273                 return error;
5274         }
5275
5276         return 0;
5277 }
5278
5279 /**
5280  * lpfc_unset_driver_resource_phase2 - Phase2 unset driver internal resources.
5281  * @phba: pointer to lpfc hba data structure.
5282  *
5283  * This routine is invoked to unset the driver internal resources set up after
5284  * the device specific resource setup for supporting the HBA device it
5285  * attached to.
5286  **/
5287 static void
5288 lpfc_unset_driver_resource_phase2(struct lpfc_hba *phba)
5289 {
5290         /* Stop kernel worker thread */
5291         kthread_stop(phba->worker_thread);
5292 }
5293
5294 /**
5295  * lpfc_free_iocb_list - Free iocb list.
5296  * @phba: pointer to lpfc hba data structure.
5297  *
5298  * This routine is invoked to free the driver's IOCB list and memory.
5299  **/
5300 static void
5301 lpfc_free_iocb_list(struct lpfc_hba *phba)
5302 {
5303         struct lpfc_iocbq *iocbq_entry = NULL, *iocbq_next = NULL;
5304
5305         spin_lock_irq(&phba->hbalock);
5306         list_for_each_entry_safe(iocbq_entry, iocbq_next,
5307                                  &phba->lpfc_iocb_list, list) {
5308                 list_del(&iocbq_entry->list);
5309                 kfree(iocbq_entry);
5310                 phba->total_iocbq_bufs--;
5311         }
5312         spin_unlock_irq(&phba->hbalock);
5313
5314         return;
5315 }
5316
5317 /**
5318  * lpfc_init_iocb_list - Allocate and initialize iocb list.
5319  * @phba: pointer to lpfc hba data structure.
5320  *
5321  * This routine is invoked to allocate and initizlize the driver's IOCB
5322  * list and set up the IOCB tag array accordingly.
5323  *
5324  * Return codes
5325  *      0 - successful
5326  *      other values - error
5327  **/
5328 static int
5329 lpfc_init_iocb_list(struct lpfc_hba *phba, int iocb_count)
5330 {
5331         struct lpfc_iocbq *iocbq_entry = NULL;
5332         uint16_t iotag;
5333         int i;
5334
5335         /* Initialize and populate the iocb list per host.  */
5336         INIT_LIST_HEAD(&phba->lpfc_iocb_list);
5337         for (i = 0; i < iocb_count; i++) {
5338                 iocbq_entry = kzalloc(sizeof(struct lpfc_iocbq), GFP_KERNEL);
5339                 if (iocbq_entry == NULL) {
5340                         printk(KERN_ERR "%s: only allocated %d iocbs of "
5341                                 "expected %d count. Unloading driver.\n",
5342                                 __func__, i, LPFC_IOCB_LIST_CNT);
5343                         goto out_free_iocbq;
5344                 }
5345
5346                 iotag = lpfc_sli_next_iotag(phba, iocbq_entry);
5347                 if (iotag == 0) {
5348                         kfree(iocbq_entry);
5349                         printk(KERN_ERR "%s: failed to allocate IOTAG. "
5350                                 "Unloading driver.\n", __func__);
5351                         goto out_free_iocbq;
5352                 }
5353                 iocbq_entry->sli4_lxritag = NO_XRI;
5354                 iocbq_entry->sli4_xritag = NO_XRI;
5355
5356                 spin_lock_irq(&phba->hbalock);
5357                 list_add(&iocbq_entry->list, &phba->lpfc_iocb_list);
5358                 phba->total_iocbq_bufs++;
5359                 spin_unlock_irq(&phba->hbalock);
5360         }
5361
5362         return 0;
5363
5364 out_free_iocbq:
5365         lpfc_free_iocb_list(phba);
5366
5367         return -ENOMEM;
5368 }
5369
5370 /**
5371  * lpfc_free_sgl_list - Free a given sgl list.
5372  * @phba: pointer to lpfc hba data structure.
5373  * @sglq_list: pointer to the head of sgl list.
5374  *
5375  * This routine is invoked to free a give sgl list and memory.
5376  **/
5377 void
5378 lpfc_free_sgl_list(struct lpfc_hba *phba, struct list_head *sglq_list)
5379 {
5380         struct lpfc_sglq *sglq_entry = NULL, *sglq_next = NULL;
5381
5382         list_for_each_entry_safe(sglq_entry, sglq_next, sglq_list, list) {
5383                 list_del(&sglq_entry->list);
5384                 lpfc_mbuf_free(phba, sglq_entry->virt, sglq_entry->phys);
5385                 kfree(sglq_entry);
5386         }
5387 }
5388
5389 /**
5390  * lpfc_free_els_sgl_list - Free els sgl list.
5391  * @phba: pointer to lpfc hba data structure.
5392  *
5393  * This routine is invoked to free the driver's els sgl list and memory.
5394  **/
5395 static void
5396 lpfc_free_els_sgl_list(struct lpfc_hba *phba)
5397 {
5398         LIST_HEAD(sglq_list);
5399
5400         /* Retrieve all els sgls from driver list */
5401         spin_lock_irq(&phba->hbalock);
5402         list_splice_init(&phba->sli4_hba.lpfc_sgl_list, &sglq_list);
5403         spin_unlock_irq(&phba->hbalock);
5404
5405         /* Now free the sgl list */
5406         lpfc_free_sgl_list(phba, &sglq_list);
5407 }
5408
5409 /**
5410  * lpfc_init_active_sgl_array - Allocate the buf to track active ELS XRIs.
5411  * @phba: pointer to lpfc hba data structure.
5412  *
5413  * This routine is invoked to allocate the driver's active sgl memory.
5414  * This array will hold the sglq_entry's for active IOs.
5415  **/
5416 static int
5417 lpfc_init_active_sgl_array(struct lpfc_hba *phba)
5418 {
5419         int size;
5420         size = sizeof(struct lpfc_sglq *);
5421         size *= phba->sli4_hba.max_cfg_param.max_xri;
5422
5423         phba->sli4_hba.lpfc_sglq_active_list =
5424                 kzalloc(size, GFP_KERNEL);
5425         if (!phba->sli4_hba.lpfc_sglq_active_list)
5426                 return -ENOMEM;
5427         return 0;
5428 }
5429
5430 /**
5431  * lpfc_free_active_sgl - Free the buf that tracks active ELS XRIs.
5432  * @phba: pointer to lpfc hba data structure.
5433  *
5434  * This routine is invoked to walk through the array of active sglq entries
5435  * and free all of the resources.
5436  * This is just a place holder for now.
5437  **/
5438 static void
5439 lpfc_free_active_sgl(struct lpfc_hba *phba)
5440 {
5441         kfree(phba->sli4_hba.lpfc_sglq_active_list);
5442 }
5443
5444 /**
5445  * lpfc_init_sgl_list - Allocate and initialize sgl list.
5446  * @phba: pointer to lpfc hba data structure.
5447  *
5448  * This routine is invoked to allocate and initizlize the driver's sgl
5449  * list and set up the sgl xritag tag array accordingly.
5450  *
5451  **/
5452 static void
5453 lpfc_init_sgl_list(struct lpfc_hba *phba)
5454 {
5455         /* Initialize and populate the sglq list per host/VF. */
5456         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_sgl_list);
5457         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_abts_els_sgl_list);
5458
5459         /* els xri-sgl book keeping */
5460         phba->sli4_hba.els_xri_cnt = 0;
5461
5462         /* scsi xri-buffer book keeping */
5463         phba->sli4_hba.scsi_xri_cnt = 0;
5464 }
5465
5466 /**
5467  * lpfc_sli4_init_rpi_hdrs - Post the rpi header memory region to the port
5468  * @phba: pointer to lpfc hba data structure.
5469  *
5470  * This routine is invoked to post rpi header templates to the
5471  * port for those SLI4 ports that do not support extents.  This routine
5472  * posts a PAGE_SIZE memory region to the port to hold up to
5473  * PAGE_SIZE modulo 64 rpi context headers.  This is an initialization routine
5474  * and should be called only when interrupts are disabled.
5475  *
5476  * Return codes
5477  *      0 - successful
5478  *      -ERROR - otherwise.
5479  **/
5480 int
5481 lpfc_sli4_init_rpi_hdrs(struct lpfc_hba *phba)
5482 {
5483         int rc = 0;
5484         struct lpfc_rpi_hdr *rpi_hdr;
5485
5486         INIT_LIST_HEAD(&phba->sli4_hba.lpfc_rpi_hdr_list);
5487         if (!phba->sli4_hba.rpi_hdrs_in_use)
5488                 return rc;
5489         if (phba->sli4_hba.extents_in_use)
5490                 return -EIO;
5491
5492         rpi_hdr = lpfc_sli4_create_rpi_hdr(phba);
5493         if (!rpi_hdr) {
5494                 lpfc_printf_log(phba, KERN_ERR, LOG_MBOX | LOG_SLI,
5495                                 "0391 Error during rpi post operation\n");
5496                 lpfc_sli4_remove_rpis(phba);
5497                 rc = -ENODEV;
5498         }
5499
5500         return rc;
5501 }
5502
5503 /**
5504  * lpfc_sli4_create_rpi_hdr - Allocate an rpi header memory region
5505  * @phba: pointer to lpfc hba data structure.
5506  *
5507  * This routine is invoked to allocate a single 4KB memory region to
5508  * support rpis and stores them in the phba.  This single region
5509  * provides support for up to 64 rpis.  The region is used globally
5510  * by the device.
5511  *
5512  * Returns:
5513  *   A valid rpi hdr on success.
5514  *   A NULL pointer on any failure.
5515  **/
5516 struct lpfc_rpi_hdr *
5517 lpfc_sli4_create_rpi_hdr(struct lpfc_hba *phba)
5518 {
5519         uint16_t rpi_limit, curr_rpi_range;
5520         struct lpfc_dmabuf *dmabuf;
5521         struct lpfc_rpi_hdr *rpi_hdr;
5522         uint32_t rpi_count;
5523
5524         /*
5525          * If the SLI4 port supports extents, posting the rpi header isn't
5526          * required.  Set the expected maximum count and let the actual value
5527          * get set when extents are fully allocated.
5528          */
5529         if (!phba->sli4_hba.rpi_hdrs_in_use)
5530                 return NULL;
5531         if (phba->sli4_hba.extents_in_use)
5532                 return NULL;
5533
5534         /* The limit on the logical index is just the max_rpi count. */
5535         rpi_limit = phba->sli4_hba.max_cfg_param.rpi_base +
5536         phba->sli4_hba.max_cfg_param.max_rpi - 1;
5537
5538         spin_lock_irq(&phba->hbalock);
5539         /*
5540          * Establish the starting RPI in this header block.  The starting
5541          * rpi is normalized to a zero base because the physical rpi is
5542          * port based.
5543          */
5544         curr_rpi_range = phba->sli4_hba.next_rpi;
5545         spin_unlock_irq(&phba->hbalock);
5546
5547         /*
5548          * The port has a limited number of rpis. The increment here
5549          * is LPFC_RPI_HDR_COUNT - 1 to account for the starting value
5550          * and to allow the full max_rpi range per port.
5551          */
5552         if ((curr_rpi_range + (LPFC_RPI_HDR_COUNT - 1)) > rpi_limit)
5553                 rpi_count = rpi_limit - curr_rpi_range;
5554         else
5555                 rpi_count = LPFC_RPI_HDR_COUNT;
5556
5557         if (!rpi_count)
5558                 return NULL;
5559         /*
5560          * First allocate the protocol header region for the port.  The
5561          * port expects a 4KB DMA-mapped memory region that is 4K aligned.
5562          */
5563         dmabuf = kzalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
5564         if (!dmabuf)
5565                 return NULL;
5566
5567         dmabuf->virt = dma_alloc_coherent(&phba->pcidev->dev,
5568                                           LPFC_HDR_TEMPLATE_SIZE,
5569                                           &dmabuf->phys,
5570                                           GFP_KERNEL);
5571         if (!dmabuf->virt) {
5572                 rpi_hdr = NULL;
5573                 goto err_free_dmabuf;
5574         }
5575
5576         memset(dmabuf->virt, 0, LPFC_HDR_TEMPLATE_SIZE);
5577         if (!IS_ALIGNED(dmabuf->phys, LPFC_HDR_TEMPLATE_SIZE)) {
5578                 rpi_hdr = NULL;
5579                 goto err_free_coherent;
5580         }
5581
5582         /* Save the rpi header data for cleanup later. */
5583         rpi_hdr = kzalloc(sizeof(struct lpfc_rpi_hdr), GFP_KERNEL);
5584         if (!rpi_hdr)
5585                 goto err_free_coherent;
5586
5587         rpi_hdr->dmabuf = dmabuf;
5588         rpi_hdr->len = LPFC_HDR_TEMPLATE_SIZE;
5589         rpi_hdr->page_count = 1;
5590         spin_lock_irq(&phba->hbalock);
5591
5592         /* The rpi_hdr stores the logical index only. */
5593         rpi_hdr->start_rpi = curr_rpi_range;
5594         list_add_tail(&rpi_hdr->list, &phba->sli4_hba.lpfc_rpi_hdr_list);
5595
5596         /*
5597          * The next_rpi stores the next logical module-64 rpi value used
5598          * to post physical rpis in subsequent rpi postings.
5599          */
5600         phba->sli4_hba.next_rpi += rpi_count;
5601         spin_unlock_irq(&phba->hbalock);
5602         return rpi_hdr;
5603
5604  err_free_coherent:
5605         dma_free_coherent(&phba->pcidev->dev, LPFC_HDR_TEMPLATE_SIZE,
5606                           dmabuf->virt, dmabuf->phys);
5607  err_free_dmabuf:
5608         kfree(dmabuf);
5609         return NULL;
5610 }
5611
5612 /**
5613  * lpfc_sli4_remove_rpi_hdrs - Remove all rpi header memory regions
5614  * @phba: pointer to lpfc hba data structure.
5615  *
5616  * This routine is invoked to remove all memory resources allocated
5617  * to support rpis for SLI4 ports not supporting extents. This routine
5618  * presumes the caller has released all rpis consumed by fabric or port
5619  * logins and is prepared to have the header pages removed.
5620  **/
5621 void
5622 lpfc_sli4_remove_rpi_hdrs(struct lpfc_hba *phba)
5623 {
5624         struct lpfc_rpi_hdr *rpi_hdr, *next_rpi_hdr;
5625
5626         if (!phba->sli4_hba.rpi_hdrs_in_use)
5627                 goto exit;
5628
5629         list_for_each_entry_safe(rpi_hdr, next_rpi_hdr,
5630                                  &phba->sli4_hba.lpfc_rpi_hdr_list, list) {
5631                 list_del(&rpi_hdr->list);
5632                 dma_free_coherent(&phba->pcidev->dev, rpi_hdr->len,
5633                                   rpi_hdr->dmabuf->virt, rpi_hdr->dmabuf->phys);
5634                 kfree(rpi_hdr->dmabuf);
5635                 kfree(rpi_hdr);
5636         }
5637  exit:
5638         /* There are no rpis available to the port now. */
5639         phba->sli4_hba.next_rpi = 0;
5640 }
5641
5642 /**
5643  * lpfc_hba_alloc - Allocate driver hba data structure for a device.
5644  * @pdev: pointer to pci device data structure.
5645  *
5646  * This routine is invoked to allocate the driver hba data structure for an
5647  * HBA device. If the allocation is successful, the phba reference to the
5648  * PCI device data structure is set.
5649  *
5650  * Return codes
5651  *      pointer to @phba - successful
5652  *      NULL - error
5653  **/
5654 static struct lpfc_hba *
5655 lpfc_hba_alloc(struct pci_dev *pdev)
5656 {
5657         struct lpfc_hba *phba;
5658
5659         /* Allocate memory for HBA structure */
5660         phba = kzalloc(sizeof(struct lpfc_hba), GFP_KERNEL);
5661         if (!phba) {
5662                 dev_err(&pdev->dev, "failed to allocate hba struct\n");
5663                 return NULL;
5664         }
5665
5666         /* Set reference to PCI device in HBA structure */
5667         phba->pcidev = pdev;
5668
5669         /* Assign an unused board number */
5670         phba->brd_no = lpfc_get_instance();
5671         if (phba->brd_no < 0) {
5672                 kfree(phba);
5673                 return NULL;
5674         }
5675
5676         spin_lock_init(&phba->ct_ev_lock);
5677         INIT_LIST_HEAD(&phba->ct_ev_waiters);
5678
5679         return phba;
5680 }
5681
5682 /**
5683  * lpfc_hba_free - Free driver hba data structure with a device.
5684  * @phba: pointer to lpfc hba data structure.
5685  *
5686  * This routine is invoked to free the driver hba data structure with an
5687  * HBA device.
5688  **/
5689 static void
5690 lpfc_hba_free(struct lpfc_hba *phba)
5691 {
5692         /* Release the driver assigned board number */
5693         idr_remove(&lpfc_hba_index, phba->brd_no);
5694
5695         /* Free memory allocated with sli rings */
5696         kfree(phba->sli.ring);
5697         phba->sli.ring = NULL;
5698
5699         kfree(phba);
5700         return;
5701 }
5702
5703 /**
5704  * lpfc_create_shost - Create hba physical port with associated scsi host.
5705  * @phba: pointer to lpfc hba data structure.
5706  *
5707  * This routine is invoked to create HBA physical port and associate a SCSI
5708  * host with it.
5709  *
5710  * Return codes
5711  *      0 - successful
5712  *      other values - error
5713  **/
5714 static int
5715 lpfc_create_shost(struct lpfc_hba *phba)
5716 {
5717         struct lpfc_vport *vport;
5718         struct Scsi_Host  *shost;
5719
5720         /* Initialize HBA FC structure */
5721         phba->fc_edtov = FF_DEF_EDTOV;
5722         phba->fc_ratov = FF_DEF_RATOV;
5723         phba->fc_altov = FF_DEF_ALTOV;
5724         phba->fc_arbtov = FF_DEF_ARBTOV;
5725
5726         atomic_set(&phba->sdev_cnt, 0);
5727         vport = lpfc_create_port(phba, phba->brd_no, &phba->pcidev->dev);
5728         if (!vport)
5729                 return -ENODEV;
5730
5731         shost = lpfc_shost_from_vport(vport);
5732         phba->pport = vport;
5733         lpfc_debugfs_initialize(vport);
5734         /* Put reference to SCSI host to driver's device private data */
5735         pci_set_drvdata(phba->pcidev, shost);
5736
5737         return 0;
5738 }
5739
5740 /**
5741  * lpfc_destroy_shost - Destroy hba physical port with associated scsi host.
5742  * @phba: pointer to lpfc hba data structure.
5743  *
5744  * This routine is invoked to destroy HBA physical port and the associated
5745  * SCSI host.
5746  **/
5747 static void
5748 lpfc_destroy_shost(struct lpfc_hba *phba)
5749 {
5750         struct lpfc_vport *vport = phba->pport;
5751
5752         /* Destroy physical port that associated with the SCSI host */
5753         destroy_port(vport);
5754
5755         return;
5756 }
5757
5758 /**
5759  * lpfc_setup_bg - Setup Block guard structures and debug areas.
5760  * @phba: pointer to lpfc hba data structure.
5761  * @shost: the shost to be used to detect Block guard settings.
5762  *
5763  * This routine sets up the local Block guard protocol settings for @shost.
5764  * This routine also allocates memory for debugging bg buffers.
5765  **/
5766 static void
5767 lpfc_setup_bg(struct lpfc_hba *phba, struct Scsi_Host *shost)
5768 {
5769         uint32_t old_mask;
5770         uint32_t old_guard;
5771
5772         int pagecnt = 10;
5773         if (lpfc_prot_mask && lpfc_prot_guard) {
5774                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
5775                                 "1478 Registering BlockGuard with the "
5776                                 "SCSI layer\n");
5777
5778                 old_mask = lpfc_prot_mask;
5779                 old_guard = lpfc_prot_guard;
5780
5781                 /* Only allow supported values */
5782                 lpfc_prot_mask &= (SHOST_DIF_TYPE1_PROTECTION |
5783                         SHOST_DIX_TYPE0_PROTECTION |
5784                         SHOST_DIX_TYPE1_PROTECTION);
5785                 lpfc_prot_guard &= (SHOST_DIX_GUARD_IP | SHOST_DIX_GUARD_CRC);
5786
5787                 /* DIF Type 1 protection for profiles AST1/C1 is end to end */
5788                 if (lpfc_prot_mask == SHOST_DIX_TYPE1_PROTECTION)
5789                         lpfc_prot_mask |= SHOST_DIF_TYPE1_PROTECTION;
5790
5791                 if (lpfc_prot_mask && lpfc_prot_guard) {
5792                         if ((old_mask != lpfc_prot_mask) ||
5793                                 (old_guard != lpfc_prot_guard))
5794                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5795                                         "1475 Registering BlockGuard with the "
5796                                         "SCSI layer: mask %d  guard %d\n",
5797                                         lpfc_prot_mask, lpfc_prot_guard);
5798
5799                         scsi_host_set_prot(shost, lpfc_prot_mask);
5800                         scsi_host_set_guard(shost, lpfc_prot_guard);
5801                 } else
5802                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
5803                                 "1479 Not Registering BlockGuard with the SCSI "
5804                                 "layer, Bad protection parameters: %d %d\n",
5805                                 old_mask, old_guard);
5806         }
5807
5808         if (!_dump_buf_data) {
5809                 while (pagecnt) {
5810                         spin_lock_init(&_dump_buf_lock);
5811                         _dump_buf_data =
5812                                 (char *) __get_free_pages(GFP_KERNEL, pagecnt);
5813                         if (_dump_buf_data) {
5814                                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5815                                         "9043 BLKGRD: allocated %d pages for "
5816                                        "_dump_buf_data at 0x%p\n",
5817                                        (1 << pagecnt), _dump_buf_data);
5818                                 _dump_buf_data_order = pagecnt;
5819                                 memset(_dump_buf_data, 0,
5820                                        ((1 << PAGE_SHIFT) << pagecnt));
5821                                 break;
5822                         } else
5823                                 --pagecnt;
5824                 }
5825                 if (!_dump_buf_data_order)
5826                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5827                                 "9044 BLKGRD: ERROR unable to allocate "
5828                                "memory for hexdump\n");
5829         } else
5830                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5831                         "9045 BLKGRD: already allocated _dump_buf_data=0x%p"
5832                        "\n", _dump_buf_data);
5833         if (!_dump_buf_dif) {
5834                 while (pagecnt) {
5835                         _dump_buf_dif =
5836                                 (char *) __get_free_pages(GFP_KERNEL, pagecnt);
5837                         if (_dump_buf_dif) {
5838                                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5839                                         "9046 BLKGRD: allocated %d pages for "
5840                                        "_dump_buf_dif at 0x%p\n",
5841                                        (1 << pagecnt), _dump_buf_dif);
5842                                 _dump_buf_dif_order = pagecnt;
5843                                 memset(_dump_buf_dif, 0,
5844                                        ((1 << PAGE_SHIFT) << pagecnt));
5845                                 break;
5846                         } else
5847                                 --pagecnt;
5848                 }
5849                 if (!_dump_buf_dif_order)
5850                         lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5851                         "9047 BLKGRD: ERROR unable to allocate "
5852                                "memory for hexdump\n");
5853         } else
5854                 lpfc_printf_log(phba, KERN_ERR, LOG_BG,
5855                         "9048 BLKGRD: already allocated _dump_buf_dif=0x%p\n",
5856                        _dump_buf_dif);
5857 }
5858
5859 /**
5860  * lpfc_post_init_setup - Perform necessary device post initialization setup.
5861  * @phba: pointer to lpfc hba data structure.
5862  *
5863  * This routine is invoked to perform all the necessary post initialization
5864  * setup for the device.
5865  **/
5866 static void
5867 lpfc_post_init_setup(struct lpfc_hba *phba)
5868 {
5869         struct Scsi_Host  *shost;
5870         struct lpfc_adapter_event_header adapter_event;
5871
5872         /* Get the default values for Model Name and Description */
5873         lpfc_get_hba_model_desc(phba, phba->ModelName, phba->ModelDesc);
5874
5875         /*
5876          * hba setup may have changed the hba_queue_depth so we need to
5877          * adjust the value of can_queue.
5878          */
5879         shost = pci_get_drvdata(phba->pcidev);
5880         shost->can_queue = phba->cfg_hba_queue_depth - 10;
5881         if (phba->sli3_options & LPFC_SLI3_BG_ENABLED)
5882                 lpfc_setup_bg(phba, shost);
5883
5884         lpfc_host_attrib_init(shost);
5885
5886         if (phba->cfg_poll & DISABLE_FCP_RING_INT) {
5887                 spin_lock_irq(shost->host_lock);
5888                 lpfc_poll_start_timer(phba);
5889                 spin_unlock_irq(shost->host_lock);
5890         }
5891
5892         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
5893                         "0428 Perform SCSI scan\n");
5894         /* Send board arrival event to upper layer */
5895         adapter_event.event_type = FC_REG_ADAPTER_EVENT;
5896         adapter_event.subcategory = LPFC_EVENT_ARRIVAL;
5897         fc_host_post_vendor_event(shost, fc_get_event_number(),
5898                                   sizeof(adapter_event),
5899                                   (char *) &adapter_event,
5900                                   LPFC_NL_VENDOR_ID);
5901         return;
5902 }
5903
5904 /**
5905  * lpfc_sli_pci_mem_setup - Setup SLI3 HBA PCI memory space.
5906  * @phba: pointer to lpfc hba data structure.
5907  *
5908  * This routine is invoked to set up the PCI device memory space for device
5909  * with SLI-3 interface spec.
5910  *
5911  * Return codes
5912  *      0 - successful
5913  *      other values - error
5914  **/
5915 static int
5916 lpfc_sli_pci_mem_setup(struct lpfc_hba *phba)
5917 {
5918         struct pci_dev *pdev;
5919         unsigned long bar0map_len, bar2map_len;
5920         int i, hbq_count;
5921         void *ptr;
5922         int error = -ENODEV;
5923
5924         /* Obtain PCI device reference */
5925         if (!phba->pcidev)
5926                 return error;
5927         else
5928                 pdev = phba->pcidev;
5929
5930         /* Set the device DMA mask size */
5931         if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) != 0
5932          || pci_set_consistent_dma_mask(pdev,DMA_BIT_MASK(64)) != 0) {
5933                 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0
5934                  || pci_set_consistent_dma_mask(pdev,DMA_BIT_MASK(32)) != 0) {
5935                         return error;
5936                 }
5937         }
5938
5939         /* Get the bus address of Bar0 and Bar2 and the number of bytes
5940          * required by each mapping.
5941          */
5942         phba->pci_bar0_map = pci_resource_start(pdev, 0);
5943         bar0map_len = pci_resource_len(pdev, 0);
5944
5945         phba->pci_bar2_map = pci_resource_start(pdev, 2);
5946         bar2map_len = pci_resource_len(pdev, 2);
5947
5948         /* Map HBA SLIM to a kernel virtual address. */
5949         phba->slim_memmap_p = ioremap(phba->pci_bar0_map, bar0map_len);
5950         if (!phba->slim_memmap_p) {
5951                 dev_printk(KERN_ERR, &pdev->dev,
5952                            "ioremap failed for SLIM memory.\n");
5953                 goto out;
5954         }
5955
5956         /* Map HBA Control Registers to a kernel virtual address. */
5957         phba->ctrl_regs_memmap_p = ioremap(phba->pci_bar2_map, bar2map_len);
5958         if (!phba->ctrl_regs_memmap_p) {
5959                 dev_printk(KERN_ERR, &pdev->dev,
5960                            "ioremap failed for HBA control registers.\n");
5961                 goto out_iounmap_slim;
5962         }
5963
5964         /* Allocate memory for SLI-2 structures */
5965         phba->slim2p.virt = dma_alloc_coherent(&pdev->dev,
5966                                                SLI2_SLIM_SIZE,
5967                                                &phba->slim2p.phys,
5968                                                GFP_KERNEL);
5969         if (!phba->slim2p.virt)
5970                 goto out_iounmap;
5971
5972         memset(phba->slim2p.virt, 0, SLI2_SLIM_SIZE);
5973         phba->mbox = phba->slim2p.virt + offsetof(struct lpfc_sli2_slim, mbx);
5974         phba->mbox_ext = (phba->slim2p.virt +
5975                 offsetof(struct lpfc_sli2_slim, mbx_ext_words));
5976         phba->pcb = (phba->slim2p.virt + offsetof(struct lpfc_sli2_slim, pcb));
5977         phba->IOCBs = (phba->slim2p.virt +
5978                        offsetof(struct lpfc_sli2_slim, IOCBs));
5979
5980         phba->hbqslimp.virt = dma_alloc_coherent(&pdev->dev,
5981                                                  lpfc_sli_hbq_size(),
5982                                                  &phba->hbqslimp.phys,
5983                                                  GFP_KERNEL);
5984         if (!phba->hbqslimp.virt)
5985                 goto out_free_slim;
5986
5987         hbq_count = lpfc_sli_hbq_count();
5988         ptr = phba->hbqslimp.virt;
5989         for (i = 0; i < hbq_count; ++i) {
5990                 phba->hbqs[i].hbq_virt = ptr;
5991                 INIT_LIST_HEAD(&phba->hbqs[i].hbq_buffer_list);
5992                 ptr += (lpfc_hbq_defs[i]->entry_count *
5993                         sizeof(struct lpfc_hbq_entry));
5994         }
5995         phba->hbqs[LPFC_ELS_HBQ].hbq_alloc_buffer = lpfc_els_hbq_alloc;
5996         phba->hbqs[LPFC_ELS_HBQ].hbq_free_buffer = lpfc_els_hbq_free;
5997
5998         memset(phba->hbqslimp.virt, 0, lpfc_sli_hbq_size());
5999
6000         INIT_LIST_HEAD(&phba->rb_pend_list);
6001
6002         phba->MBslimaddr = phba->slim_memmap_p;
6003         phba->HAregaddr = phba->ctrl_regs_memmap_p + HA_REG_OFFSET;
6004         phba->CAregaddr = phba->ctrl_regs_memmap_p + CA_REG_OFFSET;
6005         phba->HSregaddr = phba->ctrl_regs_memmap_p + HS_REG_OFFSET;
6006         phba->HCregaddr = phba->ctrl_regs_memmap_p + HC_REG_OFFSET;
6007
6008         return 0;
6009
6010 out_free_slim:
6011         dma_free_coherent(&pdev->dev, SLI2_SLIM_SIZE,
6012                           phba->slim2p.virt, phba->slim2p.phys);
6013 out_iounmap:
6014         iounmap(phba->ctrl_regs_memmap_p);
6015 out_iounmap_slim:
6016         iounmap(phba->slim_memmap_p);
6017 out:
6018         return error;
6019 }
6020
6021 /**
6022  * lpfc_sli_pci_mem_unset - Unset SLI3 HBA PCI memory space.
6023  * @phba: pointer to lpfc hba data structure.
6024  *
6025  * This routine is invoked to unset the PCI device memory space for device
6026  * with SLI-3 interface spec.
6027  **/
6028 static void
6029 lpfc_sli_pci_mem_unset(struct lpfc_hba *phba)
6030 {
6031         struct pci_dev *pdev;
6032
6033         /* Obtain PCI device reference */
6034         if (!phba->pcidev)
6035                 return;
6036         else
6037                 pdev = phba->pcidev;
6038
6039         /* Free coherent DMA memory allocated */
6040         dma_free_coherent(&pdev->dev, lpfc_sli_hbq_size(),
6041                           phba->hbqslimp.virt, phba->hbqslimp.phys);
6042         dma_free_coherent(&pdev->dev, SLI2_SLIM_SIZE,
6043                           phba->slim2p.virt, phba->slim2p.phys);
6044
6045         /* I/O memory unmap */
6046         iounmap(phba->ctrl_regs_memmap_p);
6047         iounmap(phba->slim_memmap_p);
6048
6049         return;
6050 }
6051
6052 /**
6053  * lpfc_sli4_post_status_check - Wait for SLI4 POST done and check status
6054  * @phba: pointer to lpfc hba data structure.
6055  *
6056  * This routine is invoked to wait for SLI4 device Power On Self Test (POST)
6057  * done and check status.
6058  *
6059  * Return 0 if successful, otherwise -ENODEV.
6060  **/
6061 int
6062 lpfc_sli4_post_status_check(struct lpfc_hba *phba)
6063 {
6064         struct lpfc_register portsmphr_reg, uerrlo_reg, uerrhi_reg;
6065         struct lpfc_register reg_data;
6066         int i, port_error = 0;
6067         uint32_t if_type;
6068
6069         memset(&portsmphr_reg, 0, sizeof(portsmphr_reg));
6070         memset(&reg_data, 0, sizeof(reg_data));
6071         if (!phba->sli4_hba.PSMPHRregaddr)
6072                 return -ENODEV;
6073
6074         /* Wait up to 30 seconds for the SLI Port POST done and ready */
6075         for (i = 0; i < 3000; i++) {
6076                 if (lpfc_readl(phba->sli4_hba.PSMPHRregaddr,
6077                         &portsmphr_reg.word0) ||
6078                         (bf_get(lpfc_port_smphr_perr, &portsmphr_reg))) {
6079                         /* Port has a fatal POST error, break out */
6080                         port_error = -ENODEV;
6081                         break;
6082                 }
6083                 if (LPFC_POST_STAGE_PORT_READY ==
6084                     bf_get(lpfc_port_smphr_port_status, &portsmphr_reg))
6085                         break;
6086                 msleep(10);
6087         }
6088
6089         /*
6090          * If there was a port error during POST, then don't proceed with
6091          * other register reads as the data may not be valid.  Just exit.
6092          */
6093         if (port_error) {
6094                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6095                         "1408 Port Failed POST - portsmphr=0x%x, "
6096                         "perr=x%x, sfi=x%x, nip=x%x, ipc=x%x, scr1=x%x, "
6097                         "scr2=x%x, hscratch=x%x, pstatus=x%x\n",
6098                         portsmphr_reg.word0,
6099                         bf_get(lpfc_port_smphr_perr, &portsmphr_reg),
6100                         bf_get(lpfc_port_smphr_sfi, &portsmphr_reg),
6101                         bf_get(lpfc_port_smphr_nip, &portsmphr_reg),
6102                         bf_get(lpfc_port_smphr_ipc, &portsmphr_reg),
6103                         bf_get(lpfc_port_smphr_scr1, &portsmphr_reg),
6104                         bf_get(lpfc_port_smphr_scr2, &portsmphr_reg),
6105                         bf_get(lpfc_port_smphr_host_scratch, &portsmphr_reg),
6106                         bf_get(lpfc_port_smphr_port_status, &portsmphr_reg));
6107         } else {
6108                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
6109                                 "2534 Device Info: SLIFamily=0x%x, "
6110                                 "SLIRev=0x%x, IFType=0x%x, SLIHint_1=0x%x, "
6111                                 "SLIHint_2=0x%x, FT=0x%x\n",
6112                                 bf_get(lpfc_sli_intf_sli_family,
6113                                        &phba->sli4_hba.sli_intf),
6114                                 bf_get(lpfc_sli_intf_slirev,
6115                                        &phba->sli4_hba.sli_intf),
6116                                 bf_get(lpfc_sli_intf_if_type,
6117                                        &phba->sli4_hba.sli_intf),
6118                                 bf_get(lpfc_sli_intf_sli_hint1,
6119                                        &phba->sli4_hba.sli_intf),
6120                                 bf_get(lpfc_sli_intf_sli_hint2,
6121                                        &phba->sli4_hba.sli_intf),
6122                                 bf_get(lpfc_sli_intf_func_type,
6123                                        &phba->sli4_hba.sli_intf));
6124                 /*
6125                  * Check for other Port errors during the initialization
6126                  * process.  Fail the load if the port did not come up
6127                  * correctly.
6128                  */
6129                 if_type = bf_get(lpfc_sli_intf_if_type,
6130                                  &phba->sli4_hba.sli_intf);
6131                 switch (if_type) {
6132                 case LPFC_SLI_INTF_IF_TYPE_0:
6133                         phba->sli4_hba.ue_mask_lo =
6134                               readl(phba->sli4_hba.u.if_type0.UEMASKLOregaddr);
6135                         phba->sli4_hba.ue_mask_hi =
6136                               readl(phba->sli4_hba.u.if_type0.UEMASKHIregaddr);
6137                         uerrlo_reg.word0 =
6138                               readl(phba->sli4_hba.u.if_type0.UERRLOregaddr);
6139                         uerrhi_reg.word0 =
6140                                 readl(phba->sli4_hba.u.if_type0.UERRHIregaddr);
6141                         if ((~phba->sli4_hba.ue_mask_lo & uerrlo_reg.word0) ||
6142                             (~phba->sli4_hba.ue_mask_hi & uerrhi_reg.word0)) {
6143                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6144                                                 "1422 Unrecoverable Error "
6145                                                 "Detected during POST "
6146                                                 "uerr_lo_reg=0x%x, "
6147                                                 "uerr_hi_reg=0x%x, "
6148                                                 "ue_mask_lo_reg=0x%x, "
6149                                                 "ue_mask_hi_reg=0x%x\n",
6150                                                 uerrlo_reg.word0,
6151                                                 uerrhi_reg.word0,
6152                                                 phba->sli4_hba.ue_mask_lo,
6153                                                 phba->sli4_hba.ue_mask_hi);
6154                                 port_error = -ENODEV;
6155                         }
6156                         break;
6157                 case LPFC_SLI_INTF_IF_TYPE_2:
6158                         /* Final checks.  The port status should be clean. */
6159                         if (lpfc_readl(phba->sli4_hba.u.if_type2.STATUSregaddr,
6160                                 &reg_data.word0) ||
6161                                 (bf_get(lpfc_sliport_status_err, &reg_data) &&
6162                                  !bf_get(lpfc_sliport_status_rn, &reg_data))) {
6163                                 phba->work_status[0] =
6164                                         readl(phba->sli4_hba.u.if_type2.
6165                                               ERR1regaddr);
6166                                 phba->work_status[1] =
6167                                         readl(phba->sli4_hba.u.if_type2.
6168                                               ERR2regaddr);
6169                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6170                                         "2888 Unrecoverable port error "
6171                                         "following POST: port status reg "
6172                                         "0x%x, port_smphr reg 0x%x, "
6173                                         "error 1=0x%x, error 2=0x%x\n",
6174                                         reg_data.word0,
6175                                         portsmphr_reg.word0,
6176                                         phba->work_status[0],
6177                                         phba->work_status[1]);
6178                                 port_error = -ENODEV;
6179                         }
6180                         break;
6181                 case LPFC_SLI_INTF_IF_TYPE_1:
6182                 default:
6183                         break;
6184                 }
6185         }
6186         return port_error;
6187 }
6188
6189 /**
6190  * lpfc_sli4_bar0_register_memmap - Set up SLI4 BAR0 register memory map.
6191  * @phba: pointer to lpfc hba data structure.
6192  * @if_type:  The SLI4 interface type getting configured.
6193  *
6194  * This routine is invoked to set up SLI4 BAR0 PCI config space register
6195  * memory map.
6196  **/
6197 static void
6198 lpfc_sli4_bar0_register_memmap(struct lpfc_hba *phba, uint32_t if_type)
6199 {
6200         switch (if_type) {
6201         case LPFC_SLI_INTF_IF_TYPE_0:
6202                 phba->sli4_hba.u.if_type0.UERRLOregaddr =
6203                         phba->sli4_hba.conf_regs_memmap_p + LPFC_UERR_STATUS_LO;
6204                 phba->sli4_hba.u.if_type0.UERRHIregaddr =
6205                         phba->sli4_hba.conf_regs_memmap_p + LPFC_UERR_STATUS_HI;
6206                 phba->sli4_hba.u.if_type0.UEMASKLOregaddr =
6207                         phba->sli4_hba.conf_regs_memmap_p + LPFC_UE_MASK_LO;
6208                 phba->sli4_hba.u.if_type0.UEMASKHIregaddr =
6209                         phba->sli4_hba.conf_regs_memmap_p + LPFC_UE_MASK_HI;
6210                 phba->sli4_hba.SLIINTFregaddr =
6211                         phba->sli4_hba.conf_regs_memmap_p + LPFC_SLI_INTF;
6212                 break;
6213         case LPFC_SLI_INTF_IF_TYPE_2:
6214                 phba->sli4_hba.u.if_type2.ERR1regaddr =
6215                         phba->sli4_hba.conf_regs_memmap_p +
6216                                                 LPFC_CTL_PORT_ER1_OFFSET;
6217                 phba->sli4_hba.u.if_type2.ERR2regaddr =
6218                         phba->sli4_hba.conf_regs_memmap_p +
6219                                                 LPFC_CTL_PORT_ER2_OFFSET;
6220                 phba->sli4_hba.u.if_type2.CTRLregaddr =
6221                         phba->sli4_hba.conf_regs_memmap_p +
6222                                                 LPFC_CTL_PORT_CTL_OFFSET;
6223                 phba->sli4_hba.u.if_type2.STATUSregaddr =
6224                         phba->sli4_hba.conf_regs_memmap_p +
6225                                                 LPFC_CTL_PORT_STA_OFFSET;
6226                 phba->sli4_hba.SLIINTFregaddr =
6227                         phba->sli4_hba.conf_regs_memmap_p + LPFC_SLI_INTF;
6228                 phba->sli4_hba.PSMPHRregaddr =
6229                         phba->sli4_hba.conf_regs_memmap_p +
6230                                                 LPFC_CTL_PORT_SEM_OFFSET;
6231                 phba->sli4_hba.RQDBregaddr =
6232                         phba->sli4_hba.conf_regs_memmap_p +
6233                                                 LPFC_ULP0_RQ_DOORBELL;
6234                 phba->sli4_hba.WQDBregaddr =
6235                         phba->sli4_hba.conf_regs_memmap_p +
6236                                                 LPFC_ULP0_WQ_DOORBELL;
6237                 phba->sli4_hba.EQCQDBregaddr =
6238                         phba->sli4_hba.conf_regs_memmap_p + LPFC_EQCQ_DOORBELL;
6239                 phba->sli4_hba.MQDBregaddr =
6240                         phba->sli4_hba.conf_regs_memmap_p + LPFC_MQ_DOORBELL;
6241                 phba->sli4_hba.BMBXregaddr =
6242                         phba->sli4_hba.conf_regs_memmap_p + LPFC_BMBX;
6243                 break;
6244         case LPFC_SLI_INTF_IF_TYPE_1:
6245         default:
6246                 dev_printk(KERN_ERR, &phba->pcidev->dev,
6247                            "FATAL - unsupported SLI4 interface type - %d\n",
6248                            if_type);
6249                 break;
6250         }
6251 }
6252
6253 /**
6254  * lpfc_sli4_bar1_register_memmap - Set up SLI4 BAR1 register memory map.
6255  * @phba: pointer to lpfc hba data structure.
6256  *
6257  * This routine is invoked to set up SLI4 BAR1 control status register (CSR)
6258  * memory map.
6259  **/
6260 static void
6261 lpfc_sli4_bar1_register_memmap(struct lpfc_hba *phba)
6262 {
6263         phba->sli4_hba.PSMPHRregaddr = phba->sli4_hba.ctrl_regs_memmap_p +
6264                 LPFC_SLIPORT_IF0_SMPHR;
6265         phba->sli4_hba.ISRregaddr = phba->sli4_hba.ctrl_regs_memmap_p +
6266                 LPFC_HST_ISR0;
6267         phba->sli4_hba.IMRregaddr = phba->sli4_hba.ctrl_regs_memmap_p +
6268                 LPFC_HST_IMR0;
6269         phba->sli4_hba.ISCRregaddr = phba->sli4_hba.ctrl_regs_memmap_p +
6270                 LPFC_HST_ISCR0;
6271 }
6272
6273 /**
6274  * lpfc_sli4_bar2_register_memmap - Set up SLI4 BAR2 register memory map.
6275  * @phba: pointer to lpfc hba data structure.
6276  * @vf: virtual function number
6277  *
6278  * This routine is invoked to set up SLI4 BAR2 doorbell register memory map
6279  * based on the given viftual function number, @vf.
6280  *
6281  * Return 0 if successful, otherwise -ENODEV.
6282  **/
6283 static int
6284 lpfc_sli4_bar2_register_memmap(struct lpfc_hba *phba, uint32_t vf)
6285 {
6286         if (vf > LPFC_VIR_FUNC_MAX)
6287                 return -ENODEV;
6288
6289         phba->sli4_hba.RQDBregaddr = (phba->sli4_hba.drbl_regs_memmap_p +
6290                                 vf * LPFC_VFR_PAGE_SIZE +
6291                                         LPFC_ULP0_RQ_DOORBELL);
6292         phba->sli4_hba.WQDBregaddr = (phba->sli4_hba.drbl_regs_memmap_p +
6293                                 vf * LPFC_VFR_PAGE_SIZE +
6294                                         LPFC_ULP0_WQ_DOORBELL);
6295         phba->sli4_hba.EQCQDBregaddr = (phba->sli4_hba.drbl_regs_memmap_p +
6296                                 vf * LPFC_VFR_PAGE_SIZE + LPFC_EQCQ_DOORBELL);
6297         phba->sli4_hba.MQDBregaddr = (phba->sli4_hba.drbl_regs_memmap_p +
6298                                 vf * LPFC_VFR_PAGE_SIZE + LPFC_MQ_DOORBELL);
6299         phba->sli4_hba.BMBXregaddr = (phba->sli4_hba.drbl_regs_memmap_p +
6300                                 vf * LPFC_VFR_PAGE_SIZE + LPFC_BMBX);
6301         return 0;
6302 }
6303
6304 /**
6305  * lpfc_create_bootstrap_mbox - Create the bootstrap mailbox
6306  * @phba: pointer to lpfc hba data structure.
6307  *
6308  * This routine is invoked to create the bootstrap mailbox
6309  * region consistent with the SLI-4 interface spec.  This
6310  * routine allocates all memory necessary to communicate
6311  * mailbox commands to the port and sets up all alignment
6312  * needs.  No locks are expected to be held when calling
6313  * this routine.
6314  *
6315  * Return codes
6316  *      0 - successful
6317  *      -ENOMEM - could not allocated memory.
6318  **/
6319 static int
6320 lpfc_create_bootstrap_mbox(struct lpfc_hba *phba)
6321 {
6322         uint32_t bmbx_size;
6323         struct lpfc_dmabuf *dmabuf;
6324         struct dma_address *dma_address;
6325         uint32_t pa_addr;
6326         uint64_t phys_addr;
6327
6328         dmabuf = kzalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
6329         if (!dmabuf)
6330                 return -ENOMEM;
6331
6332         /*
6333          * The bootstrap mailbox region is comprised of 2 parts
6334          * plus an alignment restriction of 16 bytes.
6335          */
6336         bmbx_size = sizeof(struct lpfc_bmbx_create) + (LPFC_ALIGN_16_BYTE - 1);
6337         dmabuf->virt = dma_alloc_coherent(&phba->pcidev->dev,
6338                                           bmbx_size,
6339                                           &dmabuf->phys,
6340                                           GFP_KERNEL);
6341         if (!dmabuf->virt) {
6342                 kfree(dmabuf);
6343                 return -ENOMEM;
6344         }
6345         memset(dmabuf->virt, 0, bmbx_size);
6346
6347         /*
6348          * Initialize the bootstrap mailbox pointers now so that the register
6349          * operations are simple later.  The mailbox dma address is required
6350          * to be 16-byte aligned.  Also align the virtual memory as each
6351          * maibox is copied into the bmbx mailbox region before issuing the
6352          * command to the port.
6353          */
6354         phba->sli4_hba.bmbx.dmabuf = dmabuf;
6355         phba->sli4_hba.bmbx.bmbx_size = bmbx_size;
6356
6357         phba->sli4_hba.bmbx.avirt = PTR_ALIGN(dmabuf->virt,
6358                                               LPFC_ALIGN_16_BYTE);
6359         phba->sli4_hba.bmbx.aphys = ALIGN(dmabuf->phys,
6360                                               LPFC_ALIGN_16_BYTE);
6361
6362         /*
6363          * Set the high and low physical addresses now.  The SLI4 alignment
6364          * requirement is 16 bytes and the mailbox is posted to the port
6365          * as two 30-bit addresses.  The other data is a bit marking whether
6366          * the 30-bit address is the high or low address.
6367          * Upcast bmbx aphys to 64bits so shift instruction compiles
6368          * clean on 32 bit machines.
6369          */
6370         dma_address = &phba->sli4_hba.bmbx.dma_address;
6371         phys_addr = (uint64_t)phba->sli4_hba.bmbx.aphys;
6372         pa_addr = (uint32_t) ((phys_addr >> 34) & 0x3fffffff);
6373         dma_address->addr_hi = (uint32_t) ((pa_addr << 2) |
6374                                            LPFC_BMBX_BIT1_ADDR_HI);
6375
6376         pa_addr = (uint32_t) ((phba->sli4_hba.bmbx.aphys >> 4) & 0x3fffffff);
6377         dma_address->addr_lo = (uint32_t) ((pa_addr << 2) |
6378                                            LPFC_BMBX_BIT1_ADDR_LO);
6379         return 0;
6380 }
6381
6382 /**
6383  * lpfc_destroy_bootstrap_mbox - Destroy all bootstrap mailbox resources
6384  * @phba: pointer to lpfc hba data structure.
6385  *
6386  * This routine is invoked to teardown the bootstrap mailbox
6387  * region and release all host resources. This routine requires
6388  * the caller to ensure all mailbox commands recovered, no
6389  * additional mailbox comands are sent, and interrupts are disabled
6390  * before calling this routine.
6391  *
6392  **/
6393 static void
6394 lpfc_destroy_bootstrap_mbox(struct lpfc_hba *phba)
6395 {
6396         dma_free_coherent(&phba->pcidev->dev,
6397                           phba->sli4_hba.bmbx.bmbx_size,
6398                           phba->sli4_hba.bmbx.dmabuf->virt,
6399                           phba->sli4_hba.bmbx.dmabuf->phys);
6400
6401         kfree(phba->sli4_hba.bmbx.dmabuf);
6402         memset(&phba->sli4_hba.bmbx, 0, sizeof(struct lpfc_bmbx));
6403 }
6404
6405 /**
6406  * lpfc_sli4_read_config - Get the config parameters.
6407  * @phba: pointer to lpfc hba data structure.
6408  *
6409  * This routine is invoked to read the configuration parameters from the HBA.
6410  * The configuration parameters are used to set the base and maximum values
6411  * for RPI's XRI's VPI's VFI's and FCFIs. These values also affect the resource
6412  * allocation for the port.
6413  *
6414  * Return codes
6415  *      0 - successful
6416  *      -ENOMEM - No available memory
6417  *      -EIO - The mailbox failed to complete successfully.
6418  **/
6419 int
6420 lpfc_sli4_read_config(struct lpfc_hba *phba)
6421 {
6422         LPFC_MBOXQ_t *pmb;
6423         struct lpfc_mbx_read_config *rd_config;
6424         union  lpfc_sli4_cfg_shdr *shdr;
6425         uint32_t shdr_status, shdr_add_status;
6426         struct lpfc_mbx_get_func_cfg *get_func_cfg;
6427         struct lpfc_rsrc_desc_fcfcoe *desc;
6428         char *pdesc_0;
6429         uint32_t desc_count;
6430         int length, i, rc = 0, rc2;
6431
6432         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
6433         if (!pmb) {
6434                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
6435                                 "2011 Unable to allocate memory for issuing "
6436                                 "SLI_CONFIG_SPECIAL mailbox command\n");
6437                 return -ENOMEM;
6438         }
6439
6440         lpfc_read_config(phba, pmb);
6441
6442         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
6443         if (rc != MBX_SUCCESS) {
6444                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
6445                         "2012 Mailbox failed , mbxCmd x%x "
6446                         "READ_CONFIG, mbxStatus x%x\n",
6447                         bf_get(lpfc_mqe_command, &pmb->u.mqe),
6448                         bf_get(lpfc_mqe_status, &pmb->u.mqe));
6449                 rc = -EIO;
6450         } else {
6451                 rd_config = &pmb->u.mqe.un.rd_config;
6452                 if (bf_get(lpfc_mbx_rd_conf_lnk_ldv, rd_config)) {
6453                         phba->sli4_hba.lnk_info.lnk_dv = LPFC_LNK_DAT_VAL;
6454                         phba->sli4_hba.lnk_info.lnk_tp =
6455                                 bf_get(lpfc_mbx_rd_conf_lnk_type, rd_config);
6456                         phba->sli4_hba.lnk_info.lnk_no =
6457                                 bf_get(lpfc_mbx_rd_conf_lnk_numb, rd_config);
6458                         lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
6459                                         "3081 lnk_type:%d, lnk_numb:%d\n",
6460                                         phba->sli4_hba.lnk_info.lnk_tp,
6461                                         phba->sli4_hba.lnk_info.lnk_no);
6462                 } else
6463                         lpfc_printf_log(phba, KERN_WARNING, LOG_SLI,
6464                                         "3082 Mailbox (x%x) returned ldv:x0\n",
6465                                         bf_get(lpfc_mqe_command, &pmb->u.mqe));
6466                 phba->sli4_hba.extents_in_use =
6467                         bf_get(lpfc_mbx_rd_conf_extnts_inuse, rd_config);
6468                 phba->sli4_hba.max_cfg_param.max_xri =
6469                         bf_get(lpfc_mbx_rd_conf_xri_count, rd_config);
6470                 phba->sli4_hba.max_cfg_param.xri_base =
6471                         bf_get(lpfc_mbx_rd_conf_xri_base, rd_config);
6472                 phba->sli4_hba.max_cfg_param.max_vpi =
6473                         bf_get(lpfc_mbx_rd_conf_vpi_count, rd_config);
6474                 phba->sli4_hba.max_cfg_param.vpi_base =
6475                         bf_get(lpfc_mbx_rd_conf_vpi_base, rd_config);
6476                 phba->sli4_hba.max_cfg_param.max_rpi =
6477                         bf_get(lpfc_mbx_rd_conf_rpi_count, rd_config);
6478                 phba->sli4_hba.max_cfg_param.rpi_base =
6479                         bf_get(lpfc_mbx_rd_conf_rpi_base, rd_config);
6480                 phba->sli4_hba.max_cfg_param.max_vfi =
6481                         bf_get(lpfc_mbx_rd_conf_vfi_count, rd_config);
6482                 phba->sli4_hba.max_cfg_param.vfi_base =
6483                         bf_get(lpfc_mbx_rd_conf_vfi_base, rd_config);
6484                 phba->sli4_hba.max_cfg_param.max_fcfi =
6485                         bf_get(lpfc_mbx_rd_conf_fcfi_count, rd_config);
6486                 phba->sli4_hba.max_cfg_param.max_eq =
6487                         bf_get(lpfc_mbx_rd_conf_eq_count, rd_config);
6488                 phba->sli4_hba.max_cfg_param.max_rq =
6489                         bf_get(lpfc_mbx_rd_conf_rq_count, rd_config);
6490                 phba->sli4_hba.max_cfg_param.max_wq =
6491                         bf_get(lpfc_mbx_rd_conf_wq_count, rd_config);
6492                 phba->sli4_hba.max_cfg_param.max_cq =
6493                         bf_get(lpfc_mbx_rd_conf_cq_count, rd_config);
6494                 phba->lmt = bf_get(lpfc_mbx_rd_conf_lmt, rd_config);
6495                 phba->sli4_hba.next_xri = phba->sli4_hba.max_cfg_param.xri_base;
6496                 phba->vpi_base = phba->sli4_hba.max_cfg_param.vpi_base;
6497                 phba->vfi_base = phba->sli4_hba.max_cfg_param.vfi_base;
6498                 phba->max_vpi = (phba->sli4_hba.max_cfg_param.max_vpi > 0) ?
6499                                 (phba->sli4_hba.max_cfg_param.max_vpi - 1) : 0;
6500                 phba->max_vports = phba->max_vpi;
6501                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
6502                                 "2003 cfg params Extents? %d "
6503                                 "XRI(B:%d M:%d), "
6504                                 "VPI(B:%d M:%d) "
6505                                 "VFI(B:%d M:%d) "
6506                                 "RPI(B:%d M:%d) "
6507                                 "FCFI(Count:%d)\n",
6508                                 phba->sli4_hba.extents_in_use,
6509                                 phba->sli4_hba.max_cfg_param.xri_base,
6510                                 phba->sli4_hba.max_cfg_param.max_xri,
6511                                 phba->sli4_hba.max_cfg_param.vpi_base,
6512                                 phba->sli4_hba.max_cfg_param.max_vpi,
6513                                 phba->sli4_hba.max_cfg_param.vfi_base,
6514                                 phba->sli4_hba.max_cfg_param.max_vfi,
6515                                 phba->sli4_hba.max_cfg_param.rpi_base,
6516                                 phba->sli4_hba.max_cfg_param.max_rpi,
6517                                 phba->sli4_hba.max_cfg_param.max_fcfi);
6518         }
6519
6520         if (rc)
6521                 goto read_cfg_out;
6522
6523         /* Reset the DFT_HBA_Q_DEPTH to the max xri  */
6524         if (phba->cfg_hba_queue_depth >
6525                 (phba->sli4_hba.max_cfg_param.max_xri -
6526                         lpfc_sli4_get_els_iocb_cnt(phba)))
6527                 phba->cfg_hba_queue_depth =
6528                         phba->sli4_hba.max_cfg_param.max_xri -
6529                                 lpfc_sli4_get_els_iocb_cnt(phba);
6530
6531         if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) !=
6532             LPFC_SLI_INTF_IF_TYPE_2)
6533                 goto read_cfg_out;
6534
6535         /* get the pf# and vf# for SLI4 if_type 2 port */
6536         length = (sizeof(struct lpfc_mbx_get_func_cfg) -
6537                   sizeof(struct lpfc_sli4_cfg_mhdr));
6538         lpfc_sli4_config(phba, pmb, LPFC_MBOX_SUBSYSTEM_COMMON,
6539                          LPFC_MBOX_OPCODE_GET_FUNCTION_CONFIG,
6540                          length, LPFC_SLI4_MBX_EMBED);
6541
6542         rc2 = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
6543         shdr = (union lpfc_sli4_cfg_shdr *)
6544                                 &pmb->u.mqe.un.sli4_config.header.cfg_shdr;
6545         shdr_status = bf_get(lpfc_mbox_hdr_status, &shdr->response);
6546         shdr_add_status = bf_get(lpfc_mbox_hdr_add_status, &shdr->response);
6547         if (rc2 || shdr_status || shdr_add_status) {
6548                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
6549                                 "3026 Mailbox failed , mbxCmd x%x "
6550                                 "GET_FUNCTION_CONFIG, mbxStatus x%x\n",
6551                                 bf_get(lpfc_mqe_command, &pmb->u.mqe),
6552                                 bf_get(lpfc_mqe_status, &pmb->u.mqe));
6553                 goto read_cfg_out;
6554         }
6555
6556         /* search for fc_fcoe resrouce descriptor */
6557         get_func_cfg = &pmb->u.mqe.un.get_func_cfg;
6558         desc_count = get_func_cfg->func_cfg.rsrc_desc_count;
6559
6560         pdesc_0 = (char *)&get_func_cfg->func_cfg.desc[0];
6561         desc = (struct lpfc_rsrc_desc_fcfcoe *)pdesc_0;
6562         length = bf_get(lpfc_rsrc_desc_fcfcoe_length, desc);
6563         if (length == LPFC_RSRC_DESC_TYPE_FCFCOE_V0_RSVD)
6564                 length = LPFC_RSRC_DESC_TYPE_FCFCOE_V0_LENGTH;
6565         else if (length != LPFC_RSRC_DESC_TYPE_FCFCOE_V1_LENGTH)
6566                 goto read_cfg_out;
6567
6568         for (i = 0; i < LPFC_RSRC_DESC_MAX_NUM; i++) {
6569                 desc = (struct lpfc_rsrc_desc_fcfcoe *)(pdesc_0 + length * i);
6570                 if (LPFC_RSRC_DESC_TYPE_FCFCOE ==
6571                     bf_get(lpfc_rsrc_desc_fcfcoe_type, desc)) {
6572                         phba->sli4_hba.iov.pf_number =
6573                                 bf_get(lpfc_rsrc_desc_fcfcoe_pfnum, desc);
6574                         phba->sli4_hba.iov.vf_number =
6575                                 bf_get(lpfc_rsrc_desc_fcfcoe_vfnum, desc);
6576                         break;
6577                 }
6578         }
6579
6580         if (i < LPFC_RSRC_DESC_MAX_NUM)
6581                 lpfc_printf_log(phba, KERN_INFO, LOG_SLI,
6582                                 "3027 GET_FUNCTION_CONFIG: pf_number:%d, "
6583                                 "vf_number:%d\n", phba->sli4_hba.iov.pf_number,
6584                                 phba->sli4_hba.iov.vf_number);
6585         else
6586                 lpfc_printf_log(phba, KERN_ERR, LOG_SLI,
6587                                 "3028 GET_FUNCTION_CONFIG: failed to find "
6588                                 "Resrouce Descriptor:x%x\n",
6589                                 LPFC_RSRC_DESC_TYPE_FCFCOE);
6590
6591 read_cfg_out:
6592         mempool_free(pmb, phba->mbox_mem_pool);
6593         return rc;
6594 }
6595
6596 /**
6597  * lpfc_setup_endian_order - Write endian order to an SLI4 if_type 0 port.
6598  * @phba: pointer to lpfc hba data structure.
6599  *
6600  * This routine is invoked to setup the port-side endian order when
6601  * the port if_type is 0.  This routine has no function for other
6602  * if_types.
6603  *
6604  * Return codes
6605  *      0 - successful
6606  *      -ENOMEM - No available memory
6607  *      -EIO - The mailbox failed to complete successfully.
6608  **/
6609 static int
6610 lpfc_setup_endian_order(struct lpfc_hba *phba)
6611 {
6612         LPFC_MBOXQ_t *mboxq;
6613         uint32_t if_type, rc = 0;
6614         uint32_t endian_mb_data[2] = {HOST_ENDIAN_LOW_WORD0,
6615                                       HOST_ENDIAN_HIGH_WORD1};
6616
6617         if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
6618         switch (if_type) {
6619         case LPFC_SLI_INTF_IF_TYPE_0:
6620                 mboxq = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool,
6621                                                        GFP_KERNEL);
6622                 if (!mboxq) {
6623                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6624                                         "0492 Unable to allocate memory for "
6625                                         "issuing SLI_CONFIG_SPECIAL mailbox "
6626                                         "command\n");
6627                         return -ENOMEM;
6628                 }
6629
6630                 /*
6631                  * The SLI4_CONFIG_SPECIAL mailbox command requires the first
6632                  * two words to contain special data values and no other data.
6633                  */
6634                 memset(mboxq, 0, sizeof(LPFC_MBOXQ_t));
6635                 memcpy(&mboxq->u.mqe, &endian_mb_data, sizeof(endian_mb_data));
6636                 rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
6637                 if (rc != MBX_SUCCESS) {
6638                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6639                                         "0493 SLI_CONFIG_SPECIAL mailbox "
6640                                         "failed with status x%x\n",
6641                                         rc);
6642                         rc = -EIO;
6643                 }
6644                 mempool_free(mboxq, phba->mbox_mem_pool);
6645                 break;
6646         case LPFC_SLI_INTF_IF_TYPE_2:
6647         case LPFC_SLI_INTF_IF_TYPE_1:
6648         default:
6649                 break;
6650         }
6651         return rc;
6652 }
6653
6654 /**
6655  * lpfc_sli4_queue_verify - Verify and update EQ and CQ counts
6656  * @phba: pointer to lpfc hba data structure.
6657  *
6658  * This routine is invoked to check the user settable queue counts for EQs and
6659  * CQs. after this routine is called the counts will be set to valid values that
6660  * adhere to the constraints of the system's interrupt vectors and the port's
6661  * queue resources.
6662  *
6663  * Return codes
6664  *      0 - successful
6665  *      -ENOMEM - No available memory
6666  **/
6667 static int
6668 lpfc_sli4_queue_verify(struct lpfc_hba *phba)
6669 {
6670         int cfg_fcp_io_channel;
6671         uint32_t cpu;
6672         uint32_t i = 0;
6673
6674
6675         /*
6676          * Sanity check for configured queue parameters against the run-time
6677          * device parameters
6678          */
6679
6680         /* Sanity check on HBA EQ parameters */
6681         cfg_fcp_io_channel = phba->cfg_fcp_io_channel;
6682
6683         /* It doesn't make sense to have more io channels then CPUs */
6684         for_each_online_cpu(cpu) {
6685                 i++;
6686         }
6687         if (i < cfg_fcp_io_channel) {
6688                 lpfc_printf_log(phba,
6689                                 KERN_ERR, LOG_INIT,
6690                                 "3188 Reducing IO channels to match number of "
6691                                 "CPUs: from %d to %d\n", cfg_fcp_io_channel, i);
6692                 cfg_fcp_io_channel = i;
6693         }
6694
6695         if (cfg_fcp_io_channel >
6696             phba->sli4_hba.max_cfg_param.max_eq) {
6697                 if (phba->sli4_hba.max_cfg_param.max_eq <
6698                     LPFC_FCP_IO_CHAN_MIN) {
6699                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6700                                         "2574 Not enough EQs (%d) from the "
6701                                         "pci function for supporting FCP "
6702                                         "EQs (%d)\n",
6703                                         phba->sli4_hba.max_cfg_param.max_eq,
6704                                         phba->cfg_fcp_io_channel);
6705                         goto out_error;
6706                 }
6707                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6708                                 "2575 Reducing IO channels to match number of "
6709                                 "available EQs: from %d to %d\n",
6710                                 cfg_fcp_io_channel,
6711                                 phba->sli4_hba.max_cfg_param.max_eq);
6712                 cfg_fcp_io_channel = phba->sli4_hba.max_cfg_param.max_eq;
6713         }
6714
6715         /* Eventually cfg_fcp_eq_count / cfg_fcp_wq_count will be depricated */
6716
6717         /* The actual number of FCP event queues adopted */
6718         phba->cfg_fcp_eq_count = cfg_fcp_io_channel;
6719         phba->cfg_fcp_wq_count = cfg_fcp_io_channel;
6720         phba->cfg_fcp_io_channel = cfg_fcp_io_channel;
6721
6722         /* Get EQ depth from module parameter, fake the default for now */
6723         phba->sli4_hba.eq_esize = LPFC_EQE_SIZE_4B;
6724         phba->sli4_hba.eq_ecount = LPFC_EQE_DEF_COUNT;
6725
6726         /* Get CQ depth from module parameter, fake the default for now */
6727         phba->sli4_hba.cq_esize = LPFC_CQE_SIZE;
6728         phba->sli4_hba.cq_ecount = LPFC_CQE_DEF_COUNT;
6729
6730         return 0;
6731 out_error:
6732         return -ENOMEM;
6733 }
6734
6735 /**
6736  * lpfc_sli4_queue_create - Create all the SLI4 queues
6737  * @phba: pointer to lpfc hba data structure.
6738  *
6739  * This routine is invoked to allocate all the SLI4 queues for the FCoE HBA
6740  * operation. For each SLI4 queue type, the parameters such as queue entry
6741  * count (queue depth) shall be taken from the module parameter. For now,
6742  * we just use some constant number as place holder.
6743  *
6744  * Return codes
6745  *      0 - successful
6746  *      -ENOMEM - No availble memory
6747  *      -EIO - The mailbox failed to complete successfully.
6748  **/
6749 int
6750 lpfc_sli4_queue_create(struct lpfc_hba *phba)
6751 {
6752         struct lpfc_queue *qdesc;
6753         int idx;
6754
6755         /*
6756          * Create HBA Record arrays.
6757          */
6758         if (!phba->cfg_fcp_io_channel)
6759                 return -ERANGE;
6760
6761         phba->sli4_hba.mq_esize = LPFC_MQE_SIZE;
6762         phba->sli4_hba.mq_ecount = LPFC_MQE_DEF_COUNT;
6763         phba->sli4_hba.wq_esize = LPFC_WQE_SIZE;
6764         phba->sli4_hba.wq_ecount = LPFC_WQE_DEF_COUNT;
6765         phba->sli4_hba.rq_esize = LPFC_RQE_SIZE;
6766         phba->sli4_hba.rq_ecount = LPFC_RQE_DEF_COUNT;
6767
6768         phba->sli4_hba.hba_eq =  kzalloc((sizeof(struct lpfc_queue *) *
6769                                 phba->cfg_fcp_io_channel), GFP_KERNEL);
6770         if (!phba->sli4_hba.hba_eq) {
6771                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6772                         "2576 Failed allocate memory for "
6773                         "fast-path EQ record array\n");
6774                 goto out_error;
6775         }
6776
6777         phba->sli4_hba.fcp_cq = kzalloc((sizeof(struct lpfc_queue *) *
6778                                 phba->cfg_fcp_io_channel), GFP_KERNEL);
6779         if (!phba->sli4_hba.fcp_cq) {
6780                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6781                                 "2577 Failed allocate memory for fast-path "
6782                                 "CQ record array\n");
6783                 goto out_error;
6784         }
6785
6786         phba->sli4_hba.fcp_wq = kzalloc((sizeof(struct lpfc_queue *) *
6787                                 phba->cfg_fcp_io_channel), GFP_KERNEL);
6788         if (!phba->sli4_hba.fcp_wq) {
6789                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6790                                 "2578 Failed allocate memory for fast-path "
6791                                 "WQ record array\n");
6792                 goto out_error;
6793         }
6794
6795         /*
6796          * Since the first EQ can have multiple CQs associated with it,
6797          * this array is used to quickly see if we have a FCP fast-path
6798          * CQ match.
6799          */
6800         phba->sli4_hba.fcp_cq_map = kzalloc((sizeof(uint16_t) *
6801                                          phba->cfg_fcp_io_channel), GFP_KERNEL);
6802         if (!phba->sli4_hba.fcp_cq_map) {
6803                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6804                                 "2545 Failed allocate memory for fast-path "
6805                                 "CQ map\n");
6806                 goto out_error;
6807         }
6808
6809         /*
6810          * Create HBA Event Queues (EQs).  The cfg_fcp_io_channel specifies
6811          * how many EQs to create.
6812          */
6813         for (idx = 0; idx < phba->cfg_fcp_io_channel; idx++) {
6814
6815                 /* Create EQs */
6816                 qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.eq_esize,
6817                                               phba->sli4_hba.eq_ecount);
6818                 if (!qdesc) {
6819                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6820                                         "0497 Failed allocate EQ (%d)\n", idx);
6821                         goto out_error;
6822                 }
6823                 phba->sli4_hba.hba_eq[idx] = qdesc;
6824
6825                 /* Create Fast Path FCP CQs */
6826                 qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.cq_esize,
6827                                               phba->sli4_hba.cq_ecount);
6828                 if (!qdesc) {
6829                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6830                                         "0499 Failed allocate fast-path FCP "
6831                                         "CQ (%d)\n", idx);
6832                         goto out_error;
6833                 }
6834                 phba->sli4_hba.fcp_cq[idx] = qdesc;
6835
6836                 /* Create Fast Path FCP WQs */
6837                 qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.wq_esize,
6838                                               phba->sli4_hba.wq_ecount);
6839                 if (!qdesc) {
6840                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6841                                         "0503 Failed allocate fast-path FCP "
6842                                         "WQ (%d)\n", idx);
6843                         goto out_error;
6844                 }
6845                 phba->sli4_hba.fcp_wq[idx] = qdesc;
6846         }
6847
6848
6849         /*
6850          * Create Slow Path Completion Queues (CQs)
6851          */
6852
6853         /* Create slow-path Mailbox Command Complete Queue */
6854         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.cq_esize,
6855                                       phba->sli4_hba.cq_ecount);
6856         if (!qdesc) {
6857                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6858                                 "0500 Failed allocate slow-path mailbox CQ\n");
6859                 goto out_error;
6860         }
6861         phba->sli4_hba.mbx_cq = qdesc;
6862
6863         /* Create slow-path ELS Complete Queue */
6864         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.cq_esize,
6865                                       phba->sli4_hba.cq_ecount);
6866         if (!qdesc) {
6867                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6868                                 "0501 Failed allocate slow-path ELS CQ\n");
6869                 goto out_error;
6870         }
6871         phba->sli4_hba.els_cq = qdesc;
6872
6873
6874         /*
6875          * Create Slow Path Work Queues (WQs)
6876          */
6877
6878         /* Create Mailbox Command Queue */
6879
6880         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.mq_esize,
6881                                       phba->sli4_hba.mq_ecount);
6882         if (!qdesc) {
6883                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6884                                 "0505 Failed allocate slow-path MQ\n");
6885                 goto out_error;
6886         }
6887         phba->sli4_hba.mbx_wq = qdesc;
6888
6889         /*
6890          * Create ELS Work Queues
6891          */
6892
6893         /* Create slow-path ELS Work Queue */
6894         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.wq_esize,
6895                                       phba->sli4_hba.wq_ecount);
6896         if (!qdesc) {
6897                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6898                                 "0504 Failed allocate slow-path ELS WQ\n");
6899                 goto out_error;
6900         }
6901         phba->sli4_hba.els_wq = qdesc;
6902
6903         /*
6904          * Create Receive Queue (RQ)
6905          */
6906
6907         /* Create Receive Queue for header */
6908         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.rq_esize,
6909                                       phba->sli4_hba.rq_ecount);
6910         if (!qdesc) {
6911                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6912                                 "0506 Failed allocate receive HRQ\n");
6913                 goto out_error;
6914         }
6915         phba->sli4_hba.hdr_rq = qdesc;
6916
6917         /* Create Receive Queue for data */
6918         qdesc = lpfc_sli4_queue_alloc(phba, phba->sli4_hba.rq_esize,
6919                                       phba->sli4_hba.rq_ecount);
6920         if (!qdesc) {
6921                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
6922                                 "0507 Failed allocate receive DRQ\n");
6923                 goto out_error;
6924         }
6925         phba->sli4_hba.dat_rq = qdesc;
6926
6927         return 0;
6928
6929 out_error:
6930         lpfc_sli4_queue_destroy(phba);
6931         return -ENOMEM;
6932 }
6933
6934 /**
6935  * lpfc_sli4_queue_destroy - Destroy all the SLI4 queues
6936  * @phba: pointer to lpfc hba data structure.
6937  *
6938  * This routine is invoked to release all the SLI4 queues with the FCoE HBA
6939  * operation.
6940  *
6941  * Return codes
6942  *      0 - successful
6943  *      -ENOMEM - No available memory
6944  *      -EIO - The mailbox failed to complete successfully.
6945  **/
6946 void
6947 lpfc_sli4_queue_destroy(struct lpfc_hba *phba)
6948 {
6949         int idx;
6950
6951         if (phba->sli4_hba.hba_eq != NULL) {
6952                 /* Release HBA event queue */
6953                 for (idx = 0; idx < phba->cfg_fcp_io_channel; idx++) {
6954                         if (phba->sli4_hba.hba_eq[idx] != NULL) {
6955                                 lpfc_sli4_queue_free(
6956                                         phba->sli4_hba.hba_eq[idx]);
6957                                 phba->sli4_hba.hba_eq[idx] = NULL;
6958                         }
6959                 }
6960                 kfree(phba->sli4_hba.hba_eq);
6961                 phba->sli4_hba.hba_eq = NULL;
6962         }
6963
6964         if (phba->sli4_hba.fcp_cq != NULL) {
6965                 /* Release FCP completion queue */
6966                 for (idx = 0; idx < phba->cfg_fcp_io_channel; idx++) {
6967                         if (phba->sli4_hba.fcp_cq[idx] != NULL) {
6968                                 lpfc_sli4_queue_free(
6969                                         phba->sli4_hba.fcp_cq[idx]);
6970                                 phba->sli4_hba.fcp_cq[idx] = NULL;
6971                         }
6972                 }
6973                 kfree(phba->sli4_hba.fcp_cq);
6974                 phba->sli4_hba.fcp_cq = NULL;
6975         }
6976
6977         if (phba->sli4_hba.fcp_wq != NULL) {
6978                 /* Release FCP work queue */
6979                 for (idx = 0; idx < phba->cfg_fcp_io_channel; idx++) {
6980                         if (phba->sli4_hba.fcp_wq[idx] != NULL) {
6981                                 lpfc_sli4_queue_free(
6982                                         phba->sli4_hba.fcp_wq[idx]);
6983                                 phba->sli4_hba.fcp_wq[idx] = NULL;
6984                         }
6985                 }
6986                 kfree(phba->sli4_hba.fcp_wq);
6987                 phba->sli4_hba.fcp_wq = NULL;
6988         }
6989
6990         if (phba->pci_bar0_memmap_p) {
6991                 iounmap(phba->pci_bar0_memmap_p);
6992                 phba->pci_bar0_memmap_p = NULL;
6993         }
6994         if (phba->pci_bar2_memmap_p) {
6995                 iounmap(phba->pci_bar2_memmap_p);
6996                 phba->pci_bar2_memmap_p = NULL;
6997         }
6998         if (phba->pci_bar4_memmap_p) {
6999                 iounmap(phba->pci_bar4_memmap_p);
7000                 phba->pci_bar4_memmap_p = NULL;
7001         }
7002
7003         /* Release FCP CQ mapping array */
7004         if (phba->sli4_hba.fcp_cq_map != NULL) {
7005                 kfree(phba->sli4_hba.fcp_cq_map);
7006                 phba->sli4_hba.fcp_cq_map = NULL;
7007         }
7008
7009         /* Release mailbox command work queue */
7010         if (phba->sli4_hba.mbx_wq != NULL) {
7011                 lpfc_sli4_queue_free(phba->sli4_hba.mbx_wq);
7012                 phba->sli4_hba.mbx_wq = NULL;
7013         }
7014
7015         /* Release ELS work queue */
7016         if (phba->sli4_hba.els_wq != NULL) {
7017                 lpfc_sli4_queue_free(phba->sli4_hba.els_wq);
7018                 phba->sli4_hba.els_wq = NULL;
7019         }
7020
7021         /* Release unsolicited receive queue */
7022         if (phba->sli4_hba.hdr_rq != NULL) {
7023                 lpfc_sli4_queue_free(phba->sli4_hba.hdr_rq);
7024                 phba->sli4_hba.hdr_rq = NULL;
7025         }
7026         if (phba->sli4_hba.dat_rq != NULL) {
7027                 lpfc_sli4_queue_free(phba->sli4_hba.dat_rq);
7028                 phba->sli4_hba.dat_rq = NULL;
7029         }
7030
7031         /* Release ELS complete queue */
7032         if (phba->sli4_hba.els_cq != NULL) {
7033                 lpfc_sli4_queue_free(phba->sli4_hba.els_cq);
7034                 phba->sli4_hba.els_cq = NULL;
7035         }
7036
7037         /* Release mailbox command complete queue */
7038         if (phba->sli4_hba.mbx_cq != NULL) {
7039                 lpfc_sli4_queue_free(phba->sli4_hba.mbx_cq);
7040                 phba->sli4_hba.mbx_cq = NULL;
7041         }
7042
7043         return;
7044 }
7045
7046 /**
7047  * lpfc_sli4_queue_setup - Set up all the SLI4 queues
7048  * @phba: pointer to lpfc hba data structure.
7049  *
7050  * This routine is invoked to set up all the SLI4 queues for the FCoE HBA
7051  * operation.
7052  *
7053  * Return codes
7054  *      0 - successful
7055  *      -ENOMEM - No available memory
7056  *      -EIO - The mailbox failed to complete successfully.
7057  **/
7058 int
7059 lpfc_sli4_queue_setup(struct lpfc_hba *phba)
7060 {
7061         struct lpfc_sli *psli = &phba->sli;
7062         struct lpfc_sli_ring *pring;
7063         int rc = -ENOMEM;
7064         int fcp_eqidx, fcp_cqidx, fcp_wqidx;
7065         int fcp_cq_index = 0;
7066         uint32_t shdr_status, shdr_add_status;
7067         union lpfc_sli4_cfg_shdr *shdr;
7068         LPFC_MBOXQ_t *mboxq;
7069         uint32_t length;
7070
7071         /* Check for dual-ULP support */
7072         mboxq = (LPFC_MBOXQ_t *)mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
7073         if (!mboxq) {
7074                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7075                                 "3249 Unable to allocate memory for "
7076                                 "QUERY_FW_CFG mailbox command\n");
7077                 return -ENOMEM;
7078         }
7079         length = (sizeof(struct lpfc_mbx_query_fw_config) -
7080                   sizeof(struct lpfc_sli4_cfg_mhdr));
7081         lpfc_sli4_config(phba, mboxq, LPFC_MBOX_SUBSYSTEM_COMMON,
7082                          LPFC_MBOX_OPCODE_QUERY_FW_CFG,
7083                          length, LPFC_SLI4_MBX_EMBED);
7084
7085         rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
7086
7087         shdr = (union lpfc_sli4_cfg_shdr *)
7088                         &mboxq->u.mqe.un.sli4_config.header.cfg_shdr;
7089         shdr_status = bf_get(lpfc_mbox_hdr_status, &shdr->response);
7090         shdr_add_status = bf_get(lpfc_mbox_hdr_add_status, &shdr->response);
7091         if (shdr_status || shdr_add_status || rc) {
7092                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7093                                 "3250 QUERY_FW_CFG mailbox failed with status "
7094                                 "x%x add_status x%x, mbx status x%x\n",
7095                                 shdr_status, shdr_add_status, rc);
7096                 if (rc != MBX_TIMEOUT)
7097                         mempool_free(mboxq, phba->mbox_mem_pool);
7098                 rc = -ENXIO;
7099                 goto out_error;
7100         }
7101
7102         phba->sli4_hba.fw_func_mode =
7103                         mboxq->u.mqe.un.query_fw_cfg.rsp.function_mode;
7104         phba->sli4_hba.ulp0_mode = mboxq->u.mqe.un.query_fw_cfg.rsp.ulp0_mode;
7105         phba->sli4_hba.ulp1_mode = mboxq->u.mqe.un.query_fw_cfg.rsp.ulp1_mode;
7106         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7107                         "3251 QUERY_FW_CFG: func_mode:x%x, ulp0_mode:x%x, "
7108                         "ulp1_mode:x%x\n", phba->sli4_hba.fw_func_mode,
7109                         phba->sli4_hba.ulp0_mode, phba->sli4_hba.ulp1_mode);
7110
7111         if (rc != MBX_TIMEOUT)
7112                 mempool_free(mboxq, phba->mbox_mem_pool);
7113
7114         /*
7115          * Set up HBA Event Queues (EQs)
7116          */
7117
7118         /* Set up HBA event queue */
7119         if (phba->cfg_fcp_io_channel && !phba->sli4_hba.hba_eq) {
7120                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7121                                 "3147 Fast-path EQs not allocated\n");
7122                 rc = -ENOMEM;
7123                 goto out_error;
7124         }
7125         for (fcp_eqidx = 0; fcp_eqidx < phba->cfg_fcp_io_channel; fcp_eqidx++) {
7126                 if (!phba->sli4_hba.hba_eq[fcp_eqidx]) {
7127                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7128                                         "0522 Fast-path EQ (%d) not "
7129                                         "allocated\n", fcp_eqidx);
7130                         rc = -ENOMEM;
7131                         goto out_destroy_hba_eq;
7132                 }
7133                 rc = lpfc_eq_create(phba, phba->sli4_hba.hba_eq[fcp_eqidx],
7134                          (phba->cfg_fcp_imax / phba->cfg_fcp_io_channel));
7135                 if (rc) {
7136                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7137                                         "0523 Failed setup of fast-path EQ "
7138                                         "(%d), rc = 0x%x\n", fcp_eqidx, rc);
7139                         goto out_destroy_hba_eq;
7140                 }
7141                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7142                                 "2584 HBA EQ setup: "
7143                                 "queue[%d]-id=%d\n", fcp_eqidx,
7144                                 phba->sli4_hba.hba_eq[fcp_eqidx]->queue_id);
7145         }
7146
7147         /* Set up fast-path FCP Response Complete Queue */
7148         if (!phba->sli4_hba.fcp_cq) {
7149                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7150                                 "3148 Fast-path FCP CQ array not "
7151                                 "allocated\n");
7152                 rc = -ENOMEM;
7153                 goto out_destroy_hba_eq;
7154         }
7155
7156         for (fcp_cqidx = 0; fcp_cqidx < phba->cfg_fcp_io_channel; fcp_cqidx++) {
7157                 if (!phba->sli4_hba.fcp_cq[fcp_cqidx]) {
7158                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7159                                         "0526 Fast-path FCP CQ (%d) not "
7160                                         "allocated\n", fcp_cqidx);
7161                         rc = -ENOMEM;
7162                         goto out_destroy_fcp_cq;
7163                 }
7164                 rc = lpfc_cq_create(phba, phba->sli4_hba.fcp_cq[fcp_cqidx],
7165                         phba->sli4_hba.hba_eq[fcp_cqidx], LPFC_WCQ, LPFC_FCP);
7166                 if (rc) {
7167                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7168                                         "0527 Failed setup of fast-path FCP "
7169                                         "CQ (%d), rc = 0x%x\n", fcp_cqidx, rc);
7170                         goto out_destroy_fcp_cq;
7171                 }
7172
7173                 /* Setup fcp_cq_map for fast lookup */
7174                 phba->sli4_hba.fcp_cq_map[fcp_cqidx] =
7175                                 phba->sli4_hba.fcp_cq[fcp_cqidx]->queue_id;
7176
7177                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7178                                 "2588 FCP CQ setup: cq[%d]-id=%d, "
7179                                 "parent seq[%d]-id=%d\n",
7180                                 fcp_cqidx,
7181                                 phba->sli4_hba.fcp_cq[fcp_cqidx]->queue_id,
7182                                 fcp_cqidx,
7183                                 phba->sli4_hba.hba_eq[fcp_cqidx]->queue_id);
7184         }
7185
7186         /* Set up fast-path FCP Work Queue */
7187         if (!phba->sli4_hba.fcp_wq) {
7188                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7189                                 "3149 Fast-path FCP WQ array not "
7190                                 "allocated\n");
7191                 rc = -ENOMEM;
7192                 goto out_destroy_fcp_cq;
7193         }
7194
7195         for (fcp_wqidx = 0; fcp_wqidx < phba->cfg_fcp_io_channel; fcp_wqidx++) {
7196                 if (!phba->sli4_hba.fcp_wq[fcp_wqidx]) {
7197                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7198                                         "0534 Fast-path FCP WQ (%d) not "
7199                                         "allocated\n", fcp_wqidx);
7200                         rc = -ENOMEM;
7201                         goto out_destroy_fcp_wq;
7202                 }
7203                 rc = lpfc_wq_create(phba, phba->sli4_hba.fcp_wq[fcp_wqidx],
7204                                     phba->sli4_hba.fcp_cq[fcp_wqidx],
7205                                     LPFC_FCP);
7206                 if (rc) {
7207                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7208                                         "0535 Failed setup of fast-path FCP "
7209                                         "WQ (%d), rc = 0x%x\n", fcp_wqidx, rc);
7210                         goto out_destroy_fcp_wq;
7211                 }
7212
7213                 /* Bind this WQ to the next FCP ring */
7214                 pring = &psli->ring[MAX_SLI3_CONFIGURED_RINGS + fcp_wqidx];
7215                 pring->sli.sli4.wqp = (void *)phba->sli4_hba.fcp_wq[fcp_wqidx];
7216                 phba->sli4_hba.fcp_cq[fcp_wqidx]->pring = pring;
7217
7218                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7219                                 "2591 FCP WQ setup: wq[%d]-id=%d, "
7220                                 "parent cq[%d]-id=%d\n",
7221                                 fcp_wqidx,
7222                                 phba->sli4_hba.fcp_wq[fcp_wqidx]->queue_id,
7223                                 fcp_cq_index,
7224                                 phba->sli4_hba.fcp_cq[fcp_wqidx]->queue_id);
7225         }
7226         /*
7227          * Set up Complete Queues (CQs)
7228          */
7229
7230         /* Set up slow-path MBOX Complete Queue as the first CQ */
7231         if (!phba->sli4_hba.mbx_cq) {
7232                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7233                                 "0528 Mailbox CQ not allocated\n");
7234                 rc = -ENOMEM;
7235                 goto out_destroy_fcp_wq;
7236         }
7237         rc = lpfc_cq_create(phba, phba->sli4_hba.mbx_cq,
7238                         phba->sli4_hba.hba_eq[0], LPFC_MCQ, LPFC_MBOX);
7239         if (rc) {
7240                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7241                                 "0529 Failed setup of slow-path mailbox CQ: "
7242                                 "rc = 0x%x\n", rc);
7243                 goto out_destroy_fcp_wq;
7244         }
7245         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7246                         "2585 MBX CQ setup: cq-id=%d, parent eq-id=%d\n",
7247                         phba->sli4_hba.mbx_cq->queue_id,
7248                         phba->sli4_hba.hba_eq[0]->queue_id);
7249
7250         /* Set up slow-path ELS Complete Queue */
7251         if (!phba->sli4_hba.els_cq) {
7252                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7253                                 "0530 ELS CQ not allocated\n");
7254                 rc = -ENOMEM;
7255                 goto out_destroy_mbx_cq;
7256         }
7257         rc = lpfc_cq_create(phba, phba->sli4_hba.els_cq,
7258                         phba->sli4_hba.hba_eq[0], LPFC_WCQ, LPFC_ELS);
7259         if (rc) {
7260                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7261                                 "0531 Failed setup of slow-path ELS CQ: "
7262                                 "rc = 0x%x\n", rc);
7263                 goto out_destroy_mbx_cq;
7264         }
7265         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7266                         "2586 ELS CQ setup: cq-id=%d, parent eq-id=%d\n",
7267                         phba->sli4_hba.els_cq->queue_id,
7268                         phba->sli4_hba.hba_eq[0]->queue_id);
7269
7270         /*
7271          * Set up all the Work Queues (WQs)
7272          */
7273
7274         /* Set up Mailbox Command Queue */
7275         if (!phba->sli4_hba.mbx_wq) {
7276                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7277                                 "0538 Slow-path MQ not allocated\n");
7278                 rc = -ENOMEM;
7279                 goto out_destroy_els_cq;
7280         }
7281         rc = lpfc_mq_create(phba, phba->sli4_hba.mbx_wq,
7282                             phba->sli4_hba.mbx_cq, LPFC_MBOX);
7283         if (rc) {
7284                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7285                                 "0539 Failed setup of slow-path MQ: "
7286                                 "rc = 0x%x\n", rc);
7287                 goto out_destroy_els_cq;
7288         }
7289         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7290                         "2589 MBX MQ setup: wq-id=%d, parent cq-id=%d\n",
7291                         phba->sli4_hba.mbx_wq->queue_id,
7292                         phba->sli4_hba.mbx_cq->queue_id);
7293
7294         /* Set up slow-path ELS Work Queue */
7295         if (!phba->sli4_hba.els_wq) {
7296                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7297                                 "0536 Slow-path ELS WQ not allocated\n");
7298                 rc = -ENOMEM;
7299                 goto out_destroy_mbx_wq;
7300         }
7301         rc = lpfc_wq_create(phba, phba->sli4_hba.els_wq,
7302                             phba->sli4_hba.els_cq, LPFC_ELS);
7303         if (rc) {
7304                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7305                                 "0537 Failed setup of slow-path ELS WQ: "
7306                                 "rc = 0x%x\n", rc);
7307                 goto out_destroy_mbx_wq;
7308         }
7309
7310         /* Bind this WQ to the ELS ring */
7311         pring = &psli->ring[LPFC_ELS_RING];
7312         pring->sli.sli4.wqp = (void *)phba->sli4_hba.els_wq;
7313         phba->sli4_hba.els_cq->pring = pring;
7314
7315         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7316                         "2590 ELS WQ setup: wq-id=%d, parent cq-id=%d\n",
7317                         phba->sli4_hba.els_wq->queue_id,
7318                         phba->sli4_hba.els_cq->queue_id);
7319
7320         /*
7321          * Create Receive Queue (RQ)
7322          */
7323         if (!phba->sli4_hba.hdr_rq || !phba->sli4_hba.dat_rq) {
7324                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7325                                 "0540 Receive Queue not allocated\n");
7326                 rc = -ENOMEM;
7327                 goto out_destroy_els_wq;
7328         }
7329
7330         lpfc_rq_adjust_repost(phba, phba->sli4_hba.hdr_rq, LPFC_ELS_HBQ);
7331         lpfc_rq_adjust_repost(phba, phba->sli4_hba.dat_rq, LPFC_ELS_HBQ);
7332
7333         rc = lpfc_rq_create(phba, phba->sli4_hba.hdr_rq, phba->sli4_hba.dat_rq,
7334                             phba->sli4_hba.els_cq, LPFC_USOL);
7335         if (rc) {
7336                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7337                                 "0541 Failed setup of Receive Queue: "
7338                                 "rc = 0x%x\n", rc);
7339                 goto out_destroy_fcp_wq;
7340         }
7341
7342         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7343                         "2592 USL RQ setup: hdr-rq-id=%d, dat-rq-id=%d "
7344                         "parent cq-id=%d\n",
7345                         phba->sli4_hba.hdr_rq->queue_id,
7346                         phba->sli4_hba.dat_rq->queue_id,
7347                         phba->sli4_hba.els_cq->queue_id);
7348         return 0;
7349
7350 out_destroy_els_wq:
7351         lpfc_wq_destroy(phba, phba->sli4_hba.els_wq);
7352 out_destroy_mbx_wq:
7353         lpfc_mq_destroy(phba, phba->sli4_hba.mbx_wq);
7354 out_destroy_els_cq:
7355         lpfc_cq_destroy(phba, phba->sli4_hba.els_cq);
7356 out_destroy_mbx_cq:
7357         lpfc_cq_destroy(phba, phba->sli4_hba.mbx_cq);
7358 out_destroy_fcp_wq:
7359         for (--fcp_wqidx; fcp_wqidx >= 0; fcp_wqidx--)
7360                 lpfc_wq_destroy(phba, phba->sli4_hba.fcp_wq[fcp_wqidx]);
7361 out_destroy_fcp_cq:
7362         for (--fcp_cqidx; fcp_cqidx >= 0; fcp_cqidx--)
7363                 lpfc_cq_destroy(phba, phba->sli4_hba.fcp_cq[fcp_cqidx]);
7364 out_destroy_hba_eq:
7365         for (--fcp_eqidx; fcp_eqidx >= 0; fcp_eqidx--)
7366                 lpfc_eq_destroy(phba, phba->sli4_hba.hba_eq[fcp_eqidx]);
7367 out_error:
7368         return rc;
7369 }
7370
7371 /**
7372  * lpfc_sli4_queue_unset - Unset all the SLI4 queues
7373  * @phba: pointer to lpfc hba data structure.
7374  *
7375  * This routine is invoked to unset all the SLI4 queues with the FCoE HBA
7376  * operation.
7377  *
7378  * Return codes
7379  *      0 - successful
7380  *      -ENOMEM - No available memory
7381  *      -EIO - The mailbox failed to complete successfully.
7382  **/
7383 void
7384 lpfc_sli4_queue_unset(struct lpfc_hba *phba)
7385 {
7386         int fcp_qidx;
7387
7388         /* Unset mailbox command work queue */
7389         lpfc_mq_destroy(phba, phba->sli4_hba.mbx_wq);
7390         /* Unset ELS work queue */
7391         lpfc_wq_destroy(phba, phba->sli4_hba.els_wq);
7392         /* Unset unsolicited receive queue */
7393         lpfc_rq_destroy(phba, phba->sli4_hba.hdr_rq, phba->sli4_hba.dat_rq);
7394         /* Unset FCP work queue */
7395         if (phba->sli4_hba.fcp_wq) {
7396                 for (fcp_qidx = 0; fcp_qidx < phba->cfg_fcp_io_channel;
7397                      fcp_qidx++)
7398                         lpfc_wq_destroy(phba, phba->sli4_hba.fcp_wq[fcp_qidx]);
7399         }
7400         /* Unset mailbox command complete queue */
7401         lpfc_cq_destroy(phba, phba->sli4_hba.mbx_cq);
7402         /* Unset ELS complete queue */
7403         lpfc_cq_destroy(phba, phba->sli4_hba.els_cq);
7404         /* Unset FCP response complete queue */
7405         if (phba->sli4_hba.fcp_cq) {
7406                 for (fcp_qidx = 0; fcp_qidx < phba->cfg_fcp_io_channel;
7407                      fcp_qidx++)
7408                         lpfc_cq_destroy(phba, phba->sli4_hba.fcp_cq[fcp_qidx]);
7409         }
7410         /* Unset fast-path event queue */
7411         if (phba->sli4_hba.hba_eq) {
7412                 for (fcp_qidx = 0; fcp_qidx < phba->cfg_fcp_io_channel;
7413                      fcp_qidx++)
7414                         lpfc_eq_destroy(phba, phba->sli4_hba.hba_eq[fcp_qidx]);
7415         }
7416 }
7417
7418 /**
7419  * lpfc_sli4_cq_event_pool_create - Create completion-queue event free pool
7420  * @phba: pointer to lpfc hba data structure.
7421  *
7422  * This routine is invoked to allocate and set up a pool of completion queue
7423  * events. The body of the completion queue event is a completion queue entry
7424  * CQE. For now, this pool is used for the interrupt service routine to queue
7425  * the following HBA completion queue events for the worker thread to process:
7426  *   - Mailbox asynchronous events
7427  *   - Receive queue completion unsolicited events
7428  * Later, this can be used for all the slow-path events.
7429  *
7430  * Return codes
7431  *      0 - successful
7432  *      -ENOMEM - No available memory
7433  **/
7434 static int
7435 lpfc_sli4_cq_event_pool_create(struct lpfc_hba *phba)
7436 {
7437         struct lpfc_cq_event *cq_event;
7438         int i;
7439
7440         for (i = 0; i < (4 * phba->sli4_hba.cq_ecount); i++) {
7441                 cq_event = kmalloc(sizeof(struct lpfc_cq_event), GFP_KERNEL);
7442                 if (!cq_event)
7443                         goto out_pool_create_fail;
7444                 list_add_tail(&cq_event->list,
7445                               &phba->sli4_hba.sp_cqe_event_pool);
7446         }
7447         return 0;
7448
7449 out_pool_create_fail:
7450         lpfc_sli4_cq_event_pool_destroy(phba);
7451         return -ENOMEM;
7452 }
7453
7454 /**
7455  * lpfc_sli4_cq_event_pool_destroy - Free completion-queue event free pool
7456  * @phba: pointer to lpfc hba data structure.
7457  *
7458  * This routine is invoked to free the pool of completion queue events at
7459  * driver unload time. Note that, it is the responsibility of the driver
7460  * cleanup routine to free all the outstanding completion-queue events
7461  * allocated from this pool back into the pool before invoking this routine
7462  * to destroy the pool.
7463  **/
7464 static void
7465 lpfc_sli4_cq_event_pool_destroy(struct lpfc_hba *phba)
7466 {
7467         struct lpfc_cq_event *cq_event, *next_cq_event;
7468
7469         list_for_each_entry_safe(cq_event, next_cq_event,
7470                                  &phba->sli4_hba.sp_cqe_event_pool, list) {
7471                 list_del(&cq_event->list);
7472                 kfree(cq_event);
7473         }
7474 }
7475
7476 /**
7477  * __lpfc_sli4_cq_event_alloc - Allocate a completion-queue event from free pool
7478  * @phba: pointer to lpfc hba data structure.
7479  *
7480  * This routine is the lock free version of the API invoked to allocate a
7481  * completion-queue event from the free pool.
7482  *
7483  * Return: Pointer to the newly allocated completion-queue event if successful
7484  *         NULL otherwise.
7485  **/
7486 struct lpfc_cq_event *
7487 __lpfc_sli4_cq_event_alloc(struct lpfc_hba *phba)
7488 {
7489         struct lpfc_cq_event *cq_event = NULL;
7490
7491         list_remove_head(&phba->sli4_hba.sp_cqe_event_pool, cq_event,
7492                          struct lpfc_cq_event, list);
7493         return cq_event;
7494 }
7495
7496 /**
7497  * lpfc_sli4_cq_event_alloc - Allocate a completion-queue event from free pool
7498  * @phba: pointer to lpfc hba data structure.
7499  *
7500  * This routine is the lock version of the API invoked to allocate a
7501  * completion-queue event from the free pool.
7502  *
7503  * Return: Pointer to the newly allocated completion-queue event if successful
7504  *         NULL otherwise.
7505  **/
7506 struct lpfc_cq_event *
7507 lpfc_sli4_cq_event_alloc(struct lpfc_hba *phba)
7508 {
7509         struct lpfc_cq_event *cq_event;
7510         unsigned long iflags;
7511
7512         spin_lock_irqsave(&phba->hbalock, iflags);
7513         cq_event = __lpfc_sli4_cq_event_alloc(phba);
7514         spin_unlock_irqrestore(&phba->hbalock, iflags);
7515         return cq_event;
7516 }
7517
7518 /**
7519  * __lpfc_sli4_cq_event_release - Release a completion-queue event to free pool
7520  * @phba: pointer to lpfc hba data structure.
7521  * @cq_event: pointer to the completion queue event to be freed.
7522  *
7523  * This routine is the lock free version of the API invoked to release a
7524  * completion-queue event back into the free pool.
7525  **/
7526 void
7527 __lpfc_sli4_cq_event_release(struct lpfc_hba *phba,
7528                              struct lpfc_cq_event *cq_event)
7529 {
7530         list_add_tail(&cq_event->list, &phba->sli4_hba.sp_cqe_event_pool);
7531 }
7532
7533 /**
7534  * lpfc_sli4_cq_event_release - Release a completion-queue event to free pool
7535  * @phba: pointer to lpfc hba data structure.
7536  * @cq_event: pointer to the completion queue event to be freed.
7537  *
7538  * This routine is the lock version of the API invoked to release a
7539  * completion-queue event back into the free pool.
7540  **/
7541 void
7542 lpfc_sli4_cq_event_release(struct lpfc_hba *phba,
7543                            struct lpfc_cq_event *cq_event)
7544 {
7545         unsigned long iflags;
7546         spin_lock_irqsave(&phba->hbalock, iflags);
7547         __lpfc_sli4_cq_event_release(phba, cq_event);
7548         spin_unlock_irqrestore(&phba->hbalock, iflags);
7549 }
7550
7551 /**
7552  * lpfc_sli4_cq_event_release_all - Release all cq events to the free pool
7553  * @phba: pointer to lpfc hba data structure.
7554  *
7555  * This routine is to free all the pending completion-queue events to the
7556  * back into the free pool for device reset.
7557  **/
7558 static void
7559 lpfc_sli4_cq_event_release_all(struct lpfc_hba *phba)
7560 {
7561         LIST_HEAD(cqelist);
7562         struct lpfc_cq_event *cqe;
7563         unsigned long iflags;
7564
7565         /* Retrieve all the pending WCQEs from pending WCQE lists */
7566         spin_lock_irqsave(&phba->hbalock, iflags);
7567         /* Pending FCP XRI abort events */
7568         list_splice_init(&phba->sli4_hba.sp_fcp_xri_aborted_work_queue,
7569                          &cqelist);
7570         /* Pending ELS XRI abort events */
7571         list_splice_init(&phba->sli4_hba.sp_els_xri_aborted_work_queue,
7572                          &cqelist);
7573         /* Pending asynnc events */
7574         list_splice_init(&phba->sli4_hba.sp_asynce_work_queue,
7575                          &cqelist);
7576         spin_unlock_irqrestore(&phba->hbalock, iflags);
7577
7578         while (!list_empty(&cqelist)) {
7579                 list_remove_head(&cqelist, cqe, struct lpfc_cq_event, list);
7580                 lpfc_sli4_cq_event_release(phba, cqe);
7581         }
7582 }
7583
7584 /**
7585  * lpfc_pci_function_reset - Reset pci function.
7586  * @phba: pointer to lpfc hba data structure.
7587  *
7588  * This routine is invoked to request a PCI function reset. It will destroys
7589  * all resources assigned to the PCI function which originates this request.
7590  *
7591  * Return codes
7592  *      0 - successful
7593  *      -ENOMEM - No available memory
7594  *      -EIO - The mailbox failed to complete successfully.
7595  **/
7596 int
7597 lpfc_pci_function_reset(struct lpfc_hba *phba)
7598 {
7599         LPFC_MBOXQ_t *mboxq;
7600         uint32_t rc = 0, if_type;
7601         uint32_t shdr_status, shdr_add_status;
7602         uint32_t rdy_chk, num_resets = 0, reset_again = 0;
7603         union lpfc_sli4_cfg_shdr *shdr;
7604         struct lpfc_register reg_data;
7605         uint16_t devid;
7606
7607         if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
7608         switch (if_type) {
7609         case LPFC_SLI_INTF_IF_TYPE_0:
7610                 mboxq = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool,
7611                                                        GFP_KERNEL);
7612                 if (!mboxq) {
7613                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7614                                         "0494 Unable to allocate memory for "
7615                                         "issuing SLI_FUNCTION_RESET mailbox "
7616                                         "command\n");
7617                         return -ENOMEM;
7618                 }
7619
7620                 /* Setup PCI function reset mailbox-ioctl command */
7621                 lpfc_sli4_config(phba, mboxq, LPFC_MBOX_SUBSYSTEM_COMMON,
7622                                  LPFC_MBOX_OPCODE_FUNCTION_RESET, 0,
7623                                  LPFC_SLI4_MBX_EMBED);
7624                 rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
7625                 shdr = (union lpfc_sli4_cfg_shdr *)
7626                         &mboxq->u.mqe.un.sli4_config.header.cfg_shdr;
7627                 shdr_status = bf_get(lpfc_mbox_hdr_status, &shdr->response);
7628                 shdr_add_status = bf_get(lpfc_mbox_hdr_add_status,
7629                                          &shdr->response);
7630                 if (rc != MBX_TIMEOUT)
7631                         mempool_free(mboxq, phba->mbox_mem_pool);
7632                 if (shdr_status || shdr_add_status || rc) {
7633                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7634                                         "0495 SLI_FUNCTION_RESET mailbox "
7635                                         "failed with status x%x add_status x%x,"
7636                                         " mbx status x%x\n",
7637                                         shdr_status, shdr_add_status, rc);
7638                         rc = -ENXIO;
7639                 }
7640                 break;
7641         case LPFC_SLI_INTF_IF_TYPE_2:
7642                 for (num_resets = 0;
7643                      num_resets < MAX_IF_TYPE_2_RESETS;
7644                      num_resets++) {
7645                         reg_data.word0 = 0;
7646                         bf_set(lpfc_sliport_ctrl_end, &reg_data,
7647                                LPFC_SLIPORT_LITTLE_ENDIAN);
7648                         bf_set(lpfc_sliport_ctrl_ip, &reg_data,
7649                                LPFC_SLIPORT_INIT_PORT);
7650                         writel(reg_data.word0, phba->sli4_hba.u.if_type2.
7651                                CTRLregaddr);
7652                         /* flush */
7653                         pci_read_config_word(phba->pcidev,
7654                                              PCI_DEVICE_ID, &devid);
7655                         /*
7656                          * Poll the Port Status Register and wait for RDY for
7657                          * up to 10 seconds.  If the port doesn't respond, treat
7658                          * it as an error.  If the port responds with RN, start
7659                          * the loop again.
7660                          */
7661                         for (rdy_chk = 0; rdy_chk < 1000; rdy_chk++) {
7662                                 msleep(10);
7663                                 if (lpfc_readl(phba->sli4_hba.u.if_type2.
7664                                               STATUSregaddr, &reg_data.word0)) {
7665                                         rc = -ENODEV;
7666                                         goto out;
7667                                 }
7668                                 if (bf_get(lpfc_sliport_status_rn, &reg_data))
7669                                         reset_again++;
7670                                 if (bf_get(lpfc_sliport_status_rdy, &reg_data))
7671                                         break;
7672                         }
7673
7674                         /*
7675                          * If the port responds to the init request with
7676                          * reset needed, delay for a bit and restart the loop.
7677                          */
7678                         if (reset_again && (rdy_chk < 1000)) {
7679                                 msleep(10);
7680                                 reset_again = 0;
7681                                 continue;
7682                         }
7683
7684                         /* Detect any port errors. */
7685                         if ((bf_get(lpfc_sliport_status_err, &reg_data)) ||
7686                             (rdy_chk >= 1000)) {
7687                                 phba->work_status[0] = readl(
7688                                         phba->sli4_hba.u.if_type2.ERR1regaddr);
7689                                 phba->work_status[1] = readl(
7690                                         phba->sli4_hba.u.if_type2.ERR2regaddr);
7691                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7692                                         "2890 Port error detected during port "
7693                                         "reset(%d): wait_tmo:%d ms, "
7694                                         "port status reg 0x%x, "
7695                                         "error 1=0x%x, error 2=0x%x\n",
7696                                         num_resets, rdy_chk*10,
7697                                         reg_data.word0,
7698                                         phba->work_status[0],
7699                                         phba->work_status[1]);
7700                                 rc = -ENODEV;
7701                         }
7702
7703                         /*
7704                          * Terminate the outer loop provided the Port indicated
7705                          * ready within 10 seconds.
7706                          */
7707                         if (rdy_chk < 1000)
7708                                 break;
7709                 }
7710                 /* delay driver action following IF_TYPE_2 function reset */
7711                 msleep(100);
7712                 break;
7713         case LPFC_SLI_INTF_IF_TYPE_1:
7714         default:
7715                 break;
7716         }
7717
7718 out:
7719         /* Catch the not-ready port failure after a port reset. */
7720         if (num_resets >= MAX_IF_TYPE_2_RESETS)
7721                 rc = -ENODEV;
7722
7723         return rc;
7724 }
7725
7726 /**
7727  * lpfc_sli4_pci_mem_setup - Setup SLI4 HBA PCI memory space.
7728  * @phba: pointer to lpfc hba data structure.
7729  *
7730  * This routine is invoked to set up the PCI device memory space for device
7731  * with SLI-4 interface spec.
7732  *
7733  * Return codes
7734  *      0 - successful
7735  *      other values - error
7736  **/
7737 static int
7738 lpfc_sli4_pci_mem_setup(struct lpfc_hba *phba)
7739 {
7740         struct pci_dev *pdev;
7741         unsigned long bar0map_len, bar1map_len, bar2map_len;
7742         int error = -ENODEV;
7743         uint32_t if_type;
7744
7745         /* Obtain PCI device reference */
7746         if (!phba->pcidev)
7747                 return error;
7748         else
7749                 pdev = phba->pcidev;
7750
7751         /* Set the device DMA mask size */
7752         if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) != 0
7753          || pci_set_consistent_dma_mask(pdev,DMA_BIT_MASK(64)) != 0) {
7754                 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0
7755                  || pci_set_consistent_dma_mask(pdev,DMA_BIT_MASK(32)) != 0) {
7756                         return error;
7757                 }
7758         }
7759
7760         /*
7761          * The BARs and register set definitions and offset locations are
7762          * dependent on the if_type.
7763          */
7764         if (pci_read_config_dword(pdev, LPFC_SLI_INTF,
7765                                   &phba->sli4_hba.sli_intf.word0)) {
7766                 return error;
7767         }
7768
7769         /* There is no SLI3 failback for SLI4 devices. */
7770         if (bf_get(lpfc_sli_intf_valid, &phba->sli4_hba.sli_intf) !=
7771             LPFC_SLI_INTF_VALID) {
7772                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7773                                 "2894 SLI_INTF reg contents invalid "
7774                                 "sli_intf reg 0x%x\n",
7775                                 phba->sli4_hba.sli_intf.word0);
7776                 return error;
7777         }
7778
7779         if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
7780         /*
7781          * Get the bus address of SLI4 device Bar regions and the
7782          * number of bytes required by each mapping. The mapping of the
7783          * particular PCI BARs regions is dependent on the type of
7784          * SLI4 device.
7785          */
7786         if (pci_resource_start(pdev, 0)) {
7787                 phba->pci_bar0_map = pci_resource_start(pdev, 0);
7788                 bar0map_len = pci_resource_len(pdev, 0);
7789
7790                 /*
7791                  * Map SLI4 PCI Config Space Register base to a kernel virtual
7792                  * addr
7793                  */
7794                 phba->sli4_hba.conf_regs_memmap_p =
7795                         ioremap(phba->pci_bar0_map, bar0map_len);
7796                 if (!phba->sli4_hba.conf_regs_memmap_p) {
7797                         dev_printk(KERN_ERR, &pdev->dev,
7798                                    "ioremap failed for SLI4 PCI config "
7799                                    "registers.\n");
7800                         goto out;
7801                 }
7802                 /* Set up BAR0 PCI config space register memory map */
7803                 lpfc_sli4_bar0_register_memmap(phba, if_type);
7804         } else {
7805                 phba->pci_bar0_map = pci_resource_start(pdev, 1);
7806                 bar0map_len = pci_resource_len(pdev, 1);
7807                 if (if_type == LPFC_SLI_INTF_IF_TYPE_2) {
7808                         dev_printk(KERN_ERR, &pdev->dev,
7809                            "FATAL - No BAR0 mapping for SLI4, if_type 2\n");
7810                         goto out;
7811                 }
7812                 phba->sli4_hba.conf_regs_memmap_p =
7813                                 ioremap(phba->pci_bar0_map, bar0map_len);
7814                 if (!phba->sli4_hba.conf_regs_memmap_p) {
7815                         dev_printk(KERN_ERR, &pdev->dev,
7816                                 "ioremap failed for SLI4 PCI config "
7817                                 "registers.\n");
7818                                 goto out;
7819                 }
7820                 lpfc_sli4_bar0_register_memmap(phba, if_type);
7821         }
7822
7823         if ((if_type == LPFC_SLI_INTF_IF_TYPE_0) &&
7824             (pci_resource_start(pdev, 2))) {
7825                 /*
7826                  * Map SLI4 if type 0 HBA Control Register base to a kernel
7827                  * virtual address and setup the registers.
7828                  */
7829                 phba->pci_bar1_map = pci_resource_start(pdev, 2);
7830                 bar1map_len = pci_resource_len(pdev, 2);
7831                 phba->sli4_hba.ctrl_regs_memmap_p =
7832                                 ioremap(phba->pci_bar1_map, bar1map_len);
7833                 if (!phba->sli4_hba.ctrl_regs_memmap_p) {
7834                         dev_printk(KERN_ERR, &pdev->dev,
7835                            "ioremap failed for SLI4 HBA control registers.\n");
7836                         goto out_iounmap_conf;
7837                 }
7838                 lpfc_sli4_bar1_register_memmap(phba);
7839         }
7840
7841         if ((if_type == LPFC_SLI_INTF_IF_TYPE_0) &&
7842             (pci_resource_start(pdev, 4))) {
7843                 /*
7844                  * Map SLI4 if type 0 HBA Doorbell Register base to a kernel
7845                  * virtual address and setup the registers.
7846                  */
7847                 phba->pci_bar2_map = pci_resource_start(pdev, 4);
7848                 bar2map_len = pci_resource_len(pdev, 4);
7849                 phba->sli4_hba.drbl_regs_memmap_p =
7850                                 ioremap(phba->pci_bar2_map, bar2map_len);
7851                 if (!phba->sli4_hba.drbl_regs_memmap_p) {
7852                         dev_printk(KERN_ERR, &pdev->dev,
7853                            "ioremap failed for SLI4 HBA doorbell registers.\n");
7854                         goto out_iounmap_ctrl;
7855                 }
7856                 error = lpfc_sli4_bar2_register_memmap(phba, LPFC_VF0);
7857                 if (error)
7858                         goto out_iounmap_all;
7859         }
7860
7861         return 0;
7862
7863 out_iounmap_all:
7864         iounmap(phba->sli4_hba.drbl_regs_memmap_p);
7865 out_iounmap_ctrl:
7866         iounmap(phba->sli4_hba.ctrl_regs_memmap_p);
7867 out_iounmap_conf:
7868         iounmap(phba->sli4_hba.conf_regs_memmap_p);
7869 out:
7870         return error;
7871 }
7872
7873 /**
7874  * lpfc_sli4_pci_mem_unset - Unset SLI4 HBA PCI memory space.
7875  * @phba: pointer to lpfc hba data structure.
7876  *
7877  * This routine is invoked to unset the PCI device memory space for device
7878  * with SLI-4 interface spec.
7879  **/
7880 static void
7881 lpfc_sli4_pci_mem_unset(struct lpfc_hba *phba)
7882 {
7883         uint32_t if_type;
7884         if_type = bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf);
7885
7886         switch (if_type) {
7887         case LPFC_SLI_INTF_IF_TYPE_0:
7888                 iounmap(phba->sli4_hba.drbl_regs_memmap_p);
7889                 iounmap(phba->sli4_hba.ctrl_regs_memmap_p);
7890                 iounmap(phba->sli4_hba.conf_regs_memmap_p);
7891                 break;
7892         case LPFC_SLI_INTF_IF_TYPE_2:
7893                 iounmap(phba->sli4_hba.conf_regs_memmap_p);
7894                 break;
7895         case LPFC_SLI_INTF_IF_TYPE_1:
7896         default:
7897                 dev_printk(KERN_ERR, &phba->pcidev->dev,
7898                            "FATAL - unsupported SLI4 interface type - %d\n",
7899                            if_type);
7900                 break;
7901         }
7902 }
7903
7904 /**
7905  * lpfc_sli_enable_msix - Enable MSI-X interrupt mode on SLI-3 device
7906  * @phba: pointer to lpfc hba data structure.
7907  *
7908  * This routine is invoked to enable the MSI-X interrupt vectors to device
7909  * with SLI-3 interface specs. The kernel function pci_enable_msix() is
7910  * called to enable the MSI-X vectors. Note that pci_enable_msix(), once
7911  * invoked, enables either all or nothing, depending on the current
7912  * availability of PCI vector resources. The device driver is responsible
7913  * for calling the individual request_irq() to register each MSI-X vector
7914  * with a interrupt handler, which is done in this function. Note that
7915  * later when device is unloading, the driver should always call free_irq()
7916  * on all MSI-X vectors it has done request_irq() on before calling
7917  * pci_disable_msix(). Failure to do so results in a BUG_ON() and a device
7918  * will be left with MSI-X enabled and leaks its vectors.
7919  *
7920  * Return codes
7921  *   0 - successful
7922  *   other values - error
7923  **/
7924 static int
7925 lpfc_sli_enable_msix(struct lpfc_hba *phba)
7926 {
7927         int rc, i;
7928         LPFC_MBOXQ_t *pmb;
7929
7930         /* Set up MSI-X multi-message vectors */
7931         for (i = 0; i < LPFC_MSIX_VECTORS; i++)
7932                 phba->msix_entries[i].entry = i;
7933
7934         /* Configure MSI-X capability structure */
7935         rc = pci_enable_msix(phba->pcidev, phba->msix_entries,
7936                                 ARRAY_SIZE(phba->msix_entries));
7937         if (rc) {
7938                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7939                                 "0420 PCI enable MSI-X failed (%d)\n", rc);
7940                 goto msi_fail_out;
7941         }
7942         for (i = 0; i < LPFC_MSIX_VECTORS; i++)
7943                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
7944                                 "0477 MSI-X entry[%d]: vector=x%x "
7945                                 "message=%d\n", i,
7946                                 phba->msix_entries[i].vector,
7947                                 phba->msix_entries[i].entry);
7948         /*
7949          * Assign MSI-X vectors to interrupt handlers
7950          */
7951
7952         /* vector-0 is associated to slow-path handler */
7953         rc = request_irq(phba->msix_entries[0].vector,
7954                          &lpfc_sli_sp_intr_handler, IRQF_SHARED,
7955                          LPFC_SP_DRIVER_HANDLER_NAME, phba);
7956         if (rc) {
7957                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
7958                                 "0421 MSI-X slow-path request_irq failed "
7959                                 "(%d)\n", rc);
7960                 goto msi_fail_out;
7961         }
7962
7963         /* vector-1 is associated to fast-path handler */
7964         rc = request_irq(phba->msix_entries[1].vector,
7965                          &lpfc_sli_fp_intr_handler, IRQF_SHARED,
7966                          LPFC_FP_DRIVER_HANDLER_NAME, phba);
7967
7968         if (rc) {
7969                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
7970                                 "0429 MSI-X fast-path request_irq failed "
7971                                 "(%d)\n", rc);
7972                 goto irq_fail_out;
7973         }
7974
7975         /*
7976          * Configure HBA MSI-X attention conditions to messages
7977          */
7978         pmb = (LPFC_MBOXQ_t *) mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
7979
7980         if (!pmb) {
7981                 rc = -ENOMEM;
7982                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
7983                                 "0474 Unable to allocate memory for issuing "
7984                                 "MBOX_CONFIG_MSI command\n");
7985                 goto mem_fail_out;
7986         }
7987         rc = lpfc_config_msi(phba, pmb);
7988         if (rc)
7989                 goto mbx_fail_out;
7990         rc = lpfc_sli_issue_mbox(phba, pmb, MBX_POLL);
7991         if (rc != MBX_SUCCESS) {
7992                 lpfc_printf_log(phba, KERN_WARNING, LOG_MBOX,
7993                                 "0351 Config MSI mailbox command failed, "
7994                                 "mbxCmd x%x, mbxStatus x%x\n",
7995                                 pmb->u.mb.mbxCommand, pmb->u.mb.mbxStatus);
7996                 goto mbx_fail_out;
7997         }
7998
7999         /* Free memory allocated for mailbox command */
8000         mempool_free(pmb, phba->mbox_mem_pool);
8001         return rc;
8002
8003 mbx_fail_out:
8004         /* Free memory allocated for mailbox command */
8005         mempool_free(pmb, phba->mbox_mem_pool);
8006
8007 mem_fail_out:
8008         /* free the irq already requested */
8009         free_irq(phba->msix_entries[1].vector, phba);
8010
8011 irq_fail_out:
8012         /* free the irq already requested */
8013         free_irq(phba->msix_entries[0].vector, phba);
8014
8015 msi_fail_out:
8016         /* Unconfigure MSI-X capability structure */
8017         pci_disable_msix(phba->pcidev);
8018         return rc;
8019 }
8020
8021 /**
8022  * lpfc_sli_disable_msix - Disable MSI-X interrupt mode on SLI-3 device.
8023  * @phba: pointer to lpfc hba data structure.
8024  *
8025  * This routine is invoked to release the MSI-X vectors and then disable the
8026  * MSI-X interrupt mode to device with SLI-3 interface spec.
8027  **/
8028 static void
8029 lpfc_sli_disable_msix(struct lpfc_hba *phba)
8030 {
8031         int i;
8032
8033         /* Free up MSI-X multi-message vectors */
8034         for (i = 0; i < LPFC_MSIX_VECTORS; i++)
8035                 free_irq(phba->msix_entries[i].vector, phba);
8036         /* Disable MSI-X */
8037         pci_disable_msix(phba->pcidev);
8038
8039         return;
8040 }
8041
8042 /**
8043  * lpfc_sli_enable_msi - Enable MSI interrupt mode on SLI-3 device.
8044  * @phba: pointer to lpfc hba data structure.
8045  *
8046  * This routine is invoked to enable the MSI interrupt mode to device with
8047  * SLI-3 interface spec. The kernel function pci_enable_msi() is called to
8048  * enable the MSI vector. The device driver is responsible for calling the
8049  * request_irq() to register MSI vector with a interrupt the handler, which
8050  * is done in this function.
8051  *
8052  * Return codes
8053  *      0 - successful
8054  *      other values - error
8055  */
8056 static int
8057 lpfc_sli_enable_msi(struct lpfc_hba *phba)
8058 {
8059         int rc;
8060
8061         rc = pci_enable_msi(phba->pcidev);
8062         if (!rc)
8063                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8064                                 "0462 PCI enable MSI mode success.\n");
8065         else {
8066                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8067                                 "0471 PCI enable MSI mode failed (%d)\n", rc);
8068                 return rc;
8069         }
8070
8071         rc = request_irq(phba->pcidev->irq, lpfc_sli_intr_handler,
8072                          IRQF_SHARED, LPFC_DRIVER_NAME, phba);
8073         if (rc) {
8074                 pci_disable_msi(phba->pcidev);
8075                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
8076                                 "0478 MSI request_irq failed (%d)\n", rc);
8077         }
8078         return rc;
8079 }
8080
8081 /**
8082  * lpfc_sli_disable_msi - Disable MSI interrupt mode to SLI-3 device.
8083  * @phba: pointer to lpfc hba data structure.
8084  *
8085  * This routine is invoked to disable the MSI interrupt mode to device with
8086  * SLI-3 interface spec. The driver calls free_irq() on MSI vector it has
8087  * done request_irq() on before calling pci_disable_msi(). Failure to do so
8088  * results in a BUG_ON() and a device will be left with MSI enabled and leaks
8089  * its vector.
8090  */
8091 static void
8092 lpfc_sli_disable_msi(struct lpfc_hba *phba)
8093 {
8094         free_irq(phba->pcidev->irq, phba);
8095         pci_disable_msi(phba->pcidev);
8096         return;
8097 }
8098
8099 /**
8100  * lpfc_sli_enable_intr - Enable device interrupt to SLI-3 device.
8101  * @phba: pointer to lpfc hba data structure.
8102  *
8103  * This routine is invoked to enable device interrupt and associate driver's
8104  * interrupt handler(s) to interrupt vector(s) to device with SLI-3 interface
8105  * spec. Depends on the interrupt mode configured to the driver, the driver
8106  * will try to fallback from the configured interrupt mode to an interrupt
8107  * mode which is supported by the platform, kernel, and device in the order
8108  * of:
8109  * MSI-X -> MSI -> IRQ.
8110  *
8111  * Return codes
8112  *   0 - successful
8113  *   other values - error
8114  **/
8115 static uint32_t
8116 lpfc_sli_enable_intr(struct lpfc_hba *phba, uint32_t cfg_mode)
8117 {
8118         uint32_t intr_mode = LPFC_INTR_ERROR;
8119         int retval;
8120
8121         if (cfg_mode == 2) {
8122                 /* Need to issue conf_port mbox cmd before conf_msi mbox cmd */
8123                 retval = lpfc_sli_config_port(phba, LPFC_SLI_REV3);
8124                 if (!retval) {
8125                         /* Now, try to enable MSI-X interrupt mode */
8126                         retval = lpfc_sli_enable_msix(phba);
8127                         if (!retval) {
8128                                 /* Indicate initialization to MSI-X mode */
8129                                 phba->intr_type = MSIX;
8130                                 intr_mode = 2;
8131                         }
8132                 }
8133         }
8134
8135         /* Fallback to MSI if MSI-X initialization failed */
8136         if (cfg_mode >= 1 && phba->intr_type == NONE) {
8137                 retval = lpfc_sli_enable_msi(phba);
8138                 if (!retval) {
8139                         /* Indicate initialization to MSI mode */
8140                         phba->intr_type = MSI;
8141                         intr_mode = 1;
8142                 }
8143         }
8144
8145         /* Fallback to INTx if both MSI-X/MSI initalization failed */
8146         if (phba->intr_type == NONE) {
8147                 retval = request_irq(phba->pcidev->irq, lpfc_sli_intr_handler,
8148                                      IRQF_SHARED, LPFC_DRIVER_NAME, phba);
8149                 if (!retval) {
8150                         /* Indicate initialization to INTx mode */
8151                         phba->intr_type = INTx;
8152                         intr_mode = 0;
8153                 }
8154         }
8155         return intr_mode;
8156 }
8157
8158 /**
8159  * lpfc_sli_disable_intr - Disable device interrupt to SLI-3 device.
8160  * @phba: pointer to lpfc hba data structure.
8161  *
8162  * This routine is invoked to disable device interrupt and disassociate the
8163  * driver's interrupt handler(s) from interrupt vector(s) to device with
8164  * SLI-3 interface spec. Depending on the interrupt mode, the driver will
8165  * release the interrupt vector(s) for the message signaled interrupt.
8166  **/
8167 static void
8168 lpfc_sli_disable_intr(struct lpfc_hba *phba)
8169 {
8170         /* Disable the currently initialized interrupt mode */
8171         if (phba->intr_type == MSIX)
8172                 lpfc_sli_disable_msix(phba);
8173         else if (phba->intr_type == MSI)
8174                 lpfc_sli_disable_msi(phba);
8175         else if (phba->intr_type == INTx)
8176                 free_irq(phba->pcidev->irq, phba);
8177
8178         /* Reset interrupt management states */
8179         phba->intr_type = NONE;
8180         phba->sli.slistat.sli_intr = 0;
8181
8182         return;
8183 }
8184
8185 /**
8186  * lpfc_sli4_enable_msix - Enable MSI-X interrupt mode to SLI-4 device
8187  * @phba: pointer to lpfc hba data structure.
8188  *
8189  * This routine is invoked to enable the MSI-X interrupt vectors to device
8190  * with SLI-4 interface spec. The kernel function pci_enable_msix() is called
8191  * to enable the MSI-X vectors. Note that pci_enable_msix(), once invoked,
8192  * enables either all or nothing, depending on the current availability of
8193  * PCI vector resources. The device driver is responsible for calling the
8194  * individual request_irq() to register each MSI-X vector with a interrupt
8195  * handler, which is done in this function. Note that later when device is
8196  * unloading, the driver should always call free_irq() on all MSI-X vectors
8197  * it has done request_irq() on before calling pci_disable_msix(). Failure
8198  * to do so results in a BUG_ON() and a device will be left with MSI-X
8199  * enabled and leaks its vectors.
8200  *
8201  * Return codes
8202  * 0 - successful
8203  * other values - error
8204  **/
8205 static int
8206 lpfc_sli4_enable_msix(struct lpfc_hba *phba)
8207 {
8208         int vectors, rc, index;
8209
8210         /* Set up MSI-X multi-message vectors */
8211         for (index = 0; index < phba->cfg_fcp_io_channel; index++)
8212                 phba->sli4_hba.msix_entries[index].entry = index;
8213
8214         /* Configure MSI-X capability structure */
8215         vectors = phba->cfg_fcp_io_channel;
8216 enable_msix_vectors:
8217         rc = pci_enable_msix(phba->pcidev, phba->sli4_hba.msix_entries,
8218                              vectors);
8219         if (rc > 1) {
8220                 vectors = rc;
8221                 goto enable_msix_vectors;
8222         } else if (rc) {
8223                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8224                                 "0484 PCI enable MSI-X failed (%d)\n", rc);
8225                 goto msi_fail_out;
8226         }
8227
8228         /* Log MSI-X vector assignment */
8229         for (index = 0; index < vectors; index++)
8230                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8231                                 "0489 MSI-X entry[%d]: vector=x%x "
8232                                 "message=%d\n", index,
8233                                 phba->sli4_hba.msix_entries[index].vector,
8234                                 phba->sli4_hba.msix_entries[index].entry);
8235
8236         /*
8237          * Assign MSI-X vectors to interrupt handlers
8238          */
8239         for (index = 0; index < vectors; index++) {
8240                 memset(&phba->sli4_hba.handler_name[index], 0, 16);
8241                 sprintf((char *)&phba->sli4_hba.handler_name[index],
8242                          LPFC_DRIVER_HANDLER_NAME"%d", index);
8243
8244                 phba->sli4_hba.fcp_eq_hdl[index].idx = index;
8245                 phba->sli4_hba.fcp_eq_hdl[index].phba = phba;
8246                 atomic_set(&phba->sli4_hba.fcp_eq_hdl[index].fcp_eq_in_use, 1);
8247                 rc = request_irq(phba->sli4_hba.msix_entries[index].vector,
8248                                  &lpfc_sli4_hba_intr_handler, IRQF_SHARED,
8249                                  (char *)&phba->sli4_hba.handler_name[index],
8250                                  &phba->sli4_hba.fcp_eq_hdl[index]);
8251                 if (rc) {
8252                         lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
8253                                         "0486 MSI-X fast-path (%d) "
8254                                         "request_irq failed (%d)\n", index, rc);
8255                         goto cfg_fail_out;
8256                 }
8257         }
8258
8259         if (vectors != phba->cfg_fcp_io_channel) {
8260                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8261                                 "3238 Reducing IO channels to match number of "
8262                                 "MSI-X vectors, requested %d got %d\n",
8263                                 phba->cfg_fcp_io_channel, vectors);
8264                 phba->cfg_fcp_io_channel = vectors;
8265         }
8266         return rc;
8267
8268 cfg_fail_out:
8269         /* free the irq already requested */
8270         for (--index; index >= 0; index--)
8271                 free_irq(phba->sli4_hba.msix_entries[index].vector,
8272                          &phba->sli4_hba.fcp_eq_hdl[index]);
8273
8274 msi_fail_out:
8275         /* Unconfigure MSI-X capability structure */
8276         pci_disable_msix(phba->pcidev);
8277         return rc;
8278 }
8279
8280 /**
8281  * lpfc_sli4_disable_msix - Disable MSI-X interrupt mode to SLI-4 device
8282  * @phba: pointer to lpfc hba data structure.
8283  *
8284  * This routine is invoked to release the MSI-X vectors and then disable the
8285  * MSI-X interrupt mode to device with SLI-4 interface spec.
8286  **/
8287 static void
8288 lpfc_sli4_disable_msix(struct lpfc_hba *phba)
8289 {
8290         int index;
8291
8292         /* Free up MSI-X multi-message vectors */
8293         for (index = 0; index < phba->cfg_fcp_io_channel; index++)
8294                 free_irq(phba->sli4_hba.msix_entries[index].vector,
8295                          &phba->sli4_hba.fcp_eq_hdl[index]);
8296
8297         /* Disable MSI-X */
8298         pci_disable_msix(phba->pcidev);
8299
8300         return;
8301 }
8302
8303 /**
8304  * lpfc_sli4_enable_msi - Enable MSI interrupt mode to SLI-4 device
8305  * @phba: pointer to lpfc hba data structure.
8306  *
8307  * This routine is invoked to enable the MSI interrupt mode to device with
8308  * SLI-4 interface spec. The kernel function pci_enable_msi() is called
8309  * to enable the MSI vector. The device driver is responsible for calling
8310  * the request_irq() to register MSI vector with a interrupt the handler,
8311  * which is done in this function.
8312  *
8313  * Return codes
8314  *      0 - successful
8315  *      other values - error
8316  **/
8317 static int
8318 lpfc_sli4_enable_msi(struct lpfc_hba *phba)
8319 {
8320         int rc, index;
8321
8322         rc = pci_enable_msi(phba->pcidev);
8323         if (!rc)
8324                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8325                                 "0487 PCI enable MSI mode success.\n");
8326         else {
8327                 lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8328                                 "0488 PCI enable MSI mode failed (%d)\n", rc);
8329                 return rc;
8330         }
8331
8332         rc = request_irq(phba->pcidev->irq, lpfc_sli4_intr_handler,
8333                          IRQF_SHARED, LPFC_DRIVER_NAME, phba);
8334         if (rc) {
8335                 pci_disable_msi(phba->pcidev);
8336                 lpfc_printf_log(phba, KERN_WARNING, LOG_INIT,
8337                                 "0490 MSI request_irq failed (%d)\n", rc);
8338                 return rc;
8339         }
8340
8341         for (index = 0; index < phba->cfg_fcp_io_channel; index++) {
8342                 phba->sli4_hba.fcp_eq_hdl[index].idx = index;
8343                 phba->sli4_hba.fcp_eq_hdl[index].phba = phba;
8344         }
8345
8346         return 0;
8347 }
8348
8349 /**
8350  * lpfc_sli4_disable_msi - Disable MSI interrupt mode to SLI-4 device
8351  * @phba: pointer to lpfc hba data structure.
8352  *
8353  * This routine is invoked to disable the MSI interrupt mode to device with
8354  * SLI-4 interface spec. The driver calls free_irq() on MSI vector it has
8355  * done request_irq() on before calling pci_disable_msi(). Failure to do so
8356  * results in a BUG_ON() and a device will be left with MSI enabled and leaks
8357  * its vector.
8358  **/
8359 static void
8360 lpfc_sli4_disable_msi(struct lpfc_hba *phba)
8361 {
8362         free_irq(phba->pcidev->irq, phba);
8363         pci_disable_msi(phba->pcidev);
8364         return;
8365 }
8366
8367 /**
8368  * lpfc_sli4_enable_intr - Enable device interrupt to SLI-4 device
8369  * @phba: pointer to lpfc hba data structure.
8370  *
8371  * This routine is invoked to enable device interrupt and associate driver's
8372  * interrupt handler(s) to interrupt vector(s) to device with SLI-4
8373  * interface spec. Depends on the interrupt mode configured to the driver,
8374  * the driver will try to fallback from the configured interrupt mode to an
8375  * interrupt mode which is supported by the platform, kernel, and device in
8376  * the order of:
8377  * MSI-X -> MSI -> IRQ.
8378  *
8379  * Return codes
8380  *      0 - successful
8381  *      other values - error
8382  **/
8383 static uint32_t
8384 lpfc_sli4_enable_intr(struct lpfc_hba *phba, uint32_t cfg_mode)
8385 {
8386         uint32_t intr_mode = LPFC_INTR_ERROR;
8387         int retval, index;
8388
8389         if (cfg_mode == 2) {
8390                 /* Preparation before conf_msi mbox cmd */
8391                 retval = 0;
8392                 if (!retval) {
8393                         /* Now, try to enable MSI-X interrupt mode */
8394                         retval = lpfc_sli4_enable_msix(phba);
8395                         if (!retval) {
8396                                 /* Indicate initialization to MSI-X mode */
8397                                 phba->intr_type = MSIX;
8398                                 intr_mode = 2;
8399                         }
8400                 }
8401         }
8402
8403         /* Fallback to MSI if MSI-X initialization failed */
8404         if (cfg_mode >= 1 && phba->intr_type == NONE) {
8405                 retval = lpfc_sli4_enable_msi(phba);
8406                 if (!retval) {
8407                         /* Indicate initialization to MSI mode */
8408                         phba->intr_type = MSI;
8409                         intr_mode = 1;
8410                 }
8411         }
8412
8413         /* Fallback to INTx if both MSI-X/MSI initalization failed */
8414         if (phba->intr_type == NONE) {
8415                 retval = request_irq(phba->pcidev->irq, lpfc_sli4_intr_handler,
8416                                      IRQF_SHARED, LPFC_DRIVER_NAME, phba);
8417                 if (!retval) {
8418                         /* Indicate initialization to INTx mode */
8419                         phba->intr_type = INTx;
8420                         intr_mode = 0;
8421                         for (index = 0; index < phba->cfg_fcp_io_channel;
8422                              index++) {
8423                                 phba->sli4_hba.fcp_eq_hdl[index].idx = index;
8424                                 phba->sli4_hba.fcp_eq_hdl[index].phba = phba;
8425                                 atomic_set(&phba->sli4_hba.fcp_eq_hdl[index].
8426                                         fcp_eq_in_use, 1);
8427                         }
8428                 }
8429         }
8430         return intr_mode;
8431 }
8432
8433 /**
8434  * lpfc_sli4_disable_intr - Disable device interrupt to SLI-4 device
8435  * @phba: pointer to lpfc hba data structure.
8436  *
8437  * This routine is invoked to disable device interrupt and disassociate
8438  * the driver's interrupt handler(s) from interrupt vector(s) to device
8439  * with SLI-4 interface spec. Depending on the interrupt mode, the driver
8440  * will release the interrupt vector(s) for the message signaled interrupt.
8441  **/
8442 static void
8443 lpfc_sli4_disable_intr(struct lpfc_hba *phba)
8444 {
8445         /* Disable the currently initialized interrupt mode */
8446         if (phba->intr_type == MSIX)
8447                 lpfc_sli4_disable_msix(phba);
8448         else if (phba->intr_type == MSI)
8449                 lpfc_sli4_disable_msi(phba);
8450         else if (phba->intr_type == INTx)
8451                 free_irq(phba->pcidev->irq, phba);
8452
8453         /* Reset interrupt management states */
8454         phba->intr_type = NONE;
8455         phba->sli.slistat.sli_intr = 0;
8456
8457         return;
8458 }
8459
8460 /**
8461  * lpfc_unset_hba - Unset SLI3 hba device initialization
8462  * @phba: pointer to lpfc hba data structure.
8463  *
8464  * This routine is invoked to unset the HBA device initialization steps to
8465  * a device with SLI-3 interface spec.
8466  **/
8467 static void
8468 lpfc_unset_hba(struct lpfc_hba *phba)
8469 {
8470         struct lpfc_vport *vport = phba->pport;
8471         struct Scsi_Host  *shost = lpfc_shost_from_vport(vport);
8472
8473         spin_lock_irq(shost->host_lock);
8474         vport->load_flag |= FC_UNLOADING;
8475         spin_unlock_irq(shost->host_lock);
8476
8477         kfree(phba->vpi_bmask);
8478         kfree(phba->vpi_ids);
8479
8480         lpfc_stop_hba_timers(phba);
8481
8482         phba->pport->work_port_events = 0;
8483
8484         lpfc_sli_hba_down(phba);
8485
8486         lpfc_sli_brdrestart(phba);
8487
8488         lpfc_sli_disable_intr(phba);
8489
8490         return;
8491 }
8492
8493 /**
8494  * lpfc_sli4_xri_exchange_busy_wait - Wait for device XRI exchange busy
8495  * @phba: Pointer to HBA context object.
8496  *
8497  * This function is called in the SLI4 code path to wait for completion
8498  * of device's XRIs exchange busy. It will check the XRI exchange busy
8499  * on outstanding FCP and ELS I/Os every 10ms for up to 10 seconds; after
8500  * that, it will check the XRI exchange busy on outstanding FCP and ELS
8501  * I/Os every 30 seconds, log error message, and wait forever. Only when
8502  * all XRI exchange busy complete, the driver unload shall proceed with
8503  * invoking the function reset ioctl mailbox command to the CNA and the
8504  * the rest of the driver unload resource release.
8505  **/
8506 static void
8507 lpfc_sli4_xri_exchange_busy_wait(struct lpfc_hba *phba)
8508 {
8509         int wait_time = 0;
8510         int fcp_xri_cmpl = list_empty(&phba->sli4_hba.lpfc_abts_scsi_buf_list);
8511         int els_xri_cmpl = list_empty(&phba->sli4_hba.lpfc_abts_els_sgl_list);
8512
8513         while (!fcp_xri_cmpl || !els_xri_cmpl) {
8514                 if (wait_time > LPFC_XRI_EXCH_BUSY_WAIT_TMO) {
8515                         if (!fcp_xri_cmpl)
8516                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8517                                                 "2877 FCP XRI exchange busy "
8518                                                 "wait time: %d seconds.\n",
8519                                                 wait_time/1000);
8520                         if (!els_xri_cmpl)
8521                                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8522                                                 "2878 ELS XRI exchange busy "
8523                                                 "wait time: %d seconds.\n",
8524                                                 wait_time/1000);
8525                         msleep(LPFC_XRI_EXCH_BUSY_WAIT_T2);
8526                         wait_time += LPFC_XRI_EXCH_BUSY_WAIT_T2;
8527                 } else {
8528                         msleep(LPFC_XRI_EXCH_BUSY_WAIT_T1);
8529                         wait_time += LPFC_XRI_EXCH_BUSY_WAIT_T1;
8530                 }
8531                 fcp_xri_cmpl =
8532                         list_empty(&phba->sli4_hba.lpfc_abts_scsi_buf_list);
8533                 els_xri_cmpl =
8534                         list_empty(&phba->sli4_hba.lpfc_abts_els_sgl_list);
8535         }
8536 }
8537
8538 /**
8539  * lpfc_sli4_hba_unset - Unset the fcoe hba
8540  * @phba: Pointer to HBA context object.
8541  *
8542  * This function is called in the SLI4 code path to reset the HBA's FCoE
8543  * function. The caller is not required to hold any lock. This routine
8544  * issues PCI function reset mailbox command to reset the FCoE function.
8545  * At the end of the function, it calls lpfc_hba_down_post function to
8546  * free any pending commands.
8547  **/
8548 static void
8549 lpfc_sli4_hba_unset(struct lpfc_hba *phba)
8550 {
8551         int wait_cnt = 0;
8552         LPFC_MBOXQ_t *mboxq;
8553         struct pci_dev *pdev = phba->pcidev;
8554
8555         lpfc_stop_hba_timers(phba);
8556         phba->sli4_hba.intr_enable = 0;
8557
8558         /*
8559          * Gracefully wait out the potential current outstanding asynchronous
8560          * mailbox command.
8561          */
8562
8563         /* First, block any pending async mailbox command from posted */
8564         spin_lock_irq(&phba->hbalock);
8565         phba->sli.sli_flag |= LPFC_SLI_ASYNC_MBX_BLK;
8566         spin_unlock_irq(&phba->hbalock);
8567         /* Now, trying to wait it out if we can */
8568         while (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE) {
8569                 msleep(10);
8570                 if (++wait_cnt > LPFC_ACTIVE_MBOX_WAIT_CNT)
8571                         break;
8572         }
8573         /* Forcefully release the outstanding mailbox command if timed out */
8574         if (phba->sli.sli_flag & LPFC_SLI_MBOX_ACTIVE) {
8575                 spin_lock_irq(&phba->hbalock);
8576                 mboxq = phba->sli.mbox_active;
8577                 mboxq->u.mb.mbxStatus = MBX_NOT_FINISHED;
8578                 __lpfc_mbox_cmpl_put(phba, mboxq);
8579                 phba->sli.sli_flag &= ~LPFC_SLI_MBOX_ACTIVE;
8580                 phba->sli.mbox_active = NULL;
8581                 spin_unlock_irq(&phba->hbalock);
8582         }
8583
8584         /* Abort all iocbs associated with the hba */
8585         lpfc_sli_hba_iocb_abort(phba);
8586
8587         /* Wait for completion of device XRI exchange busy */
8588         lpfc_sli4_xri_exchange_busy_wait(phba);
8589
8590         /* Disable PCI subsystem interrupt */
8591         lpfc_sli4_disable_intr(phba);
8592
8593         /* Disable SR-IOV if enabled */
8594         if (phba->cfg_sriov_nr_virtfn)
8595                 pci_disable_sriov(pdev);
8596
8597         /* Stop kthread signal shall trigger work_done one more time */
8598         kthread_stop(phba->worker_thread);
8599
8600         /* Reset SLI4 HBA FCoE function */
8601         lpfc_pci_function_reset(phba);
8602         lpfc_sli4_queue_destroy(phba);
8603
8604         /* Stop the SLI4 device port */
8605         phba->pport->work_port_events = 0;
8606 }
8607
8608  /**
8609  * lpfc_pc_sli4_params_get - Get the SLI4_PARAMS port capabilities.
8610  * @phba: Pointer to HBA context object.
8611  * @mboxq: Pointer to the mailboxq memory for the mailbox command response.
8612  *
8613  * This function is called in the SLI4 code path to read the port's
8614  * sli4 capabilities.
8615  *
8616  * This function may be be called from any context that can block-wait
8617  * for the completion.  The expectation is that this routine is called
8618  * typically from probe_one or from the online routine.
8619  **/
8620 int
8621 lpfc_pc_sli4_params_get(struct lpfc_hba *phba, LPFC_MBOXQ_t *mboxq)
8622 {
8623         int rc;
8624         struct lpfc_mqe *mqe;
8625         struct lpfc_pc_sli4_params *sli4_params;
8626         uint32_t mbox_tmo;
8627
8628         rc = 0;
8629         mqe = &mboxq->u.mqe;
8630
8631         /* Read the port's SLI4 Parameters port capabilities */
8632         lpfc_pc_sli4_params(mboxq);
8633         if (!phba->sli4_hba.intr_enable)
8634                 rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
8635         else {
8636                 mbox_tmo = lpfc_mbox_tmo_val(phba, mboxq);
8637                 rc = lpfc_sli_issue_mbox_wait(phba, mboxq, mbox_tmo);
8638         }
8639
8640         if (unlikely(rc))
8641                 return 1;
8642
8643         sli4_params = &phba->sli4_hba.pc_sli4_params;
8644         sli4_params->if_type = bf_get(if_type, &mqe->un.sli4_params);
8645         sli4_params->sli_rev = bf_get(sli_rev, &mqe->un.sli4_params);
8646         sli4_params->sli_family = bf_get(sli_family, &mqe->un.sli4_params);
8647         sli4_params->featurelevel_1 = bf_get(featurelevel_1,
8648                                              &mqe->un.sli4_params);
8649         sli4_params->featurelevel_2 = bf_get(featurelevel_2,
8650                                              &mqe->un.sli4_params);
8651         sli4_params->proto_types = mqe->un.sli4_params.word3;
8652         sli4_params->sge_supp_len = mqe->un.sli4_params.sge_supp_len;
8653         sli4_params->if_page_sz = bf_get(if_page_sz, &mqe->un.sli4_params);
8654         sli4_params->rq_db_window = bf_get(rq_db_window, &mqe->un.sli4_params);
8655         sli4_params->loopbk_scope = bf_get(loopbk_scope, &mqe->un.sli4_params);
8656         sli4_params->eq_pages_max = bf_get(eq_pages, &mqe->un.sli4_params);
8657         sli4_params->eqe_size = bf_get(eqe_size, &mqe->un.sli4_params);
8658         sli4_params->cq_pages_max = bf_get(cq_pages, &mqe->un.sli4_params);
8659         sli4_params->cqe_size = bf_get(cqe_size, &mqe->un.sli4_params);
8660         sli4_params->mq_pages_max = bf_get(mq_pages, &mqe->un.sli4_params);
8661         sli4_params->mqe_size = bf_get(mqe_size, &mqe->un.sli4_params);
8662         sli4_params->mq_elem_cnt = bf_get(mq_elem_cnt, &mqe->un.sli4_params);
8663         sli4_params->wq_pages_max = bf_get(wq_pages, &mqe->un.sli4_params);
8664         sli4_params->wqe_size = bf_get(wqe_size, &mqe->un.sli4_params);
8665         sli4_params->rq_pages_max = bf_get(rq_pages, &mqe->un.sli4_params);
8666         sli4_params->rqe_size = bf_get(rqe_size, &mqe->un.sli4_params);
8667         sli4_params->hdr_pages_max = bf_get(hdr_pages, &mqe->un.sli4_params);
8668         sli4_params->hdr_size = bf_get(hdr_size, &mqe->un.sli4_params);
8669         sli4_params->hdr_pp_align = bf_get(hdr_pp_align, &mqe->un.sli4_params);
8670         sli4_params->sgl_pages_max = bf_get(sgl_pages, &mqe->un.sli4_params);
8671         sli4_params->sgl_pp_align = bf_get(sgl_pp_align, &mqe->un.sli4_params);
8672
8673         /* Make sure that sge_supp_len can be handled by the driver */
8674         if (sli4_params->sge_supp_len > LPFC_MAX_SGE_SIZE)
8675                 sli4_params->sge_supp_len = LPFC_MAX_SGE_SIZE;
8676
8677         return rc;
8678 }
8679
8680 /**
8681  * lpfc_get_sli4_parameters - Get the SLI4 Config PARAMETERS.
8682  * @phba: Pointer to HBA context object.
8683  * @mboxq: Pointer to the mailboxq memory for the mailbox command response.
8684  *
8685  * This function is called in the SLI4 code path to read the port's
8686  * sli4 capabilities.
8687  *
8688  * This function may be be called from any context that can block-wait
8689  * for the completion.  The expectation is that this routine is called
8690  * typically from probe_one or from the online routine.
8691  **/
8692 int
8693 lpfc_get_sli4_parameters(struct lpfc_hba *phba, LPFC_MBOXQ_t *mboxq)
8694 {
8695         int rc;
8696         struct lpfc_mqe *mqe = &mboxq->u.mqe;
8697         struct lpfc_pc_sli4_params *sli4_params;
8698         uint32_t mbox_tmo;
8699         int length;
8700         struct lpfc_sli4_parameters *mbx_sli4_parameters;
8701
8702         /*
8703          * By default, the driver assumes the SLI4 port requires RPI
8704          * header postings.  The SLI4_PARAM response will correct this
8705          * assumption.
8706          */
8707         phba->sli4_hba.rpi_hdrs_in_use = 1;
8708
8709         /* Read the port's SLI4 Config Parameters */
8710         length = (sizeof(struct lpfc_mbx_get_sli4_parameters) -
8711                   sizeof(struct lpfc_sli4_cfg_mhdr));
8712         lpfc_sli4_config(phba, mboxq, LPFC_MBOX_SUBSYSTEM_COMMON,
8713                          LPFC_MBOX_OPCODE_GET_SLI4_PARAMETERS,
8714                          length, LPFC_SLI4_MBX_EMBED);
8715         if (!phba->sli4_hba.intr_enable)
8716                 rc = lpfc_sli_issue_mbox(phba, mboxq, MBX_POLL);
8717         else {
8718                 mbox_tmo = lpfc_mbox_tmo_val(phba, mboxq);
8719                 rc = lpfc_sli_issue_mbox_wait(phba, mboxq, mbox_tmo);
8720         }
8721         if (unlikely(rc))
8722                 return rc;
8723         sli4_params = &phba->sli4_hba.pc_sli4_params;
8724         mbx_sli4_parameters = &mqe->un.get_sli4_parameters.sli4_parameters;
8725         sli4_params->if_type = bf_get(cfg_if_type, mbx_sli4_parameters);
8726         sli4_params->sli_rev = bf_get(cfg_sli_rev, mbx_sli4_parameters);
8727         sli4_params->sli_family = bf_get(cfg_sli_family, mbx_sli4_parameters);
8728         sli4_params->featurelevel_1 = bf_get(cfg_sli_hint_1,
8729                                              mbx_sli4_parameters);
8730         sli4_params->featurelevel_2 = bf_get(cfg_sli_hint_2,
8731                                              mbx_sli4_parameters);
8732         if (bf_get(cfg_phwq, mbx_sli4_parameters))
8733                 phba->sli3_options |= LPFC_SLI4_PHWQ_ENABLED;
8734         else
8735                 phba->sli3_options &= ~LPFC_SLI4_PHWQ_ENABLED;
8736         sli4_params->sge_supp_len = mbx_sli4_parameters->sge_supp_len;
8737         sli4_params->loopbk_scope = bf_get(loopbk_scope, mbx_sli4_parameters);
8738         sli4_params->cqv = bf_get(cfg_cqv, mbx_sli4_parameters);
8739         sli4_params->mqv = bf_get(cfg_mqv, mbx_sli4_parameters);
8740         sli4_params->wqv = bf_get(cfg_wqv, mbx_sli4_parameters);
8741         sli4_params->rqv = bf_get(cfg_rqv, mbx_sli4_parameters);
8742         sli4_params->sgl_pages_max = bf_get(cfg_sgl_page_cnt,
8743                                             mbx_sli4_parameters);
8744         sli4_params->sgl_pp_align = bf_get(cfg_sgl_pp_align,
8745                                            mbx_sli4_parameters);
8746         phba->sli4_hba.extents_in_use = bf_get(cfg_ext, mbx_sli4_parameters);
8747         phba->sli4_hba.rpi_hdrs_in_use = bf_get(cfg_hdrr, mbx_sli4_parameters);
8748
8749         /* Make sure that sge_supp_len can be handled by the driver */
8750         if (sli4_params->sge_supp_len > LPFC_MAX_SGE_SIZE)
8751                 sli4_params->sge_supp_len = LPFC_MAX_SGE_SIZE;
8752
8753         return 0;
8754 }
8755
8756 /**
8757  * lpfc_pci_probe_one_s3 - PCI probe func to reg SLI-3 device to PCI subsystem.
8758  * @pdev: pointer to PCI device
8759  * @pid: pointer to PCI device identifier
8760  *
8761  * This routine is to be called to attach a device with SLI-3 interface spec
8762  * to the PCI subsystem. When an Emulex HBA with SLI-3 interface spec is
8763  * presented on PCI bus, the kernel PCI subsystem looks at PCI device-specific
8764  * information of the device and driver to see if the driver state that it can
8765  * support this kind of device. If the match is successful, the driver core
8766  * invokes this routine. If this routine determines it can claim the HBA, it
8767  * does all the initialization that it needs to do to handle the HBA properly.
8768  *
8769  * Return code
8770  *      0 - driver can claim the device
8771  *      negative value - driver can not claim the device
8772  **/
8773 static int
8774 lpfc_pci_probe_one_s3(struct pci_dev *pdev, const struct pci_device_id *pid)
8775 {
8776         struct lpfc_hba   *phba;
8777         struct lpfc_vport *vport = NULL;
8778         struct Scsi_Host  *shost = NULL;
8779         int error;
8780         uint32_t cfg_mode, intr_mode;
8781
8782         /* Allocate memory for HBA structure */
8783         phba = lpfc_hba_alloc(pdev);
8784         if (!phba)
8785                 return -ENOMEM;
8786
8787         /* Perform generic PCI device enabling operation */
8788         error = lpfc_enable_pci_dev(phba);
8789         if (error)
8790                 goto out_free_phba;
8791
8792         /* Set up SLI API function jump table for PCI-device group-0 HBAs */
8793         error = lpfc_api_table_setup(phba, LPFC_PCI_DEV_LP);
8794         if (error)
8795                 goto out_disable_pci_dev;
8796
8797         /* Set up SLI-3 specific device PCI memory space */
8798         error = lpfc_sli_pci_mem_setup(phba);
8799         if (error) {
8800                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8801                                 "1402 Failed to set up pci memory space.\n");
8802                 goto out_disable_pci_dev;
8803         }
8804
8805         /* Set up phase-1 common device driver resources */
8806         error = lpfc_setup_driver_resource_phase1(phba);
8807         if (error) {
8808                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8809                                 "1403 Failed to set up driver resource.\n");
8810                 goto out_unset_pci_mem_s3;
8811         }
8812
8813         /* Set up SLI-3 specific device driver resources */
8814         error = lpfc_sli_driver_resource_setup(phba);
8815         if (error) {
8816                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8817                                 "1404 Failed to set up driver resource.\n");
8818                 goto out_unset_pci_mem_s3;
8819         }
8820
8821         /* Initialize and populate the iocb list per host */
8822         error = lpfc_init_iocb_list(phba, LPFC_IOCB_LIST_CNT);
8823         if (error) {
8824                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8825                                 "1405 Failed to initialize iocb list.\n");
8826                 goto out_unset_driver_resource_s3;
8827         }
8828
8829         /* Set up common device driver resources */
8830         error = lpfc_setup_driver_resource_phase2(phba);
8831         if (error) {
8832                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8833                                 "1406 Failed to set up driver resource.\n");
8834                 goto out_free_iocb_list;
8835         }
8836
8837         /* Get the default values for Model Name and Description */
8838         lpfc_get_hba_model_desc(phba, phba->ModelName, phba->ModelDesc);
8839
8840         /* Create SCSI host to the physical port */
8841         error = lpfc_create_shost(phba);
8842         if (error) {
8843                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8844                                 "1407 Failed to create scsi host.\n");
8845                 goto out_unset_driver_resource;
8846         }
8847
8848         /* Configure sysfs attributes */
8849         vport = phba->pport;
8850         error = lpfc_alloc_sysfs_attr(vport);
8851         if (error) {
8852                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8853                                 "1476 Failed to allocate sysfs attr\n");
8854                 goto out_destroy_shost;
8855         }
8856
8857         shost = lpfc_shost_from_vport(vport); /* save shost for error cleanup */
8858         /* Now, trying to enable interrupt and bring up the device */
8859         cfg_mode = phba->cfg_use_msi;
8860         while (true) {
8861                 /* Put device to a known state before enabling interrupt */
8862                 lpfc_stop_port(phba);
8863                 /* Configure and enable interrupt */
8864                 intr_mode = lpfc_sli_enable_intr(phba, cfg_mode);
8865                 if (intr_mode == LPFC_INTR_ERROR) {
8866                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8867                                         "0431 Failed to enable interrupt.\n");
8868                         error = -ENODEV;
8869                         goto out_free_sysfs_attr;
8870                 }
8871                 /* SLI-3 HBA setup */
8872                 if (lpfc_sli_hba_setup(phba)) {
8873                         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
8874                                         "1477 Failed to set up hba\n");
8875                         error = -ENODEV;
8876                         goto out_remove_device;
8877                 }
8878
8879                 /* Wait 50ms for the interrupts of previous mailbox commands */
8880                 msleep(50);
8881                 /* Check active interrupts on message signaled interrupts */
8882                 if (intr_mode == 0 ||
8883                     phba->sli.slistat.sli_intr > LPFC_MSIX_VECTORS) {
8884                         /* Log the current active interrupt mode */
8885                         phba->intr_mode = intr_mode;
8886                         lpfc_log_intr_mode(phba, intr_mode);
8887                         break;
8888                 } else {
8889                         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
8890                                         "0447 Configure interrupt mode (%d) "
8891                                         "failed active interrupt test.\n",
8892                                         intr_mode);
8893                         /* Disable the current interrupt mode */
8894                         lpfc_sli_disable_intr(phba);
8895                         /* Try next level of interrupt mode */
8896                         cfg_mode = --intr_mode;
8897                 }
8898         }
8899
8900         /* Perform post initialization setup */
8901         lpfc_post_init_setup(phba);
8902
8903         /* Check if there are static vports to be created. */
8904         lpfc_create_static_vport(phba);
8905
8906         return 0;
8907
8908 out_remove_device:
8909         lpfc_unset_hba(phba);
8910 out_free_sysfs_attr:
8911         lpfc_free_sysfs_attr(vport);
8912 out_destroy_shost:
8913         lpfc_destroy_shost(phba);
8914 out_unset_driver_resource:
8915         lpfc_unset_driver_resource_phase2(phba);
8916 out_free_iocb_list:
8917         lpfc_free_iocb_list(phba);
8918 out_unset_driver_resource_s3:
8919         lpfc_sli_driver_resource_unset(phba);
8920 out_unset_pci_mem_s3:
8921         lpfc_sli_pci_mem_unset(phba);
8922 out_disable_pci_dev:
8923         lpfc_disable_pci_dev(phba);
8924         if (shost)
8925                 scsi_host_put(shost);
8926 out_free_phba:
8927         lpfc_hba_free(phba);
8928         return error;
8929 }
8930
8931 /**
8932  * lpfc_pci_remove_one_s3 - PCI func to unreg SLI-3 device from PCI subsystem.
8933  * @pdev: pointer to PCI device
8934  *
8935  * This routine is to be called to disattach a device with SLI-3 interface
8936  * spec from PCI subsystem. When an Emulex HBA with SLI-3 interface spec is
8937  * removed from PCI bus, it performs all the necessary cleanup for the HBA
8938  * device to be removed from the PCI subsystem properly.
8939  **/
8940 static void
8941 lpfc_pci_remove_one_s3(struct pci_dev *pdev)
8942 {
8943         struct Scsi_Host  *shost = pci_get_drvdata(pdev);
8944         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
8945         struct lpfc_vport **vports;
8946         struct lpfc_hba   *phba = vport->phba;
8947         int i;
8948         int bars = pci_select_bars(pdev, IORESOURCE_MEM);
8949
8950         spin_lock_irq(&phba->hbalock);
8951         vport->load_flag |= FC_UNLOADING;
8952         spin_unlock_irq(&phba->hbalock);
8953
8954         lpfc_free_sysfs_attr(vport);
8955
8956         /* Release all the vports against this physical port */
8957         vports = lpfc_create_vport_work_array(phba);
8958         if (vports != NULL)
8959                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
8960                         if (vports[i]->port_type == LPFC_PHYSICAL_PORT)
8961                                 continue;
8962                         fc_vport_terminate(vports[i]->fc_vport);
8963                 }
8964         lpfc_destroy_vport_work_array(phba, vports);
8965
8966         /* Remove FC host and then SCSI host with the physical port */
8967         fc_remove_host(shost);
8968         scsi_remove_host(shost);
8969         lpfc_cleanup(vport);
8970
8971         /*
8972          * Bring down the SLI Layer. This step disable all interrupts,
8973          * clears the rings, discards all mailbox commands, and resets
8974          * the HBA.
8975          */
8976
8977         /* HBA interrupt will be disabled after this call */
8978         lpfc_sli_hba_down(phba);
8979         /* Stop kthread signal shall trigger work_done one more time */
8980         kthread_stop(phba->worker_thread);
8981         /* Final cleanup of txcmplq and reset the HBA */
8982         lpfc_sli_brdrestart(phba);
8983
8984         kfree(phba->vpi_bmask);
8985         kfree(phba->vpi_ids);
8986
8987         lpfc_stop_hba_timers(phba);
8988         spin_lock_irq(&phba->hbalock);
8989         list_del_init(&vport->listentry);
8990         spin_unlock_irq(&phba->hbalock);
8991
8992         lpfc_debugfs_terminate(vport);
8993
8994         /* Disable SR-IOV if enabled */
8995         if (phba->cfg_sriov_nr_virtfn)
8996                 pci_disable_sriov(pdev);
8997
8998         /* Disable interrupt */
8999         lpfc_sli_disable_intr(phba);
9000
9001         pci_set_drvdata(pdev, NULL);
9002         scsi_host_put(shost);
9003
9004         /*
9005          * Call scsi_free before mem_free since scsi bufs are released to their
9006          * corresponding pools here.
9007          */
9008         lpfc_scsi_free(phba);
9009         lpfc_mem_free_all(phba);
9010
9011         dma_free_coherent(&pdev->dev, lpfc_sli_hbq_size(),
9012                           phba->hbqslimp.virt, phba->hbqslimp.phys);
9013
9014         /* Free resources associated with SLI2 interface */
9015         dma_free_coherent(&pdev->dev, SLI2_SLIM_SIZE,
9016                           phba->slim2p.virt, phba->slim2p.phys);
9017
9018         /* unmap adapter SLIM and Control Registers */
9019         iounmap(phba->ctrl_regs_memmap_p);
9020         iounmap(phba->slim_memmap_p);
9021
9022         lpfc_hba_free(phba);
9023
9024         pci_release_selected_regions(pdev, bars);
9025         pci_disable_device(pdev);
9026 }
9027
9028 /**
9029  * lpfc_pci_suspend_one_s3 - PCI func to suspend SLI-3 device for power mgmnt
9030  * @pdev: pointer to PCI device
9031  * @msg: power management message
9032  *
9033  * This routine is to be called from the kernel's PCI subsystem to support
9034  * system Power Management (PM) to device with SLI-3 interface spec. When
9035  * PM invokes this method, it quiesces the device by stopping the driver's
9036  * worker thread for the device, turning off device's interrupt and DMA,
9037  * and bring the device offline. Note that as the driver implements the
9038  * minimum PM requirements to a power-aware driver's PM support for the
9039  * suspend/resume -- all the possible PM messages (SUSPEND, HIBERNATE, FREEZE)
9040  * to the suspend() method call will be treated as SUSPEND and the driver will
9041  * fully reinitialize its device during resume() method call, the driver will
9042  * set device to PCI_D3hot state in PCI config space instead of setting it
9043  * according to the @msg provided by the PM.
9044  *
9045  * Return code
9046  *      0 - driver suspended the device
9047  *      Error otherwise
9048  **/
9049 static int
9050 lpfc_pci_suspend_one_s3(struct pci_dev *pdev, pm_message_t msg)
9051 {
9052         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9053         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9054
9055         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
9056                         "0473 PCI device Power Management suspend.\n");
9057
9058         /* Bring down the device */
9059         lpfc_offline_prep(phba, LPFC_MBX_WAIT);
9060         lpfc_offline(phba);
9061         kthread_stop(phba->worker_thread);
9062
9063         /* Disable interrupt from device */
9064         lpfc_sli_disable_intr(phba);
9065
9066         /* Save device state to PCI config space */
9067         pci_save_state(pdev);
9068         pci_set_power_state(pdev, PCI_D3hot);
9069
9070         return 0;
9071 }
9072
9073 /**
9074  * lpfc_pci_resume_one_s3 - PCI func to resume SLI-3 device for power mgmnt
9075  * @pdev: pointer to PCI device
9076  *
9077  * This routine is to be called from the kernel's PCI subsystem to support
9078  * system Power Management (PM) to device with SLI-3 interface spec. When PM
9079  * invokes this method, it restores the device's PCI config space state and
9080  * fully reinitializes the device and brings it online. Note that as the
9081  * driver implements the minimum PM requirements to a power-aware driver's
9082  * PM for suspend/resume -- all the possible PM messages (SUSPEND, HIBERNATE,
9083  * FREEZE) to the suspend() method call will be treated as SUSPEND and the
9084  * driver will fully reinitialize its device during resume() method call,
9085  * the device will be set to PCI_D0 directly in PCI config space before
9086  * restoring the state.
9087  *
9088  * Return code
9089  *      0 - driver suspended the device
9090  *      Error otherwise
9091  **/
9092 static int
9093 lpfc_pci_resume_one_s3(struct pci_dev *pdev)
9094 {
9095         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9096         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9097         uint32_t intr_mode;
9098         int error;
9099
9100         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
9101                         "0452 PCI device Power Management resume.\n");
9102
9103         /* Restore device state from PCI config space */
9104         pci_set_power_state(pdev, PCI_D0);
9105         pci_restore_state(pdev);
9106
9107         /*
9108          * As the new kernel behavior of pci_restore_state() API call clears
9109          * device saved_state flag, need to save the restored state again.
9110          */
9111         pci_save_state(pdev);
9112
9113         if (pdev->is_busmaster)
9114                 pci_set_master(pdev);
9115
9116         /* Startup the kernel thread for this host adapter. */
9117         phba->worker_thread = kthread_run(lpfc_do_work, phba,
9118                                         "lpfc_worker_%d", phba->brd_no);
9119         if (IS_ERR(phba->worker_thread)) {
9120                 error = PTR_ERR(phba->worker_thread);
9121                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9122                                 "0434 PM resume failed to start worker "
9123                                 "thread: error=x%x.\n", error);
9124                 return error;
9125         }
9126
9127         /* Configure and enable interrupt */
9128         intr_mode = lpfc_sli_enable_intr(phba, phba->intr_mode);
9129         if (intr_mode == LPFC_INTR_ERROR) {
9130                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9131                                 "0430 PM resume Failed to enable interrupt\n");
9132                 return -EIO;
9133         } else
9134                 phba->intr_mode = intr_mode;
9135
9136         /* Restart HBA and bring it online */
9137         lpfc_sli_brdrestart(phba);
9138         lpfc_online(phba);
9139
9140         /* Log the current active interrupt mode */
9141         lpfc_log_intr_mode(phba, phba->intr_mode);
9142
9143         return 0;
9144 }
9145
9146 /**
9147  * lpfc_sli_prep_dev_for_recover - Prepare SLI3 device for pci slot recover
9148  * @phba: pointer to lpfc hba data structure.
9149  *
9150  * This routine is called to prepare the SLI3 device for PCI slot recover. It
9151  * aborts all the outstanding SCSI I/Os to the pci device.
9152  **/
9153 static void
9154 lpfc_sli_prep_dev_for_recover(struct lpfc_hba *phba)
9155 {
9156         struct lpfc_sli *psli = &phba->sli;
9157         struct lpfc_sli_ring  *pring;
9158
9159         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9160                         "2723 PCI channel I/O abort preparing for recovery\n");
9161
9162         /*
9163          * There may be errored I/Os through HBA, abort all I/Os on txcmplq
9164          * and let the SCSI mid-layer to retry them to recover.
9165          */
9166         pring = &psli->ring[psli->fcp_ring];
9167         lpfc_sli_abort_iocb_ring(phba, pring);
9168 }
9169
9170 /**
9171  * lpfc_sli_prep_dev_for_reset - Prepare SLI3 device for pci slot reset
9172  * @phba: pointer to lpfc hba data structure.
9173  *
9174  * This routine is called to prepare the SLI3 device for PCI slot reset. It
9175  * disables the device interrupt and pci device, and aborts the internal FCP
9176  * pending I/Os.
9177  **/
9178 static void
9179 lpfc_sli_prep_dev_for_reset(struct lpfc_hba *phba)
9180 {
9181         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9182                         "2710 PCI channel disable preparing for reset\n");
9183
9184         /* Block any management I/Os to the device */
9185         lpfc_block_mgmt_io(phba, LPFC_MBX_WAIT);
9186
9187         /* Block all SCSI devices' I/Os on the host */
9188         lpfc_scsi_dev_block(phba);
9189
9190         /* stop all timers */
9191         lpfc_stop_hba_timers(phba);
9192
9193         /* Disable interrupt and pci device */
9194         lpfc_sli_disable_intr(phba);
9195         pci_disable_device(phba->pcidev);
9196
9197         /* Flush all driver's outstanding SCSI I/Os as we are to reset */
9198         lpfc_sli_flush_fcp_rings(phba);
9199 }
9200
9201 /**
9202  * lpfc_sli_prep_dev_for_perm_failure - Prepare SLI3 dev for pci slot disable
9203  * @phba: pointer to lpfc hba data structure.
9204  *
9205  * This routine is called to prepare the SLI3 device for PCI slot permanently
9206  * disabling. It blocks the SCSI transport layer traffic and flushes the FCP
9207  * pending I/Os.
9208  **/
9209 static void
9210 lpfc_sli_prep_dev_for_perm_failure(struct lpfc_hba *phba)
9211 {
9212         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9213                         "2711 PCI channel permanent disable for failure\n");
9214         /* Block all SCSI devices' I/Os on the host */
9215         lpfc_scsi_dev_block(phba);
9216
9217         /* stop all timers */
9218         lpfc_stop_hba_timers(phba);
9219
9220         /* Clean up all driver's outstanding SCSI I/Os */
9221         lpfc_sli_flush_fcp_rings(phba);
9222 }
9223
9224 /**
9225  * lpfc_io_error_detected_s3 - Method for handling SLI-3 device PCI I/O error
9226  * @pdev: pointer to PCI device.
9227  * @state: the current PCI connection state.
9228  *
9229  * This routine is called from the PCI subsystem for I/O error handling to
9230  * device with SLI-3 interface spec. This function is called by the PCI
9231  * subsystem after a PCI bus error affecting this device has been detected.
9232  * When this function is invoked, it will need to stop all the I/Os and
9233  * interrupt(s) to the device. Once that is done, it will return
9234  * PCI_ERS_RESULT_NEED_RESET for the PCI subsystem to perform proper recovery
9235  * as desired.
9236  *
9237  * Return codes
9238  *      PCI_ERS_RESULT_CAN_RECOVER - can be recovered with reset_link
9239  *      PCI_ERS_RESULT_NEED_RESET - need to reset before recovery
9240  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
9241  **/
9242 static pci_ers_result_t
9243 lpfc_io_error_detected_s3(struct pci_dev *pdev, pci_channel_state_t state)
9244 {
9245         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9246         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9247
9248         switch (state) {
9249         case pci_channel_io_normal:
9250                 /* Non-fatal error, prepare for recovery */
9251                 lpfc_sli_prep_dev_for_recover(phba);
9252                 return PCI_ERS_RESULT_CAN_RECOVER;
9253         case pci_channel_io_frozen:
9254                 /* Fatal error, prepare for slot reset */
9255                 lpfc_sli_prep_dev_for_reset(phba);
9256                 return PCI_ERS_RESULT_NEED_RESET;
9257         case pci_channel_io_perm_failure:
9258                 /* Permanent failure, prepare for device down */
9259                 lpfc_sli_prep_dev_for_perm_failure(phba);
9260                 return PCI_ERS_RESULT_DISCONNECT;
9261         default:
9262                 /* Unknown state, prepare and request slot reset */
9263                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9264                                 "0472 Unknown PCI error state: x%x\n", state);
9265                 lpfc_sli_prep_dev_for_reset(phba);
9266                 return PCI_ERS_RESULT_NEED_RESET;
9267         }
9268 }
9269
9270 /**
9271  * lpfc_io_slot_reset_s3 - Method for restarting PCI SLI-3 device from scratch.
9272  * @pdev: pointer to PCI device.
9273  *
9274  * This routine is called from the PCI subsystem for error handling to
9275  * device with SLI-3 interface spec. This is called after PCI bus has been
9276  * reset to restart the PCI card from scratch, as if from a cold-boot.
9277  * During the PCI subsystem error recovery, after driver returns
9278  * PCI_ERS_RESULT_NEED_RESET, the PCI subsystem will perform proper error
9279  * recovery and then call this routine before calling the .resume method
9280  * to recover the device. This function will initialize the HBA device,
9281  * enable the interrupt, but it will just put the HBA to offline state
9282  * without passing any I/O traffic.
9283  *
9284  * Return codes
9285  *      PCI_ERS_RESULT_RECOVERED - the device has been recovered
9286  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
9287  */
9288 static pci_ers_result_t
9289 lpfc_io_slot_reset_s3(struct pci_dev *pdev)
9290 {
9291         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9292         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9293         struct lpfc_sli *psli = &phba->sli;
9294         uint32_t intr_mode;
9295
9296         dev_printk(KERN_INFO, &pdev->dev, "recovering from a slot reset.\n");
9297         if (pci_enable_device_mem(pdev)) {
9298                 printk(KERN_ERR "lpfc: Cannot re-enable "
9299                         "PCI device after reset.\n");
9300                 return PCI_ERS_RESULT_DISCONNECT;
9301         }
9302
9303         pci_restore_state(pdev);
9304
9305         /*
9306          * As the new kernel behavior of pci_restore_state() API call clears
9307          * device saved_state flag, need to save the restored state again.
9308          */
9309         pci_save_state(pdev);
9310
9311         if (pdev->is_busmaster)
9312                 pci_set_master(pdev);
9313
9314         spin_lock_irq(&phba->hbalock);
9315         psli->sli_flag &= ~LPFC_SLI_ACTIVE;
9316         spin_unlock_irq(&phba->hbalock);
9317
9318         /* Configure and enable interrupt */
9319         intr_mode = lpfc_sli_enable_intr(phba, phba->intr_mode);
9320         if (intr_mode == LPFC_INTR_ERROR) {
9321                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9322                                 "0427 Cannot re-enable interrupt after "
9323                                 "slot reset.\n");
9324                 return PCI_ERS_RESULT_DISCONNECT;
9325         } else
9326                 phba->intr_mode = intr_mode;
9327
9328         /* Take device offline, it will perform cleanup */
9329         lpfc_offline_prep(phba, LPFC_MBX_WAIT);
9330         lpfc_offline(phba);
9331         lpfc_sli_brdrestart(phba);
9332
9333         /* Log the current active interrupt mode */
9334         lpfc_log_intr_mode(phba, phba->intr_mode);
9335
9336         return PCI_ERS_RESULT_RECOVERED;
9337 }
9338
9339 /**
9340  * lpfc_io_resume_s3 - Method for resuming PCI I/O operation on SLI-3 device.
9341  * @pdev: pointer to PCI device
9342  *
9343  * This routine is called from the PCI subsystem for error handling to device
9344  * with SLI-3 interface spec. It is called when kernel error recovery tells
9345  * the lpfc driver that it is ok to resume normal PCI operation after PCI bus
9346  * error recovery. After this call, traffic can start to flow from this device
9347  * again.
9348  */
9349 static void
9350 lpfc_io_resume_s3(struct pci_dev *pdev)
9351 {
9352         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9353         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9354
9355         /* Bring device online, it will be no-op for non-fatal error resume */
9356         lpfc_online(phba);
9357
9358         /* Clean up Advanced Error Reporting (AER) if needed */
9359         if (phba->hba_flag & HBA_AER_ENABLED)
9360                 pci_cleanup_aer_uncorrect_error_status(pdev);
9361 }
9362
9363 /**
9364  * lpfc_sli4_get_els_iocb_cnt - Calculate the # of ELS IOCBs to reserve
9365  * @phba: pointer to lpfc hba data structure.
9366  *
9367  * returns the number of ELS/CT IOCBs to reserve
9368  **/
9369 int
9370 lpfc_sli4_get_els_iocb_cnt(struct lpfc_hba *phba)
9371 {
9372         int max_xri = phba->sli4_hba.max_cfg_param.max_xri;
9373
9374         if (phba->sli_rev == LPFC_SLI_REV4) {
9375                 if (max_xri <= 100)
9376                         return 10;
9377                 else if (max_xri <= 256)
9378                         return 25;
9379                 else if (max_xri <= 512)
9380                         return 50;
9381                 else if (max_xri <= 1024)
9382                         return 100;
9383                 else if (max_xri <= 1536)
9384                         return 150;
9385                 else if (max_xri <= 2048)
9386                         return 200;
9387                 else
9388                         return 250;
9389         } else
9390                 return 0;
9391 }
9392
9393 /**
9394  * lpfc_write_firmware - attempt to write a firmware image to the port
9395  * @fw: pointer to firmware image returned from request_firmware.
9396  * @phba: pointer to lpfc hba data structure.
9397  *
9398  **/
9399 static void
9400 lpfc_write_firmware(const struct firmware *fw, void *context)
9401 {
9402         struct lpfc_hba *phba = (struct lpfc_hba *)context;
9403         char fwrev[FW_REV_STR_SIZE];
9404         struct lpfc_grp_hdr *image;
9405         struct list_head dma_buffer_list;
9406         int i, rc = 0;
9407         struct lpfc_dmabuf *dmabuf, *next;
9408         uint32_t offset = 0, temp_offset = 0;
9409
9410         /* It can be null in no-wait mode, sanity check */
9411         if (!fw) {
9412                 rc = -ENXIO;
9413                 goto out;
9414         }
9415         image = (struct lpfc_grp_hdr *)fw->data;
9416
9417         INIT_LIST_HEAD(&dma_buffer_list);
9418         if ((be32_to_cpu(image->magic_number) != LPFC_GROUP_OJECT_MAGIC_NUM) ||
9419             (bf_get_be32(lpfc_grp_hdr_file_type, image) !=
9420              LPFC_FILE_TYPE_GROUP) ||
9421             (bf_get_be32(lpfc_grp_hdr_id, image) != LPFC_FILE_ID_GROUP) ||
9422             (be32_to_cpu(image->size) != fw->size)) {
9423                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9424                                 "3022 Invalid FW image found. "
9425                                 "Magic:%x Type:%x ID:%x\n",
9426                                 be32_to_cpu(image->magic_number),
9427                                 bf_get_be32(lpfc_grp_hdr_file_type, image),
9428                                 bf_get_be32(lpfc_grp_hdr_id, image));
9429                 rc = -EINVAL;
9430                 goto release_out;
9431         }
9432         lpfc_decode_firmware_rev(phba, fwrev, 1);
9433         if (strncmp(fwrev, image->revision, strnlen(image->revision, 16))) {
9434                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9435                                 "3023 Updating Firmware, Current Version:%s "
9436                                 "New Version:%s\n",
9437                                 fwrev, image->revision);
9438                 for (i = 0; i < LPFC_MBX_WR_CONFIG_MAX_BDE; i++) {
9439                         dmabuf = kzalloc(sizeof(struct lpfc_dmabuf),
9440                                          GFP_KERNEL);
9441                         if (!dmabuf) {
9442                                 rc = -ENOMEM;
9443                                 goto release_out;
9444                         }
9445                         dmabuf->virt = dma_alloc_coherent(&phba->pcidev->dev,
9446                                                           SLI4_PAGE_SIZE,
9447                                                           &dmabuf->phys,
9448                                                           GFP_KERNEL);
9449                         if (!dmabuf->virt) {
9450                                 kfree(dmabuf);
9451                                 rc = -ENOMEM;
9452                                 goto release_out;
9453                         }
9454                         list_add_tail(&dmabuf->list, &dma_buffer_list);
9455                 }
9456                 while (offset < fw->size) {
9457                         temp_offset = offset;
9458                         list_for_each_entry(dmabuf, &dma_buffer_list, list) {
9459                                 if (temp_offset + SLI4_PAGE_SIZE > fw->size) {
9460                                         memcpy(dmabuf->virt,
9461                                                fw->data + temp_offset,
9462                                                fw->size - temp_offset);
9463                                         temp_offset = fw->size;
9464                                         break;
9465                                 }
9466                                 memcpy(dmabuf->virt, fw->data + temp_offset,
9467                                        SLI4_PAGE_SIZE);
9468                                 temp_offset += SLI4_PAGE_SIZE;
9469                         }
9470                         rc = lpfc_wr_object(phba, &dma_buffer_list,
9471                                     (fw->size - offset), &offset);
9472                         if (rc)
9473                                 goto release_out;
9474                 }
9475                 rc = offset;
9476         }
9477
9478 release_out:
9479         list_for_each_entry_safe(dmabuf, next, &dma_buffer_list, list) {
9480                 list_del(&dmabuf->list);
9481                 dma_free_coherent(&phba->pcidev->dev, SLI4_PAGE_SIZE,
9482                                   dmabuf->virt, dmabuf->phys);
9483                 kfree(dmabuf);
9484         }
9485         release_firmware(fw);
9486 out:
9487         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9488                         "3024 Firmware update done: %d.\n", rc);
9489         return;
9490 }
9491
9492 /**
9493  * lpfc_sli4_request_firmware_update - Request linux generic firmware upgrade
9494  * @phba: pointer to lpfc hba data structure.
9495  *
9496  * This routine is called to perform Linux generic firmware upgrade on device
9497  * that supports such feature.
9498  **/
9499 int
9500 lpfc_sli4_request_firmware_update(struct lpfc_hba *phba, uint8_t fw_upgrade)
9501 {
9502         uint8_t file_name[ELX_MODEL_NAME_SIZE];
9503         int ret;
9504         const struct firmware *fw;
9505
9506         /* Only supported on SLI4 interface type 2 for now */
9507         if (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) !=
9508             LPFC_SLI_INTF_IF_TYPE_2)
9509                 return -EPERM;
9510
9511         snprintf(file_name, ELX_MODEL_NAME_SIZE, "%s.grp", phba->ModelName);
9512
9513         if (fw_upgrade == INT_FW_UPGRADE) {
9514                 ret = request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
9515                                         file_name, &phba->pcidev->dev,
9516                                         GFP_KERNEL, (void *)phba,
9517                                         lpfc_write_firmware);
9518         } else if (fw_upgrade == RUN_FW_UPGRADE) {
9519                 ret = request_firmware(&fw, file_name, &phba->pcidev->dev);
9520                 if (!ret)
9521                         lpfc_write_firmware(fw, (void *)phba);
9522         } else {
9523                 ret = -EINVAL;
9524         }
9525
9526         return ret;
9527 }
9528
9529 /**
9530  * lpfc_pci_probe_one_s4 - PCI probe func to reg SLI-4 device to PCI subsys
9531  * @pdev: pointer to PCI device
9532  * @pid: pointer to PCI device identifier
9533  *
9534  * This routine is called from the kernel's PCI subsystem to device with
9535  * SLI-4 interface spec. When an Emulex HBA with SLI-4 interface spec is
9536  * presented on PCI bus, the kernel PCI subsystem looks at PCI device-specific
9537  * information of the device and driver to see if the driver state that it
9538  * can support this kind of device. If the match is successful, the driver
9539  * core invokes this routine. If this routine determines it can claim the HBA,
9540  * it does all the initialization that it needs to do to handle the HBA
9541  * properly.
9542  *
9543  * Return code
9544  *      0 - driver can claim the device
9545  *      negative value - driver can not claim the device
9546  **/
9547 static int
9548 lpfc_pci_probe_one_s4(struct pci_dev *pdev, const struct pci_device_id *pid)
9549 {
9550         struct lpfc_hba   *phba;
9551         struct lpfc_vport *vport = NULL;
9552         struct Scsi_Host  *shost = NULL;
9553         int error, ret;
9554         uint32_t cfg_mode, intr_mode;
9555         int adjusted_fcp_io_channel;
9556
9557         /* Allocate memory for HBA structure */
9558         phba = lpfc_hba_alloc(pdev);
9559         if (!phba)
9560                 return -ENOMEM;
9561
9562         /* Perform generic PCI device enabling operation */
9563         error = lpfc_enable_pci_dev(phba);
9564         if (error)
9565                 goto out_free_phba;
9566
9567         /* Set up SLI API function jump table for PCI-device group-1 HBAs */
9568         error = lpfc_api_table_setup(phba, LPFC_PCI_DEV_OC);
9569         if (error)
9570                 goto out_disable_pci_dev;
9571
9572         /* Set up SLI-4 specific device PCI memory space */
9573         error = lpfc_sli4_pci_mem_setup(phba);
9574         if (error) {
9575                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9576                                 "1410 Failed to set up pci memory space.\n");
9577                 goto out_disable_pci_dev;
9578         }
9579
9580         /* Set up phase-1 common device driver resources */
9581         error = lpfc_setup_driver_resource_phase1(phba);
9582         if (error) {
9583                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9584                                 "1411 Failed to set up driver resource.\n");
9585                 goto out_unset_pci_mem_s4;
9586         }
9587
9588         /* Set up SLI-4 Specific device driver resources */
9589         error = lpfc_sli4_driver_resource_setup(phba);
9590         if (error) {
9591                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9592                                 "1412 Failed to set up driver resource.\n");
9593                 goto out_unset_pci_mem_s4;
9594         }
9595
9596         /* Initialize and populate the iocb list per host */
9597
9598         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
9599                         "2821 initialize iocb list %d.\n",
9600                         phba->cfg_iocb_cnt*1024);
9601         error = lpfc_init_iocb_list(phba, phba->cfg_iocb_cnt*1024);
9602
9603         if (error) {
9604                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9605                                 "1413 Failed to initialize iocb list.\n");
9606                 goto out_unset_driver_resource_s4;
9607         }
9608
9609         INIT_LIST_HEAD(&phba->active_rrq_list);
9610         INIT_LIST_HEAD(&phba->fcf.fcf_pri_list);
9611
9612         /* Set up common device driver resources */
9613         error = lpfc_setup_driver_resource_phase2(phba);
9614         if (error) {
9615                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9616                                 "1414 Failed to set up driver resource.\n");
9617                 goto out_free_iocb_list;
9618         }
9619
9620         /* Get the default values for Model Name and Description */
9621         lpfc_get_hba_model_desc(phba, phba->ModelName, phba->ModelDesc);
9622
9623         /* Create SCSI host to the physical port */
9624         error = lpfc_create_shost(phba);
9625         if (error) {
9626                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9627                                 "1415 Failed to create scsi host.\n");
9628                 goto out_unset_driver_resource;
9629         }
9630
9631         /* Configure sysfs attributes */
9632         vport = phba->pport;
9633         error = lpfc_alloc_sysfs_attr(vport);
9634         if (error) {
9635                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9636                                 "1416 Failed to allocate sysfs attr\n");
9637                 goto out_destroy_shost;
9638         }
9639
9640         shost = lpfc_shost_from_vport(vport); /* save shost for error cleanup */
9641         /* Now, trying to enable interrupt and bring up the device */
9642         cfg_mode = phba->cfg_use_msi;
9643
9644         /* Put device to a known state before enabling interrupt */
9645         lpfc_stop_port(phba);
9646         /* Configure and enable interrupt */
9647         intr_mode = lpfc_sli4_enable_intr(phba, cfg_mode);
9648         if (intr_mode == LPFC_INTR_ERROR) {
9649                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9650                                 "0426 Failed to enable interrupt.\n");
9651                 error = -ENODEV;
9652                 goto out_free_sysfs_attr;
9653         }
9654         /* Default to single EQ for non-MSI-X */
9655         if (phba->intr_type != MSIX)
9656                 adjusted_fcp_io_channel = 1;
9657         else
9658                 adjusted_fcp_io_channel = phba->cfg_fcp_io_channel;
9659         phba->cfg_fcp_io_channel = adjusted_fcp_io_channel;
9660         /* Set up SLI-4 HBA */
9661         if (lpfc_sli4_hba_setup(phba)) {
9662                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9663                                 "1421 Failed to set up hba\n");
9664                 error = -ENODEV;
9665                 goto out_disable_intr;
9666         }
9667
9668         /* Log the current active interrupt mode */
9669         phba->intr_mode = intr_mode;
9670         lpfc_log_intr_mode(phba, intr_mode);
9671
9672         /* Perform post initialization setup */
9673         lpfc_post_init_setup(phba);
9674
9675         /* check for firmware upgrade or downgrade */
9676         if (phba->cfg_request_firmware_upgrade)
9677                 ret = lpfc_sli4_request_firmware_update(phba, INT_FW_UPGRADE);
9678
9679         /* Check if there are static vports to be created. */
9680         lpfc_create_static_vport(phba);
9681         return 0;
9682
9683 out_disable_intr:
9684         lpfc_sli4_disable_intr(phba);
9685 out_free_sysfs_attr:
9686         lpfc_free_sysfs_attr(vport);
9687 out_destroy_shost:
9688         lpfc_destroy_shost(phba);
9689 out_unset_driver_resource:
9690         lpfc_unset_driver_resource_phase2(phba);
9691 out_free_iocb_list:
9692         lpfc_free_iocb_list(phba);
9693 out_unset_driver_resource_s4:
9694         lpfc_sli4_driver_resource_unset(phba);
9695 out_unset_pci_mem_s4:
9696         lpfc_sli4_pci_mem_unset(phba);
9697 out_disable_pci_dev:
9698         lpfc_disable_pci_dev(phba);
9699         if (shost)
9700                 scsi_host_put(shost);
9701 out_free_phba:
9702         lpfc_hba_free(phba);
9703         return error;
9704 }
9705
9706 /**
9707  * lpfc_pci_remove_one_s4 - PCI func to unreg SLI-4 device from PCI subsystem
9708  * @pdev: pointer to PCI device
9709  *
9710  * This routine is called from the kernel's PCI subsystem to device with
9711  * SLI-4 interface spec. When an Emulex HBA with SLI-4 interface spec is
9712  * removed from PCI bus, it performs all the necessary cleanup for the HBA
9713  * device to be removed from the PCI subsystem properly.
9714  **/
9715 static void
9716 lpfc_pci_remove_one_s4(struct pci_dev *pdev)
9717 {
9718         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9719         struct lpfc_vport *vport = (struct lpfc_vport *) shost->hostdata;
9720         struct lpfc_vport **vports;
9721         struct lpfc_hba *phba = vport->phba;
9722         int i;
9723
9724         /* Mark the device unloading flag */
9725         spin_lock_irq(&phba->hbalock);
9726         vport->load_flag |= FC_UNLOADING;
9727         spin_unlock_irq(&phba->hbalock);
9728
9729         /* Free the HBA sysfs attributes */
9730         lpfc_free_sysfs_attr(vport);
9731
9732         /* Release all the vports against this physical port */
9733         vports = lpfc_create_vport_work_array(phba);
9734         if (vports != NULL)
9735                 for (i = 0; i <= phba->max_vports && vports[i] != NULL; i++) {
9736                         if (vports[i]->port_type == LPFC_PHYSICAL_PORT)
9737                                 continue;
9738                         fc_vport_terminate(vports[i]->fc_vport);
9739                 }
9740         lpfc_destroy_vport_work_array(phba, vports);
9741
9742         /* Remove FC host and then SCSI host with the physical port */
9743         fc_remove_host(shost);
9744         scsi_remove_host(shost);
9745
9746         /* Perform cleanup on the physical port */
9747         lpfc_cleanup(vport);
9748
9749         /*
9750          * Bring down the SLI Layer. This step disables all interrupts,
9751          * clears the rings, discards all mailbox commands, and resets
9752          * the HBA FCoE function.
9753          */
9754         lpfc_debugfs_terminate(vport);
9755         lpfc_sli4_hba_unset(phba);
9756
9757         spin_lock_irq(&phba->hbalock);
9758         list_del_init(&vport->listentry);
9759         spin_unlock_irq(&phba->hbalock);
9760
9761         /* Perform scsi free before driver resource_unset since scsi
9762          * buffers are released to their corresponding pools here.
9763          */
9764         lpfc_scsi_free(phba);
9765
9766         lpfc_sli4_driver_resource_unset(phba);
9767
9768         /* Unmap adapter Control and Doorbell registers */
9769         lpfc_sli4_pci_mem_unset(phba);
9770
9771         /* Release PCI resources and disable device's PCI function */
9772         scsi_host_put(shost);
9773         lpfc_disable_pci_dev(phba);
9774
9775         /* Finally, free the driver's device data structure */
9776         lpfc_hba_free(phba);
9777
9778         return;
9779 }
9780
9781 /**
9782  * lpfc_pci_suspend_one_s4 - PCI func to suspend SLI-4 device for power mgmnt
9783  * @pdev: pointer to PCI device
9784  * @msg: power management message
9785  *
9786  * This routine is called from the kernel's PCI subsystem to support system
9787  * Power Management (PM) to device with SLI-4 interface spec. When PM invokes
9788  * this method, it quiesces the device by stopping the driver's worker
9789  * thread for the device, turning off device's interrupt and DMA, and bring
9790  * the device offline. Note that as the driver implements the minimum PM
9791  * requirements to a power-aware driver's PM support for suspend/resume -- all
9792  * the possible PM messages (SUSPEND, HIBERNATE, FREEZE) to the suspend()
9793  * method call will be treated as SUSPEND and the driver will fully
9794  * reinitialize its device during resume() method call, the driver will set
9795  * device to PCI_D3hot state in PCI config space instead of setting it
9796  * according to the @msg provided by the PM.
9797  *
9798  * Return code
9799  *      0 - driver suspended the device
9800  *      Error otherwise
9801  **/
9802 static int
9803 lpfc_pci_suspend_one_s4(struct pci_dev *pdev, pm_message_t msg)
9804 {
9805         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9806         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9807
9808         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
9809                         "2843 PCI device Power Management suspend.\n");
9810
9811         /* Bring down the device */
9812         lpfc_offline_prep(phba, LPFC_MBX_WAIT);
9813         lpfc_offline(phba);
9814         kthread_stop(phba->worker_thread);
9815
9816         /* Disable interrupt from device */
9817         lpfc_sli4_disable_intr(phba);
9818         lpfc_sli4_queue_destroy(phba);
9819
9820         /* Save device state to PCI config space */
9821         pci_save_state(pdev);
9822         pci_set_power_state(pdev, PCI_D3hot);
9823
9824         return 0;
9825 }
9826
9827 /**
9828  * lpfc_pci_resume_one_s4 - PCI func to resume SLI-4 device for power mgmnt
9829  * @pdev: pointer to PCI device
9830  *
9831  * This routine is called from the kernel's PCI subsystem to support system
9832  * Power Management (PM) to device with SLI-4 interface spac. When PM invokes
9833  * this method, it restores the device's PCI config space state and fully
9834  * reinitializes the device and brings it online. Note that as the driver
9835  * implements the minimum PM requirements to a power-aware driver's PM for
9836  * suspend/resume -- all the possible PM messages (SUSPEND, HIBERNATE, FREEZE)
9837  * to the suspend() method call will be treated as SUSPEND and the driver
9838  * will fully reinitialize its device during resume() method call, the device
9839  * will be set to PCI_D0 directly in PCI config space before restoring the
9840  * state.
9841  *
9842  * Return code
9843  *      0 - driver suspended the device
9844  *      Error otherwise
9845  **/
9846 static int
9847 lpfc_pci_resume_one_s4(struct pci_dev *pdev)
9848 {
9849         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9850         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
9851         uint32_t intr_mode;
9852         int error;
9853
9854         lpfc_printf_log(phba, KERN_INFO, LOG_INIT,
9855                         "0292 PCI device Power Management resume.\n");
9856
9857         /* Restore device state from PCI config space */
9858         pci_set_power_state(pdev, PCI_D0);
9859         pci_restore_state(pdev);
9860
9861         /*
9862          * As the new kernel behavior of pci_restore_state() API call clears
9863          * device saved_state flag, need to save the restored state again.
9864          */
9865         pci_save_state(pdev);
9866
9867         if (pdev->is_busmaster)
9868                 pci_set_master(pdev);
9869
9870          /* Startup the kernel thread for this host adapter. */
9871         phba->worker_thread = kthread_run(lpfc_do_work, phba,
9872                                         "lpfc_worker_%d", phba->brd_no);
9873         if (IS_ERR(phba->worker_thread)) {
9874                 error = PTR_ERR(phba->worker_thread);
9875                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9876                                 "0293 PM resume failed to start worker "
9877                                 "thread: error=x%x.\n", error);
9878                 return error;
9879         }
9880
9881         /* Configure and enable interrupt */
9882         intr_mode = lpfc_sli4_enable_intr(phba, phba->intr_mode);
9883         if (intr_mode == LPFC_INTR_ERROR) {
9884                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9885                                 "0294 PM resume Failed to enable interrupt\n");
9886                 return -EIO;
9887         } else
9888                 phba->intr_mode = intr_mode;
9889
9890         /* Restart HBA and bring it online */
9891         lpfc_sli_brdrestart(phba);
9892         lpfc_online(phba);
9893
9894         /* Log the current active interrupt mode */
9895         lpfc_log_intr_mode(phba, phba->intr_mode);
9896
9897         return 0;
9898 }
9899
9900 /**
9901  * lpfc_sli4_prep_dev_for_recover - Prepare SLI4 device for pci slot recover
9902  * @phba: pointer to lpfc hba data structure.
9903  *
9904  * This routine is called to prepare the SLI4 device for PCI slot recover. It
9905  * aborts all the outstanding SCSI I/Os to the pci device.
9906  **/
9907 static void
9908 lpfc_sli4_prep_dev_for_recover(struct lpfc_hba *phba)
9909 {
9910         struct lpfc_sli *psli = &phba->sli;
9911         struct lpfc_sli_ring  *pring;
9912
9913         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9914                         "2828 PCI channel I/O abort preparing for recovery\n");
9915         /*
9916          * There may be errored I/Os through HBA, abort all I/Os on txcmplq
9917          * and let the SCSI mid-layer to retry them to recover.
9918          */
9919         pring = &psli->ring[psli->fcp_ring];
9920         lpfc_sli_abort_iocb_ring(phba, pring);
9921 }
9922
9923 /**
9924  * lpfc_sli4_prep_dev_for_reset - Prepare SLI4 device for pci slot reset
9925  * @phba: pointer to lpfc hba data structure.
9926  *
9927  * This routine is called to prepare the SLI4 device for PCI slot reset. It
9928  * disables the device interrupt and pci device, and aborts the internal FCP
9929  * pending I/Os.
9930  **/
9931 static void
9932 lpfc_sli4_prep_dev_for_reset(struct lpfc_hba *phba)
9933 {
9934         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9935                         "2826 PCI channel disable preparing for reset\n");
9936
9937         /* Block any management I/Os to the device */
9938         lpfc_block_mgmt_io(phba, LPFC_MBX_NO_WAIT);
9939
9940         /* Block all SCSI devices' I/Os on the host */
9941         lpfc_scsi_dev_block(phba);
9942
9943         /* stop all timers */
9944         lpfc_stop_hba_timers(phba);
9945
9946         /* Disable interrupt and pci device */
9947         lpfc_sli4_disable_intr(phba);
9948         lpfc_sli4_queue_destroy(phba);
9949         pci_disable_device(phba->pcidev);
9950
9951         /* Flush all driver's outstanding SCSI I/Os as we are to reset */
9952         lpfc_sli_flush_fcp_rings(phba);
9953 }
9954
9955 /**
9956  * lpfc_sli4_prep_dev_for_perm_failure - Prepare SLI4 dev for pci slot disable
9957  * @phba: pointer to lpfc hba data structure.
9958  *
9959  * This routine is called to prepare the SLI4 device for PCI slot permanently
9960  * disabling. It blocks the SCSI transport layer traffic and flushes the FCP
9961  * pending I/Os.
9962  **/
9963 static void
9964 lpfc_sli4_prep_dev_for_perm_failure(struct lpfc_hba *phba)
9965 {
9966         lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
9967                         "2827 PCI channel permanent disable for failure\n");
9968
9969         /* Block all SCSI devices' I/Os on the host */
9970         lpfc_scsi_dev_block(phba);
9971
9972         /* stop all timers */
9973         lpfc_stop_hba_timers(phba);
9974
9975         /* Clean up all driver's outstanding SCSI I/Os */
9976         lpfc_sli_flush_fcp_rings(phba);
9977 }
9978
9979 /**
9980  * lpfc_io_error_detected_s4 - Method for handling PCI I/O error to SLI-4 device
9981  * @pdev: pointer to PCI device.
9982  * @state: the current PCI connection state.
9983  *
9984  * This routine is called from the PCI subsystem for error handling to device
9985  * with SLI-4 interface spec. This function is called by the PCI subsystem
9986  * after a PCI bus error affecting this device has been detected. When this
9987  * function is invoked, it will need to stop all the I/Os and interrupt(s)
9988  * to the device. Once that is done, it will return PCI_ERS_RESULT_NEED_RESET
9989  * for the PCI subsystem to perform proper recovery as desired.
9990  *
9991  * Return codes
9992  *      PCI_ERS_RESULT_NEED_RESET - need to reset before recovery
9993  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
9994  **/
9995 static pci_ers_result_t
9996 lpfc_io_error_detected_s4(struct pci_dev *pdev, pci_channel_state_t state)
9997 {
9998         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9999         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10000
10001         switch (state) {
10002         case pci_channel_io_normal:
10003                 /* Non-fatal error, prepare for recovery */
10004                 lpfc_sli4_prep_dev_for_recover(phba);
10005                 return PCI_ERS_RESULT_CAN_RECOVER;
10006         case pci_channel_io_frozen:
10007                 /* Fatal error, prepare for slot reset */
10008                 lpfc_sli4_prep_dev_for_reset(phba);
10009                 return PCI_ERS_RESULT_NEED_RESET;
10010         case pci_channel_io_perm_failure:
10011                 /* Permanent failure, prepare for device down */
10012                 lpfc_sli4_prep_dev_for_perm_failure(phba);
10013                 return PCI_ERS_RESULT_DISCONNECT;
10014         default:
10015                 /* Unknown state, prepare and request slot reset */
10016                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10017                                 "2825 Unknown PCI error state: x%x\n", state);
10018                 lpfc_sli4_prep_dev_for_reset(phba);
10019                 return PCI_ERS_RESULT_NEED_RESET;
10020         }
10021 }
10022
10023 /**
10024  * lpfc_io_slot_reset_s4 - Method for restart PCI SLI-4 device from scratch
10025  * @pdev: pointer to PCI device.
10026  *
10027  * This routine is called from the PCI subsystem for error handling to device
10028  * with SLI-4 interface spec. It is called after PCI bus has been reset to
10029  * restart the PCI card from scratch, as if from a cold-boot. During the
10030  * PCI subsystem error recovery, after the driver returns
10031  * PCI_ERS_RESULT_NEED_RESET, the PCI subsystem will perform proper error
10032  * recovery and then call this routine before calling the .resume method to
10033  * recover the device. This function will initialize the HBA device, enable
10034  * the interrupt, but it will just put the HBA to offline state without
10035  * passing any I/O traffic.
10036  *
10037  * Return codes
10038  *      PCI_ERS_RESULT_RECOVERED - the device has been recovered
10039  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
10040  */
10041 static pci_ers_result_t
10042 lpfc_io_slot_reset_s4(struct pci_dev *pdev)
10043 {
10044         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10045         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10046         struct lpfc_sli *psli = &phba->sli;
10047         uint32_t intr_mode;
10048
10049         dev_printk(KERN_INFO, &pdev->dev, "recovering from a slot reset.\n");
10050         if (pci_enable_device_mem(pdev)) {
10051                 printk(KERN_ERR "lpfc: Cannot re-enable "
10052                         "PCI device after reset.\n");
10053                 return PCI_ERS_RESULT_DISCONNECT;
10054         }
10055
10056         pci_restore_state(pdev);
10057
10058         /*
10059          * As the new kernel behavior of pci_restore_state() API call clears
10060          * device saved_state flag, need to save the restored state again.
10061          */
10062         pci_save_state(pdev);
10063
10064         if (pdev->is_busmaster)
10065                 pci_set_master(pdev);
10066
10067         spin_lock_irq(&phba->hbalock);
10068         psli->sli_flag &= ~LPFC_SLI_ACTIVE;
10069         spin_unlock_irq(&phba->hbalock);
10070
10071         /* Configure and enable interrupt */
10072         intr_mode = lpfc_sli4_enable_intr(phba, phba->intr_mode);
10073         if (intr_mode == LPFC_INTR_ERROR) {
10074                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10075                                 "2824 Cannot re-enable interrupt after "
10076                                 "slot reset.\n");
10077                 return PCI_ERS_RESULT_DISCONNECT;
10078         } else
10079                 phba->intr_mode = intr_mode;
10080
10081         /* Log the current active interrupt mode */
10082         lpfc_log_intr_mode(phba, phba->intr_mode);
10083
10084         return PCI_ERS_RESULT_RECOVERED;
10085 }
10086
10087 /**
10088  * lpfc_io_resume_s4 - Method for resuming PCI I/O operation to SLI-4 device
10089  * @pdev: pointer to PCI device
10090  *
10091  * This routine is called from the PCI subsystem for error handling to device
10092  * with SLI-4 interface spec. It is called when kernel error recovery tells
10093  * the lpfc driver that it is ok to resume normal PCI operation after PCI bus
10094  * error recovery. After this call, traffic can start to flow from this device
10095  * again.
10096  **/
10097 static void
10098 lpfc_io_resume_s4(struct pci_dev *pdev)
10099 {
10100         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10101         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10102
10103         /*
10104          * In case of slot reset, as function reset is performed through
10105          * mailbox command which needs DMA to be enabled, this operation
10106          * has to be moved to the io resume phase. Taking device offline
10107          * will perform the necessary cleanup.
10108          */
10109         if (!(phba->sli.sli_flag & LPFC_SLI_ACTIVE)) {
10110                 /* Perform device reset */
10111                 lpfc_offline_prep(phba, LPFC_MBX_WAIT);
10112                 lpfc_offline(phba);
10113                 lpfc_sli_brdrestart(phba);
10114                 /* Bring the device back online */
10115                 lpfc_online(phba);
10116         }
10117
10118         /* Clean up Advanced Error Reporting (AER) if needed */
10119         if (phba->hba_flag & HBA_AER_ENABLED)
10120                 pci_cleanup_aer_uncorrect_error_status(pdev);
10121 }
10122
10123 /**
10124  * lpfc_pci_probe_one - lpfc PCI probe func to reg dev to PCI subsystem
10125  * @pdev: pointer to PCI device
10126  * @pid: pointer to PCI device identifier
10127  *
10128  * This routine is to be registered to the kernel's PCI subsystem. When an
10129  * Emulex HBA device is presented on PCI bus, the kernel PCI subsystem looks
10130  * at PCI device-specific information of the device and driver to see if the
10131  * driver state that it can support this kind of device. If the match is
10132  * successful, the driver core invokes this routine. This routine dispatches
10133  * the action to the proper SLI-3 or SLI-4 device probing routine, which will
10134  * do all the initialization that it needs to do to handle the HBA device
10135  * properly.
10136  *
10137  * Return code
10138  *      0 - driver can claim the device
10139  *      negative value - driver can not claim the device
10140  **/
10141 static int
10142 lpfc_pci_probe_one(struct pci_dev *pdev, const struct pci_device_id *pid)
10143 {
10144         int rc;
10145         struct lpfc_sli_intf intf;
10146
10147         if (pci_read_config_dword(pdev, LPFC_SLI_INTF, &intf.word0))
10148                 return -ENODEV;
10149
10150         if ((bf_get(lpfc_sli_intf_valid, &intf) == LPFC_SLI_INTF_VALID) &&
10151             (bf_get(lpfc_sli_intf_slirev, &intf) == LPFC_SLI_INTF_REV_SLI4))
10152                 rc = lpfc_pci_probe_one_s4(pdev, pid);
10153         else
10154                 rc = lpfc_pci_probe_one_s3(pdev, pid);
10155
10156         return rc;
10157 }
10158
10159 /**
10160  * lpfc_pci_remove_one - lpfc PCI func to unreg dev from PCI subsystem
10161  * @pdev: pointer to PCI device
10162  *
10163  * This routine is to be registered to the kernel's PCI subsystem. When an
10164  * Emulex HBA is removed from PCI bus, the driver core invokes this routine.
10165  * This routine dispatches the action to the proper SLI-3 or SLI-4 device
10166  * remove routine, which will perform all the necessary cleanup for the
10167  * device to be removed from the PCI subsystem properly.
10168  **/
10169 static void
10170 lpfc_pci_remove_one(struct pci_dev *pdev)
10171 {
10172         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10173         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10174
10175         switch (phba->pci_dev_grp) {
10176         case LPFC_PCI_DEV_LP:
10177                 lpfc_pci_remove_one_s3(pdev);
10178                 break;
10179         case LPFC_PCI_DEV_OC:
10180                 lpfc_pci_remove_one_s4(pdev);
10181                 break;
10182         default:
10183                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10184                                 "1424 Invalid PCI device group: 0x%x\n",
10185                                 phba->pci_dev_grp);
10186                 break;
10187         }
10188         return;
10189 }
10190
10191 /**
10192  * lpfc_pci_suspend_one - lpfc PCI func to suspend dev for power management
10193  * @pdev: pointer to PCI device
10194  * @msg: power management message
10195  *
10196  * This routine is to be registered to the kernel's PCI subsystem to support
10197  * system Power Management (PM). When PM invokes this method, it dispatches
10198  * the action to the proper SLI-3 or SLI-4 device suspend routine, which will
10199  * suspend the device.
10200  *
10201  * Return code
10202  *      0 - driver suspended the device
10203  *      Error otherwise
10204  **/
10205 static int
10206 lpfc_pci_suspend_one(struct pci_dev *pdev, pm_message_t msg)
10207 {
10208         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10209         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10210         int rc = -ENODEV;
10211
10212         switch (phba->pci_dev_grp) {
10213         case LPFC_PCI_DEV_LP:
10214                 rc = lpfc_pci_suspend_one_s3(pdev, msg);
10215                 break;
10216         case LPFC_PCI_DEV_OC:
10217                 rc = lpfc_pci_suspend_one_s4(pdev, msg);
10218                 break;
10219         default:
10220                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10221                                 "1425 Invalid PCI device group: 0x%x\n",
10222                                 phba->pci_dev_grp);
10223                 break;
10224         }
10225         return rc;
10226 }
10227
10228 /**
10229  * lpfc_pci_resume_one - lpfc PCI func to resume dev for power management
10230  * @pdev: pointer to PCI device
10231  *
10232  * This routine is to be registered to the kernel's PCI subsystem to support
10233  * system Power Management (PM). When PM invokes this method, it dispatches
10234  * the action to the proper SLI-3 or SLI-4 device resume routine, which will
10235  * resume the device.
10236  *
10237  * Return code
10238  *      0 - driver suspended the device
10239  *      Error otherwise
10240  **/
10241 static int
10242 lpfc_pci_resume_one(struct pci_dev *pdev)
10243 {
10244         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10245         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10246         int rc = -ENODEV;
10247
10248         switch (phba->pci_dev_grp) {
10249         case LPFC_PCI_DEV_LP:
10250                 rc = lpfc_pci_resume_one_s3(pdev);
10251                 break;
10252         case LPFC_PCI_DEV_OC:
10253                 rc = lpfc_pci_resume_one_s4(pdev);
10254                 break;
10255         default:
10256                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10257                                 "1426 Invalid PCI device group: 0x%x\n",
10258                                 phba->pci_dev_grp);
10259                 break;
10260         }
10261         return rc;
10262 }
10263
10264 /**
10265  * lpfc_io_error_detected - lpfc method for handling PCI I/O error
10266  * @pdev: pointer to PCI device.
10267  * @state: the current PCI connection state.
10268  *
10269  * This routine is registered to the PCI subsystem for error handling. This
10270  * function is called by the PCI subsystem after a PCI bus error affecting
10271  * this device has been detected. When this routine is invoked, it dispatches
10272  * the action to the proper SLI-3 or SLI-4 device error detected handling
10273  * routine, which will perform the proper error detected operation.
10274  *
10275  * Return codes
10276  *      PCI_ERS_RESULT_NEED_RESET - need to reset before recovery
10277  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
10278  **/
10279 static pci_ers_result_t
10280 lpfc_io_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
10281 {
10282         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10283         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10284         pci_ers_result_t rc = PCI_ERS_RESULT_DISCONNECT;
10285
10286         switch (phba->pci_dev_grp) {
10287         case LPFC_PCI_DEV_LP:
10288                 rc = lpfc_io_error_detected_s3(pdev, state);
10289                 break;
10290         case LPFC_PCI_DEV_OC:
10291                 rc = lpfc_io_error_detected_s4(pdev, state);
10292                 break;
10293         default:
10294                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10295                                 "1427 Invalid PCI device group: 0x%x\n",
10296                                 phba->pci_dev_grp);
10297                 break;
10298         }
10299         return rc;
10300 }
10301
10302 /**
10303  * lpfc_io_slot_reset - lpfc method for restart PCI dev from scratch
10304  * @pdev: pointer to PCI device.
10305  *
10306  * This routine is registered to the PCI subsystem for error handling. This
10307  * function is called after PCI bus has been reset to restart the PCI card
10308  * from scratch, as if from a cold-boot. When this routine is invoked, it
10309  * dispatches the action to the proper SLI-3 or SLI-4 device reset handling
10310  * routine, which will perform the proper device reset.
10311  *
10312  * Return codes
10313  *      PCI_ERS_RESULT_RECOVERED - the device has been recovered
10314  *      PCI_ERS_RESULT_DISCONNECT - device could not be recovered
10315  **/
10316 static pci_ers_result_t
10317 lpfc_io_slot_reset(struct pci_dev *pdev)
10318 {
10319         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10320         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10321         pci_ers_result_t rc = PCI_ERS_RESULT_DISCONNECT;
10322
10323         switch (phba->pci_dev_grp) {
10324         case LPFC_PCI_DEV_LP:
10325                 rc = lpfc_io_slot_reset_s3(pdev);
10326                 break;
10327         case LPFC_PCI_DEV_OC:
10328                 rc = lpfc_io_slot_reset_s4(pdev);
10329                 break;
10330         default:
10331                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10332                                 "1428 Invalid PCI device group: 0x%x\n",
10333                                 phba->pci_dev_grp);
10334                 break;
10335         }
10336         return rc;
10337 }
10338
10339 /**
10340  * lpfc_io_resume - lpfc method for resuming PCI I/O operation
10341  * @pdev: pointer to PCI device
10342  *
10343  * This routine is registered to the PCI subsystem for error handling. It
10344  * is called when kernel error recovery tells the lpfc driver that it is
10345  * OK to resume normal PCI operation after PCI bus error recovery. When
10346  * this routine is invoked, it dispatches the action to the proper SLI-3
10347  * or SLI-4 device io_resume routine, which will resume the device operation.
10348  **/
10349 static void
10350 lpfc_io_resume(struct pci_dev *pdev)
10351 {
10352         struct Scsi_Host *shost = pci_get_drvdata(pdev);
10353         struct lpfc_hba *phba = ((struct lpfc_vport *)shost->hostdata)->phba;
10354
10355         switch (phba->pci_dev_grp) {
10356         case LPFC_PCI_DEV_LP:
10357                 lpfc_io_resume_s3(pdev);
10358                 break;
10359         case LPFC_PCI_DEV_OC:
10360                 lpfc_io_resume_s4(pdev);
10361                 break;
10362         default:
10363                 lpfc_printf_log(phba, KERN_ERR, LOG_INIT,
10364                                 "1429 Invalid PCI device group: 0x%x\n",
10365                                 phba->pci_dev_grp);
10366                 break;
10367         }
10368         return;
10369 }
10370
10371 /**
10372  * lpfc_mgmt_open - method called when 'lpfcmgmt' is opened from userspace
10373  * @inode: pointer to the inode representing the lpfcmgmt device
10374  * @filep: pointer to the file representing the open lpfcmgmt device
10375  *
10376  * This routine puts a reference count on the lpfc module whenever the
10377  * character device is opened
10378  **/
10379 static int
10380 lpfc_mgmt_open(struct inode *inode, struct file *filep)
10381 {
10382         try_module_get(THIS_MODULE);
10383         return 0;
10384 }
10385
10386 /**
10387  * lpfc_mgmt_release - method called when 'lpfcmgmt' is closed in userspace
10388  * @inode: pointer to the inode representing the lpfcmgmt device
10389  * @filep: pointer to the file representing the open lpfcmgmt device
10390  *
10391  * This routine removes a reference count from the lpfc module when the
10392  * character device is closed
10393  **/
10394 static int
10395 lpfc_mgmt_release(struct inode *inode, struct file *filep)
10396 {
10397         module_put(THIS_MODULE);
10398         return 0;
10399 }
10400
10401 static struct pci_device_id lpfc_id_table[] = {
10402         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_VIPER,
10403                 PCI_ANY_ID, PCI_ANY_ID, },
10404         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_FIREFLY,
10405                 PCI_ANY_ID, PCI_ANY_ID, },
10406         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_THOR,
10407                 PCI_ANY_ID, PCI_ANY_ID, },
10408         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_PEGASUS,
10409                 PCI_ANY_ID, PCI_ANY_ID, },
10410         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_CENTAUR,
10411                 PCI_ANY_ID, PCI_ANY_ID, },
10412         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_DRAGONFLY,
10413                 PCI_ANY_ID, PCI_ANY_ID, },
10414         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SUPERFLY,
10415                 PCI_ANY_ID, PCI_ANY_ID, },
10416         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_RFLY,
10417                 PCI_ANY_ID, PCI_ANY_ID, },
10418         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_PFLY,
10419                 PCI_ANY_ID, PCI_ANY_ID, },
10420         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_NEPTUNE,
10421                 PCI_ANY_ID, PCI_ANY_ID, },
10422         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_NEPTUNE_SCSP,
10423                 PCI_ANY_ID, PCI_ANY_ID, },
10424         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_NEPTUNE_DCSP,
10425                 PCI_ANY_ID, PCI_ANY_ID, },
10426         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_HELIOS,
10427                 PCI_ANY_ID, PCI_ANY_ID, },
10428         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_HELIOS_SCSP,
10429                 PCI_ANY_ID, PCI_ANY_ID, },
10430         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_HELIOS_DCSP,
10431                 PCI_ANY_ID, PCI_ANY_ID, },
10432         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_BMID,
10433                 PCI_ANY_ID, PCI_ANY_ID, },
10434         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_BSMB,
10435                 PCI_ANY_ID, PCI_ANY_ID, },
10436         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_ZEPHYR,
10437                 PCI_ANY_ID, PCI_ANY_ID, },
10438         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_HORNET,
10439                 PCI_ANY_ID, PCI_ANY_ID, },
10440         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_ZEPHYR_SCSP,
10441                 PCI_ANY_ID, PCI_ANY_ID, },
10442         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_ZEPHYR_DCSP,
10443                 PCI_ANY_ID, PCI_ANY_ID, },
10444         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_ZMID,
10445                 PCI_ANY_ID, PCI_ANY_ID, },
10446         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_ZSMB,
10447                 PCI_ANY_ID, PCI_ANY_ID, },
10448         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_TFLY,
10449                 PCI_ANY_ID, PCI_ANY_ID, },
10450         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LP101,
10451                 PCI_ANY_ID, PCI_ANY_ID, },
10452         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LP10000S,
10453                 PCI_ANY_ID, PCI_ANY_ID, },
10454         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LP11000S,
10455                 PCI_ANY_ID, PCI_ANY_ID, },
10456         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LPE11000S,
10457                 PCI_ANY_ID, PCI_ANY_ID, },
10458         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT,
10459                 PCI_ANY_ID, PCI_ANY_ID, },
10460         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT_MID,
10461                 PCI_ANY_ID, PCI_ANY_ID, },
10462         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT_SMB,
10463                 PCI_ANY_ID, PCI_ANY_ID, },
10464         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT_DCSP,
10465                 PCI_ANY_ID, PCI_ANY_ID, },
10466         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT_SCSP,
10467                 PCI_ANY_ID, PCI_ANY_ID, },
10468         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SAT_S,
10469                 PCI_ANY_ID, PCI_ANY_ID, },
10470         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_PROTEUS_VF,
10471                 PCI_ANY_ID, PCI_ANY_ID, },
10472         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_PROTEUS_PF,
10473                 PCI_ANY_ID, PCI_ANY_ID, },
10474         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_PROTEUS_S,
10475                 PCI_ANY_ID, PCI_ANY_ID, },
10476         {PCI_VENDOR_ID_SERVERENGINE, PCI_DEVICE_ID_TIGERSHARK,
10477                 PCI_ANY_ID, PCI_ANY_ID, },
10478         {PCI_VENDOR_ID_SERVERENGINE, PCI_DEVICE_ID_TOMCAT,
10479                 PCI_ANY_ID, PCI_ANY_ID, },
10480         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_FALCON,
10481                 PCI_ANY_ID, PCI_ANY_ID, },
10482         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_BALIUS,
10483                 PCI_ANY_ID, PCI_ANY_ID, },
10484         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LANCER_FC,
10485                 PCI_ANY_ID, PCI_ANY_ID, },
10486         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LANCER_FCOE,
10487                 PCI_ANY_ID, PCI_ANY_ID, },
10488         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LANCER_FC_VF,
10489                 PCI_ANY_ID, PCI_ANY_ID, },
10490         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_LANCER_FCOE_VF,
10491                 PCI_ANY_ID, PCI_ANY_ID, },
10492         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SKYHAWK,
10493                 PCI_ANY_ID, PCI_ANY_ID, },
10494         {PCI_VENDOR_ID_EMULEX, PCI_DEVICE_ID_SKYHAWK_VF,
10495                 PCI_ANY_ID, PCI_ANY_ID, },
10496         { 0 }
10497 };
10498
10499 MODULE_DEVICE_TABLE(pci, lpfc_id_table);
10500
10501 static const struct pci_error_handlers lpfc_err_handler = {
10502         .error_detected = lpfc_io_error_detected,
10503         .slot_reset = lpfc_io_slot_reset,
10504         .resume = lpfc_io_resume,
10505 };
10506
10507 static struct pci_driver lpfc_driver = {
10508         .name           = LPFC_DRIVER_NAME,
10509         .id_table       = lpfc_id_table,
10510         .probe          = lpfc_pci_probe_one,
10511         .remove         = lpfc_pci_remove_one,
10512         .suspend        = lpfc_pci_suspend_one,
10513         .resume         = lpfc_pci_resume_one,
10514         .err_handler    = &lpfc_err_handler,
10515 };
10516
10517 static const struct file_operations lpfc_mgmt_fop = {
10518         .open = lpfc_mgmt_open,
10519         .release = lpfc_mgmt_release,
10520 };
10521
10522 static struct miscdevice lpfc_mgmt_dev = {
10523         .minor = MISC_DYNAMIC_MINOR,
10524         .name = "lpfcmgmt",
10525         .fops = &lpfc_mgmt_fop,
10526 };
10527
10528 /**
10529  * lpfc_init - lpfc module initialization routine
10530  *
10531  * This routine is to be invoked when the lpfc module is loaded into the
10532  * kernel. The special kernel macro module_init() is used to indicate the
10533  * role of this routine to the kernel as lpfc module entry point.
10534  *
10535  * Return codes
10536  *   0 - successful
10537  *   -ENOMEM - FC attach transport failed
10538  *   all others - failed
10539  */
10540 static int __init
10541 lpfc_init(void)
10542 {
10543         int error = 0;
10544
10545         printk(LPFC_MODULE_DESC "\n");
10546         printk(LPFC_COPYRIGHT "\n");
10547
10548         error = misc_register(&lpfc_mgmt_dev);
10549         if (error)
10550                 printk(KERN_ERR "Could not register lpfcmgmt device, "
10551                         "misc_register returned with status %d", error);
10552
10553         if (lpfc_enable_npiv) {
10554                 lpfc_transport_functions.vport_create = lpfc_vport_create;
10555                 lpfc_transport_functions.vport_delete = lpfc_vport_delete;
10556         }
10557         lpfc_transport_template =
10558                                 fc_attach_transport(&lpfc_transport_functions);
10559         if (lpfc_transport_template == NULL)
10560                 return -ENOMEM;
10561         if (lpfc_enable_npiv) {
10562                 lpfc_vport_transport_template =
10563                         fc_attach_transport(&lpfc_vport_transport_functions);
10564                 if (lpfc_vport_transport_template == NULL) {
10565                         fc_release_transport(lpfc_transport_template);
10566                         return -ENOMEM;
10567                 }
10568         }
10569         error = pci_register_driver(&lpfc_driver);
10570         if (error) {
10571                 fc_release_transport(lpfc_transport_template);
10572                 if (lpfc_enable_npiv)
10573                         fc_release_transport(lpfc_vport_transport_template);
10574         }
10575
10576         return error;
10577 }
10578
10579 /**
10580  * lpfc_exit - lpfc module removal routine
10581  *
10582  * This routine is invoked when the lpfc module is removed from the kernel.
10583  * The special kernel macro module_exit() is used to indicate the role of
10584  * this routine to the kernel as lpfc module exit point.
10585  */
10586 static void __exit
10587 lpfc_exit(void)
10588 {
10589         misc_deregister(&lpfc_mgmt_dev);
10590         pci_unregister_driver(&lpfc_driver);
10591         fc_release_transport(lpfc_transport_template);
10592         if (lpfc_enable_npiv)
10593                 fc_release_transport(lpfc_vport_transport_template);
10594         if (_dump_buf_data) {
10595                 printk(KERN_ERR "9062 BLKGRD: freeing %lu pages for "
10596                                 "_dump_buf_data at 0x%p\n",
10597                                 (1L << _dump_buf_data_order), _dump_buf_data);
10598                 free_pages((unsigned long)_dump_buf_data, _dump_buf_data_order);
10599         }
10600
10601         if (_dump_buf_dif) {
10602                 printk(KERN_ERR "9049 BLKGRD: freeing %lu pages for "
10603                                 "_dump_buf_dif at 0x%p\n",
10604                                 (1L << _dump_buf_dif_order), _dump_buf_dif);
10605                 free_pages((unsigned long)_dump_buf_dif, _dump_buf_dif_order);
10606         }
10607 }
10608
10609 module_init(lpfc_init);
10610 module_exit(lpfc_exit);
10611 MODULE_LICENSE("GPL");
10612 MODULE_DESCRIPTION(LPFC_MODULE_DESC);
10613 MODULE_AUTHOR("Emulex Corporation - tech.support@emulex.com");
10614 MODULE_VERSION("0:" LPFC_DRIVER_VERSION);