drivers/scsi/lpfc/lpfc_els.c

   1 /*******************************************************************
   2  * This file is part of the Emulex Linux Device Driver for         *
   3  * Fibre Channel Host Bus Adapters.                                *
   4  * Copyright (C) 2004-2005 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/pci.h>
  24 #include <linux/interrupt.h>
  25
  26 #include <scsi/scsi.h>
  27 #include <scsi/scsi_device.h>
  28 #include <scsi/scsi_host.h>
  29 #include <scsi/scsi_transport_fc.h>
  30
  31 #include "lpfc_hw.h"
  32 #include "lpfc_sli.h"
  33 #include "lpfc_disc.h"
  34 #include "lpfc_scsi.h"
  35 #include "lpfc.h"
  36 #include "lpfc_logmsg.h"
  37 #include "lpfc_crtn.h"
  38
  39 static int lpfc_els_retry(struct lpfc_hba *, struct lpfc_iocbq *,
  40                           struct lpfc_iocbq *);
  41 static int lpfc_max_els_tries = 3;
  42
  43 static int
  44 lpfc_els_chk_latt(struct lpfc_hba * phba)
  45 {
  46         struct lpfc_sli *psli;
  47         LPFC_MBOXQ_t *mbox;
  48         uint32_t ha_copy;
  49         int rc;
  50
  51         psli = &phba->sli;
  52
  53         if ((phba->hba_state >= LPFC_HBA_READY) ||
  54             (phba->hba_state == LPFC_LINK_DOWN))
  55                 return 0;
  56
  57         /* Read the HBA Host Attention Register */
  58         spin_lock_irq(phba->host->host_lock);
  59         ha_copy = readl(phba->HAregaddr);
  60         spin_unlock_irq(phba->host->host_lock);
  61
  62         if (!(ha_copy & HA_LATT))
  63                 return 0;
  64
  65         /* Pending Link Event during Discovery */
  66         lpfc_printf_log(phba, KERN_WARNING, LOG_DISCOVERY,
  67                         "%d:0237 Pending Link Event during "
  68                         "Discovery: State x%x\n",
  69                         phba->brd_no, phba->hba_state);
  70
  71         /* CLEAR_LA should re-enable link attention events and
  72          * we should then imediately take a LATT event. The
  73          * LATT processing should call lpfc_linkdown() which
  74          * will cleanup any left over in-progress discovery
  75          * events.
  76          */
  77         spin_lock_irq(phba->host->host_lock);
  78         phba->fc_flag |= FC_ABORT_DISCOVERY;
  79         spin_unlock_irq(phba->host->host_lock);
  80
  81         if (phba->hba_state != LPFC_CLEAR_LA) {
  82                 if ((mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL))) {
  83                         phba->hba_state = LPFC_CLEAR_LA;
  84                         lpfc_clear_la(phba, mbox);
  85                         mbox->mbox_cmpl = lpfc_mbx_cmpl_clear_la;
  86                         rc = lpfc_sli_issue_mbox (phba, mbox,
  87                                                   (MBX_NOWAIT | MBX_STOP_IOCB));
  88                         if (rc == MBX_NOT_FINISHED) {
  89                                 mempool_free(mbox, phba->mbox_mem_pool);
  90                                 phba->hba_state = LPFC_HBA_ERROR;
  91                         }
  92                 }
  93         }
  94
  95         return (1);
  96
  97 }
  98
  99 static struct lpfc_iocbq *
 100 lpfc_prep_els_iocb(struct lpfc_hba * phba,
 101                    uint8_t expectRsp,
 102                    uint16_t cmdSize,
 103                    uint8_t retry, struct lpfc_nodelist * ndlp, uint32_t elscmd)
 104 {
 105         struct lpfc_sli_ring *pring;
 106         struct lpfc_iocbq *elsiocb;
 107         struct lpfc_dmabuf *pcmd, *prsp, *pbuflist;
 108         struct ulp_bde64 *bpl;
 109         IOCB_t *icmd;
 110
 111         pring = &phba->sli.ring[LPFC_ELS_RING];
 112
 113         if (phba->hba_state < LPFC_LINK_UP)
 114                 return  NULL;
 115
 116         /* Allocate buffer for  command iocb */
 117         spin_lock_irq(phba->host->host_lock);
 118         elsiocb = lpfc_sli_get_iocbq(phba);
 119         spin_unlock_irq(phba->host->host_lock);
 120
 121         if (elsiocb == NULL)
 122                 return NULL;
 123         icmd = &elsiocb->iocb;
 124
 125         /* fill in BDEs for command */
 126         /* Allocate buffer for command payload */
 127         if (((pcmd = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL)) == 0) ||
 128             ((pcmd->virt = lpfc_mbuf_alloc(phba,
 129                                            MEM_PRI, &(pcmd->phys))) == 0)) {
 130                 kfree(pcmd);
 131
 132                 spin_lock_irq(phba->host->host_lock);
 133                 lpfc_sli_release_iocbq(phba, elsiocb);
 134                 spin_unlock_irq(phba->host->host_lock);
 135                 return NULL;
 136         }
 137
 138         INIT_LIST_HEAD(&pcmd->list);
 139
 140         /* Allocate buffer for response payload */
 141         if (expectRsp) {
 142                 prsp = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
 143                 if (prsp)
 144                         prsp->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
 145                                                      &prsp->phys);
 146                 if (prsp == 0 || prsp->virt == 0) {
 147                         kfree(prsp);
 148                         lpfc_mbuf_free(phba, pcmd->virt, pcmd->phys);
 149                         kfree(pcmd);
 150                         spin_lock_irq(phba->host->host_lock);
 151                         lpfc_sli_release_iocbq(phba, elsiocb);
 152                         spin_unlock_irq(phba->host->host_lock);
 153                         return NULL;
 154                 }
 155                 INIT_LIST_HEAD(&prsp->list);
 156         } else {
 157                 prsp = NULL;
 158         }
 159
 160         /* Allocate buffer for Buffer ptr list */
 161         pbuflist = kmalloc(sizeof (struct lpfc_dmabuf), GFP_KERNEL);
 162         if (pbuflist)
 163             pbuflist->virt = lpfc_mbuf_alloc(phba, MEM_PRI,
 164                                              &pbuflist->phys);
 165         if (pbuflist == 0 || pbuflist->virt == 0) {
 166                 spin_lock_irq(phba->host->host_lock);
 167                 lpfc_sli_release_iocbq(phba, elsiocb);
 168                 spin_unlock_irq(phba->host->host_lock);
 169                 lpfc_mbuf_free(phba, pcmd->virt, pcmd->phys);
 170                 lpfc_mbuf_free(phba, prsp->virt, prsp->phys);
 171                 kfree(pcmd);
 172                 kfree(prsp);
 173                 kfree(pbuflist);
 174                 return NULL;
 175         }
 176
 177         INIT_LIST_HEAD(&pbuflist->list);
 178
 179         icmd->un.elsreq64.bdl.addrHigh = putPaddrHigh(pbuflist->phys);
 180         icmd->un.elsreq64.bdl.addrLow = putPaddrLow(pbuflist->phys);
 181         icmd->un.elsreq64.bdl.bdeFlags = BUFF_TYPE_BDL;
 182         if (expectRsp) {
 183                 icmd->un.elsreq64.bdl.bdeSize = (2 * sizeof (struct ulp_bde64));
 184                 icmd->un.elsreq64.remoteID = ndlp->nlp_DID;     /* DID */
 185                 icmd->ulpCommand = CMD_ELS_REQUEST64_CR;
 186         } else {
 187                 icmd->un.elsreq64.bdl.bdeSize = sizeof (struct ulp_bde64);
 188                 icmd->ulpCommand = CMD_XMIT_ELS_RSP64_CX;
 189         }
 190
 191         icmd->ulpBdeCount = 1;
 192         icmd->ulpLe = 1;
 193         icmd->ulpClass = CLASS3;
 194
 195         bpl = (struct ulp_bde64 *) pbuflist->virt;
 196         bpl->addrLow = le32_to_cpu(putPaddrLow(pcmd->phys));
 197         bpl->addrHigh = le32_to_cpu(putPaddrHigh(pcmd->phys));
 198         bpl->tus.f.bdeSize = cmdSize;
 199         bpl->tus.f.bdeFlags = 0;
 200         bpl->tus.w = le32_to_cpu(bpl->tus.w);
 201
 202         if (expectRsp) {
 203                 bpl++;
 204                 bpl->addrLow = le32_to_cpu(putPaddrLow(prsp->phys));
 205                 bpl->addrHigh = le32_to_cpu(putPaddrHigh(prsp->phys));
 206                 bpl->tus.f.bdeSize = FCELSSIZE;
 207                 bpl->tus.f.bdeFlags = BUFF_USE_RCV;
 208                 bpl->tus.w = le32_to_cpu(bpl->tus.w);
 209         }
 210
 211         /* Save for completion so we can release these resources */
 212         elsiocb->context1 = (uint8_t *) ndlp;
 213         elsiocb->context2 = (uint8_t *) pcmd;
 214         elsiocb->context3 = (uint8_t *) pbuflist;
 215         elsiocb->retry = retry;
 216         elsiocb->drvrTimeout = (phba->fc_ratov << 1) + LPFC_DRVR_TIMEOUT;
 217
 218         if (prsp) {
 219                 list_add(&prsp->list, &pcmd->list);
 220         }
 221
 222         if (expectRsp) {
 223                 /* Xmit ELS command <elsCmd> to remote NPORT <did> */
 224                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
 225                                 "%d:0116 Xmit ELS command x%x to remote "
 226                                 "NPORT x%x Data: x%x x%x\n",
 227                                 phba->brd_no, elscmd,
 228                                 ndlp->nlp_DID, icmd->ulpIoTag, phba->hba_state);
 229         } else {
 230                 /* Xmit ELS response <elsCmd> to remote NPORT <did> */
 231                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
 232                                 "%d:0117 Xmit ELS response x%x to remote "
 233                                 "NPORT x%x Data: x%x x%x\n",
 234                                 phba->brd_no, elscmd,
 235                                 ndlp->nlp_DID, icmd->ulpIoTag, cmdSize);
 236         }
 237
 238         return (elsiocb);
 239 }
 240
 241
 242 static int
 243 lpfc_cmpl_els_flogi_fabric(struct lpfc_hba *phba, struct lpfc_nodelist *ndlp,
 244                 struct serv_parm *sp, IOCB_t *irsp)
 245 {
 246         LPFC_MBOXQ_t *mbox;
 247         int rc;
 248
 249         spin_lock_irq(phba->host->host_lock);
 250         phba->fc_flag |= FC_FABRIC;
 251         spin_unlock_irq(phba->host->host_lock);
 252
 253         phba->fc_edtov = be32_to_cpu(sp->cmn.e_d_tov);
 254         if (sp->cmn.edtovResolution)    /* E_D_TOV ticks are in nanoseconds */
 255                 phba->fc_edtov = (phba->fc_edtov + 999999) / 1000000;
 256
 257         phba->fc_ratov = (be32_to_cpu(sp->cmn.w2.r_a_tov) + 999) / 1000;
 258
 259         if (phba->fc_topology == TOPOLOGY_LOOP) {
 260                 spin_lock_irq(phba->host->host_lock);
 261                 phba->fc_flag |= FC_PUBLIC_LOOP;
 262                 spin_unlock_irq(phba->host->host_lock);
 263         } else {
 264                 /*
 265                  * If we are a N-port connected to a Fabric, fixup sparam's so
 266                  * logins to devices on remote loops work.
 267                  */
 268                 phba->fc_sparam.cmn.altBbCredit = 1;
 269         }
 270
 271         phba->fc_myDID = irsp->un.ulpWord[4] & Mask_DID;
 272         memcpy(&ndlp->nlp_portname, &sp->portName, sizeof(struct lpfc_name));
 273         memcpy(&ndlp->nlp_nodename, &sp->nodeName, sizeof (struct lpfc_name));
 274         ndlp->nlp_class_sup = 0;
 275         if (sp->cls1.classValid)
 276                 ndlp->nlp_class_sup |= FC_COS_CLASS1;
 277         if (sp->cls2.classValid)
 278                 ndlp->nlp_class_sup |= FC_COS_CLASS2;
 279         if (sp->cls3.classValid)
 280                 ndlp->nlp_class_sup |= FC_COS_CLASS3;
 281         if (sp->cls4.classValid)
 282                 ndlp->nlp_class_sup |= FC_COS_CLASS4;
 283         ndlp->nlp_maxframe = ((sp->cmn.bbRcvSizeMsb & 0x0F) << 8) |
 284                                 sp->cmn.bbRcvSizeLsb;
 285         memcpy(&phba->fc_fabparam, sp, sizeof(struct serv_parm));
 286
 287         mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 288         if (!mbox)
 289                 goto fail;
 290
 291         phba->hba_state = LPFC_FABRIC_CFG_LINK;
 292         lpfc_config_link(phba, mbox);
 293         mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 294
 295         rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT | MBX_STOP_IOCB);
 296         if (rc == MBX_NOT_FINISHED)
 297                 goto fail_free_mbox;
 298
 299         mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 300         if (!mbox)
 301                 goto fail;
 302
 303         if (lpfc_reg_login(phba, Fabric_DID, (uint8_t *) sp, mbox, 0))
 304                 goto fail_free_mbox;
 305
 306         /*
 307          * set_slim mailbox command needs to execute first,
 308          * queue this command to be processed later.
 309          */
 310         mbox->mbox_cmpl = lpfc_mbx_cmpl_fabric_reg_login;
 311         mbox->context2 = ndlp;
 312
 313         rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT | MBX_STOP_IOCB);
 314         if (rc == MBX_NOT_FINISHED)
 315                 goto fail_free_mbox;
 316
 317         return 0;
 318
 319  fail_free_mbox:
 320         mempool_free(mbox, phba->mbox_mem_pool);
 321  fail:
 322         return -ENXIO;
 323 }
 324
 325 /*
 326  * We FLOGIed into an NPort, initiate pt2pt protocol
 327  */
 328 static int
 329 lpfc_cmpl_els_flogi_nport(struct lpfc_hba *phba, struct lpfc_nodelist *ndlp,
 330                 struct serv_parm *sp)
 331 {
 332         LPFC_MBOXQ_t *mbox;
 333         int rc;
 334
 335         spin_lock_irq(phba->host->host_lock);
 336         phba->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
 337         spin_unlock_irq(phba->host->host_lock);
 338
 339         phba->fc_edtov = FF_DEF_EDTOV;
 340         phba->fc_ratov = FF_DEF_RATOV;
 341         rc = memcmp(&phba->fc_portname, &sp->portName,
 342                         sizeof(struct lpfc_name));
 343         if (rc >= 0) {
 344                 /* This side will initiate the PLOGI */
 345                 spin_lock_irq(phba->host->host_lock);
 346                 phba->fc_flag |= FC_PT2PT_PLOGI;
 347                 spin_unlock_irq(phba->host->host_lock);
 348
 349                 /*
 350                  * N_Port ID cannot be 0, set our to LocalID the other
 351                  * side will be RemoteID.
 352                  */
 353
 354                 /* not equal */
 355                 if (rc)
 356                         phba->fc_myDID = PT2PT_LocalID;
 357
 358                 mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);
 359                 if (!mbox)
 360                         goto fail;
 361
 362                 lpfc_config_link(phba, mbox);
 363
 364                 mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
 365                 rc = lpfc_sli_issue_mbox(phba, mbox,
 366                                 MBX_NOWAIT | MBX_STOP_IOCB);
 367                 if (rc == MBX_NOT_FINISHED) {
 368                         mempool_free(mbox, phba->mbox_mem_pool);
 369                         goto fail;
 370                 }
 371                 mempool_free(ndlp, phba->nlp_mem_pool);
 372
 373                 ndlp = lpfc_findnode_did(phba, NLP_SEARCH_ALL, PT2PT_RemoteID);
 374                 if (!ndlp) {
 375                         /*
 376                          * Cannot find existing Fabric ndlp, so allocate a
 377                          * new one
 378                          */
 379                         ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL);
 380                         if (!ndlp)
 381                                 goto fail;
 382
 383                         lpfc_nlp_init(phba, ndlp, PT2PT_RemoteID);
 384                 }
 385
 386                 memcpy(&ndlp->nlp_portname, &sp->portName,
 387                                 sizeof(struct lpfc_name));
 388                 memcpy(&ndlp->nlp_nodename, &sp->nodeName,
 389                                 sizeof(struct lpfc_name));
 390                 ndlp->nlp_state = NLP_STE_NPR_NODE;
 391                 lpfc_nlp_list(phba, ndlp, NLP_NPR_LIST);
 392                 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
 393         } else {
 394                 /* This side will wait for the PLOGI */
 395                 mempool_free( ndlp, phba->nlp_mem_pool);
 396         }
 397
 398         spin_lock_irq(phba->host->host_lock);
 399         phba->fc_flag |= FC_PT2PT;
 400         spin_unlock_irq(phba->host->host_lock);
 401
 402         /* Start discovery - this should just do CLEAR_LA */
 403         lpfc_disc_start(phba);
 404         return 0;
 405  fail:
 406         return -ENXIO;
 407 }
 408
 409 static void
 410 lpfc_cmpl_els_flogi(struct lpfc_hba * phba,
 411                     struct lpfc_iocbq * cmdiocb, struct lpfc_iocbq * rspiocb)
 412 {
 413         IOCB_t *irsp = &rspiocb->iocb;
 414         struct lpfc_nodelist *ndlp = cmdiocb->context1;
 415         struct lpfc_dmabuf *pcmd = cmdiocb->context2, *prsp;
 416         struct serv_parm *sp;
 417         int rc;
 418
 419         /* Check to see if link went down during discovery */
 420         if (lpfc_els_chk_latt(phba)) {
 421                 lpfc_nlp_remove(phba, ndlp);
 422                 goto out;
 423         }
 424
 425         if (irsp->ulpStatus) {
 426                 /* Check for retry */
 427                 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
 428                         /* ELS command is being retried */
 429                         goto out;
 430                 }
 431                 /* FLOGI failed, so there is no fabric */
 432                 spin_lock_irq(phba->host->host_lock);
 433                 phba->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
 434                 spin_unlock_irq(phba->host->host_lock);
 435
 436                 /* If private loop, then allow max outstandting els to be
 437                  * LPFC_MAX_DISC_THREADS (32). Scanning in the case of no
 438                  * alpa map would take too long otherwise.
 439                  */
 440                 if (phba->alpa_map[0] == 0) {
 441                         phba->cfg_discovery_threads =
 442                             LPFC_MAX_DISC_THREADS;
 443                 }
 444
 445                 /* FLOGI failure */
 446                 lpfc_printf_log(phba,
 447                                 KERN_INFO,
 448                                 LOG_ELS,
 449                                 "%d:0100 FLOGI failure Data: x%x x%x\n",
 450                                 phba->brd_no,
 451                                 irsp->ulpStatus, irsp->un.ulpWord[4]);
 452                 goto flogifail;
 453         }
 454
 455         /*
 456          * The FLogI succeeded.  Sync the data for the CPU before
 457          * accessing it.
 458          */
 459         prsp = list_get_first(&pcmd->list, struct lpfc_dmabuf, list);
 460
 461         sp = prsp->virt + sizeof(uint32_t);
 462
 463         /* FLOGI completes successfully */
 464         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
 465                         "%d:0101 FLOGI completes sucessfully "
 466                         "Data: x%x x%x x%x x%x\n",
 467                         phba->brd_no,
 468                         irsp->un.ulpWord[4], sp->cmn.e_d_tov,
 469                         sp->cmn.w2.r_a_tov, sp->cmn.edtovResolution);
 470
 471         if (phba->hba_state == LPFC_FLOGI) {
 472                 /*
 473                  * If Common Service Parameters indicate Nport
 474                  * we are point to point, if Fport we are Fabric.
 475                  */
 476                 if (sp->cmn.fPort)
 477                         rc = lpfc_cmpl_els_flogi_fabric(phba, ndlp, sp, irsp);
 478                 else
 479                         rc = lpfc_cmpl_els_flogi_nport(phba, ndlp, sp);
 480
 481                 if (!rc)
 482                         goto out;
 483         }
 484
 485 flogifail:
 486         lpfc_nlp_remove(phba, ndlp);
 487
 488         if (irsp->ulpStatus != IOSTAT_LOCAL_REJECT ||
 489             (irsp->un.ulpWord[4] != IOERR_SLI_ABORTED &&
 490              irsp->un.ulpWord[4] != IOERR_SLI_DOWN)) {
 491                 /* FLOGI failed, so just use loop map to make discovery list */
 492                 lpfc_disc_list_loopmap(phba);
 493
 494                 /* Start discovery */
 495                 lpfc_disc_start(phba);
 496         }
 497
 498 out:
 499         lpfc_els_free_iocb(phba, cmdiocb);
 500 }
 501
 502 static int
 503 lpfc_issue_els_flogi(struct lpfc_hba * phba, struct lpfc_nodelist * ndlp,
 504                      uint8_t retry)
 505 {
 506         struct serv_parm *sp;
 507         IOCB_t *icmd;
 508         struct lpfc_iocbq *elsiocb;
 509         struct lpfc_sli_ring *pring;
 510         uint8_t *pcmd;
 511         uint16_t cmdsize;
 512         uint32_t tmo;
 513         int rc;
 514
 515         pring = &phba->sli.ring[LPFC_ELS_RING];
 516
 517         cmdsize = (sizeof (uint32_t) + sizeof (struct serv_parm));
 518         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
 519                                           ndlp, ELS_CMD_FLOGI)) == 0) {
 520                 return (1);
 521         }
 522
 523         icmd = &elsiocb->iocb;
 524         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
 525
 526         /* For FLOGI request, remainder of payload is service parameters */
 527         *((uint32_t *) (pcmd)) = ELS_CMD_FLOGI;
 528         pcmd += sizeof (uint32_t);
 529         memcpy(pcmd, &phba->fc_sparam, sizeof (struct serv_parm));
 530         sp = (struct serv_parm *) pcmd;
 531
 532         /* Setup CSPs accordingly for Fabric */
 533         sp->cmn.e_d_tov = 0;
 534         sp->cmn.w2.r_a_tov = 0;
 535         sp->cls1.classValid = 0;
 536         sp->cls2.seqDelivery = 1;
 537         sp->cls3.seqDelivery = 1;
 538         if (sp->cmn.fcphLow < FC_PH3)
 539                 sp->cmn.fcphLow = FC_PH3;
 540         if (sp->cmn.fcphHigh < FC_PH3)
 541                 sp->cmn.fcphHigh = FC_PH3;
 542
 543         tmo = phba->fc_ratov;
 544         phba->fc_ratov = LPFC_DISC_FLOGI_TMO;
 545         lpfc_set_disctmo(phba);
 546         phba->fc_ratov = tmo;
 547
 548         phba->fc_stat.elsXmitFLOGI++;
 549         elsiocb->iocb_cmpl = lpfc_cmpl_els_flogi;
 550         spin_lock_irq(phba->host->host_lock);
 551         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
 552         spin_unlock_irq(phba->host->host_lock);
 553         if (rc == IOCB_ERROR) {
 554                 lpfc_els_free_iocb(phba, elsiocb);
 555                 return (1);
 556         }
 557         return (0);
 558 }
 559
 560 int
 561 lpfc_els_abort_flogi(struct lpfc_hba * phba)
 562 {
 563         struct lpfc_sli_ring *pring;
 564         struct lpfc_iocbq *iocb, *next_iocb;
 565         struct lpfc_nodelist *ndlp;
 566         IOCB_t *icmd;
 567
 568         /* Abort outstanding I/O on NPort <nlp_DID> */
 569         lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
 570                         "%d:0201 Abort outstanding I/O on NPort x%x\n",
 571                         phba->brd_no, Fabric_DID);
 572
 573         pring = &phba->sli.ring[LPFC_ELS_RING];
 574
 575         /*
 576          * Check the txcmplq for an iocb that matches the nport the driver is
 577          * searching for.
 578          */
 579         spin_lock_irq(phba->host->host_lock);
 580         list_for_each_entry_safe(iocb, next_iocb, &pring->txcmplq, list) {
 581                 icmd = &iocb->iocb;
 582                 if (icmd->ulpCommand == CMD_ELS_REQUEST64_CR) {
 583                         ndlp = (struct lpfc_nodelist *)(iocb->context1);
 584                         if (ndlp && (ndlp->nlp_DID == Fabric_DID)) {
 585                                 list_del(&iocb->list);
 586                                 pring->txcmplq_cnt--;
 587
 588                                 if ((icmd->un.elsreq64.bdl.ulpIoTag32)) {
 589                                         lpfc_sli_issue_abort_iotag32
 590                                                 (phba, pring, iocb);
 591                                 }
 592                                 if (iocb->iocb_cmpl) {
 593                                         icmd->ulpStatus = IOSTAT_LOCAL_REJECT;
 594                                         icmd->un.ulpWord[4] =
 595                                             IOERR_SLI_ABORTED;
 596                                         spin_unlock_irq(phba->host->host_lock);
 597                                         (iocb->iocb_cmpl) (phba, iocb, iocb);
 598                                         spin_lock_irq(phba->host->host_lock);
 599                                 } else
 600                                         lpfc_sli_release_iocbq(phba, iocb);
 601                         }
 602                 }
 603         }
 604         spin_unlock_irq(phba->host->host_lock);
 605
 606         return 0;
 607 }
 608
 609 int
 610 lpfc_initial_flogi(struct lpfc_hba * phba)
 611 {
 612         struct lpfc_nodelist *ndlp;
 613
 614         /* First look for Fabric ndlp on the unmapped list */
 615
 616         if ((ndlp =
 617              lpfc_findnode_did(phba, NLP_SEARCH_UNMAPPED,
 618                                Fabric_DID)) == 0) {
 619                 /* Cannot find existing Fabric ndlp, so allocate a new one */
 620                 if ((ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL))
 621                     == 0) {
 622                         return (0);
 623                 }
 624                 lpfc_nlp_init(phba, ndlp, Fabric_DID);
 625         }
 626         else {
 627                 phba->fc_unmap_cnt--;
 628                 list_del(&ndlp->nlp_listp);
 629                 spin_lock_irq(phba->host->host_lock);
 630                 ndlp->nlp_flag &= ~NLP_LIST_MASK;
 631                 spin_unlock_irq(phba->host->host_lock);
 632         }
 633         if (lpfc_issue_els_flogi(phba, ndlp, 0)) {
 634                 mempool_free( ndlp, phba->nlp_mem_pool);
 635         }
 636         return (1);
 637 }
 638
 639 static void
 640 lpfc_more_plogi(struct lpfc_hba * phba)
 641 {
 642         int sentplogi;
 643
 644         if (phba->num_disc_nodes)
 645                 phba->num_disc_nodes--;
 646
 647         /* Continue discovery with <num_disc_nodes> PLOGIs to go */
 648         lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
 649                         "%d:0232 Continue discovery with %d PLOGIs to go "
 650                         "Data: x%x x%x x%x\n",
 651                         phba->brd_no, phba->num_disc_nodes, phba->fc_plogi_cnt,
 652                         phba->fc_flag, phba->hba_state);
 653
 654         /* Check to see if there are more PLOGIs to be sent */
 655         if (phba->fc_flag & FC_NLP_MORE) {
 656                 /* go thru NPR list and issue any remaining ELS PLOGIs */
 657                 sentplogi = lpfc_els_disc_plogi(phba);
 658         }
 659         return;
 660 }
 661
 662 static void
 663 lpfc_cmpl_els_plogi(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
 664                     struct lpfc_iocbq * rspiocb)
 665 {
 666         IOCB_t *irsp;
 667         struct lpfc_sli *psli;
 668         struct lpfc_nodelist *ndlp;
 669         int disc, rc, did, type;
 670
 671         psli = &phba->sli;
 672
 673         /* we pass cmdiocb to state machine which needs rspiocb as well */
 674         cmdiocb->context_un.rsp_iocb = rspiocb;
 675
 676         irsp = &rspiocb->iocb;
 677         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
 678         spin_lock_irq(phba->host->host_lock);
 679         ndlp->nlp_flag &= ~NLP_PLOGI_SND;
 680         spin_unlock_irq(phba->host->host_lock);
 681
 682         /* Since ndlp can be freed in the disc state machine, note if this node
 683          * is being used during discovery.
 684          */
 685         disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
 686         rc   = 0;
 687
 688         /* PLOGI completes to NPort <nlp_DID> */
 689         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
 690                         "%d:0102 PLOGI completes to NPort x%x "
 691                         "Data: x%x x%x x%x x%x\n",
 692                         phba->brd_no, ndlp->nlp_DID, irsp->ulpStatus,
 693                         irsp->un.ulpWord[4], disc, phba->num_disc_nodes);
 694
 695         /* Check to see if link went down during discovery */
 696         if (lpfc_els_chk_latt(phba)) {
 697                 spin_lock_irq(phba->host->host_lock);
 698                 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
 699                 spin_unlock_irq(phba->host->host_lock);
 700                 goto out;
 701         }
 702
 703         /* ndlp could be freed in DSM, save these values now */
 704         type = ndlp->nlp_type;
 705         did = ndlp->nlp_DID;
 706
 707         if (irsp->ulpStatus) {
 708                 /* Check for retry */
 709                 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
 710                         /* ELS command is being retried */
 711                         if (disc) {
 712                                 spin_lock_irq(phba->host->host_lock);
 713                                 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
 714                                 spin_unlock_irq(phba->host->host_lock);
 715                         }
 716                         goto out;
 717                 }
 718
 719                 /* PLOGI failed */
 720                 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
 721                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
 722                    ((irsp->un.ulpWord[4] == IOERR_SLI_ABORTED) ||
 723                    (irsp->un.ulpWord[4] == IOERR_SLI_DOWN))) {
 724                         disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
 725                 }
 726                 else {
 727                         rc = lpfc_disc_state_machine(phba, ndlp, cmdiocb,
 728                                         NLP_EVT_CMPL_PLOGI);
 729                 }
 730         } else {
 731                 /* Good status, call state machine */
 732                 rc = lpfc_disc_state_machine(phba, ndlp, cmdiocb,
 733                                         NLP_EVT_CMPL_PLOGI);
 734         }
 735
 736         if (type & NLP_FABRIC) {
 737                 /* If we cannot login to Nameserver, kick off discovery now */
 738                 if ((did == NameServer_DID) && (rc == NLP_STE_FREED_NODE)) {
 739                         lpfc_disc_start(phba);
 740                 }
 741                 goto out;
 742         }
 743
 744         if (disc && phba->num_disc_nodes) {
 745                 /* Check to see if there are more PLOGIs to be sent */
 746                 lpfc_more_plogi(phba);
 747         }
 748
 749         if (rc != NLP_STE_FREED_NODE) {
 750                 spin_lock_irq(phba->host->host_lock);
 751                 ndlp->nlp_flag &= ~NLP_NPR_2B_DISC;
 752                 spin_unlock_irq(phba->host->host_lock);
 753         }
 754
 755         if (phba->num_disc_nodes == 0) {
 756                 if(disc) {
 757                         spin_lock_irq(phba->host->host_lock);
 758                         phba->fc_flag &= ~FC_NDISC_ACTIVE;
 759                         spin_unlock_irq(phba->host->host_lock);
 760                 }
 761                 lpfc_can_disctmo(phba);
 762                 if (phba->fc_flag & FC_RSCN_MODE) {
 763                         /* Check to see if more RSCNs came in while we were
 764                          * processing this one.
 765                          */
 766                         if ((phba->fc_rscn_id_cnt == 0) &&
 767                             (!(phba->fc_flag & FC_RSCN_DISCOVERY))) {
 768                                 spin_lock_irq(phba->host->host_lock);
 769                                 phba->fc_flag &= ~FC_RSCN_MODE;
 770                                 spin_unlock_irq(phba->host->host_lock);
 771                         } else {
 772                                 lpfc_els_handle_rscn(phba);
 773                         }
 774                 }
 775         }
 776
 777 out:
 778         lpfc_els_free_iocb(phba, cmdiocb);
 779         return;
 780 }
 781
 782 int
 783 lpfc_issue_els_plogi(struct lpfc_hba * phba, struct lpfc_nodelist * ndlp,
 784                      uint8_t retry)
 785 {
 786         struct serv_parm *sp;
 787         IOCB_t *icmd;
 788         struct lpfc_iocbq *elsiocb;
 789         struct lpfc_sli_ring *pring;
 790         struct lpfc_sli *psli;
 791         uint8_t *pcmd;
 792         uint16_t cmdsize;
 793
 794         psli = &phba->sli;
 795         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
 796
 797         cmdsize = (sizeof (uint32_t) + sizeof (struct serv_parm));
 798         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
 799                                           ndlp, ELS_CMD_PLOGI)) == 0) {
 800                 return (1);
 801         }
 802
 803         icmd = &elsiocb->iocb;
 804         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
 805
 806         /* For PLOGI request, remainder of payload is service parameters */
 807         *((uint32_t *) (pcmd)) = ELS_CMD_PLOGI;
 808         pcmd += sizeof (uint32_t);
 809         memcpy(pcmd, &phba->fc_sparam, sizeof (struct serv_parm));
 810         sp = (struct serv_parm *) pcmd;
 811
 812         if (sp->cmn.fcphLow < FC_PH_4_3)
 813                 sp->cmn.fcphLow = FC_PH_4_3;
 814
 815         if (sp->cmn.fcphHigh < FC_PH3)
 816                 sp->cmn.fcphHigh = FC_PH3;
 817
 818         phba->fc_stat.elsXmitPLOGI++;
 819         elsiocb->iocb_cmpl = lpfc_cmpl_els_plogi;
 820         spin_lock_irq(phba->host->host_lock);
 821         ndlp->nlp_flag |= NLP_PLOGI_SND;
 822         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
 823                 ndlp->nlp_flag &= ~NLP_PLOGI_SND;
 824                 spin_unlock_irq(phba->host->host_lock);
 825                 lpfc_els_free_iocb(phba, elsiocb);
 826                 return (1);
 827         }
 828         spin_unlock_irq(phba->host->host_lock);
 829         return (0);
 830 }
 831
 832 static void
 833 lpfc_cmpl_els_prli(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
 834                    struct lpfc_iocbq * rspiocb)
 835 {
 836         IOCB_t *irsp;
 837         struct lpfc_sli *psli;
 838         struct lpfc_nodelist *ndlp;
 839
 840         psli = &phba->sli;
 841         /* we pass cmdiocb to state machine which needs rspiocb as well */
 842         cmdiocb->context_un.rsp_iocb = rspiocb;
 843
 844         irsp = &(rspiocb->iocb);
 845         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
 846         spin_lock_irq(phba->host->host_lock);
 847         ndlp->nlp_flag &= ~NLP_PRLI_SND;
 848         spin_unlock_irq(phba->host->host_lock);
 849
 850         /* PRLI completes to NPort <nlp_DID> */
 851         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
 852                         "%d:0103 PRLI completes to NPort x%x "
 853                         "Data: x%x x%x x%x\n",
 854                         phba->brd_no, ndlp->nlp_DID, irsp->ulpStatus,
 855                         irsp->un.ulpWord[4], phba->num_disc_nodes);
 856
 857         phba->fc_prli_sent--;
 858         /* Check to see if link went down during discovery */
 859         if (lpfc_els_chk_latt(phba))
 860                 goto out;
 861
 862         if (irsp->ulpStatus) {
 863                 /* Check for retry */
 864                 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
 865                         /* ELS command is being retried */
 866                         goto out;
 867                 }
 868                 /* PRLI failed */
 869                 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
 870                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
 871                    ((irsp->un.ulpWord[4] == IOERR_SLI_ABORTED) ||
 872                    (irsp->un.ulpWord[4] == IOERR_SLI_DOWN))) {
 873                         goto out;
 874                 }
 875                 else {
 876                         lpfc_disc_state_machine(phba, ndlp, cmdiocb,
 877                                         NLP_EVT_CMPL_PRLI);
 878                 }
 879         } else {
 880                 /* Good status, call state machine */
 881                 lpfc_disc_state_machine(phba, ndlp, cmdiocb, NLP_EVT_CMPL_PRLI);
 882         }
 883
 884 out:
 885         lpfc_els_free_iocb(phba, cmdiocb);
 886         return;
 887 }
 888
 889 int
 890 lpfc_issue_els_prli(struct lpfc_hba * phba, struct lpfc_nodelist * ndlp,
 891                     uint8_t retry)
 892 {
 893         PRLI *npr;
 894         IOCB_t *icmd;
 895         struct lpfc_iocbq *elsiocb;
 896         struct lpfc_sli_ring *pring;
 897         struct lpfc_sli *psli;
 898         uint8_t *pcmd;
 899         uint16_t cmdsize;
 900
 901         psli = &phba->sli;
 902         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
 903
 904         cmdsize = (sizeof (uint32_t) + sizeof (PRLI));
 905         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
 906                                           ndlp, ELS_CMD_PRLI)) == 0) {
 907                 return (1);
 908         }
 909
 910         icmd = &elsiocb->iocb;
 911         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
 912
 913         /* For PRLI request, remainder of payload is service parameters */
 914         memset(pcmd, 0, (sizeof (PRLI) + sizeof (uint32_t)));
 915         *((uint32_t *) (pcmd)) = ELS_CMD_PRLI;
 916         pcmd += sizeof (uint32_t);
 917
 918         /* For PRLI, remainder of payload is PRLI parameter page */
 919         npr = (PRLI *) pcmd;
 920         /*
 921          * If our firmware version is 3.20 or later,
 922          * set the following bits for FC-TAPE support.
 923          */
 924         if (phba->vpd.rev.feaLevelHigh >= 0x02) {
 925                 npr->ConfmComplAllowed = 1;
 926                 npr->Retry = 1;
 927                 npr->TaskRetryIdReq = 1;
 928         }
 929         npr->estabImagePair = 1;
 930         npr->readXferRdyDis = 1;
 931
 932         /* For FCP support */
 933         npr->prliType = PRLI_FCP_TYPE;
 934         npr->initiatorFunc = 1;
 935
 936         phba->fc_stat.elsXmitPRLI++;
 937         elsiocb->iocb_cmpl = lpfc_cmpl_els_prli;
 938         spin_lock_irq(phba->host->host_lock);
 939         ndlp->nlp_flag |= NLP_PRLI_SND;
 940         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
 941                 ndlp->nlp_flag &= ~NLP_PRLI_SND;
 942                 spin_unlock_irq(phba->host->host_lock);
 943                 lpfc_els_free_iocb(phba, elsiocb);
 944                 return (1);
 945         }
 946         spin_unlock_irq(phba->host->host_lock);
 947         phba->fc_prli_sent++;
 948         return (0);
 949 }
 950
 951 static void
 952 lpfc_more_adisc(struct lpfc_hba * phba)
 953 {
 954         int sentadisc;
 955
 956         if (phba->num_disc_nodes)
 957                 phba->num_disc_nodes--;
 958
 959         /* Continue discovery with <num_disc_nodes> ADISCs to go */
 960         lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
 961                         "%d:0210 Continue discovery with %d ADISCs to go "
 962                         "Data: x%x x%x x%x\n",
 963                         phba->brd_no, phba->num_disc_nodes, phba->fc_adisc_cnt,
 964                         phba->fc_flag, phba->hba_state);
 965
 966         /* Check to see if there are more ADISCs to be sent */
 967         if (phba->fc_flag & FC_NLP_MORE) {
 968                 lpfc_set_disctmo(phba);
 969
 970                 /* go thru NPR list and issue any remaining ELS ADISCs */
 971                 sentadisc = lpfc_els_disc_adisc(phba);
 972         }
 973         return;
 974 }
 975
 976 static void
 977 lpfc_rscn_disc(struct lpfc_hba * phba)
 978 {
 979         /* RSCN discovery */
 980         /* go thru NPR list and issue ELS PLOGIs */
 981         if (phba->fc_npr_cnt) {
 982                 if (lpfc_els_disc_plogi(phba))
 983                         return;
 984         }
 985         if (phba->fc_flag & FC_RSCN_MODE) {
 986                 /* Check to see if more RSCNs came in while we were
 987                  * processing this one.
 988                  */
 989                 if ((phba->fc_rscn_id_cnt == 0) &&
 990                     (!(phba->fc_flag & FC_RSCN_DISCOVERY))) {
 991                         spin_lock_irq(phba->host->host_lock);
 992                         phba->fc_flag &= ~FC_RSCN_MODE;
 993                         spin_unlock_irq(phba->host->host_lock);
 994                 } else {
 995                         lpfc_els_handle_rscn(phba);
 996                 }
 997         }
 998 }
 999
1000 static void
1001 lpfc_cmpl_els_adisc(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1002                     struct lpfc_iocbq * rspiocb)
1003 {
1004         IOCB_t *irsp;
1005         struct lpfc_sli *psli;
1006         struct lpfc_nodelist *ndlp;
1007         LPFC_MBOXQ_t *mbox;
1008         int disc, rc;
1009
1010         psli = &phba->sli;
1011
1012         /* we pass cmdiocb to state machine which needs rspiocb as well */
1013         cmdiocb->context_un.rsp_iocb = rspiocb;
1014
1015         irsp = &(rspiocb->iocb);
1016         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1017         spin_lock_irq(phba->host->host_lock);
1018         ndlp->nlp_flag &= ~NLP_ADISC_SND;
1019         spin_unlock_irq(phba->host->host_lock);
1020
1021         /* Since ndlp can be freed in the disc state machine, note if this node
1022          * is being used during discovery.
1023          */
1024         disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
1025
1026         /* ADISC completes to NPort <nlp_DID> */
1027         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1028                         "%d:0104 ADISC completes to NPort x%x "
1029                         "Data: x%x x%x x%x x%x\n",
1030                         phba->brd_no, ndlp->nlp_DID, irsp->ulpStatus,
1031                         irsp->un.ulpWord[4], disc, phba->num_disc_nodes);
1032
1033         /* Check to see if link went down during discovery */
1034         if (lpfc_els_chk_latt(phba)) {
1035                 spin_lock_irq(phba->host->host_lock);
1036                 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1037                 spin_unlock_irq(phba->host->host_lock);
1038                 goto out;
1039         }
1040
1041         if (irsp->ulpStatus) {
1042                 /* Check for retry */
1043                 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1044                         /* ELS command is being retried */
1045                         if (disc) {
1046                                 spin_lock_irq(phba->host->host_lock);
1047                                 ndlp->nlp_flag |= NLP_NPR_2B_DISC;
1048                                 spin_unlock_irq(phba->host->host_lock);
1049                                 lpfc_set_disctmo(phba);
1050                         }
1051                         goto out;
1052                 }
1053                 /* ADISC failed */
1054                 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1055                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
1056                    ((irsp->un.ulpWord[4] == IOERR_SLI_ABORTED) ||
1057                    (irsp->un.ulpWord[4] == IOERR_SLI_DOWN))) {
1058                         disc = (ndlp->nlp_flag & NLP_NPR_2B_DISC);
1059                 }
1060                 else {
1061                         lpfc_disc_state_machine(phba, ndlp, cmdiocb,
1062                                         NLP_EVT_CMPL_ADISC);
1063                 }
1064         } else {
1065                 /* Good status, call state machine */
1066                 lpfc_disc_state_machine(phba, ndlp, cmdiocb,
1067                                         NLP_EVT_CMPL_ADISC);
1068         }
1069
1070         if (disc && phba->num_disc_nodes) {
1071                 /* Check to see if there are more ADISCs to be sent */
1072                 lpfc_more_adisc(phba);
1073
1074                 /* Check to see if we are done with ADISC authentication */
1075                 if (phba->num_disc_nodes == 0) {
1076                         lpfc_can_disctmo(phba);
1077                         /* If we get here, there is nothing left to wait for */
1078                         if ((phba->hba_state < LPFC_HBA_READY) &&
1079                             (phba->hba_state != LPFC_CLEAR_LA)) {
1080                                 /* Link up discovery */
1081                                 if ((mbox = mempool_alloc(phba->mbox_mem_pool,
1082                                                           GFP_KERNEL))) {
1083                                         phba->hba_state = LPFC_CLEAR_LA;
1084                                         lpfc_clear_la(phba, mbox);
1085                                         mbox->mbox_cmpl =
1086                                             lpfc_mbx_cmpl_clear_la;
1087                                         rc = lpfc_sli_issue_mbox
1088                                                 (phba, mbox,
1089                                                  (MBX_NOWAIT | MBX_STOP_IOCB));
1090                                         if (rc == MBX_NOT_FINISHED) {
1091                                                 mempool_free(mbox,
1092                                                      phba->mbox_mem_pool);
1093                                                 lpfc_disc_flush_list(phba);
1094                                                 psli->ring[(psli->ip_ring)].
1095                                                     flag &=
1096                                                     ~LPFC_STOP_IOCB_EVENT;
1097                                                 psli->ring[(psli->fcp_ring)].
1098                                                     flag &=
1099                                                     ~LPFC_STOP_IOCB_EVENT;
1100                                                 psli->ring[(psli->next_ring)].
1101                                                     flag &=
1102                                                     ~LPFC_STOP_IOCB_EVENT;
1103                                                 phba->hba_state =
1104                                                     LPFC_HBA_READY;
1105                                         }
1106                                 }
1107                         } else {
1108                                 lpfc_rscn_disc(phba);
1109                         }
1110                 }
1111         }
1112         spin_lock_irq(phba->host->host_lock);
1113         ndlp->nlp_flag &= ~NLP_NPR_2B_DISC;
1114         spin_unlock_irq(phba->host->host_lock);
1115 out:
1116         lpfc_els_free_iocb(phba, cmdiocb);
1117         return;
1118 }
1119
1120 int
1121 lpfc_issue_els_adisc(struct lpfc_hba * phba, struct lpfc_nodelist * ndlp,
1122                      uint8_t retry)
1123 {
1124         ADISC *ap;
1125         IOCB_t *icmd;
1126         struct lpfc_iocbq *elsiocb;
1127         struct lpfc_sli_ring *pring;
1128         struct lpfc_sli *psli;
1129         uint8_t *pcmd;
1130         uint16_t cmdsize;
1131
1132         psli = &phba->sli;
1133         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1134
1135         cmdsize = (sizeof (uint32_t) + sizeof (ADISC));
1136         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
1137                                           ndlp, ELS_CMD_ADISC)) == 0) {
1138                 return (1);
1139         }
1140
1141         icmd = &elsiocb->iocb;
1142         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1143
1144         /* For ADISC request, remainder of payload is service parameters */
1145         *((uint32_t *) (pcmd)) = ELS_CMD_ADISC;
1146         pcmd += sizeof (uint32_t);
1147
1148         /* Fill in ADISC payload */
1149         ap = (ADISC *) pcmd;
1150         ap->hardAL_PA = phba->fc_pref_ALPA;
1151         memcpy(&ap->portName, &phba->fc_portname, sizeof (struct lpfc_name));
1152         memcpy(&ap->nodeName, &phba->fc_nodename, sizeof (struct lpfc_name));
1153         ap->DID = be32_to_cpu(phba->fc_myDID);
1154
1155         phba->fc_stat.elsXmitADISC++;
1156         elsiocb->iocb_cmpl = lpfc_cmpl_els_adisc;
1157         spin_lock_irq(phba->host->host_lock);
1158         ndlp->nlp_flag |= NLP_ADISC_SND;
1159         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1160                 ndlp->nlp_flag &= ~NLP_ADISC_SND;
1161                 spin_unlock_irq(phba->host->host_lock);
1162                 lpfc_els_free_iocb(phba, elsiocb);
1163                 return (1);
1164         }
1165         spin_unlock_irq(phba->host->host_lock);
1166         return (0);
1167 }
1168
1169 static void
1170 lpfc_cmpl_els_logo(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1171                    struct lpfc_iocbq * rspiocb)
1172 {
1173         IOCB_t *irsp;
1174         struct lpfc_sli *psli;
1175         struct lpfc_nodelist *ndlp;
1176
1177         psli = &phba->sli;
1178         /* we pass cmdiocb to state machine which needs rspiocb as well */
1179         cmdiocb->context_un.rsp_iocb = rspiocb;
1180
1181         irsp = &(rspiocb->iocb);
1182         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1183         spin_lock_irq(phba->host->host_lock);
1184         ndlp->nlp_flag &= ~NLP_LOGO_SND;
1185         spin_unlock_irq(phba->host->host_lock);
1186
1187         /* LOGO completes to NPort <nlp_DID> */
1188         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1189                         "%d:0105 LOGO completes to NPort x%x "
1190                         "Data: x%x x%x x%x\n",
1191                         phba->brd_no, ndlp->nlp_DID, irsp->ulpStatus,
1192                         irsp->un.ulpWord[4], phba->num_disc_nodes);
1193
1194         /* Check to see if link went down during discovery */
1195         if (lpfc_els_chk_latt(phba))
1196                 goto out;
1197
1198         if (irsp->ulpStatus) {
1199                 /* Check for retry */
1200                 if (lpfc_els_retry(phba, cmdiocb, rspiocb)) {
1201                         /* ELS command is being retried */
1202                         goto out;
1203                 }
1204                 /* LOGO failed */
1205                 /* Do not call DSM for lpfc_els_abort'ed ELS cmds */
1206                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
1207                    ((irsp->un.ulpWord[4] == IOERR_SLI_ABORTED) ||
1208                    (irsp->un.ulpWord[4] == IOERR_SLI_DOWN))) {
1209                         goto out;
1210                 }
1211                 else {
1212                         lpfc_disc_state_machine(phba, ndlp, cmdiocb,
1213                                         NLP_EVT_CMPL_LOGO);
1214                 }
1215         } else {
1216                 /* Good status, call state machine */
1217                 lpfc_disc_state_machine(phba, ndlp, cmdiocb, NLP_EVT_CMPL_LOGO);
1218
1219                 if (ndlp->nlp_flag & NLP_DELAY_TMO) {
1220                         lpfc_unreg_rpi(phba, ndlp);
1221                 }
1222         }
1223
1224 out:
1225         lpfc_els_free_iocb(phba, cmdiocb);
1226         return;
1227 }
1228
1229 int
1230 lpfc_issue_els_logo(struct lpfc_hba * phba, struct lpfc_nodelist * ndlp,
1231                     uint8_t retry)
1232 {
1233         IOCB_t *icmd;
1234         struct lpfc_iocbq *elsiocb;
1235         struct lpfc_sli_ring *pring;
1236         struct lpfc_sli *psli;
1237         uint8_t *pcmd;
1238         uint16_t cmdsize;
1239
1240         psli = &phba->sli;
1241         pring = &psli->ring[LPFC_ELS_RING];
1242
1243         cmdsize = 2 * (sizeof (uint32_t) + sizeof (struct lpfc_name));
1244         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
1245                                           ndlp, ELS_CMD_LOGO)) == 0) {
1246                 return (1);
1247         }
1248
1249         icmd = &elsiocb->iocb;
1250         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1251         *((uint32_t *) (pcmd)) = ELS_CMD_LOGO;
1252         pcmd += sizeof (uint32_t);
1253
1254         /* Fill in LOGO payload */
1255         *((uint32_t *) (pcmd)) = be32_to_cpu(phba->fc_myDID);
1256         pcmd += sizeof (uint32_t);
1257         memcpy(pcmd, &phba->fc_portname, sizeof (struct lpfc_name));
1258
1259         phba->fc_stat.elsXmitLOGO++;
1260         elsiocb->iocb_cmpl = lpfc_cmpl_els_logo;
1261         spin_lock_irq(phba->host->host_lock);
1262         ndlp->nlp_flag |= NLP_LOGO_SND;
1263         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1264                 ndlp->nlp_flag &= ~NLP_LOGO_SND;
1265                 spin_unlock_irq(phba->host->host_lock);
1266                 lpfc_els_free_iocb(phba, elsiocb);
1267                 return (1);
1268         }
1269         spin_unlock_irq(phba->host->host_lock);
1270         return (0);
1271 }
1272
1273 static void
1274 lpfc_cmpl_els_cmd(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1275                   struct lpfc_iocbq * rspiocb)
1276 {
1277         IOCB_t *irsp;
1278
1279         irsp = &rspiocb->iocb;
1280
1281         /* ELS cmd tag <ulpIoTag> completes */
1282         lpfc_printf_log(phba,
1283                         KERN_INFO,
1284                         LOG_ELS,
1285                         "%d:0106 ELS cmd tag x%x completes Data: x%x x%x\n",
1286                         phba->brd_no,
1287                         irsp->ulpIoTag, irsp->ulpStatus, irsp->un.ulpWord[4]);
1288
1289         /* Check to see if link went down during discovery */
1290         lpfc_els_chk_latt(phba);
1291         lpfc_els_free_iocb(phba, cmdiocb);
1292         return;
1293 }
1294
1295 int
1296 lpfc_issue_els_scr(struct lpfc_hba * phba, uint32_t nportid, uint8_t retry)
1297 {
1298         IOCB_t *icmd;
1299         struct lpfc_iocbq *elsiocb;
1300         struct lpfc_sli_ring *pring;
1301         struct lpfc_sli *psli;
1302         uint8_t *pcmd;
1303         uint16_t cmdsize;
1304         struct lpfc_nodelist *ndlp;
1305
1306         psli = &phba->sli;
1307         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1308         cmdsize = (sizeof (uint32_t) + sizeof (SCR));
1309         if ((ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL)) == 0) {
1310                 return (1);
1311         }
1312
1313         lpfc_nlp_init(phba, ndlp, nportid);
1314
1315         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
1316                                           ndlp, ELS_CMD_SCR)) == 0) {
1317                 mempool_free( ndlp, phba->nlp_mem_pool);
1318                 return (1);
1319         }
1320
1321         icmd = &elsiocb->iocb;
1322         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1323
1324         *((uint32_t *) (pcmd)) = ELS_CMD_SCR;
1325         pcmd += sizeof (uint32_t);
1326
1327         /* For SCR, remainder of payload is SCR parameter page */
1328         memset(pcmd, 0, sizeof (SCR));
1329         ((SCR *) pcmd)->Function = SCR_FUNC_FULL;
1330
1331         phba->fc_stat.elsXmitSCR++;
1332         elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1333         spin_lock_irq(phba->host->host_lock);
1334         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1335                 spin_unlock_irq(phba->host->host_lock);
1336                 mempool_free( ndlp, phba->nlp_mem_pool);
1337                 lpfc_els_free_iocb(phba, elsiocb);
1338                 return (1);
1339         }
1340         spin_unlock_irq(phba->host->host_lock);
1341         mempool_free( ndlp, phba->nlp_mem_pool);
1342         return (0);
1343 }
1344
1345 static int
1346 lpfc_issue_els_farpr(struct lpfc_hba * phba, uint32_t nportid, uint8_t retry)
1347 {
1348         IOCB_t *icmd;
1349         struct lpfc_iocbq *elsiocb;
1350         struct lpfc_sli_ring *pring;
1351         struct lpfc_sli *psli;
1352         FARP *fp;
1353         uint8_t *pcmd;
1354         uint32_t *lp;
1355         uint16_t cmdsize;
1356         struct lpfc_nodelist *ondlp;
1357         struct lpfc_nodelist *ndlp;
1358
1359         psli = &phba->sli;
1360         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1361         cmdsize = (sizeof (uint32_t) + sizeof (FARP));
1362         if ((ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL)) == 0) {
1363                 return (1);
1364         }
1365         lpfc_nlp_init(phba, ndlp, nportid);
1366
1367         if ((elsiocb = lpfc_prep_els_iocb(phba, 1, cmdsize, retry,
1368                                           ndlp, ELS_CMD_RNID)) == 0) {
1369                 mempool_free( ndlp, phba->nlp_mem_pool);
1370                 return (1);
1371         }
1372
1373         icmd = &elsiocb->iocb;
1374         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1375
1376         *((uint32_t *) (pcmd)) = ELS_CMD_FARPR;
1377         pcmd += sizeof (uint32_t);
1378
1379         /* Fill in FARPR payload */
1380         fp = (FARP *) (pcmd);
1381         memset(fp, 0, sizeof (FARP));
1382         lp = (uint32_t *) pcmd;
1383         *lp++ = be32_to_cpu(nportid);
1384         *lp++ = be32_to_cpu(phba->fc_myDID);
1385         fp->Rflags = 0;
1386         fp->Mflags = (FARP_MATCH_PORT | FARP_MATCH_NODE);
1387
1388         memcpy(&fp->RportName, &phba->fc_portname, sizeof (struct lpfc_name));
1389         memcpy(&fp->RnodeName, &phba->fc_nodename, sizeof (struct lpfc_name));
1390         if ((ondlp = lpfc_findnode_did(phba, NLP_SEARCH_ALL, nportid))) {
1391                 memcpy(&fp->OportName, &ondlp->nlp_portname,
1392                        sizeof (struct lpfc_name));
1393                 memcpy(&fp->OnodeName, &ondlp->nlp_nodename,
1394                        sizeof (struct lpfc_name));
1395         }
1396
1397         phba->fc_stat.elsXmitFARPR++;
1398         elsiocb->iocb_cmpl = lpfc_cmpl_els_cmd;
1399         spin_lock_irq(phba->host->host_lock);
1400         if (lpfc_sli_issue_iocb(phba, pring, elsiocb, 0) == IOCB_ERROR) {
1401                 spin_unlock_irq(phba->host->host_lock);
1402                 mempool_free( ndlp, phba->nlp_mem_pool);
1403                 lpfc_els_free_iocb(phba, elsiocb);
1404                 return (1);
1405         }
1406         spin_unlock_irq(phba->host->host_lock);
1407         mempool_free( ndlp, phba->nlp_mem_pool);
1408         return (0);
1409 }
1410
1411 void
1412 lpfc_els_retry_delay(unsigned long ptr)
1413 {
1414         struct lpfc_nodelist *ndlp;
1415         struct lpfc_hba *phba;
1416         unsigned long iflag;
1417         struct lpfc_work_evt  *evtp;
1418
1419         ndlp = (struct lpfc_nodelist *)ptr;
1420         phba = ndlp->nlp_phba;
1421         evtp = &ndlp->els_retry_evt;
1422
1423         spin_lock_irqsave(phba->host->host_lock, iflag);
1424         if (!list_empty(&evtp->evt_listp)) {
1425                 spin_unlock_irqrestore(phba->host->host_lock, iflag);
1426                 return;
1427         }
1428
1429         evtp->evt_arg1  = ndlp;
1430         evtp->evt       = LPFC_EVT_ELS_RETRY;
1431         list_add_tail(&evtp->evt_listp, &phba->work_list);
1432         if (phba->work_wait)
1433                 wake_up(phba->work_wait);
1434
1435         spin_unlock_irqrestore(phba->host->host_lock, iflag);
1436         return;
1437 }
1438
1439 void
1440 lpfc_els_retry_delay_handler(struct lpfc_nodelist *ndlp)
1441 {
1442         struct lpfc_hba *phba;
1443         uint32_t cmd;
1444         uint32_t did;
1445         uint8_t retry;
1446
1447         phba = ndlp->nlp_phba;
1448         spin_lock_irq(phba->host->host_lock);
1449         did = (uint32_t) (ndlp->nlp_DID);
1450         cmd = (uint32_t) (ndlp->nlp_last_elscmd);
1451
1452         if (!(ndlp->nlp_flag & NLP_DELAY_TMO)) {
1453                 spin_unlock_irq(phba->host->host_lock);
1454                 return;
1455         }
1456
1457         ndlp->nlp_flag &= ~NLP_DELAY_TMO;
1458         spin_unlock_irq(phba->host->host_lock);
1459         retry = ndlp->nlp_retry;
1460
1461         switch (cmd) {
1462         case ELS_CMD_FLOGI:
1463                 lpfc_issue_els_flogi(phba, ndlp, retry);
1464                 break;
1465         case ELS_CMD_PLOGI:
1466                 ndlp->nlp_state = NLP_STE_PLOGI_ISSUE;
1467                 lpfc_nlp_list(phba, ndlp, NLP_PLOGI_LIST);
1468                 lpfc_issue_els_plogi(phba, ndlp, retry);
1469                 break;
1470         case ELS_CMD_ADISC:
1471                 ndlp->nlp_state = NLP_STE_ADISC_ISSUE;
1472                 lpfc_nlp_list(phba, ndlp, NLP_ADISC_LIST);
1473                 lpfc_issue_els_adisc(phba, ndlp, retry);
1474                 break;
1475         case ELS_CMD_PRLI:
1476                 ndlp->nlp_state = NLP_STE_PRLI_ISSUE;
1477                 lpfc_nlp_list(phba, ndlp, NLP_PRLI_LIST);
1478                 lpfc_issue_els_prli(phba, ndlp, retry);
1479                 break;
1480         case ELS_CMD_LOGO:
1481                 ndlp->nlp_state = NLP_STE_NPR_NODE;
1482                 lpfc_nlp_list(phba, ndlp, NLP_NPR_LIST);
1483                 lpfc_issue_els_logo(phba, ndlp, retry);
1484                 break;
1485         }
1486         return;
1487 }
1488
1489 static int
1490 lpfc_els_retry(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1491                struct lpfc_iocbq * rspiocb)
1492 {
1493         IOCB_t *irsp;
1494         struct lpfc_dmabuf *pcmd;
1495         struct lpfc_nodelist *ndlp;
1496         uint32_t *elscmd;
1497         struct ls_rjt stat;
1498         int retry, maxretry;
1499         int delay;
1500         uint32_t cmd;
1501
1502         retry = 0;
1503         delay = 0;
1504         maxretry = lpfc_max_els_tries;
1505         irsp = &rspiocb->iocb;
1506         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1507         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
1508         cmd = 0;
1509         /* Note: context2 may be 0 for internal driver abort
1510          * of delays ELS command.
1511          */
1512
1513         if (pcmd && pcmd->virt) {
1514                 elscmd = (uint32_t *) (pcmd->virt);
1515                 cmd = *elscmd++;
1516         }
1517
1518         switch (irsp->ulpStatus) {
1519         case IOSTAT_FCP_RSP_ERROR:
1520         case IOSTAT_REMOTE_STOP:
1521                 break;
1522
1523         case IOSTAT_LOCAL_REJECT:
1524                 switch ((irsp->un.ulpWord[4] & 0xff)) {
1525                 case IOERR_LOOP_OPEN_FAILURE:
1526                         if (cmd == ELS_CMD_PLOGI) {
1527                                 if (cmdiocb->retry == 0) {
1528                                         delay = 1;
1529                                 }
1530                         }
1531                         retry = 1;
1532                         break;
1533
1534                 case IOERR_SEQUENCE_TIMEOUT:
1535                         retry = 1;
1536                         if ((cmd == ELS_CMD_FLOGI)
1537                             && (phba->fc_topology != TOPOLOGY_LOOP)) {
1538                                 delay = 1;
1539                                 maxretry = 48;
1540                         }
1541                         break;
1542
1543                 case IOERR_NO_RESOURCES:
1544                         if (cmd == ELS_CMD_PLOGI) {
1545                                 delay = 1;
1546                         }
1547                         retry = 1;
1548                         break;
1549
1550                 case IOERR_INVALID_RPI:
1551                         retry = 1;
1552                         break;
1553                 }
1554                 break;
1555
1556         case IOSTAT_NPORT_RJT:
1557         case IOSTAT_FABRIC_RJT:
1558                 if (irsp->un.ulpWord[4] & RJT_UNAVAIL_TEMP) {
1559                         retry = 1;
1560                         break;
1561                 }
1562                 break;
1563
1564         case IOSTAT_NPORT_BSY:
1565         case IOSTAT_FABRIC_BSY:
1566                 retry = 1;
1567                 break;
1568
1569         case IOSTAT_LS_RJT:
1570                 stat.un.lsRjtError = be32_to_cpu(irsp->un.ulpWord[4]);
1571                 /* Added for Vendor specifc support
1572                  * Just keep retrying for these Rsn / Exp codes
1573                  */
1574                 switch (stat.un.b.lsRjtRsnCode) {
1575                 case LSRJT_UNABLE_TPC:
1576                         if (stat.un.b.lsRjtRsnCodeExp ==
1577                             LSEXP_CMD_IN_PROGRESS) {
1578                                 if (cmd == ELS_CMD_PLOGI) {
1579                                         delay = 1;
1580                                         maxretry = 48;
1581                                 }
1582                                 retry = 1;
1583                                 break;
1584                         }
1585                         if (cmd == ELS_CMD_PLOGI) {
1586                                 delay = 1;
1587                                 maxretry = lpfc_max_els_tries + 1;
1588                                 retry = 1;
1589                                 break;
1590                         }
1591                         break;
1592
1593                 case LSRJT_LOGICAL_BSY:
1594                         if (cmd == ELS_CMD_PLOGI) {
1595                                 delay = 1;
1596                                 maxretry = 48;
1597                         }
1598                         retry = 1;
1599                         break;
1600                 }
1601                 break;
1602
1603         case IOSTAT_INTERMED_RSP:
1604         case IOSTAT_BA_RJT:
1605                 break;
1606
1607         default:
1608                 break;
1609         }
1610
1611         if (ndlp->nlp_DID == FDMI_DID) {
1612                 retry = 1;
1613         }
1614
1615         if ((++cmdiocb->retry) >= maxretry) {
1616                 phba->fc_stat.elsRetryExceeded++;
1617                 retry = 0;
1618         }
1619
1620         if (retry) {
1621
1622                 /* Retry ELS command <elsCmd> to remote NPORT <did> */
1623                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1624                                 "%d:0107 Retry ELS command x%x to remote "
1625                                 "NPORT x%x Data: x%x x%x\n",
1626                                 phba->brd_no,
1627                                 cmd, ndlp->nlp_DID, cmdiocb->retry, delay);
1628
1629                 if ((cmd == ELS_CMD_PLOGI) || (cmd == ELS_CMD_ADISC)) {
1630                         /* If discovery / RSCN timer is running, reset it */
1631                         if (timer_pending(&phba->fc_disctmo) ||
1632                               (phba->fc_flag & FC_RSCN_MODE)) {
1633                                 lpfc_set_disctmo(phba);
1634                         }
1635                 }
1636
1637                 phba->fc_stat.elsXmitRetry++;
1638                 if (delay) {
1639                         phba->fc_stat.elsDelayRetry++;
1640                         ndlp->nlp_retry = cmdiocb->retry;
1641
1642                         mod_timer(&ndlp->nlp_delayfunc, jiffies + HZ);
1643                         ndlp->nlp_flag |= NLP_DELAY_TMO;
1644
1645                         ndlp->nlp_state = NLP_STE_NPR_NODE;
1646                         lpfc_nlp_list(phba, ndlp, NLP_NPR_LIST);
1647                         ndlp->nlp_last_elscmd = cmd;
1648
1649                         return (1);
1650                 }
1651                 switch (cmd) {
1652                 case ELS_CMD_FLOGI:
1653                         lpfc_issue_els_flogi(phba, ndlp, cmdiocb->retry);
1654                         return (1);
1655                 case ELS_CMD_PLOGI:
1656                         ndlp->nlp_state = NLP_STE_PLOGI_ISSUE;
1657                         lpfc_nlp_list(phba, ndlp, NLP_PLOGI_LIST);
1658                         lpfc_issue_els_plogi(phba, ndlp, cmdiocb->retry);
1659                         return (1);
1660                 case ELS_CMD_ADISC:
1661                         ndlp->nlp_state = NLP_STE_ADISC_ISSUE;
1662                         lpfc_nlp_list(phba, ndlp, NLP_ADISC_LIST);
1663                         lpfc_issue_els_adisc(phba, ndlp, cmdiocb->retry);
1664                         return (1);
1665                 case ELS_CMD_PRLI:
1666                         ndlp->nlp_state = NLP_STE_PRLI_ISSUE;
1667                         lpfc_nlp_list(phba, ndlp, NLP_PRLI_LIST);
1668                         lpfc_issue_els_prli(phba, ndlp, cmdiocb->retry);
1669                         return (1);
1670                 case ELS_CMD_LOGO:
1671                         ndlp->nlp_state = NLP_STE_NPR_NODE;
1672                         lpfc_nlp_list(phba, ndlp, NLP_NPR_LIST);
1673                         lpfc_issue_els_logo(phba, ndlp, cmdiocb->retry);
1674                         return (1);
1675                 }
1676         }
1677
1678         /* No retry ELS command <elsCmd> to remote NPORT <did> */
1679         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1680                         "%d:0108 No retry ELS command x%x to remote NPORT x%x "
1681                         "Data: x%x x%x\n",
1682                         phba->brd_no,
1683                         cmd, ndlp->nlp_DID, cmdiocb->retry, ndlp->nlp_flag);
1684
1685         return (0);
1686 }
1687
1688 int
1689 lpfc_els_free_iocb(struct lpfc_hba * phba, struct lpfc_iocbq * elsiocb)
1690 {
1691         struct lpfc_dmabuf *buf_ptr, *buf_ptr1;
1692
1693         /* context2  = cmd,  context2->next = rsp, context3 = bpl */
1694         if (elsiocb->context2) {
1695                 buf_ptr1 = (struct lpfc_dmabuf *) elsiocb->context2;
1696                 /* Free the response before processing the command.  */
1697                 if (!list_empty(&buf_ptr1->list)) {
1698                         list_remove_head(&buf_ptr1->list, buf_ptr,
1699                                          struct lpfc_dmabuf,
1700                                          list);
1701                         lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
1702                         kfree(buf_ptr);
1703                 }
1704                 lpfc_mbuf_free(phba, buf_ptr1->virt, buf_ptr1->phys);
1705                 kfree(buf_ptr1);
1706         }
1707
1708         if (elsiocb->context3) {
1709                 buf_ptr = (struct lpfc_dmabuf *) elsiocb->context3;
1710                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
1711                 kfree(buf_ptr);
1712         }
1713         spin_lock_irq(phba->host->host_lock);
1714         lpfc_sli_release_iocbq(phba, elsiocb);
1715         spin_unlock_irq(phba->host->host_lock);
1716         return 0;
1717 }
1718
1719 static void
1720 lpfc_cmpl_els_logo_acc(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1721                        struct lpfc_iocbq * rspiocb)
1722 {
1723         struct lpfc_nodelist *ndlp;
1724
1725         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1726
1727         /* ACC to LOGO completes to NPort <nlp_DID> */
1728         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1729                         "%d:0109 ACC to LOGO completes to NPort x%x "
1730                         "Data: x%x x%x x%x\n",
1731                         phba->brd_no, ndlp->nlp_DID, ndlp->nlp_flag,
1732                         ndlp->nlp_state, ndlp->nlp_rpi);
1733
1734         spin_lock_irq(phba->host->host_lock);
1735         ndlp->nlp_flag &= ~NLP_LOGO_ACC;
1736         spin_unlock_irq(phba->host->host_lock);
1737
1738         switch (ndlp->nlp_state) {
1739         case NLP_STE_UNUSED_NODE:       /* node is just allocated */
1740                 lpfc_nlp_list(phba, ndlp, NLP_NO_LIST);
1741                 break;
1742         case NLP_STE_NPR_NODE:          /* NPort Recovery mode */
1743                 lpfc_unreg_rpi(phba, ndlp);
1744                 break;
1745         default:
1746                 break;
1747         }
1748         lpfc_els_free_iocb(phba, cmdiocb);
1749         return;
1750 }
1751
1752 static void
1753 lpfc_cmpl_els_acc(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
1754                   struct lpfc_iocbq * rspiocb)
1755 {
1756         struct lpfc_nodelist *ndlp;
1757         LPFC_MBOXQ_t *mbox = NULL;
1758
1759         ndlp = (struct lpfc_nodelist *) cmdiocb->context1;
1760         if (cmdiocb->context_un.mbox)
1761                 mbox = cmdiocb->context_un.mbox;
1762
1763
1764         /* Check to see if link went down during discovery */
1765         if ((lpfc_els_chk_latt(phba)) || !ndlp) {
1766                 if (mbox) {
1767                         mempool_free( mbox, phba->mbox_mem_pool);
1768                 }
1769                 goto out;
1770         }
1771
1772         /* ELS response tag <ulpIoTag> completes */
1773         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1774                         "%d:0110 ELS response tag x%x completes "
1775                         "Data: x%x x%x x%x x%x x%x x%x\n",
1776                         phba->brd_no,
1777                         cmdiocb->iocb.ulpIoTag, rspiocb->iocb.ulpStatus,
1778                         rspiocb->iocb.un.ulpWord[4], ndlp->nlp_DID,
1779                         ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
1780
1781         if (mbox) {
1782                 if ((rspiocb->iocb.ulpStatus == 0)
1783                     && (ndlp->nlp_flag & NLP_ACC_REGLOGIN)) {
1784                         /* set_slim mailbox command needs to execute first,
1785                          * queue this command to be processed later.
1786                          */
1787                         lpfc_unreg_rpi(phba, ndlp);
1788                         mbox->mbox_cmpl = lpfc_mbx_cmpl_reg_login;
1789                         mbox->context2 = ndlp;
1790                         ndlp->nlp_state = NLP_STE_REG_LOGIN_ISSUE;
1791                         lpfc_nlp_list(phba, ndlp, NLP_REGLOGIN_LIST);
1792                         if (lpfc_sli_issue_mbox(phba, mbox,
1793                                                 (MBX_NOWAIT | MBX_STOP_IOCB))
1794                             != MBX_NOT_FINISHED) {
1795                                 goto out;
1796                         }
1797                         /* NOTE: we should have messages for unsuccessful
1798                            reglogin */
1799                         mempool_free( mbox, phba->mbox_mem_pool);
1800                 } else {
1801                         mempool_free( mbox, phba->mbox_mem_pool);
1802                         if (ndlp->nlp_flag & NLP_ACC_REGLOGIN) {
1803                                 lpfc_nlp_list(phba, ndlp, NLP_NO_LIST);
1804                         }
1805                 }
1806         }
1807 out:
1808         if (ndlp) {
1809                 spin_lock_irq(phba->host->host_lock);
1810                 ndlp->nlp_flag &= ~NLP_ACC_REGLOGIN;
1811                 spin_unlock_irq(phba->host->host_lock);
1812         }
1813         lpfc_els_free_iocb(phba, cmdiocb);
1814         return;
1815 }
1816
1817 int
1818 lpfc_els_rsp_acc(struct lpfc_hba * phba, uint32_t flag,
1819                  struct lpfc_iocbq * oldiocb, struct lpfc_nodelist * ndlp,
1820                  LPFC_MBOXQ_t * mbox, uint8_t newnode)
1821 {
1822         IOCB_t *icmd;
1823         IOCB_t *oldcmd;
1824         struct lpfc_iocbq *elsiocb;
1825         struct lpfc_sli_ring *pring;
1826         struct lpfc_sli *psli;
1827         uint8_t *pcmd;
1828         uint16_t cmdsize;
1829         int rc;
1830
1831         psli = &phba->sli;
1832         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1833         oldcmd = &oldiocb->iocb;
1834
1835         switch (flag) {
1836         case ELS_CMD_ACC:
1837                 cmdsize = sizeof (uint32_t);
1838                 if ((elsiocb =
1839                      lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
1840                                         ndlp, ELS_CMD_ACC)) == 0) {
1841                         return (1);
1842                 }
1843                 icmd = &elsiocb->iocb;
1844                 icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
1845                 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1846                 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
1847                 pcmd += sizeof (uint32_t);
1848                 break;
1849         case ELS_CMD_PLOGI:
1850                 cmdsize = (sizeof (struct serv_parm) + sizeof (uint32_t));
1851                 if ((elsiocb =
1852                      lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
1853                                         ndlp, ELS_CMD_ACC)) == 0) {
1854                         return (1);
1855                 }
1856                 icmd = &elsiocb->iocb;
1857                 icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
1858                 pcmd = (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1859
1860                 if (mbox)
1861                         elsiocb->context_un.mbox = mbox;
1862
1863                 *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
1864                 pcmd += sizeof (uint32_t);
1865                 memcpy(pcmd, &phba->fc_sparam, sizeof (struct serv_parm));
1866                 break;
1867         default:
1868                 return (1);
1869         }
1870
1871         if (newnode)
1872                 elsiocb->context1 = NULL;
1873
1874         /* Xmit ELS ACC response tag <ulpIoTag> */
1875         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1876                         "%d:0128 Xmit ELS ACC response tag x%x "
1877                         "Data: x%x x%x x%x x%x x%x\n",
1878                         phba->brd_no,
1879                         elsiocb->iocb.ulpIoTag,
1880                         elsiocb->iocb.ulpContext, ndlp->nlp_DID,
1881                         ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
1882
1883         if (ndlp->nlp_flag & NLP_LOGO_ACC) {
1884                 elsiocb->iocb_cmpl = lpfc_cmpl_els_logo_acc;
1885         } else {
1886                 elsiocb->iocb_cmpl = lpfc_cmpl_els_acc;
1887         }
1888
1889         phba->fc_stat.elsXmitACC++;
1890         spin_lock_irq(phba->host->host_lock);
1891         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
1892         spin_unlock_irq(phba->host->host_lock);
1893         if (rc == IOCB_ERROR) {
1894                 lpfc_els_free_iocb(phba, elsiocb);
1895                 return (1);
1896         }
1897         return (0);
1898 }
1899
1900 int
1901 lpfc_els_rsp_reject(struct lpfc_hba * phba, uint32_t rejectError,
1902                     struct lpfc_iocbq * oldiocb, struct lpfc_nodelist * ndlp)
1903 {
1904         IOCB_t *icmd;
1905         IOCB_t *oldcmd;
1906         struct lpfc_iocbq *elsiocb;
1907         struct lpfc_sli_ring *pring;
1908         struct lpfc_sli *psli;
1909         uint8_t *pcmd;
1910         uint16_t cmdsize;
1911         int rc;
1912
1913         psli = &phba->sli;
1914         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1915
1916         cmdsize = 2 * sizeof (uint32_t);
1917         if ((elsiocb = lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
1918                                           ndlp, ELS_CMD_LS_RJT)) == 0) {
1919                 return (1);
1920         }
1921
1922         icmd = &elsiocb->iocb;
1923         oldcmd = &oldiocb->iocb;
1924         icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
1925         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1926
1927         *((uint32_t *) (pcmd)) = ELS_CMD_LS_RJT;
1928         pcmd += sizeof (uint32_t);
1929         *((uint32_t *) (pcmd)) = rejectError;
1930
1931         /* Xmit ELS RJT <err> response tag <ulpIoTag> */
1932         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1933                         "%d:0129 Xmit ELS RJT x%x response tag x%x "
1934                         "Data: x%x x%x x%x x%x x%x\n",
1935                         phba->brd_no,
1936                         rejectError, elsiocb->iocb.ulpIoTag,
1937                         elsiocb->iocb.ulpContext, ndlp->nlp_DID,
1938                         ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
1939
1940         phba->fc_stat.elsXmitLSRJT++;
1941         elsiocb->iocb_cmpl = lpfc_cmpl_els_acc;
1942         spin_lock_irq(phba->host->host_lock);
1943         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
1944         spin_unlock_irq(phba->host->host_lock);
1945         if (rc == IOCB_ERROR) {
1946                 lpfc_els_free_iocb(phba, elsiocb);
1947                 return (1);
1948         }
1949         return (0);
1950 }
1951
1952 int
1953 lpfc_els_rsp_adisc_acc(struct lpfc_hba * phba,
1954                        struct lpfc_iocbq * oldiocb, struct lpfc_nodelist * ndlp)
1955 {
1956         ADISC *ap;
1957         IOCB_t *icmd;
1958         IOCB_t *oldcmd;
1959         struct lpfc_iocbq *elsiocb;
1960         struct lpfc_sli_ring *pring;
1961         struct lpfc_sli *psli;
1962         uint8_t *pcmd;
1963         uint16_t cmdsize;
1964         int rc;
1965
1966         psli = &phba->sli;
1967         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
1968
1969         cmdsize = sizeof (uint32_t) + sizeof (ADISC);
1970         if ((elsiocb = lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
1971                                           ndlp, ELS_CMD_ACC)) == 0) {
1972                 return (1);
1973         }
1974
1975         /* Xmit ADISC ACC response tag <ulpIoTag> */
1976         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
1977                         "%d:0130 Xmit ADISC ACC response tag x%x "
1978                         "Data: x%x x%x x%x x%x x%x\n",
1979                         phba->brd_no,
1980                         elsiocb->iocb.ulpIoTag,
1981                         elsiocb->iocb.ulpContext, ndlp->nlp_DID,
1982                         ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
1983
1984         icmd = &elsiocb->iocb;
1985         oldcmd = &oldiocb->iocb;
1986         icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
1987         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
1988
1989         *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
1990         pcmd += sizeof (uint32_t);
1991
1992         ap = (ADISC *) (pcmd);
1993         ap->hardAL_PA = phba->fc_pref_ALPA;
1994         memcpy(&ap->portName, &phba->fc_portname, sizeof (struct lpfc_name));
1995         memcpy(&ap->nodeName, &phba->fc_nodename, sizeof (struct lpfc_name));
1996         ap->DID = be32_to_cpu(phba->fc_myDID);
1997
1998         phba->fc_stat.elsXmitACC++;
1999         elsiocb->iocb_cmpl = lpfc_cmpl_els_acc;
2000         spin_lock_irq(phba->host->host_lock);
2001         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2002         spin_unlock_irq(phba->host->host_lock);
2003         if (rc == IOCB_ERROR) {
2004                 lpfc_els_free_iocb(phba, elsiocb);
2005                 return (1);
2006         }
2007         return (0);
2008 }
2009
2010 int
2011 lpfc_els_rsp_prli_acc(struct lpfc_hba * phba,
2012                       struct lpfc_iocbq * oldiocb, struct lpfc_nodelist * ndlp)
2013 {
2014         PRLI *npr;
2015         lpfc_vpd_t *vpd;
2016         IOCB_t *icmd;
2017         IOCB_t *oldcmd;
2018         struct lpfc_iocbq *elsiocb;
2019         struct lpfc_sli_ring *pring;
2020         struct lpfc_sli *psli;
2021         uint8_t *pcmd;
2022         uint16_t cmdsize;
2023         int rc;
2024
2025         psli = &phba->sli;
2026         pring = &psli->ring[LPFC_ELS_RING];     /* ELS ring */
2027
2028         cmdsize = sizeof (uint32_t) + sizeof (PRLI);
2029         if ((elsiocb = lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
2030                                           ndlp,
2031                                           (ELS_CMD_ACC |
2032                                            (ELS_CMD_PRLI & ~ELS_RSP_MASK)))) ==
2033             0) {
2034                 return (1);
2035         }
2036
2037         /* Xmit PRLI ACC response tag <ulpIoTag> */
2038         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2039                         "%d:0131 Xmit PRLI ACC response tag x%x "
2040                         "Data: x%x x%x x%x x%x x%x\n",
2041                         phba->brd_no,
2042                         elsiocb->iocb.ulpIoTag,
2043                         elsiocb->iocb.ulpContext, ndlp->nlp_DID,
2044                         ndlp->nlp_flag, ndlp->nlp_state, ndlp->nlp_rpi);
2045
2046         icmd = &elsiocb->iocb;
2047         oldcmd = &oldiocb->iocb;
2048         icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
2049         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2050
2051         *((uint32_t *) (pcmd)) = (ELS_CMD_ACC | (ELS_CMD_PRLI & ~ELS_RSP_MASK));
2052         pcmd += sizeof (uint32_t);
2053
2054         /* For PRLI, remainder of payload is PRLI parameter page */
2055         memset(pcmd, 0, sizeof (PRLI));
2056
2057         npr = (PRLI *) pcmd;
2058         vpd = &phba->vpd;
2059         /*
2060          * If our firmware version is 3.20 or later,
2061          * set the following bits for FC-TAPE support.
2062          */
2063         if (vpd->rev.feaLevelHigh >= 0x02) {
2064                 npr->ConfmComplAllowed = 1;
2065                 npr->Retry = 1;
2066                 npr->TaskRetryIdReq = 1;
2067         }
2068
2069         npr->acceptRspCode = PRLI_REQ_EXECUTED;
2070         npr->estabImagePair = 1;
2071         npr->readXferRdyDis = 1;
2072         npr->ConfmComplAllowed = 1;
2073
2074         npr->prliType = PRLI_FCP_TYPE;
2075         npr->initiatorFunc = 1;
2076
2077         phba->fc_stat.elsXmitACC++;
2078         elsiocb->iocb_cmpl = lpfc_cmpl_els_acc;
2079
2080         spin_lock_irq(phba->host->host_lock);
2081         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2082         spin_unlock_irq(phba->host->host_lock);
2083         if (rc == IOCB_ERROR) {
2084                 lpfc_els_free_iocb(phba, elsiocb);
2085                 return (1);
2086         }
2087         return (0);
2088 }
2089
2090 static int
2091 lpfc_els_rsp_rnid_acc(struct lpfc_hba * phba,
2092                       uint8_t format,
2093                       struct lpfc_iocbq * oldiocb, struct lpfc_nodelist * ndlp)
2094 {
2095         RNID *rn;
2096         IOCB_t *icmd;
2097         IOCB_t *oldcmd;
2098         struct lpfc_iocbq *elsiocb;
2099         struct lpfc_sli_ring *pring;
2100         struct lpfc_sli *psli;
2101         uint8_t *pcmd;
2102         uint16_t cmdsize;
2103         int rc;
2104
2105         psli = &phba->sli;
2106         pring = &psli->ring[LPFC_ELS_RING];
2107
2108         cmdsize = sizeof (uint32_t) + sizeof (uint32_t)
2109                 + (2 * sizeof (struct lpfc_name));
2110         if (format)
2111                 cmdsize += sizeof (RNID_TOP_DISC);
2112
2113         if ((elsiocb = lpfc_prep_els_iocb(phba, 0, cmdsize, oldiocb->retry,
2114                                           ndlp, ELS_CMD_ACC)) == 0) {
2115                 return (1);
2116         }
2117
2118         /* Xmit RNID ACC response tag <ulpIoTag> */
2119         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
2120                         "%d:0132 Xmit RNID ACC response tag x%x "
2121                         "Data: x%x\n",
2122                         phba->brd_no,
2123                         elsiocb->iocb.ulpIoTag,
2124                         elsiocb->iocb.ulpContext);
2125
2126         icmd = &elsiocb->iocb;
2127         oldcmd = &oldiocb->iocb;
2128         icmd->ulpContext = oldcmd->ulpContext;  /* Xri */
2129         pcmd = (uint8_t *) (((struct lpfc_dmabuf *) elsiocb->context2)->virt);
2130
2131         *((uint32_t *) (pcmd)) = ELS_CMD_ACC;
2132         pcmd += sizeof (uint32_t);
2133
2134         memset(pcmd, 0, sizeof (RNID));
2135         rn = (RNID *) (pcmd);
2136         rn->Format = format;
2137         rn->CommonLen = (2 * sizeof (struct lpfc_name));
2138         memcpy(&rn->portName, &phba->fc_portname, sizeof (struct lpfc_name));
2139         memcpy(&rn->nodeName, &phba->fc_nodename, sizeof (struct lpfc_name));
2140         switch (format) {
2141         case 0:
2142                 rn->SpecificLen = 0;
2143                 break;
2144         case RNID_TOPOLOGY_DISC:
2145                 rn->SpecificLen = sizeof (RNID_TOP_DISC);
2146                 memcpy(&rn->un.topologyDisc.portName,
2147                        &phba->fc_portname, sizeof (struct lpfc_name));
2148                 rn->un.topologyDisc.unitType = RNID_HBA;
2149                 rn->un.topologyDisc.physPort = 0;
2150                 rn->un.topologyDisc.attachedNodes = 0;
2151                 break;
2152         default:
2153                 rn->CommonLen = 0;
2154                 rn->SpecificLen = 0;
2155                 break;
2156         }
2157
2158         phba->fc_stat.elsXmitACC++;
2159         elsiocb->iocb_cmpl = lpfc_cmpl_els_acc;
2160         elsiocb->context1 = NULL;  /* Don't need ndlp for cmpl,
2161                                     * it could be freed */
2162
2163         spin_lock_irq(phba->host->host_lock);
2164         rc = lpfc_sli_issue_iocb(phba, pring, elsiocb, 0);
2165         spin_unlock_irq(phba->host->host_lock);
2166         if (rc == IOCB_ERROR) {
2167                 lpfc_els_free_iocb(phba, elsiocb);
2168                 return (1);
2169         }
2170         return (0);
2171 }
2172
2173 int
2174 lpfc_els_disc_adisc(struct lpfc_hba * phba)
2175 {
2176         int sentadisc;
2177         struct lpfc_nodelist *ndlp, *next_ndlp;
2178
2179         sentadisc = 0;
2180         /* go thru NPR list and issue any remaining ELS ADISCs */
2181         list_for_each_entry_safe(ndlp, next_ndlp, &phba->fc_npr_list,
2182                         nlp_listp) {
2183                 if (ndlp->nlp_flag & NLP_NPR_2B_DISC) {
2184                         if (ndlp->nlp_flag & NLP_NPR_ADISC) {
2185                                 ndlp->nlp_flag &= ~NLP_NPR_ADISC;
2186                                 ndlp->nlp_state = NLP_STE_ADISC_ISSUE;
2187                                 lpfc_nlp_list(phba, ndlp,
2188                                         NLP_ADISC_LIST);
2189                                 lpfc_issue_els_adisc(phba, ndlp, 0);
2190                                 sentadisc++;
2191                                 phba->num_disc_nodes++;
2192                                 if (phba->num_disc_nodes >=
2193                                     phba->cfg_discovery_threads) {
2194                                         spin_lock_irq(phba->host->host_lock);
2195                                         phba->fc_flag |= FC_NLP_MORE;
2196                                         spin_unlock_irq(phba->host->host_lock);
2197                                         break;
2198                                 }
2199                         }
2200                 }
2201         }
2202         if (sentadisc == 0) {
2203                 spin_lock_irq(phba->host->host_lock);
2204                 phba->fc_flag &= ~FC_NLP_MORE;
2205                 spin_unlock_irq(phba->host->host_lock);
2206         }
2207         return(sentadisc);
2208 }
2209
2210 int
2211 lpfc_els_disc_plogi(struct lpfc_hba * phba)
2212 {
2213         int sentplogi;
2214         struct lpfc_nodelist *ndlp, *next_ndlp;
2215
2216         sentplogi = 0;
2217         /* go thru NPR list and issue any remaining ELS PLOGIs */
2218         list_for_each_entry_safe(ndlp, next_ndlp, &phba->fc_npr_list,
2219                                 nlp_listp) {
2220                 if ((ndlp->nlp_flag & NLP_NPR_2B_DISC) &&
2221                    (!(ndlp->nlp_flag & NLP_DELAY_TMO))) {
2222                         if (!(ndlp->nlp_flag & NLP_NPR_ADISC)) {
2223                                 ndlp->nlp_state = NLP_STE_PLOGI_ISSUE;
2224                                 lpfc_nlp_list(phba, ndlp, NLP_PLOGI_LIST);
2225                                 lpfc_issue_els_plogi(phba, ndlp, 0);
2226                                 sentplogi++;
2227                                 phba->num_disc_nodes++;
2228                                 if (phba->num_disc_nodes >=
2229                                     phba->cfg_discovery_threads) {
2230                                         spin_lock_irq(phba->host->host_lock);
2231                                         phba->fc_flag |= FC_NLP_MORE;
2232                                         spin_unlock_irq(phba->host->host_lock);
2233                                         break;
2234                                 }
2235                         }
2236                 }
2237         }
2238         if (sentplogi == 0) {
2239                 spin_lock_irq(phba->host->host_lock);
2240                 phba->fc_flag &= ~FC_NLP_MORE;
2241                 spin_unlock_irq(phba->host->host_lock);
2242         }
2243         return(sentplogi);
2244 }
2245
2246 int
2247 lpfc_els_flush_rscn(struct lpfc_hba * phba)
2248 {
2249         struct lpfc_dmabuf *mp;
2250         int i;
2251
2252         for (i = 0; i < phba->fc_rscn_id_cnt; i++) {
2253                 mp = phba->fc_rscn_id_list[i];
2254                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
2255                 kfree(mp);
2256                 phba->fc_rscn_id_list[i] = NULL;
2257         }
2258         phba->fc_rscn_id_cnt = 0;
2259         spin_lock_irq(phba->host->host_lock);
2260         phba->fc_flag &= ~(FC_RSCN_MODE | FC_RSCN_DISCOVERY);
2261         spin_unlock_irq(phba->host->host_lock);
2262         lpfc_can_disctmo(phba);
2263         return (0);
2264 }
2265
2266 int
2267 lpfc_rscn_payload_check(struct lpfc_hba * phba, uint32_t did)
2268 {
2269         D_ID ns_did;
2270         D_ID rscn_did;
2271         struct lpfc_dmabuf *mp;
2272         uint32_t *lp;
2273         uint32_t payload_len, cmd, i, match;
2274
2275         ns_did.un.word = did;
2276         match = 0;
2277
2278         /* Never match fabric nodes for RSCNs */
2279         if ((did & Fabric_DID_MASK) == Fabric_DID_MASK)
2280                 return(0);
2281
2282         /* If we are doing a FULL RSCN rediscovery, match everything */
2283         if (phba->fc_flag & FC_RSCN_DISCOVERY) {
2284                 return (did);
2285         }
2286
2287         for (i = 0; i < phba->fc_rscn_id_cnt; i++) {
2288                 mp = phba->fc_rscn_id_list[i];
2289                 lp = (uint32_t *) mp->virt;
2290                 cmd = *lp++;
2291                 payload_len = be32_to_cpu(cmd) & 0xffff; /* payload length */
2292                 payload_len -= sizeof (uint32_t);       /* take off word 0 */
2293                 while (payload_len) {
2294                         rscn_did.un.word = *lp++;
2295                         rscn_did.un.word = be32_to_cpu(rscn_did.un.word);
2296                         payload_len -= sizeof (uint32_t);
2297                         switch (rscn_did.un.b.resv) {
2298                         case 0: /* Single N_Port ID effected */
2299                                 if (ns_did.un.word == rscn_did.un.word) {
2300                                         match = did;
2301                                 }
2302                                 break;
2303                         case 1: /* Whole N_Port Area effected */
2304                                 if ((ns_did.un.b.domain == rscn_did.un.b.domain)
2305                                     && (ns_did.un.b.area == rscn_did.un.b.area))
2306                                         {
2307                                                 match = did;
2308                                         }
2309                                 break;
2310                         case 2: /* Whole N_Port Domain effected */
2311                                 if (ns_did.un.b.domain == rscn_did.un.b.domain)
2312                                         {
2313                                                 match = did;
2314                                         }
2315                                 break;
2316                         case 3: /* Whole Fabric effected */
2317                                 match = did;
2318                                 break;
2319                         default:
2320                                 /* Unknown Identifier in RSCN list */
2321                                 lpfc_printf_log(phba, KERN_ERR, LOG_DISCOVERY,
2322                                                 "%d:0217 Unknown Identifier in "
2323                                                 "RSCN payload Data: x%x\n",
2324                                                 phba->brd_no, rscn_did.un.word);
2325                                 break;
2326                         }
2327                         if (match) {
2328                                 break;
2329                         }
2330                 }
2331         }
2332         return (match);
2333 }
2334
2335 static int
2336 lpfc_rscn_recovery_check(struct lpfc_hba * phba)
2337 {
2338         struct lpfc_nodelist *ndlp = NULL, *next_ndlp;
2339         struct list_head *listp;
2340         struct list_head *node_list[7];
2341         int i;
2342
2343         /* Look at all nodes effected by pending RSCNs and move
2344          * them to NPR list.
2345          */
2346         node_list[0] = &phba->fc_npr_list;  /* MUST do this list first */
2347         node_list[1] = &phba->fc_nlpmap_list;
2348         node_list[2] = &phba->fc_nlpunmap_list;
2349         node_list[3] = &phba->fc_prli_list;
2350         node_list[4] = &phba->fc_reglogin_list;
2351         node_list[5] = &phba->fc_adisc_list;
2352         node_list[6] = &phba->fc_plogi_list;
2353         for (i = 0; i < 7; i++) {
2354                 listp = node_list[i];
2355                 if (list_empty(listp))
2356                         continue;
2357
2358                 list_for_each_entry_safe(ndlp, next_ndlp, listp, nlp_listp) {
2359                         if (!(lpfc_rscn_payload_check(phba, ndlp->nlp_DID)))
2360                                 continue;
2361
2362                         lpfc_disc_state_machine(phba, ndlp, NULL,
2363                                         NLP_EVT_DEVICE_RECOVERY);
2364                         if (ndlp->nlp_flag & NLP_DELAY_TMO) {
2365                                 ndlp->nlp_flag &= ~NLP_DELAY_TMO;
2366                                 del_timer_sync(&ndlp->nlp_delayfunc);
2367                                 if (!list_empty(&ndlp->
2368                                                 els_retry_evt.evt_listp))
2369                                         list_del_init(&ndlp->
2370                                                 els_retry_evt.evt_listp);
2371                         }
2372                 }
2373         }
2374         return (0);
2375 }
2376
2377 static int
2378 lpfc_els_rcv_rscn(struct lpfc_hba * phba,
2379                   struct lpfc_iocbq * cmdiocb,
2380                   struct lpfc_nodelist * ndlp, uint8_t newnode)
2381 {
2382         struct lpfc_dmabuf *pcmd;
2383         uint32_t *lp;
2384         IOCB_t *icmd;
2385         uint32_t payload_len, cmd;
2386
2387         icmd = &cmdiocb->iocb;
2388         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2389         lp = (uint32_t *) pcmd->virt;
2390
2391         cmd = *lp++;
2392         payload_len = be32_to_cpu(cmd) & 0xffff;        /* payload length */
2393         payload_len -= sizeof (uint32_t);       /* take off word 0 */
2394         cmd &= ELS_CMD_MASK;
2395
2396         /* RSCN received */
2397         lpfc_printf_log(phba,
2398                         KERN_INFO,
2399                         LOG_DISCOVERY,
2400                         "%d:0214 RSCN received Data: x%x x%x x%x x%x\n",
2401                         phba->brd_no,
2402                         phba->fc_flag, payload_len, *lp, phba->fc_rscn_id_cnt);
2403
2404         /* If we are about to begin discovery, just ACC the RSCN.
2405          * Discovery processing will satisfy it.
2406          */
2407         if (phba->hba_state < LPFC_NS_QRY) {
2408                 lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL,
2409                                                                 newnode);
2410                 return (0);
2411         }
2412
2413         /* If we are already processing an RSCN, save the received
2414          * RSCN payload buffer, cmdiocb->context2 to process later.
2415          */
2416         if (phba->fc_flag & (FC_RSCN_MODE | FC_NDISC_ACTIVE)) {
2417                 if ((phba->fc_rscn_id_cnt < FC_MAX_HOLD_RSCN) &&
2418                     !(phba->fc_flag & FC_RSCN_DISCOVERY)) {
2419                         spin_lock_irq(phba->host->host_lock);
2420                         phba->fc_flag |= FC_RSCN_MODE;
2421                         spin_unlock_irq(phba->host->host_lock);
2422                         phba->fc_rscn_id_list[phba->fc_rscn_id_cnt++] = pcmd;
2423
2424                         /* If we zero, cmdiocb->context2, the calling
2425                          * routine will not try to free it.
2426                          */
2427                         cmdiocb->context2 = NULL;
2428
2429                         /* Deferred RSCN */
2430                         lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2431                                         "%d:0235 Deferred RSCN "
2432                                         "Data: x%x x%x x%x\n",
2433                                         phba->brd_no, phba->fc_rscn_id_cnt,
2434                                         phba->fc_flag, phba->hba_state);
2435                 } else {
2436                         spin_lock_irq(phba->host->host_lock);
2437                         phba->fc_flag |= FC_RSCN_DISCOVERY;
2438                         spin_unlock_irq(phba->host->host_lock);
2439                         /* ReDiscovery RSCN */
2440                         lpfc_printf_log(phba, KERN_INFO, LOG_DISCOVERY,
2441                                         "%d:0234 ReDiscovery RSCN "
2442                                         "Data: x%x x%x x%x\n",
2443                                         phba->brd_no, phba->fc_rscn_id_cnt,
2444                                         phba->fc_flag, phba->hba_state);
2445                 }
2446                 /* Send back ACC */
2447                 lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL,
2448                                                                 newnode);
2449
2450                 /* send RECOVERY event for ALL nodes that match RSCN payload */
2451                 lpfc_rscn_recovery_check(phba);
2452                 return (0);
2453         }
2454
2455         phba->fc_flag |= FC_RSCN_MODE;
2456         phba->fc_rscn_id_list[phba->fc_rscn_id_cnt++] = pcmd;
2457         /*
2458          * If we zero, cmdiocb->context2, the calling routine will
2459          * not try to free it.
2460          */
2461         cmdiocb->context2 = NULL;
2462
2463         lpfc_set_disctmo(phba);
2464
2465         /* Send back ACC */
2466         lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL, newnode);
2467
2468         /* send RECOVERY event for ALL nodes that match RSCN payload */
2469         lpfc_rscn_recovery_check(phba);
2470
2471         return (lpfc_els_handle_rscn(phba));
2472 }
2473
2474 int
2475 lpfc_els_handle_rscn(struct lpfc_hba * phba)
2476 {
2477         struct lpfc_nodelist *ndlp;
2478
2479         /* Start timer for RSCN processing */
2480         lpfc_set_disctmo(phba);
2481
2482         /* RSCN processed */
2483         lpfc_printf_log(phba,
2484                         KERN_INFO,
2485                         LOG_DISCOVERY,
2486                         "%d:0215 RSCN processed Data: x%x x%x x%x x%x\n",
2487                         phba->brd_no,
2488                         phba->fc_flag, 0, phba->fc_rscn_id_cnt,
2489                         phba->hba_state);
2490
2491         /* To process RSCN, first compare RSCN data with NameServer */
2492         phba->fc_ns_retry = 0;
2493         if ((ndlp = lpfc_findnode_did(phba, NLP_SEARCH_UNMAPPED,
2494                                       NameServer_DID))) {
2495                 /* Good ndlp, issue CT Request to NameServer */
2496                 if (lpfc_ns_cmd(phba, ndlp, SLI_CTNS_GID_FT) == 0) {
2497                         /* Wait for NameServer query cmpl before we can
2498                            continue */
2499                         return (1);
2500                 }
2501         } else {
2502                 /* If login to NameServer does not exist, issue one */
2503                 /* Good status, issue PLOGI to NameServer */
2504                 if ((ndlp =
2505                      lpfc_findnode_did(phba, NLP_SEARCH_ALL, NameServer_DID))) {
2506                         /* Wait for NameServer login cmpl before we can
2507                            continue */
2508                         return (1);
2509                 }
2510                 if ((ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL))
2511                     == 0) {
2512                         lpfc_els_flush_rscn(phba);
2513                         return (0);
2514                 } else {
2515                         lpfc_nlp_init(phba, ndlp, NameServer_DID);
2516                         ndlp->nlp_type |= NLP_FABRIC;
2517                         ndlp->nlp_state = NLP_STE_PLOGI_ISSUE;
2518                         lpfc_issue_els_plogi(phba, ndlp, 0);
2519                         /* Wait for NameServer login cmpl before we can
2520                            continue */
2521                         return (1);
2522                 }
2523         }
2524
2525         lpfc_els_flush_rscn(phba);
2526         return (0);
2527 }
2528
2529 static int
2530 lpfc_els_rcv_flogi(struct lpfc_hba * phba,
2531                    struct lpfc_iocbq * cmdiocb,
2532                    struct lpfc_nodelist * ndlp, uint8_t newnode)
2533 {
2534         struct lpfc_dmabuf *pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2535         uint32_t *lp = (uint32_t *) pcmd->virt;
2536         IOCB_t *icmd = &cmdiocb->iocb;
2537         struct serv_parm *sp;
2538         LPFC_MBOXQ_t *mbox;
2539         struct ls_rjt stat;
2540         uint32_t cmd, did;
2541         int rc;
2542
2543         cmd = *lp++;
2544         sp = (struct serv_parm *) lp;
2545
2546         /* FLOGI received */
2547
2548         lpfc_set_disctmo(phba);
2549
2550         if (phba->fc_topology == TOPOLOGY_LOOP) {
2551                 /* We should never receive a FLOGI in loop mode, ignore it */
2552                 did = icmd->un.elsreq64.remoteID;
2553
2554                 /* An FLOGI ELS command <elsCmd> was received from DID <did> in
2555                    Loop Mode */
2556                 lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
2557                                 "%d:0113 An FLOGI ELS command x%x was received "
2558                                 "from DID x%x in Loop Mode\n",
2559                                 phba->brd_no, cmd, did);
2560                 return (1);
2561         }
2562
2563         did = Fabric_DID;
2564
2565         if ((lpfc_check_sparm(phba, ndlp, sp, CLASS3))) {
2566                 /* For a FLOGI we accept, then if our portname is greater
2567                  * then the remote portname we initiate Nport login.
2568                  */
2569
2570                 rc = memcmp(&phba->fc_portname, &sp->portName,
2571                             sizeof (struct lpfc_name));
2572
2573                 if (!rc) {
2574                         if ((mbox = mempool_alloc(phba->mbox_mem_pool,
2575                                                   GFP_KERNEL)) == 0) {
2576                                 return (1);
2577                         }
2578                         lpfc_linkdown(phba);
2579                         lpfc_init_link(phba, mbox,
2580                                        phba->cfg_topology,
2581                                        phba->cfg_link_speed);
2582                         mbox->mb.un.varInitLnk.lipsr_AL_PA = 0;
2583                         mbox->mbox_cmpl = lpfc_sli_def_mbox_cmpl;
2584                         rc = lpfc_sli_issue_mbox
2585                                 (phba, mbox, (MBX_NOWAIT | MBX_STOP_IOCB));
2586                         if (rc == MBX_NOT_FINISHED) {
2587                                 mempool_free( mbox, phba->mbox_mem_pool);
2588                         }
2589                         return (1);
2590                 }
2591                 else if (rc > 0) {      /* greater than */
2592                         spin_lock_irq(phba->host->host_lock);
2593                         phba->fc_flag |= FC_PT2PT_PLOGI;
2594                         spin_unlock_irq(phba->host->host_lock);
2595                 }
2596                 phba->fc_flag |= FC_PT2PT;
2597                 phba->fc_flag &= ~(FC_FABRIC | FC_PUBLIC_LOOP);
2598         } else {
2599                 /* Reject this request because invalid parameters */
2600                 stat.un.b.lsRjtRsvd0 = 0;
2601                 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
2602                 stat.un.b.lsRjtRsnCodeExp = LSEXP_SPARM_OPTIONS;
2603                 stat.un.b.vendorUnique = 0;
2604                 lpfc_els_rsp_reject(phba, stat.un.lsRjtError, cmdiocb, ndlp);
2605                 return (1);
2606         }
2607
2608         /* Send back ACC */
2609         lpfc_els_rsp_acc(phba, ELS_CMD_PLOGI, cmdiocb, ndlp, NULL, newnode);
2610
2611         return (0);
2612 }
2613
2614 static int
2615 lpfc_els_rcv_rnid(struct lpfc_hba * phba,
2616                   struct lpfc_iocbq * cmdiocb, struct lpfc_nodelist * ndlp)
2617 {
2618         struct lpfc_dmabuf *pcmd;
2619         uint32_t *lp;
2620         IOCB_t *icmd;
2621         RNID *rn;
2622         struct ls_rjt stat;
2623         uint32_t cmd, did;
2624
2625         icmd = &cmdiocb->iocb;
2626         did = icmd->un.elsreq64.remoteID;
2627         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2628         lp = (uint32_t *) pcmd->virt;
2629
2630         cmd = *lp++;
2631         rn = (RNID *) lp;
2632
2633         /* RNID received */
2634
2635         switch (rn->Format) {
2636         case 0:
2637         case RNID_TOPOLOGY_DISC:
2638                 /* Send back ACC */
2639                 lpfc_els_rsp_rnid_acc(phba, rn->Format, cmdiocb, ndlp);
2640                 break;
2641         default:
2642                 /* Reject this request because format not supported */
2643                 stat.un.b.lsRjtRsvd0 = 0;
2644                 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
2645                 stat.un.b.lsRjtRsnCodeExp = LSEXP_CANT_GIVE_DATA;
2646                 stat.un.b.vendorUnique = 0;
2647                 lpfc_els_rsp_reject(phba, stat.un.lsRjtError, cmdiocb, ndlp);
2648         }
2649         return (0);
2650 }
2651
2652 static int
2653 lpfc_els_rcv_rrq(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
2654                  struct lpfc_nodelist * ndlp)
2655 {
2656         struct lpfc_dmabuf *pcmd;
2657         uint32_t *lp;
2658         IOCB_t *icmd;
2659         struct lpfc_sli_ring *pring;
2660         struct lpfc_sli *psli;
2661         RRQ *rrq;
2662         uint32_t cmd, did;
2663
2664         psli = &phba->sli;
2665         pring = &psli->ring[LPFC_FCP_RING];
2666         icmd = &cmdiocb->iocb;
2667         did = icmd->un.elsreq64.remoteID;
2668         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2669         lp = (uint32_t *) pcmd->virt;
2670
2671         cmd = *lp++;
2672         rrq = (RRQ *) lp;
2673
2674         /* RRQ received */
2675         /* Get oxid / rxid from payload and abort it */
2676         spin_lock_irq(phba->host->host_lock);
2677         if ((rrq->SID == be32_to_cpu(phba->fc_myDID))) {
2678                 lpfc_sli_abort_iocb(phba, pring, 0, 0, rrq->Oxid,
2679                                                         LPFC_CTX_CTX);
2680         } else {
2681                 lpfc_sli_abort_iocb(phba, pring, 0, 0, rrq->Rxid,
2682                                                         LPFC_CTX_CTX);
2683         }
2684
2685         spin_unlock_irq(phba->host->host_lock);
2686         /* ACCEPT the rrq request */
2687         lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL, 0);
2688
2689         return 0;
2690 }
2691
2692 static int
2693 lpfc_els_rcv_farp(struct lpfc_hba * phba,
2694                   struct lpfc_iocbq * cmdiocb, struct lpfc_nodelist * ndlp)
2695 {
2696         struct lpfc_dmabuf *pcmd;
2697         uint32_t *lp;
2698         IOCB_t *icmd;
2699         FARP *fp;
2700         uint32_t cmd, cnt, did;
2701
2702         icmd = &cmdiocb->iocb;
2703         did = icmd->un.elsreq64.remoteID;
2704         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2705         lp = (uint32_t *) pcmd->virt;
2706
2707         cmd = *lp++;
2708         fp = (FARP *) lp;
2709
2710         /* FARP-REQ received from DID <did> */
2711         lpfc_printf_log(phba,
2712                          KERN_INFO,
2713                          LOG_IP,
2714                          "%d:0601 FARP-REQ received from DID x%x\n",
2715                          phba->brd_no, did);
2716
2717         /* We will only support match on WWPN or WWNN */
2718         if (fp->Mflags & ~(FARP_MATCH_NODE | FARP_MATCH_PORT)) {
2719                 return (0);
2720         }
2721
2722         cnt = 0;
2723         /* If this FARP command is searching for my portname */
2724         if (fp->Mflags & FARP_MATCH_PORT) {
2725                 if (memcmp(&fp->RportName, &phba->fc_portname,
2726                            sizeof (struct lpfc_name)) == 0)
2727                         cnt = 1;
2728         }
2729
2730         /* If this FARP command is searching for my nodename */
2731         if (fp->Mflags & FARP_MATCH_NODE) {
2732                 if (memcmp(&fp->RnodeName, &phba->fc_nodename,
2733                            sizeof (struct lpfc_name)) == 0)
2734                         cnt = 1;
2735         }
2736
2737         if (cnt) {
2738                 if ((ndlp->nlp_state == NLP_STE_UNMAPPED_NODE) ||
2739                    (ndlp->nlp_state == NLP_STE_MAPPED_NODE)) {
2740                         /* Log back into the node before sending the FARP. */
2741                         if (fp->Rflags & FARP_REQUEST_PLOGI) {
2742                                 ndlp->nlp_state = NLP_STE_PLOGI_ISSUE;
2743                                 lpfc_nlp_list(phba, ndlp, NLP_PLOGI_LIST);
2744                                 lpfc_issue_els_plogi(phba, ndlp, 0);
2745                         }
2746
2747                         /* Send a FARP response to that node */
2748                         if (fp->Rflags & FARP_REQUEST_FARPR) {
2749                                 lpfc_issue_els_farpr(phba, did, 0);
2750                         }
2751                 }
2752         }
2753         return (0);
2754 }
2755
2756 static int
2757 lpfc_els_rcv_farpr(struct lpfc_hba * phba,
2758                    struct lpfc_iocbq * cmdiocb, struct lpfc_nodelist * ndlp)
2759 {
2760         struct lpfc_dmabuf *pcmd;
2761         uint32_t *lp;
2762         IOCB_t *icmd;
2763         uint32_t cmd, did;
2764
2765         icmd = &cmdiocb->iocb;
2766         did = icmd->un.elsreq64.remoteID;
2767         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2768         lp = (uint32_t *) pcmd->virt;
2769
2770         cmd = *lp++;
2771         /* FARP-RSP received from DID <did> */
2772         lpfc_printf_log(phba,
2773                          KERN_INFO,
2774                          LOG_IP,
2775                          "%d:0600 FARP-RSP received from DID x%x\n",
2776                          phba->brd_no, did);
2777
2778         /* ACCEPT the Farp resp request */
2779         lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL, 0);
2780
2781         return 0;
2782 }
2783
2784 static int
2785 lpfc_els_rcv_fan(struct lpfc_hba * phba, struct lpfc_iocbq * cmdiocb,
2786                  struct lpfc_nodelist * ndlp)
2787 {
2788         struct lpfc_dmabuf *pcmd;
2789         uint32_t *lp;
2790         IOCB_t *icmd;
2791         FAN *fp;
2792         uint32_t cmd, did;
2793
2794         icmd = &cmdiocb->iocb;
2795         did = icmd->un.elsreq64.remoteID;
2796         pcmd = (struct lpfc_dmabuf *) cmdiocb->context2;
2797         lp = (uint32_t *) pcmd->virt;
2798
2799         cmd = *lp++;
2800         fp = (FAN *) lp;
2801
2802         /* FAN received */
2803
2804         /* ACCEPT the FAN request */
2805         lpfc_els_rsp_acc(phba, ELS_CMD_ACC, cmdiocb, ndlp, NULL, 0);
2806
2807         if (phba->hba_state == LPFC_LOCAL_CFG_LINK) {
2808                 /* The discovery state machine needs to take a different
2809                  * action if this node has switched fabrics
2810                  */
2811                 if ((memcmp(&fp->FportName, &phba->fc_fabparam.portName,
2812                             sizeof (struct lpfc_name)) != 0)
2813                     ||
2814                     (memcmp(&fp->FnodeName, &phba->fc_fabparam.nodeName,
2815                             sizeof (struct lpfc_name)) != 0)) {
2816                         /* This node has switched fabrics.  An FLOGI is required
2817                          * after the timeout
2818                          */
2819                         return (0);
2820                 }
2821
2822                 /* Start discovery */
2823                 lpfc_disc_start(phba);
2824         }
2825
2826         return (0);
2827 }
2828
2829 void
2830 lpfc_els_timeout(unsigned long ptr)
2831 {
2832         struct lpfc_hba *phba;
2833         unsigned long iflag;
2834
2835         phba = (struct lpfc_hba *)ptr;
2836         if (phba == 0)
2837                 return;
2838         spin_lock_irqsave(phba->host->host_lock, iflag);
2839         if (!(phba->work_hba_events & WORKER_ELS_TMO)) {
2840                 phba->work_hba_events |= WORKER_ELS_TMO;
2841                 if (phba->work_wait)
2842                         wake_up(phba->work_wait);
2843         }
2844         spin_unlock_irqrestore(phba->host->host_lock, iflag);
2845         return;
2846 }
2847
2848 void
2849 lpfc_els_timeout_handler(struct lpfc_hba *phba)
2850 {
2851         struct lpfc_sli_ring *pring;
2852         struct lpfc_iocbq *tmp_iocb, *piocb;
2853         IOCB_t *cmd = NULL;
2854         struct lpfc_dmabuf *pcmd;
2855         struct list_head *dlp;
2856         uint32_t *elscmd;
2857         uint32_t els_command;
2858         uint32_t timeout;
2859         uint32_t remote_ID;
2860
2861         if (phba == 0)
2862                 return;
2863         spin_lock_irq(phba->host->host_lock);
2864         /* If the timer is already canceled do nothing */
2865         if (!(phba->work_hba_events & WORKER_ELS_TMO)) {
2866                 spin_unlock_irq(phba->host->host_lock);
2867                 return;
2868         }
2869         timeout = (uint32_t)(phba->fc_ratov << 1);
2870
2871         pring = &phba->sli.ring[LPFC_ELS_RING];
2872         dlp = &pring->txcmplq;
2873
2874         list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
2875                 cmd = &piocb->iocb;
2876
2877                 if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
2878                         continue;
2879                 }
2880                 pcmd = (struct lpfc_dmabuf *) piocb->context2;
2881                 elscmd = (uint32_t *) (pcmd->virt);
2882                 els_command = *elscmd;
2883
2884                 if ((els_command == ELS_CMD_FARP)
2885                     || (els_command == ELS_CMD_FARPR)) {
2886                         continue;
2887                 }
2888
2889                 if (piocb->drvrTimeout > 0) {
2890                         if (piocb->drvrTimeout >= timeout) {
2891                                 piocb->drvrTimeout -= timeout;
2892                         } else {
2893                                 piocb->drvrTimeout = 0;
2894                         }
2895                         continue;
2896                 }
2897
2898                 list_del(&piocb->list);
2899                 pring->txcmplq_cnt--;
2900
2901                 if (cmd->ulpCommand == CMD_GEN_REQUEST64_CR) {
2902                         struct lpfc_nodelist *ndlp;
2903
2904                         ndlp = lpfc_findnode_rpi(phba, cmd->ulpContext);
2905                         remote_ID = ndlp->nlp_DID;
2906                         if (cmd->un.elsreq64.bdl.ulpIoTag32) {
2907                                 lpfc_sli_issue_abort_iotag32(phba,
2908                                         pring, piocb);
2909                         }
2910                 } else {
2911                         remote_ID = cmd->un.elsreq64.remoteID;
2912                 }
2913
2914                 lpfc_printf_log(phba,
2915                                 KERN_ERR,
2916                                 LOG_ELS,
2917                                 "%d:0127 ELS timeout Data: x%x x%x x%x x%x\n",
2918                                 phba->brd_no, els_command,
2919                                 remote_ID, cmd->ulpCommand, cmd->ulpIoTag);
2920
2921                 /*
2922                  * The iocb has timed out; abort it.
2923                  */
2924                 if (piocb->iocb_cmpl) {
2925                         cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
2926                         cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
2927                         spin_unlock_irq(phba->host->host_lock);
2928                         (piocb->iocb_cmpl) (phba, piocb, piocb);
2929                         spin_lock_irq(phba->host->host_lock);
2930                 } else
2931                         lpfc_sli_release_iocbq(phba, piocb);
2932         }
2933         if (phba->sli.ring[LPFC_ELS_RING].txcmplq_cnt) {
2934                 phba->els_tmofunc.expires = jiffies + HZ * timeout;
2935                 add_timer(&phba->els_tmofunc);
2936         }
2937         spin_unlock_irq(phba->host->host_lock);
2938 }
2939
2940 void
2941 lpfc_els_flush_cmd(struct lpfc_hba * phba)
2942 {
2943         struct lpfc_sli_ring *pring;
2944         struct lpfc_iocbq *tmp_iocb, *piocb;
2945         IOCB_t *cmd = NULL;
2946         struct lpfc_dmabuf *pcmd;
2947         uint32_t *elscmd;
2948         uint32_t els_command;
2949         uint32_t remote_ID;
2950
2951         pring = &phba->sli.ring[LPFC_ELS_RING];
2952         spin_lock_irq(phba->host->host_lock);
2953         list_for_each_entry_safe(piocb, tmp_iocb, &pring->txq, list) {
2954                 cmd = &piocb->iocb;
2955
2956                 if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
2957                         continue;
2958                 }
2959
2960                 /* Do not flush out the QUE_RING and ABORT/CLOSE iocbs */
2961                 if ((cmd->ulpCommand == CMD_QUE_RING_BUF_CN) ||
2962                     (cmd->ulpCommand == CMD_QUE_RING_BUF64_CN) ||
2963                     (cmd->ulpCommand == CMD_CLOSE_XRI_CN) ||
2964                     (cmd->ulpCommand == CMD_ABORT_XRI_CN)) {
2965                         continue;
2966                 }
2967
2968                 pcmd = (struct lpfc_dmabuf *) piocb->context2;
2969                 elscmd = (uint32_t *) (pcmd->virt);
2970                 els_command = *elscmd;
2971
2972                 if (cmd->ulpCommand == CMD_GEN_REQUEST64_CR) {
2973                         struct lpfc_nodelist *ndlp;
2974
2975                         ndlp = lpfc_findnode_rpi(phba, cmd->ulpContext);
2976                         remote_ID = ndlp->nlp_DID;
2977                         if (phba->hba_state == LPFC_HBA_READY) {
2978                                 continue;
2979                         }
2980                 } else {
2981                         remote_ID = cmd->un.elsreq64.remoteID;
2982                 }
2983
2984                 list_del(&piocb->list);
2985                 pring->txcmplq_cnt--;
2986
2987                 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
2988                 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
2989
2990                 if (piocb->iocb_cmpl) {
2991                         spin_unlock_irq(phba->host->host_lock);
2992                         (piocb->iocb_cmpl) (phba, piocb, piocb);
2993                         spin_lock_irq(phba->host->host_lock);
2994                 }
2995                 else
2996                         lpfc_sli_release_iocbq(phba, piocb);
2997         }
2998
2999         list_for_each_entry_safe(piocb, tmp_iocb, &pring->txcmplq, list) {
3000                 cmd = &piocb->iocb;
3001
3002                 if (piocb->iocb_flag & LPFC_IO_LIBDFC) {
3003                         continue;
3004                 }
3005                 pcmd = (struct lpfc_dmabuf *) piocb->context2;
3006                 elscmd = (uint32_t *) (pcmd->virt);
3007                 els_command = *elscmd;
3008
3009                 if (cmd->ulpCommand == CMD_GEN_REQUEST64_CR) {
3010                         struct lpfc_nodelist *ndlp;
3011
3012                         ndlp = lpfc_findnode_rpi(phba, cmd->ulpContext);
3013                         remote_ID = ndlp->nlp_DID;
3014                         if (phba->hba_state == LPFC_HBA_READY) {
3015                                 continue;
3016                         }
3017                 } else {
3018                         remote_ID = cmd->un.elsreq64.remoteID;
3019                 }
3020
3021                 list_del(&piocb->list);
3022                 pring->txcmplq_cnt--;
3023
3024                 cmd->ulpStatus = IOSTAT_LOCAL_REJECT;
3025                 cmd->un.ulpWord[4] = IOERR_SLI_ABORTED;
3026
3027                 if (piocb->iocb_cmpl) {
3028                         spin_unlock_irq(phba->host->host_lock);
3029                         (piocb->iocb_cmpl) (phba, piocb, piocb);
3030                         spin_lock_irq(phba->host->host_lock);
3031                 }
3032                 else
3033                         lpfc_sli_release_iocbq(phba, piocb);
3034         }
3035         spin_unlock_irq(phba->host->host_lock);
3036         return;
3037 }
3038
3039 void
3040 lpfc_els_unsol_event(struct lpfc_hba * phba,
3041                      struct lpfc_sli_ring * pring, struct lpfc_iocbq * elsiocb)
3042 {
3043         struct lpfc_sli *psli;
3044         struct lpfc_nodelist *ndlp;
3045         struct lpfc_dmabuf *mp;
3046         uint32_t *lp;
3047         IOCB_t *icmd;
3048         struct ls_rjt stat;
3049         uint32_t cmd;
3050         uint32_t did;
3051         uint32_t newnode;
3052         uint32_t drop_cmd = 0;  /* by default do NOT drop received cmd */
3053         uint32_t rjt_err = 0;
3054
3055         psli = &phba->sli;
3056         icmd = &elsiocb->iocb;
3057
3058         if ((icmd->ulpStatus == IOSTAT_LOCAL_REJECT) &&
3059                 ((icmd->un.ulpWord[4] & 0xff) == IOERR_RCV_BUFFER_WAITING)) {
3060                 /* Not enough posted buffers; Try posting more buffers */
3061                 phba->fc_stat.NoRcvBuf++;
3062                 lpfc_post_buffer(phba, pring, 0, 1);
3063                 return;
3064         }
3065
3066         /* If there are no BDEs associated with this IOCB,
3067          * there is nothing to do.
3068          */
3069         if (icmd->ulpBdeCount == 0)
3070                 return;
3071
3072         /* type of ELS cmd is first 32bit word in packet */
3073         mp = lpfc_sli_ringpostbuf_get(phba, pring, getPaddr(icmd->un.
3074                                                             cont64[0].
3075                                                             addrHigh,
3076                                                             icmd->un.
3077                                                             cont64[0].addrLow));
3078         if (mp == 0) {
3079                 drop_cmd = 1;
3080                 goto dropit;
3081         }
3082
3083         newnode = 0;
3084         lp = (uint32_t *) mp->virt;
3085         cmd = *lp++;
3086         lpfc_post_buffer(phba, &psli->ring[LPFC_ELS_RING], 1, 1);
3087
3088         if (icmd->ulpStatus) {
3089                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
3090                 kfree(mp);
3091                 drop_cmd = 1;
3092                 goto dropit;
3093         }
3094
3095         /* Check to see if link went down during discovery */
3096         if (lpfc_els_chk_latt(phba)) {
3097                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
3098                 kfree(mp);
3099                 drop_cmd = 1;
3100                 goto dropit;
3101         }
3102
3103         did = icmd->un.rcvels.remoteID;
3104         if ((ndlp = lpfc_findnode_did(phba, NLP_SEARCH_ALL, did)) == 0) {
3105                 /* Cannot find existing Fabric ndlp, so allocate a new one */
3106                 if ((ndlp = mempool_alloc(phba->nlp_mem_pool, GFP_KERNEL))
3107                     == 0) {
3108                         lpfc_mbuf_free(phba, mp->virt, mp->phys);
3109                         kfree(mp);
3110                         drop_cmd = 1;
3111                         goto dropit;
3112                 }
3113
3114                 lpfc_nlp_init(phba, ndlp, did);
3115                 newnode = 1;
3116                 if ((did & Fabric_DID_MASK) == Fabric_DID_MASK) {
3117                         ndlp->nlp_type |= NLP_FABRIC;
3118                 }
3119         }
3120
3121         phba->fc_stat.elsRcvFrame++;
3122         elsiocb->context1 = ndlp;
3123         elsiocb->context2 = mp;
3124
3125         if ((cmd & ELS_CMD_MASK) == ELS_CMD_RSCN) {
3126                 cmd &= ELS_CMD_MASK;
3127         }
3128         /* ELS command <elsCmd> received from NPORT <did> */
3129         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
3130                         "%d:0112 ELS command x%x received from NPORT x%x "
3131                         "Data: x%x\n", phba->brd_no, cmd, did, phba->hba_state);
3132
3133         switch (cmd) {
3134         case ELS_CMD_PLOGI:
3135                 phba->fc_stat.elsRcvPLOGI++;
3136                 if (phba->hba_state < LPFC_DISC_AUTH) {
3137                         rjt_err = 1;
3138                         break;
3139                 }
3140                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_PLOGI);
3141                 break;
3142         case ELS_CMD_FLOGI:
3143                 phba->fc_stat.elsRcvFLOGI++;
3144                 lpfc_els_rcv_flogi(phba, elsiocb, ndlp, newnode);
3145                 if (newnode) {
3146                         mempool_free( ndlp, phba->nlp_mem_pool);
3147                 }
3148                 break;
3149         case ELS_CMD_LOGO:
3150                 phba->fc_stat.elsRcvLOGO++;
3151                 if (phba->hba_state < LPFC_DISC_AUTH) {
3152                         rjt_err = 1;
3153                         break;
3154                 }
3155                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_LOGO);
3156                 break;
3157         case ELS_CMD_PRLO:
3158                 phba->fc_stat.elsRcvPRLO++;
3159                 if (phba->hba_state < LPFC_DISC_AUTH) {
3160                         rjt_err = 1;
3161                         break;
3162                 }
3163                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_PRLO);
3164                 break;
3165         case ELS_CMD_RSCN:
3166                 phba->fc_stat.elsRcvRSCN++;
3167                 lpfc_els_rcv_rscn(phba, elsiocb, ndlp, newnode);
3168                 if (newnode) {
3169                         mempool_free( ndlp, phba->nlp_mem_pool);
3170                 }
3171                 break;
3172         case ELS_CMD_ADISC:
3173                 phba->fc_stat.elsRcvADISC++;
3174                 if (phba->hba_state < LPFC_DISC_AUTH) {
3175                         rjt_err = 1;
3176                         break;
3177                 }
3178                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_ADISC);
3179                 break;
3180         case ELS_CMD_PDISC:
3181                 phba->fc_stat.elsRcvPDISC++;
3182                 if (phba->hba_state < LPFC_DISC_AUTH) {
3183                         rjt_err = 1;
3184                         break;
3185                 }
3186                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_PDISC);
3187                 break;
3188         case ELS_CMD_FARPR:
3189                 phba->fc_stat.elsRcvFARPR++;
3190                 lpfc_els_rcv_farpr(phba, elsiocb, ndlp);
3191                 break;
3192         case ELS_CMD_FARP:
3193                 phba->fc_stat.elsRcvFARP++;
3194                 lpfc_els_rcv_farp(phba, elsiocb, ndlp);
3195                 break;
3196         case ELS_CMD_FAN:
3197                 phba->fc_stat.elsRcvFAN++;
3198                 lpfc_els_rcv_fan(phba, elsiocb, ndlp);
3199                 break;
3200         case ELS_CMD_RRQ:
3201                 phba->fc_stat.elsRcvRRQ++;
3202                 lpfc_els_rcv_rrq(phba, elsiocb, ndlp);
3203                 break;
3204         case ELS_CMD_PRLI:
3205                 phba->fc_stat.elsRcvPRLI++;
3206                 if (phba->hba_state < LPFC_DISC_AUTH) {
3207                         rjt_err = 1;
3208                         break;
3209                 }
3210                 lpfc_disc_state_machine(phba, ndlp, elsiocb, NLP_EVT_RCV_PRLI);
3211                 break;
3212         case ELS_CMD_RNID:
3213                 phba->fc_stat.elsRcvRNID++;
3214                 lpfc_els_rcv_rnid(phba, elsiocb, ndlp);
3215                 break;
3216         default:
3217                 /* Unsupported ELS command, reject */
3218                 rjt_err = 1;
3219
3220                 /* Unknown ELS command <elsCmd> received from NPORT <did> */
3221                 lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
3222                                 "%d:0115 Unknown ELS command x%x received from "
3223                                 "NPORT x%x\n", phba->brd_no, cmd, did);
3224                 if (newnode) {
3225                         mempool_free( ndlp, phba->nlp_mem_pool);
3226                 }
3227                 break;
3228         }
3229
3230         /* check if need to LS_RJT received ELS cmd */
3231         if (rjt_err) {
3232                 stat.un.b.lsRjtRsvd0 = 0;
3233                 stat.un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;
3234                 stat.un.b.lsRjtRsnCodeExp = LSEXP_NOTHING_MORE;
3235                 stat.un.b.vendorUnique = 0;
3236                 lpfc_els_rsp_reject(phba, stat.un.lsRjtError, elsiocb, ndlp);
3237         }
3238
3239         if (elsiocb->context2) {
3240                 lpfc_mbuf_free(phba, mp->virt, mp->phys);
3241                 kfree(mp);
3242         }
3243 dropit:
3244         /* check if need to drop received ELS cmd */
3245         if (drop_cmd == 1) {
3246                 lpfc_printf_log(phba, KERN_ERR, LOG_ELS,
3247                                 "%d:0111 Dropping received ELS cmd "
3248                                 "Data: x%x x%x\n", phba->brd_no,
3249                                 icmd->ulpStatus, icmd->un.ulpWord[4]);
3250                 phba->fc_stat.elsRcvDrop++;
3251         }
3252         return;
3253 }