drivers/scsi/lpfc/lpfc_ct.c

   1 /*******************************************************************
   2  * This file is part of the Emulex Linux Device Driver for         *
   3  * Fibre Channel Host Bus Adapters.                                *
   4  * Copyright (C) 2017-2018 Broadcom. All Rights Reserved. The term *
   5  * “Broadcom” refers to Broadcom Inc. and/or its subsidiaries.     *
   6  * Copyright (C) 2004-2016 Emulex.  All rights reserved.           *
   7  * EMULEX and SLI are trademarks of Emulex.                        *
   8  * www.broadcom.com                                                *
   9  *                                                                 *
  10  * This program is free software; you can redistribute it and/or   *
  11  * modify it under the terms of version 2 of the GNU General       *
  12  * Public License as published by the Free Software Foundation.    *
  13  * This program is distributed in the hope that it will be useful. *
  14  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
  15  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
  16  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
  17  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
  18  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
  19  * more details, a copy of which can be found in the file COPYING  *
  20  * included with this package.                                     *
  21  *******************************************************************/
  22
  23 /*
  24  * Fibre Channel SCSI LAN Device Driver CT support: FC Generic Services FC-GS
  25  */
  26
  27 #include <linux/blkdev.h>
  28 #include <linux/pci.h>
  29 #include <linux/interrupt.h>
  30 #include <linux/slab.h>
  31 #include <linux/utsname.h>
  32
  33 #include <scsi/scsi.h>
  34 #include <scsi/scsi_device.h>
  35 #include <scsi/scsi_host.h>
  36 #include <scsi/scsi_transport_fc.h>
  37 #include <scsi/fc/fc_fs.h>
  38
  39 #include "lpfc_hw4.h"
  40 #include "lpfc_hw.h"
  41 #include "lpfc_sli.h"
  42 #include "lpfc_sli4.h"
  43 #include "lpfc_nl.h"
  44 #include "lpfc_disc.h"
  45 #include "lpfc.h"
  46 #include "lpfc_scsi.h"
  47 #include "lpfc_nvme.h"
  48 #include "lpfc_logmsg.h"
  49 #include "lpfc_crtn.h"
  50 #include "lpfc_version.h"
  51 #include "lpfc_vport.h"
  52 #include "lpfc_debugfs.h"
  53
  54 /* FDMI Port Speed definitions - FC-GS-7 */
  55 #define HBA_PORTSPEED_1GFC              0x00000001      /* 1G FC */
  56 #define HBA_PORTSPEED_2GFC              0x00000002      /* 2G FC */
  57 #define HBA_PORTSPEED_4GFC              0x00000008      /* 4G FC */
  58 #define HBA_PORTSPEED_10GFC             0x00000004      /* 10G FC */
  59 #define HBA_PORTSPEED_8GFC              0x00000010      /* 8G FC */
  60 #define HBA_PORTSPEED_16GFC             0x00000020      /* 16G FC */
  61 #define HBA_PORTSPEED_32GFC             0x00000040      /* 32G FC */
  62 #define HBA_PORTSPEED_20GFC             0x00000080      /* 20G FC */
  63 #define HBA_PORTSPEED_40GFC             0x00000100      /* 40G FC */
  64 #define HBA_PORTSPEED_128GFC            0x00000200      /* 128G FC */
  65 #define HBA_PORTSPEED_64GFC             0x00000400      /* 64G FC */
  66 #define HBA_PORTSPEED_256GFC            0x00000800      /* 256G FC */
  67 #define HBA_PORTSPEED_UNKNOWN           0x00008000      /* Unknown */
  68 #define HBA_PORTSPEED_10GE              0x00010000      /* 10G E */
  69 #define HBA_PORTSPEED_40GE              0x00020000      /* 40G E */
  70 #define HBA_PORTSPEED_100GE             0x00040000      /* 100G E */
  71 #define HBA_PORTSPEED_25GE              0x00080000      /* 25G E */
  72 #define HBA_PORTSPEED_50GE              0x00100000      /* 50G E */
  73 #define HBA_PORTSPEED_400GE             0x00200000      /* 400G E */
  74
  75 #define FOURBYTES       4
  76
  77
  78 static char *lpfc_release_version = LPFC_DRIVER_VERSION;
  79
  80 static void
  81 lpfc_ct_ignore_hbq_buffer(struct lpfc_hba *phba, struct lpfc_iocbq *piocbq,
  82                           struct lpfc_dmabuf *mp, uint32_t size)
  83 {
  84         if (!mp) {
  85                 lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
  86                                 "0146 Ignoring unsolicited CT No HBQ "
  87                                 "status = x%x\n",
  88                                 piocbq->iocb.ulpStatus);
  89         }
  90         lpfc_printf_log(phba, KERN_INFO, LOG_ELS,
  91                         "0145 Ignoring unsolicted CT HBQ Size:%d "
  92                         "status = x%x\n",
  93                         size, piocbq->iocb.ulpStatus);
  94 }
  95
  96 static void
  97 lpfc_ct_unsol_buffer(struct lpfc_hba *phba, struct lpfc_iocbq *piocbq,
  98                      struct lpfc_dmabuf *mp, uint32_t size)
  99 {
 100         lpfc_ct_ignore_hbq_buffer(phba, piocbq, mp, size);
 101 }
 102
 103 void
 104 lpfc_ct_unsol_event(struct lpfc_hba *phba, struct lpfc_sli_ring *pring,
 105                     struct lpfc_iocbq *piocbq)
 106 {
 107         struct lpfc_dmabuf *mp = NULL;
 108         IOCB_t *icmd = &piocbq->iocb;
 109         int i;
 110         struct lpfc_iocbq *iocbq;
 111         dma_addr_t paddr;
 112         uint32_t size;
 113         struct list_head head;
 114         struct lpfc_dmabuf *bdeBuf;
 115
 116         if (lpfc_bsg_ct_unsol_event(phba, pring, piocbq) == 0)
 117                 return;
 118
 119         if (unlikely(icmd->ulpStatus == IOSTAT_NEED_BUFFER)) {
 120                 lpfc_sli_hbqbuf_add_hbqs(phba, LPFC_ELS_HBQ);
 121         } else if ((icmd->ulpStatus == IOSTAT_LOCAL_REJECT) &&
 122                    ((icmd->un.ulpWord[4] & IOERR_PARAM_MASK) ==
 123                    IOERR_RCV_BUFFER_WAITING)) {
 124                 /* Not enough posted buffers; Try posting more buffers */
 125                 phba->fc_stat.NoRcvBuf++;
 126                 if (!(phba->sli3_options & LPFC_SLI3_HBQ_ENABLED))
 127                         lpfc_post_buffer(phba, pring, 2);
 128                 return;
 129         }
 130
 131         /* If there are no BDEs associated with this IOCB,
 132          * there is nothing to do.
 133          */
 134         if (icmd->ulpBdeCount == 0)
 135                 return;
 136
 137         if (phba->sli3_options & LPFC_SLI3_HBQ_ENABLED) {
 138                 INIT_LIST_HEAD(&head);
 139                 list_add_tail(&head, &piocbq->list);
 140                 list_for_each_entry(iocbq, &head, list) {
 141                         icmd = &iocbq->iocb;
 142                         if (icmd->ulpBdeCount == 0)
 143                                 continue;
 144                         bdeBuf = iocbq->context2;
 145                         iocbq->context2 = NULL;
 146                         size  = icmd->un.cont64[0].tus.f.bdeSize;
 147                         lpfc_ct_unsol_buffer(phba, piocbq, bdeBuf, size);
 148                         lpfc_in_buf_free(phba, bdeBuf);
 149                         if (icmd->ulpBdeCount == 2) {
 150                                 bdeBuf = iocbq->context3;
 151                                 iocbq->context3 = NULL;
 152                                 size  = icmd->unsli3.rcvsli3.bde2.tus.f.bdeSize;
 153                                 lpfc_ct_unsol_buffer(phba, piocbq, bdeBuf,
 154                                                      size);
 155                                 lpfc_in_buf_free(phba, bdeBuf);
 156                         }
 157                 }
 158                 list_del(&head);
 159         } else {
 160                 INIT_LIST_HEAD(&head);
 161                 list_add_tail(&head, &piocbq->list);
 162                 list_for_each_entry(iocbq, &head, list) {
 163                         icmd = &iocbq->iocb;
 164                         if (icmd->ulpBdeCount == 0)
 165                                 lpfc_ct_unsol_buffer(phba, iocbq, NULL, 0);
 166                         for (i = 0; i < icmd->ulpBdeCount; i++) {
 167                                 paddr = getPaddr(icmd->un.cont64[i].addrHigh,
 168                                                  icmd->un.cont64[i].addrLow);
 169                                 mp = lpfc_sli_ringpostbuf_get(phba, pring,
 170                                                               paddr);
 171                                 size = icmd->un.cont64[i].tus.f.bdeSize;
 172                                 lpfc_ct_unsol_buffer(phba, iocbq, mp, size);
 173                                 lpfc_in_buf_free(phba, mp);
 174                         }
 175                         lpfc_post_buffer(phba, pring, i);
 176                 }
 177                 list_del(&head);
 178         }
 179 }
 180
 181 /**
 182  * lpfc_ct_handle_unsol_abort - ct upper level protocol abort handler
 183  * @phba: Pointer to HBA context object.
 184  * @dmabuf: pointer to a dmabuf that describes the FC sequence
 185  *
 186  * This function serves as the upper level protocol abort handler for CT
 187  * protocol.
 188  *
 189  * Return 1 if abort has been handled, 0 otherwise.
 190  **/
 191 int
 192 lpfc_ct_handle_unsol_abort(struct lpfc_hba *phba, struct hbq_dmabuf *dmabuf)
 193 {
 194         int handled;
 195
 196         /* CT upper level goes through BSG */
 197         handled = lpfc_bsg_ct_unsol_abort(phba, dmabuf);
 198
 199         return handled;
 200 }
 201
 202 static void
 203 lpfc_free_ct_rsp(struct lpfc_hba *phba, struct lpfc_dmabuf *mlist)
 204 {
 205         struct lpfc_dmabuf *mlast, *next_mlast;
 206
 207         list_for_each_entry_safe(mlast, next_mlast, &mlist->list, list) {
 208                 lpfc_mbuf_free(phba, mlast->virt, mlast->phys);
 209                 list_del(&mlast->list);
 210                 kfree(mlast);
 211         }
 212         lpfc_mbuf_free(phba, mlist->virt, mlist->phys);
 213         kfree(mlist);
 214         return;
 215 }
 216
 217 static struct lpfc_dmabuf *
 218 lpfc_alloc_ct_rsp(struct lpfc_hba *phba, int cmdcode, struct ulp_bde64 *bpl,
 219                   uint32_t size, int *entries)
 220 {
 221         struct lpfc_dmabuf *mlist = NULL;
 222         struct lpfc_dmabuf *mp;
 223         int cnt, i = 0;
 224
 225         /* We get chunks of FCELSSIZE */
 226         cnt = size > FCELSSIZE ? FCELSSIZE: size;
 227
 228         while (size) {
 229                 /* Allocate buffer for rsp payload */
 230                 mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
 231                 if (!mp) {
 232                         if (mlist)
 233                                 lpfc_free_ct_rsp(phba, mlist);
 234                         return NULL;
 235                 }
 236
 237                 INIT_LIST_HEAD(&mp->list);
 238
 239                 if (cmdcode == be16_to_cpu(SLI_CTNS_GID_FT) ||
 240                     cmdcode == be16_to_cpu(SLI_CTNS_GFF_ID))
 241                         mp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(mp->phys));
 242                 else
 243                         mp->virt = lpfc_mbuf_alloc(phba, 0, &(mp->phys));
 244
 245                 if (!mp->virt) {
 246                         kfree(mp);
 247                         if (mlist)
 248                                 lpfc_free_ct_rsp(phba, mlist);
 249                         return NULL;
 250                 }
 251
 252                 /* Queue it to a linked list */
 253                 if (!mlist)
 254                         mlist = mp;
 255                 else
 256                         list_add_tail(&mp->list, &mlist->list);
 257
 258                 bpl->tus.f.bdeFlags = BUFF_TYPE_BDE_64I;
 259                 /* build buffer ptr list for IOCB */
 260                 bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys) );
 261                 bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys) );
 262                 bpl->tus.f.bdeSize = (uint16_t) cnt;
 263                 bpl->tus.w = le32_to_cpu(bpl->tus.w);
 264                 bpl++;
 265
 266                 i++;
 267                 size -= cnt;
 268         }
 269
 270         *entries = i;
 271         return mlist;
 272 }
 273
 274 int
 275 lpfc_ct_free_iocb(struct lpfc_hba *phba, struct lpfc_iocbq *ctiocb)
 276 {
 277         struct lpfc_dmabuf *buf_ptr;
 278
 279         if (ctiocb->context_un.ndlp) {
 280                 lpfc_nlp_put(ctiocb->context_un.ndlp);
 281                 ctiocb->context_un.ndlp = NULL;
 282         }
 283         if (ctiocb->context1) {
 284                 buf_ptr = (struct lpfc_dmabuf *) ctiocb->context1;
 285                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
 286                 kfree(buf_ptr);
 287                 ctiocb->context1 = NULL;
 288         }
 289         if (ctiocb->context2) {
 290                 lpfc_free_ct_rsp(phba, (struct lpfc_dmabuf *) ctiocb->context2);
 291                 ctiocb->context2 = NULL;
 292         }
 293
 294         if (ctiocb->context3) {
 295                 buf_ptr = (struct lpfc_dmabuf *) ctiocb->context3;
 296                 lpfc_mbuf_free(phba, buf_ptr->virt, buf_ptr->phys);
 297                 kfree(buf_ptr);
 298                 ctiocb->context3 = NULL;
 299         }
 300         lpfc_sli_release_iocbq(phba, ctiocb);
 301         return 0;
 302 }
 303
 304 /**
 305  * lpfc_gen_req - Build and issue a GEN_REQUEST command  to the SLI Layer
 306  * @vport: pointer to a host virtual N_Port data structure.
 307  * @bmp: Pointer to BPL for SLI command
 308  * @inp: Pointer to data buffer for response data.
 309  * @outp: Pointer to data buffer that hold the CT command.
 310  * @cmpl: completion routine to call when command completes
 311  * @ndlp: Destination NPort nodelist entry
 312  *
 313  * This function as the final part for issuing a CT command.
 314  */
 315 static int
 316 lpfc_gen_req(struct lpfc_vport *vport, struct lpfc_dmabuf *bmp,
 317              struct lpfc_dmabuf *inp, struct lpfc_dmabuf *outp,
 318              void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
 319                      struct lpfc_iocbq *),
 320              struct lpfc_nodelist *ndlp, uint32_t usr_flg, uint32_t num_entry,
 321              uint32_t tmo, uint8_t retry)
 322 {
 323         struct lpfc_hba  *phba = vport->phba;
 324         IOCB_t *icmd;
 325         struct lpfc_iocbq *geniocb;
 326         int rc;
 327
 328         /* Allocate buffer for  command iocb */
 329         geniocb = lpfc_sli_get_iocbq(phba);
 330
 331         if (geniocb == NULL)
 332                 return 1;
 333
 334         icmd = &geniocb->iocb;
 335         icmd->un.genreq64.bdl.ulpIoTag32 = 0;
 336         icmd->un.genreq64.bdl.addrHigh = putPaddrHigh(bmp->phys);
 337         icmd->un.genreq64.bdl.addrLow = putPaddrLow(bmp->phys);
 338         icmd->un.genreq64.bdl.bdeFlags = BUFF_TYPE_BLP_64;
 339         icmd->un.genreq64.bdl.bdeSize = (num_entry * sizeof(struct ulp_bde64));
 340
 341         if (usr_flg)
 342                 geniocb->context3 = NULL;
 343         else
 344                 geniocb->context3 = (uint8_t *) bmp;
 345
 346         /* Save for completion so we can release these resources */
 347         geniocb->context1 = (uint8_t *) inp;
 348         geniocb->context2 = (uint8_t *) outp;
 349         geniocb->context_un.ndlp = lpfc_nlp_get(ndlp);
 350
 351         /* Fill in payload, bp points to frame payload */
 352         icmd->ulpCommand = CMD_GEN_REQUEST64_CR;
 353
 354         /* Fill in rest of iocb */
 355         icmd->un.genreq64.w5.hcsw.Fctl = (SI | LA);
 356         icmd->un.genreq64.w5.hcsw.Dfctl = 0;
 357         icmd->un.genreq64.w5.hcsw.Rctl = FC_RCTL_DD_UNSOL_CTL;
 358         icmd->un.genreq64.w5.hcsw.Type = FC_TYPE_CT;
 359
 360         if (!tmo) {
 361                  /* FC spec states we need 3 * ratov for CT requests */
 362                 tmo = (3 * phba->fc_ratov);
 363         }
 364         icmd->ulpTimeout = tmo;
 365         icmd->ulpBdeCount = 1;
 366         icmd->ulpLe = 1;
 367         icmd->ulpClass = CLASS3;
 368         icmd->ulpContext = ndlp->nlp_rpi;
 369         if (phba->sli_rev == LPFC_SLI_REV4)
 370                 icmd->ulpContext = phba->sli4_hba.rpi_ids[ndlp->nlp_rpi];
 371
 372         if (phba->sli3_options & LPFC_SLI3_NPIV_ENABLED) {
 373                 /* For GEN_REQUEST64_CR, use the RPI */
 374                 icmd->ulpCt_h = 0;
 375                 icmd->ulpCt_l = 0;
 376         }
 377
 378         /* Issue GEN REQ IOCB for NPORT <did> */
 379         lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
 380                          "0119 Issue GEN REQ IOCB to NPORT x%x "
 381                          "Data: x%x x%x\n",
 382                          ndlp->nlp_DID, icmd->ulpIoTag,
 383                          vport->port_state);
 384         geniocb->iocb_cmpl = cmpl;
 385         geniocb->drvrTimeout = icmd->ulpTimeout + LPFC_DRVR_TIMEOUT;
 386         geniocb->vport = vport;
 387         geniocb->retry = retry;
 388         rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, geniocb, 0);
 389
 390         if (rc == IOCB_ERROR) {
 391                 lpfc_sli_release_iocbq(phba, geniocb);
 392                 return 1;
 393         }
 394
 395         return 0;
 396 }
 397
 398 /**
 399  * lpfc_ct_cmd - Build and issue a CT command
 400  * @vport: pointer to a host virtual N_Port data structure.
 401  * @inmp: Pointer to data buffer for response data.
 402  * @bmp: Pointer to BPL for SLI command
 403  * @ndlp: Destination NPort nodelist entry
 404  * @cmpl: completion routine to call when command completes
 405  *
 406  * This function is called for issuing a CT command.
 407  */
 408 static int
 409 lpfc_ct_cmd(struct lpfc_vport *vport, struct lpfc_dmabuf *inmp,
 410             struct lpfc_dmabuf *bmp, struct lpfc_nodelist *ndlp,
 411             void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
 412                           struct lpfc_iocbq *),
 413             uint32_t rsp_size, uint8_t retry)
 414 {
 415         struct lpfc_hba  *phba = vport->phba;
 416         struct ulp_bde64 *bpl = (struct ulp_bde64 *) bmp->virt;
 417         struct lpfc_dmabuf *outmp;
 418         int cnt = 0, status;
 419         int cmdcode = ((struct lpfc_sli_ct_request *) inmp->virt)->
 420                 CommandResponse.bits.CmdRsp;
 421
 422         bpl++;                  /* Skip past ct request */
 423
 424         /* Put buffer(s) for ct rsp in bpl */
 425         outmp = lpfc_alloc_ct_rsp(phba, cmdcode, bpl, rsp_size, &cnt);
 426         if (!outmp)
 427                 return -ENOMEM;
 428         /*
 429          * Form the CT IOCB.  The total number of BDEs in this IOCB
 430          * is the single command plus response count from
 431          * lpfc_alloc_ct_rsp.
 432          */
 433         cnt += 1;
 434         status = lpfc_gen_req(vport, bmp, inmp, outmp, cmpl, ndlp, 0,
 435                               cnt, 0, retry);
 436         if (status) {
 437                 lpfc_free_ct_rsp(phba, outmp);
 438                 return -ENOMEM;
 439         }
 440         return 0;
 441 }
 442
 443 struct lpfc_vport *
 444 lpfc_find_vport_by_did(struct lpfc_hba *phba, uint32_t did) {
 445         struct lpfc_vport *vport_curr;
 446         unsigned long flags;
 447
 448         spin_lock_irqsave(&phba->port_list_lock, flags);
 449         list_for_each_entry(vport_curr, &phba->port_list, listentry) {
 450                 if ((vport_curr->fc_myDID) && (vport_curr->fc_myDID == did)) {
 451                         spin_unlock_irqrestore(&phba->port_list_lock, flags);
 452                         return vport_curr;
 453                 }
 454         }
 455         spin_unlock_irqrestore(&phba->port_list_lock, flags);
 456         return NULL;
 457 }
 458
 459 static void
 460 lpfc_prep_node_fc4type(struct lpfc_vport *vport, uint32_t Did, uint8_t fc4_type)
 461 {
 462         struct lpfc_nodelist *ndlp;
 463
 464         if ((vport->port_type != LPFC_NPIV_PORT) ||
 465             !(vport->ct_flags & FC_CT_RFF_ID) || !vport->cfg_restrict_login) {
 466
 467                 ndlp = lpfc_setup_disc_node(vport, Did);
 468
 469                 if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
 470                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 471                                 "Parse GID_FTrsp: did:x%x flg:x%x x%x",
 472                                 Did, ndlp->nlp_flag, vport->fc_flag);
 473
 474                         /* By default, the driver expects to support FCP FC4 */
 475                         if (fc4_type == FC_TYPE_FCP)
 476                                 ndlp->nlp_fc4_type |= NLP_FC4_FCP;
 477
 478                         if (fc4_type == FC_TYPE_NVME)
 479                                 ndlp->nlp_fc4_type |= NLP_FC4_NVME;
 480
 481                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 482                                          "0238 Process x%06x NameServer Rsp "
 483                                          "Data: x%x x%x x%x x%x\n", Did,
 484                                          ndlp->nlp_flag, ndlp->nlp_fc4_type,
 485                                          vport->fc_flag,
 486                                          vport->fc_rscn_id_cnt);
 487                 } else {
 488                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 489                                 "Skip1 GID_FTrsp: did:x%x flg:x%x cnt:%d",
 490                                 Did, vport->fc_flag, vport->fc_rscn_id_cnt);
 491
 492                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 493                                          "0239 Skip x%06x NameServer Rsp "
 494                                          "Data: x%x x%x\n", Did,
 495                                          vport->fc_flag,
 496                                          vport->fc_rscn_id_cnt);
 497                 }
 498         } else {
 499                 if (!(vport->fc_flag & FC_RSCN_MODE) ||
 500                     lpfc_rscn_payload_check(vport, Did)) {
 501                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 502                                 "Query GID_FTrsp: did:x%x flg:x%x cnt:%d",
 503                                 Did, vport->fc_flag, vport->fc_rscn_id_cnt);
 504
 505                         /*
 506                          * This NPortID was previously a FCP/NVMe target,
 507                          * Don't even bother to send GFF_ID.
 508                          */
 509                         ndlp = lpfc_findnode_did(vport, Did);
 510                         if (ndlp && NLP_CHK_NODE_ACT(ndlp) &&
 511                             (ndlp->nlp_type &
 512                             (NLP_FCP_TARGET | NLP_NVME_TARGET))) {
 513                                 if (fc4_type == FC_TYPE_FCP)
 514                                         ndlp->nlp_fc4_type |= NLP_FC4_FCP;
 515                                 if (fc4_type == FC_TYPE_NVME)
 516                                         ndlp->nlp_fc4_type |= NLP_FC4_NVME;
 517                                 lpfc_setup_disc_node(vport, Did);
 518                         } else if (lpfc_ns_cmd(vport, SLI_CTNS_GFF_ID,
 519                                    0, Did) == 0)
 520                                 vport->num_disc_nodes++;
 521                         else
 522                                 lpfc_setup_disc_node(vport, Did);
 523                 } else {
 524                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 525                                 "Skip2 GID_FTrsp: did:x%x flg:x%x cnt:%d",
 526                                 Did, vport->fc_flag, vport->fc_rscn_id_cnt);
 527
 528                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 529                                          "0245 Skip x%06x NameServer Rsp "
 530                                          "Data: x%x x%x\n", Did,
 531                                          vport->fc_flag,
 532                                          vport->fc_rscn_id_cnt);
 533                 }
 534         }
 535 }
 536
 537 static void
 538 lpfc_ns_rsp_audit_did(struct lpfc_vport *vport, uint32_t Did, uint8_t fc4_type)
 539 {
 540         struct lpfc_hba *phba = vport->phba;
 541         struct lpfc_nodelist *ndlp = NULL;
 542         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
 543
 544         /*
 545          * To conserve rpi's, filter out addresses for other
 546          * vports on the same physical HBAs.
 547          */
 548         if (Did != vport->fc_myDID &&
 549             (!lpfc_find_vport_by_did(phba, Did) ||
 550              vport->cfg_peer_port_login)) {
 551                 if (!phba->nvmet_support) {
 552                         /* FCPI/NVMEI path. Process Did */
 553                         lpfc_prep_node_fc4type(vport, Did, fc4_type);
 554                         return;
 555                 }
 556                 /* NVMET path.  NVMET only cares about NVMEI nodes. */
 557                 list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
 558                         if (ndlp->nlp_type != NLP_NVME_INITIATOR ||
 559                             ndlp->nlp_state != NLP_STE_UNMAPPED_NODE)
 560                                 continue;
 561                         spin_lock_irq(shost->host_lock);
 562                         if (ndlp->nlp_DID == Did)
 563                                 ndlp->nlp_flag &= ~NLP_NVMET_RECOV;
 564                         else
 565                                 ndlp->nlp_flag |= NLP_NVMET_RECOV;
 566                         spin_unlock_irq(shost->host_lock);
 567                 }
 568         }
 569 }
 570
 571 static int
 572 lpfc_ns_rsp(struct lpfc_vport *vport, struct lpfc_dmabuf *mp, uint8_t fc4_type,
 573             uint32_t Size)
 574 {
 575         struct lpfc_sli_ct_request *Response =
 576                 (struct lpfc_sli_ct_request *) mp->virt;
 577         struct lpfc_dmabuf *mlast, *next_mp;
 578         uint32_t *ctptr = (uint32_t *) & Response->un.gid.PortType;
 579         uint32_t Did, CTentry;
 580         int Cnt;
 581         struct list_head head;
 582         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
 583         struct lpfc_nodelist *ndlp = NULL;
 584
 585         lpfc_set_disctmo(vport);
 586         vport->num_disc_nodes = 0;
 587         vport->fc_ns_retry = 0;
 588
 589
 590         list_add_tail(&head, &mp->list);
 591         list_for_each_entry_safe(mp, next_mp, &head, list) {
 592                 mlast = mp;
 593
 594                 Cnt = Size  > FCELSSIZE ? FCELSSIZE : Size;
 595
 596                 Size -= Cnt;
 597
 598                 if (!ctptr) {
 599                         ctptr = (uint32_t *) mlast->virt;
 600                 } else
 601                         Cnt -= 16;      /* subtract length of CT header */
 602
 603                 /* Loop through entire NameServer list of DIDs */
 604                 while (Cnt >= sizeof(uint32_t)) {
 605                         /* Get next DID from NameServer List */
 606                         CTentry = *ctptr++;
 607                         Did = ((be32_to_cpu(CTentry)) & Mask_DID);
 608                         lpfc_ns_rsp_audit_did(vport, Did, fc4_type);
 609                         if (CTentry & (cpu_to_be32(SLI_CT_LAST_ENTRY)))
 610                                 goto nsout1;
 611
 612                         Cnt -= sizeof(uint32_t);
 613                 }
 614                 ctptr = NULL;
 615
 616         }
 617
 618         /* All GID_FT entries processed.  If the driver is running in
 619          * in target mode, put impacted nodes into recovery and drop
 620          * the RPI to flush outstanding IO.
 621          */
 622         if (vport->phba->nvmet_support) {
 623                 list_for_each_entry(ndlp, &vport->fc_nodes, nlp_listp) {
 624                         if (!(ndlp->nlp_flag & NLP_NVMET_RECOV))
 625                                 continue;
 626                         lpfc_disc_state_machine(vport, ndlp, NULL,
 627                                                 NLP_EVT_DEVICE_RECOVERY);
 628                         spin_lock_irq(shost->host_lock);
 629                         ndlp->nlp_flag &= ~NLP_NVMET_RECOV;
 630                         spin_unlock_irq(shost->host_lock);
 631                 }
 632         }
 633
 634 nsout1:
 635         list_del(&head);
 636         return 0;
 637 }
 638
 639 static void
 640 lpfc_cmpl_ct_cmd_gid_ft(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
 641                         struct lpfc_iocbq *rspiocb)
 642 {
 643         struct lpfc_vport *vport = cmdiocb->vport;
 644         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
 645         IOCB_t *irsp;
 646         struct lpfc_dmabuf *outp;
 647         struct lpfc_dmabuf *inp;
 648         struct lpfc_sli_ct_request *CTrsp;
 649         struct lpfc_sli_ct_request *CTreq;
 650         struct lpfc_nodelist *ndlp;
 651         int rc, type;
 652
 653         /* First save ndlp, before we overwrite it */
 654         ndlp = cmdiocb->context_un.ndlp;
 655
 656         /* we pass cmdiocb to state machine which needs rspiocb as well */
 657         cmdiocb->context_un.rsp_iocb = rspiocb;
 658         inp = (struct lpfc_dmabuf *) cmdiocb->context1;
 659         outp = (struct lpfc_dmabuf *) cmdiocb->context2;
 660         irsp = &rspiocb->iocb;
 661
 662         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 663                  "GID_FT cmpl:     status:x%x/x%x rtry:%d",
 664                 irsp->ulpStatus, irsp->un.ulpWord[4], vport->fc_ns_retry);
 665
 666         /* Don't bother processing response if vport is being torn down. */
 667         if (vport->load_flag & FC_UNLOADING) {
 668                 if (vport->fc_flag & FC_RSCN_MODE)
 669                         lpfc_els_flush_rscn(vport);
 670                 goto out;
 671         }
 672
 673         if (lpfc_els_chk_latt(vport)) {
 674                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 675                                  "0216 Link event during NS query\n");
 676                 if (vport->fc_flag & FC_RSCN_MODE)
 677                         lpfc_els_flush_rscn(vport);
 678                 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
 679                 goto out;
 680         }
 681         if (lpfc_error_lost_link(irsp)) {
 682                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 683                                  "0226 NS query failed due to link event\n");
 684                 if (vport->fc_flag & FC_RSCN_MODE)
 685                         lpfc_els_flush_rscn(vport);
 686                 goto out;
 687         }
 688
 689         spin_lock_irq(shost->host_lock);
 690         if (vport->fc_flag & FC_RSCN_DEFERRED) {
 691                 vport->fc_flag &= ~FC_RSCN_DEFERRED;
 692                 spin_unlock_irq(shost->host_lock);
 693
 694                 /* This is a GID_FT completing so the gidft_inp counter was
 695                  * incremented before the GID_FT was issued to the wire.
 696                  */
 697                 vport->gidft_inp--;
 698
 699                 /*
 700                  * Skip processing the NS response
 701                  * Re-issue the NS cmd
 702                  */
 703                 lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,
 704                                  "0151 Process Deferred RSCN Data: x%x x%x\n",
 705                                  vport->fc_flag, vport->fc_rscn_id_cnt);
 706                 lpfc_els_handle_rscn(vport);
 707
 708                 goto out;
 709         }
 710         spin_unlock_irq(shost->host_lock);
 711
 712         if (irsp->ulpStatus) {
 713                 /* Check for retry */
 714                 if (vport->fc_ns_retry < LPFC_MAX_NS_RETRY) {
 715                         if (irsp->ulpStatus != IOSTAT_LOCAL_REJECT ||
 716                             (irsp->un.ulpWord[4] & IOERR_PARAM_MASK) !=
 717                             IOERR_NO_RESOURCES)
 718                                 vport->fc_ns_retry++;
 719
 720                         type = lpfc_get_gidft_type(vport, cmdiocb);
 721                         if (type == 0)
 722                                 goto out;
 723
 724                         /* CT command is being retried */
 725                         vport->gidft_inp--;
 726                         rc = lpfc_ns_cmd(vport, SLI_CTNS_GID_FT,
 727                                          vport->fc_ns_retry, type);
 728                         if (rc == 0)
 729                                 goto out;
 730                 }
 731                 if (vport->fc_flag & FC_RSCN_MODE)
 732                         lpfc_els_flush_rscn(vport);
 733                 lpfc_vport_set_state(vport, FC_VPORT_FAILED);
 734                 lpfc_printf_vlog(vport, KERN_ERR, LOG_ELS,
 735                                  "0257 GID_FT Query error: 0x%x 0x%x\n",
 736                                  irsp->ulpStatus, vport->fc_ns_retry);
 737         } else {
 738                 /* Good status, continue checking */
 739                 CTreq = (struct lpfc_sli_ct_request *) inp->virt;
 740                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
 741                 if (CTrsp->CommandResponse.bits.CmdRsp ==
 742                     cpu_to_be16(SLI_CT_RESPONSE_FS_ACC)) {
 743                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 744                                          "0208 NameServer Rsp Data: x%x x%x\n",
 745                                          vport->fc_flag,
 746                                          CTreq->un.gid.Fc4Type);
 747
 748                         lpfc_ns_rsp(vport,
 749                                     outp,
 750                                     CTreq->un.gid.Fc4Type,
 751                                     (uint32_t) (irsp->un.genreq64.bdl.bdeSize));
 752                 } else if (CTrsp->CommandResponse.bits.CmdRsp ==
 753                            be16_to_cpu(SLI_CT_RESPONSE_FS_RJT)) {
 754                         /* NameServer Rsp Error */
 755                         if ((CTrsp->ReasonCode == SLI_CT_UNABLE_TO_PERFORM_REQ)
 756                             && (CTrsp->Explanation == SLI_CT_NO_FC4_TYPES)) {
 757                                 lpfc_printf_vlog(vport, KERN_INFO,
 758                                         LOG_DISCOVERY,
 759                                         "0269 No NameServer Entries "
 760                                         "Data: x%x x%x x%x x%x\n",
 761                                         CTrsp->CommandResponse.bits.CmdRsp,
 762                                         (uint32_t) CTrsp->ReasonCode,
 763                                         (uint32_t) CTrsp->Explanation,
 764                                         vport->fc_flag);
 765
 766                                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 767                                 "GID_FT no entry  cmd:x%x rsn:x%x exp:x%x",
 768                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
 769                                 (uint32_t) CTrsp->ReasonCode,
 770                                 (uint32_t) CTrsp->Explanation);
 771                         } else {
 772                                 lpfc_printf_vlog(vport, KERN_INFO,
 773                                         LOG_DISCOVERY,
 774                                         "0240 NameServer Rsp Error "
 775                                         "Data: x%x x%x x%x x%x\n",
 776                                         CTrsp->CommandResponse.bits.CmdRsp,
 777                                         (uint32_t) CTrsp->ReasonCode,
 778                                         (uint32_t) CTrsp->Explanation,
 779                                         vport->fc_flag);
 780
 781                                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 782                                 "GID_FT rsp err1  cmd:x%x rsn:x%x exp:x%x",
 783                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
 784                                 (uint32_t) CTrsp->ReasonCode,
 785                                 (uint32_t) CTrsp->Explanation);
 786                         }
 787
 788
 789                 } else {
 790                         /* NameServer Rsp Error */
 791                         lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
 792                                         "0241 NameServer Rsp Error "
 793                                         "Data: x%x x%x x%x x%x\n",
 794                                         CTrsp->CommandResponse.bits.CmdRsp,
 795                                         (uint32_t) CTrsp->ReasonCode,
 796                                         (uint32_t) CTrsp->Explanation,
 797                                         vport->fc_flag);
 798
 799                         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 800                                 "GID_FT rsp err2  cmd:x%x rsn:x%x exp:x%x",
 801                                 (uint32_t)CTrsp->CommandResponse.bits.CmdRsp,
 802                                 (uint32_t) CTrsp->ReasonCode,
 803                                 (uint32_t) CTrsp->Explanation);
 804                 }
 805                 vport->gidft_inp--;
 806         }
 807         /* Link up / RSCN discovery */
 808         if ((vport->num_disc_nodes == 0) &&
 809             (vport->gidft_inp == 0)) {
 810                 /*
 811                  * The driver has cycled through all Nports in the RSCN payload.
 812                  * Complete the handling by cleaning up and marking the
 813                  * current driver state.
 814                  */
 815                 if (vport->port_state >= LPFC_DISC_AUTH) {
 816                         if (vport->fc_flag & FC_RSCN_MODE) {
 817                                 lpfc_els_flush_rscn(vport);
 818                                 spin_lock_irq(shost->host_lock);
 819                                 vport->fc_flag |= FC_RSCN_MODE; /* RSCN still */
 820                                 spin_unlock_irq(shost->host_lock);
 821                         }
 822                         else
 823                                 lpfc_els_flush_rscn(vport);
 824                 }
 825
 826                 lpfc_disc_start(vport);
 827         }
 828 out:
 829         cmdiocb->context_un.ndlp = ndlp; /* Now restore ndlp for free */
 830         lpfc_ct_free_iocb(phba, cmdiocb);
 831         return;
 832 }
 833
 834 static void
 835 lpfc_cmpl_ct_cmd_gff_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
 836                         struct lpfc_iocbq *rspiocb)
 837 {
 838         struct lpfc_vport *vport = cmdiocb->vport;
 839         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
 840         IOCB_t *irsp = &rspiocb->iocb;
 841         struct lpfc_dmabuf *inp = (struct lpfc_dmabuf *) cmdiocb->context1;
 842         struct lpfc_dmabuf *outp = (struct lpfc_dmabuf *) cmdiocb->context2;
 843         struct lpfc_sli_ct_request *CTrsp;
 844         int did, rc, retry;
 845         uint8_t fbits;
 846         struct lpfc_nodelist *ndlp;
 847
 848         did = ((struct lpfc_sli_ct_request *) inp->virt)->un.gff.PortId;
 849         did = be32_to_cpu(did);
 850
 851         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 852                 "GFF_ID cmpl:     status:x%x/x%x did:x%x",
 853                 irsp->ulpStatus, irsp->un.ulpWord[4], did);
 854
 855         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
 856                 /* Good status, continue checking */
 857                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
 858                 fbits = CTrsp->un.gff_acc.fbits[FCP_TYPE_FEATURE_OFFSET];
 859
 860                 if (CTrsp->CommandResponse.bits.CmdRsp ==
 861                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC)) {
 862                         if ((fbits & FC4_FEATURE_INIT) &&
 863                             !(fbits & FC4_FEATURE_TARGET)) {
 864                                 lpfc_printf_vlog(vport, KERN_INFO,
 865                                                  LOG_DISCOVERY,
 866                                                  "0270 Skip x%x GFF "
 867                                                  "NameServer Rsp Data: (init) "
 868                                                  "x%x x%x\n", did, fbits,
 869                                                  vport->fc_rscn_id_cnt);
 870                                 goto out;
 871                         }
 872                 }
 873         }
 874         else {
 875                 /* Check for retry */
 876                 if (cmdiocb->retry < LPFC_MAX_NS_RETRY) {
 877                         retry = 1;
 878                         if (irsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
 879                                 switch ((irsp->un.ulpWord[4] &
 880                                         IOERR_PARAM_MASK)) {
 881
 882                                 case IOERR_NO_RESOURCES:
 883                                         /* We don't increment the retry
 884                                          * count for this case.
 885                                          */
 886                                         break;
 887                                 case IOERR_LINK_DOWN:
 888                                 case IOERR_SLI_ABORTED:
 889                                 case IOERR_SLI_DOWN:
 890                                         retry = 0;
 891                                         break;
 892                                 default:
 893                                         cmdiocb->retry++;
 894                                 }
 895                         }
 896                         else
 897                                 cmdiocb->retry++;
 898
 899                         if (retry) {
 900                                 /* CT command is being retried */
 901                                 rc = lpfc_ns_cmd(vport, SLI_CTNS_GFF_ID,
 902                                          cmdiocb->retry, did);
 903                                 if (rc == 0) {
 904                                         /* success */
 905                                         lpfc_ct_free_iocb(phba, cmdiocb);
 906                                         return;
 907                                 }
 908                         }
 909                 }
 910                 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
 911                                  "0267 NameServer GFF Rsp "
 912                                  "x%x Error (%d %d) Data: x%x x%x\n",
 913                                  did, irsp->ulpStatus, irsp->un.ulpWord[4],
 914                                  vport->fc_flag, vport->fc_rscn_id_cnt);
 915         }
 916
 917         /* This is a target port, unregistered port, or the GFF_ID failed */
 918         ndlp = lpfc_setup_disc_node(vport, did);
 919         if (ndlp && NLP_CHK_NODE_ACT(ndlp)) {
 920                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 921                                  "0242 Process x%x GFF "
 922                                  "NameServer Rsp Data: x%x x%x x%x\n",
 923                                  did, ndlp->nlp_flag, vport->fc_flag,
 924                                  vport->fc_rscn_id_cnt);
 925         } else {
 926                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 927                                  "0243 Skip x%x GFF "
 928                                  "NameServer Rsp Data: x%x x%x\n", did,
 929                                  vport->fc_flag, vport->fc_rscn_id_cnt);
 930         }
 931 out:
 932         /* Link up / RSCN discovery */
 933         if (vport->num_disc_nodes)
 934                 vport->num_disc_nodes--;
 935         if (vport->num_disc_nodes == 0) {
 936                 /*
 937                  * The driver has cycled through all Nports in the RSCN payload.
 938                  * Complete the handling by cleaning up and marking the
 939                  * current driver state.
 940                  */
 941                 if (vport->port_state >= LPFC_DISC_AUTH) {
 942                         if (vport->fc_flag & FC_RSCN_MODE) {
 943                                 lpfc_els_flush_rscn(vport);
 944                                 spin_lock_irq(shost->host_lock);
 945                                 vport->fc_flag |= FC_RSCN_MODE; /* RSCN still */
 946                                 spin_unlock_irq(shost->host_lock);
 947                         }
 948                         else
 949                                 lpfc_els_flush_rscn(vport);
 950                 }
 951                 lpfc_disc_start(vport);
 952         }
 953         lpfc_ct_free_iocb(phba, cmdiocb);
 954         return;
 955 }
 956
 957 static void
 958 lpfc_cmpl_ct_cmd_gft_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
 959                                 struct lpfc_iocbq *rspiocb)
 960 {
 961         struct lpfc_vport *vport = cmdiocb->vport;
 962         IOCB_t *irsp = &rspiocb->iocb;
 963         struct lpfc_dmabuf *inp = (struct lpfc_dmabuf *)cmdiocb->context1;
 964         struct lpfc_dmabuf *outp = (struct lpfc_dmabuf *)cmdiocb->context2;
 965         struct lpfc_sli_ct_request *CTrsp;
 966         int did;
 967         struct lpfc_nodelist *ndlp;
 968         uint32_t fc4_data_0, fc4_data_1;
 969
 970         did = ((struct lpfc_sli_ct_request *)inp->virt)->un.gft.PortId;
 971         did = be32_to_cpu(did);
 972
 973         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
 974                               "GFT_ID cmpl: status:x%x/x%x did:x%x",
 975                               irsp->ulpStatus, irsp->un.ulpWord[4], did);
 976
 977         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
 978                 /* Good status, continue checking */
 979                 CTrsp = (struct lpfc_sli_ct_request *)outp->virt;
 980                 fc4_data_0 = be32_to_cpu(CTrsp->un.gft_acc.fc4_types[0]);
 981                 fc4_data_1 = be32_to_cpu(CTrsp->un.gft_acc.fc4_types[1]);
 982                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 983                                  "3062 DID x%06x GFT Wd0 x%08x Wd1 x%08x\n",
 984                                  did, fc4_data_0, fc4_data_1);
 985
 986                 ndlp = lpfc_findnode_did(vport, did);
 987                 if (ndlp) {
 988                         /* The bitmask value for FCP and NVME FCP types is
 989                          * the same because they are 32 bits distant from
 990                          * each other in word0 and word0.
 991                          */
 992                         if (fc4_data_0 & LPFC_FC4_TYPE_BITMASK)
 993                                 ndlp->nlp_fc4_type |= NLP_FC4_FCP;
 994                         if (fc4_data_1 &  LPFC_FC4_TYPE_BITMASK)
 995                                 ndlp->nlp_fc4_type |= NLP_FC4_NVME;
 996                         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
 997                                          "3064 Setting ndlp %p, DID x%06x with "
 998                                          "FC4 x%08x, Data: x%08x x%08x\n",
 999                                          ndlp, did, ndlp->nlp_fc4_type,
1000                                          FC_TYPE_FCP, FC_TYPE_NVME);
1001                         ndlp->nlp_prev_state = NLP_STE_REG_LOGIN_ISSUE;
1002
1003                         lpfc_nlp_set_state(vport, ndlp, NLP_STE_PRLI_ISSUE);
1004                         lpfc_issue_els_prli(vport, ndlp, 0);
1005                 }
1006         } else
1007                 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
1008                                  "3065 GFT_ID failed x%08x\n", irsp->ulpStatus);
1009
1010         lpfc_ct_free_iocb(phba, cmdiocb);
1011 }
1012
1013 static void
1014 lpfc_cmpl_ct(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1015              struct lpfc_iocbq *rspiocb)
1016 {
1017         struct lpfc_vport *vport = cmdiocb->vport;
1018         struct lpfc_dmabuf *inp;
1019         struct lpfc_dmabuf *outp;
1020         IOCB_t *irsp;
1021         struct lpfc_sli_ct_request *CTrsp;
1022         struct lpfc_nodelist *ndlp;
1023         int cmdcode, rc;
1024         uint8_t retry;
1025         uint32_t latt;
1026
1027         /* First save ndlp, before we overwrite it */
1028         ndlp = cmdiocb->context_un.ndlp;
1029
1030         /* we pass cmdiocb to state machine which needs rspiocb as well */
1031         cmdiocb->context_un.rsp_iocb = rspiocb;
1032
1033         inp = (struct lpfc_dmabuf *) cmdiocb->context1;
1034         outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1035         irsp = &rspiocb->iocb;
1036
1037         cmdcode = be16_to_cpu(((struct lpfc_sli_ct_request *) inp->virt)->
1038                                         CommandResponse.bits.CmdRsp);
1039         CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1040
1041         latt = lpfc_els_chk_latt(vport);
1042
1043         /* RFT request completes status <ulpStatus> CmdRsp <CmdRsp> */
1044         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1045                          "0209 CT Request completes, latt %d, "
1046                          "ulpStatus x%x CmdRsp x%x, Context x%x, Tag x%x\n",
1047                          latt, irsp->ulpStatus,
1048                          CTrsp->CommandResponse.bits.CmdRsp,
1049                          cmdiocb->iocb.ulpContext, cmdiocb->iocb.ulpIoTag);
1050
1051         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
1052                 "CT cmd cmpl:     status:x%x/x%x cmd:x%x",
1053                 irsp->ulpStatus, irsp->un.ulpWord[4], cmdcode);
1054
1055         if (irsp->ulpStatus) {
1056                 lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
1057                                  "0268 NS cmd x%x Error (x%x x%x)\n",
1058                                  cmdcode, irsp->ulpStatus, irsp->un.ulpWord[4]);
1059
1060                 if ((irsp->ulpStatus == IOSTAT_LOCAL_REJECT) &&
1061                         (((irsp->un.ulpWord[4] & IOERR_PARAM_MASK) ==
1062                           IOERR_SLI_DOWN) ||
1063                          ((irsp->un.ulpWord[4] & IOERR_PARAM_MASK) ==
1064                           IOERR_SLI_ABORTED)))
1065                         goto out;
1066
1067                 retry = cmdiocb->retry;
1068                 if (retry >= LPFC_MAX_NS_RETRY)
1069                         goto out;
1070
1071                 retry++;
1072                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1073                                  "0250 Retrying NS cmd %x\n", cmdcode);
1074                 rc = lpfc_ns_cmd(vport, cmdcode, retry, 0);
1075                 if (rc == 0)
1076                         goto out;
1077         }
1078
1079 out:
1080         cmdiocb->context_un.ndlp = ndlp; /* Now restore ndlp for free */
1081         lpfc_ct_free_iocb(phba, cmdiocb);
1082         return;
1083 }
1084
1085 static void
1086 lpfc_cmpl_ct_cmd_rft_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1087                         struct lpfc_iocbq *rspiocb)
1088 {
1089         IOCB_t *irsp = &rspiocb->iocb;
1090         struct lpfc_vport *vport = cmdiocb->vport;
1091
1092         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
1093                 struct lpfc_dmabuf *outp;
1094                 struct lpfc_sli_ct_request *CTrsp;
1095
1096                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1097                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1098                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1099                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1100                         vport->ct_flags |= FC_CT_RFT_ID;
1101         }
1102         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1103         return;
1104 }
1105
1106 static void
1107 lpfc_cmpl_ct_cmd_rnn_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1108                         struct lpfc_iocbq *rspiocb)
1109 {
1110         IOCB_t *irsp = &rspiocb->iocb;
1111         struct lpfc_vport *vport = cmdiocb->vport;
1112
1113         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
1114                 struct lpfc_dmabuf *outp;
1115                 struct lpfc_sli_ct_request *CTrsp;
1116
1117                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1118                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1119                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1120                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1121                         vport->ct_flags |= FC_CT_RNN_ID;
1122         }
1123         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1124         return;
1125 }
1126
1127 static void
1128 lpfc_cmpl_ct_cmd_rspn_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1129                          struct lpfc_iocbq *rspiocb)
1130 {
1131         IOCB_t *irsp = &rspiocb->iocb;
1132         struct lpfc_vport *vport = cmdiocb->vport;
1133
1134         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
1135                 struct lpfc_dmabuf *outp;
1136                 struct lpfc_sli_ct_request *CTrsp;
1137
1138                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1139                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1140                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1141                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1142                         vport->ct_flags |= FC_CT_RSPN_ID;
1143         }
1144         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1145         return;
1146 }
1147
1148 static void
1149 lpfc_cmpl_ct_cmd_rsnn_nn(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1150                          struct lpfc_iocbq *rspiocb)
1151 {
1152         IOCB_t *irsp = &rspiocb->iocb;
1153         struct lpfc_vport *vport = cmdiocb->vport;
1154
1155         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
1156                 struct lpfc_dmabuf *outp;
1157                 struct lpfc_sli_ct_request *CTrsp;
1158
1159                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1160                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1161                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1162                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1163                         vport->ct_flags |= FC_CT_RSNN_NN;
1164         }
1165         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1166         return;
1167 }
1168
1169 static void
1170 lpfc_cmpl_ct_cmd_da_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1171  struct lpfc_iocbq *rspiocb)
1172 {
1173         struct lpfc_vport *vport = cmdiocb->vport;
1174
1175         /* even if it fails we will act as though it succeeded. */
1176         vport->ct_flags = 0;
1177         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1178         return;
1179 }
1180
1181 static void
1182 lpfc_cmpl_ct_cmd_rff_id(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1183                         struct lpfc_iocbq *rspiocb)
1184 {
1185         IOCB_t *irsp = &rspiocb->iocb;
1186         struct lpfc_vport *vport = cmdiocb->vport;
1187
1188         if (irsp->ulpStatus == IOSTAT_SUCCESS) {
1189                 struct lpfc_dmabuf *outp;
1190                 struct lpfc_sli_ct_request *CTrsp;
1191
1192                 outp = (struct lpfc_dmabuf *) cmdiocb->context2;
1193                 CTrsp = (struct lpfc_sli_ct_request *) outp->virt;
1194                 if (CTrsp->CommandResponse.bits.CmdRsp ==
1195                     be16_to_cpu(SLI_CT_RESPONSE_FS_ACC))
1196                         vport->ct_flags |= FC_CT_RFF_ID;
1197         }
1198         lpfc_cmpl_ct(phba, cmdiocb, rspiocb);
1199         return;
1200 }
1201
1202 /*
1203  * Although the symbolic port name is thought to be an integer
1204  * as of January 18, 2016, leave it as a string until more of
1205  * the record state becomes defined.
1206  */
1207 int
1208 lpfc_vport_symbolic_port_name(struct lpfc_vport *vport, char *symbol,
1209         size_t size)
1210 {
1211         int n;
1212
1213         /*
1214          * Use the lpfc board number as the Symbolic Port
1215          * Name object.  NPIV is not in play so this integer
1216          * value is sufficient and unique per FC-ID.
1217          */
1218         n = snprintf(symbol, size, "%d", vport->phba->brd_no);
1219         return n;
1220 }
1221
1222
1223 int
1224 lpfc_vport_symbolic_node_name(struct lpfc_vport *vport, char *symbol,
1225         size_t size)
1226 {
1227         char fwrev[FW_REV_STR_SIZE];
1228         int n;
1229
1230         lpfc_decode_firmware_rev(vport->phba, fwrev, 0);
1231
1232         n = snprintf(symbol, size, "Emulex %s", vport->phba->ModelName);
1233         if (size < n)
1234                 return n;
1235
1236         n += snprintf(symbol + n, size - n, " FV%s", fwrev);
1237         if (size < n)
1238                 return n;
1239
1240         n += snprintf(symbol + n, size - n, " DV%s.",
1241                       lpfc_release_version);
1242         if (size < n)
1243                 return n;
1244
1245         n += snprintf(symbol + n, size - n, " HN:%s.",
1246                       init_utsname()->nodename);
1247         if (size < n)
1248                 return n;
1249
1250         /* Note :- OS name is "Linux" */
1251         n += snprintf(symbol + n, size - n, " OS:%s\n",
1252                       init_utsname()->sysname);
1253         return n;
1254 }
1255
1256 static uint32_t
1257 lpfc_find_map_node(struct lpfc_vport *vport)
1258 {
1259         struct lpfc_nodelist *ndlp, *next_ndlp;
1260         struct Scsi_Host  *shost;
1261         uint32_t cnt = 0;
1262
1263         shost = lpfc_shost_from_vport(vport);
1264         spin_lock_irq(shost->host_lock);
1265         list_for_each_entry_safe(ndlp, next_ndlp, &vport->fc_nodes, nlp_listp) {
1266                 if (ndlp->nlp_type & NLP_FABRIC)
1267                         continue;
1268                 if ((ndlp->nlp_state == NLP_STE_MAPPED_NODE) ||
1269                     (ndlp->nlp_state == NLP_STE_UNMAPPED_NODE))
1270                         cnt++;
1271         }
1272         spin_unlock_irq(shost->host_lock);
1273         return cnt;
1274 }
1275
1276 /*
1277  * This routine will return the FC4 Type associated with the CT
1278  * GID_FT command.
1279  */
1280 int
1281 lpfc_get_gidft_type(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb)
1282 {
1283         struct lpfc_sli_ct_request *CtReq;
1284         struct lpfc_dmabuf *mp;
1285         uint32_t type;
1286
1287         mp = cmdiocb->context1;
1288         if (mp == NULL)
1289                 return 0;
1290         CtReq = (struct lpfc_sli_ct_request *)mp->virt;
1291         type = (uint32_t)CtReq->un.gid.Fc4Type;
1292         if ((type != SLI_CTPT_FCP) && (type != SLI_CTPT_NVME))
1293                 return 0;
1294         return type;
1295 }
1296
1297 /*
1298  * lpfc_ns_cmd
1299  * Description:
1300  *    Issue Cmd to NameServer
1301  *       SLI_CTNS_GID_FT
1302  *       LI_CTNS_RFT_ID
1303  */
1304 int
1305 lpfc_ns_cmd(struct lpfc_vport *vport, int cmdcode,
1306             uint8_t retry, uint32_t context)
1307 {
1308         struct lpfc_nodelist * ndlp;
1309         struct lpfc_hba *phba = vport->phba;
1310         struct lpfc_dmabuf *mp, *bmp;
1311         struct lpfc_sli_ct_request *CtReq;
1312         struct ulp_bde64 *bpl;
1313         void (*cmpl) (struct lpfc_hba *, struct lpfc_iocbq *,
1314                       struct lpfc_iocbq *) = NULL;
1315         uint32_t rsp_size = 1024;
1316         size_t   size;
1317         int rc = 0;
1318
1319         ndlp = lpfc_findnode_did(vport, NameServer_DID);
1320         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp)
1321             || ndlp->nlp_state != NLP_STE_UNMAPPED_NODE) {
1322                 rc=1;
1323                 goto ns_cmd_exit;
1324         }
1325
1326         /* fill in BDEs for command */
1327         /* Allocate buffer for command payload */
1328         mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
1329         if (!mp) {
1330                 rc=2;
1331                 goto ns_cmd_exit;
1332         }
1333
1334         INIT_LIST_HEAD(&mp->list);
1335         mp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(mp->phys));
1336         if (!mp->virt) {
1337                 rc=3;
1338                 goto ns_cmd_free_mp;
1339         }
1340
1341         /* Allocate buffer for Buffer ptr list */
1342         bmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
1343         if (!bmp) {
1344                 rc=4;
1345                 goto ns_cmd_free_mpvirt;
1346         }
1347
1348         INIT_LIST_HEAD(&bmp->list);
1349         bmp->virt = lpfc_mbuf_alloc(phba, MEM_PRI, &(bmp->phys));
1350         if (!bmp->virt) {
1351                 rc=5;
1352                 goto ns_cmd_free_bmp;
1353         }
1354
1355         /* NameServer Req */
1356         lpfc_printf_vlog(vport, KERN_INFO ,LOG_DISCOVERY,
1357                          "0236 NameServer Req Data: x%x x%x x%x x%x\n",
1358                          cmdcode, vport->fc_flag, vport->fc_rscn_id_cnt,
1359                          context);
1360
1361         bpl = (struct ulp_bde64 *) bmp->virt;
1362         memset(bpl, 0, sizeof(struct ulp_bde64));
1363         bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys) );
1364         bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys) );
1365         bpl->tus.f.bdeFlags = 0;
1366         if (cmdcode == SLI_CTNS_GID_FT)
1367                 bpl->tus.f.bdeSize = GID_REQUEST_SZ;
1368         else if (cmdcode == SLI_CTNS_GFF_ID)
1369                 bpl->tus.f.bdeSize = GFF_REQUEST_SZ;
1370         else if (cmdcode == SLI_CTNS_GFT_ID)
1371                 bpl->tus.f.bdeSize = GFT_REQUEST_SZ;
1372         else if (cmdcode == SLI_CTNS_RFT_ID)
1373                 bpl->tus.f.bdeSize = RFT_REQUEST_SZ;
1374         else if (cmdcode == SLI_CTNS_RNN_ID)
1375                 bpl->tus.f.bdeSize = RNN_REQUEST_SZ;
1376         else if (cmdcode == SLI_CTNS_RSPN_ID)
1377                 bpl->tus.f.bdeSize = RSPN_REQUEST_SZ;
1378         else if (cmdcode == SLI_CTNS_RSNN_NN)
1379                 bpl->tus.f.bdeSize = RSNN_REQUEST_SZ;
1380         else if (cmdcode == SLI_CTNS_DA_ID)
1381                 bpl->tus.f.bdeSize = DA_ID_REQUEST_SZ;
1382         else if (cmdcode == SLI_CTNS_RFF_ID)
1383                 bpl->tus.f.bdeSize = RFF_REQUEST_SZ;
1384         else
1385                 bpl->tus.f.bdeSize = 0;
1386         bpl->tus.w = le32_to_cpu(bpl->tus.w);
1387
1388         CtReq = (struct lpfc_sli_ct_request *) mp->virt;
1389         memset(CtReq, 0, sizeof(struct lpfc_sli_ct_request));
1390         CtReq->RevisionId.bits.Revision = SLI_CT_REVISION;
1391         CtReq->RevisionId.bits.InId = 0;
1392         CtReq->FsType = SLI_CT_DIRECTORY_SERVICE;
1393         CtReq->FsSubType = SLI_CT_DIRECTORY_NAME_SERVER;
1394         CtReq->CommandResponse.bits.Size = 0;
1395         switch (cmdcode) {
1396         case SLI_CTNS_GID_FT:
1397                 CtReq->CommandResponse.bits.CmdRsp =
1398                     cpu_to_be16(SLI_CTNS_GID_FT);
1399                 CtReq->un.gid.Fc4Type = context;
1400
1401                 if (vport->port_state < LPFC_NS_QRY)
1402                         vport->port_state = LPFC_NS_QRY;
1403                 lpfc_set_disctmo(vport);
1404                 cmpl = lpfc_cmpl_ct_cmd_gid_ft;
1405                 rsp_size = FC_MAX_NS_RSP;
1406                 break;
1407
1408         case SLI_CTNS_GFF_ID:
1409                 CtReq->CommandResponse.bits.CmdRsp =
1410                         cpu_to_be16(SLI_CTNS_GFF_ID);
1411                 CtReq->un.gff.PortId = cpu_to_be32(context);
1412                 cmpl = lpfc_cmpl_ct_cmd_gff_id;
1413                 break;
1414
1415         case SLI_CTNS_GFT_ID:
1416                 CtReq->CommandResponse.bits.CmdRsp =
1417                         cpu_to_be16(SLI_CTNS_GFT_ID);
1418                 CtReq->un.gft.PortId = cpu_to_be32(context);
1419                 cmpl = lpfc_cmpl_ct_cmd_gft_id;
1420                 break;
1421
1422         case SLI_CTNS_RFT_ID:
1423                 vport->ct_flags &= ~FC_CT_RFT_ID;
1424                 CtReq->CommandResponse.bits.CmdRsp =
1425                     cpu_to_be16(SLI_CTNS_RFT_ID);
1426                 CtReq->un.rft.PortId = cpu_to_be32(vport->fc_myDID);
1427
1428                 /* Register FC4 FCP type if enabled.  */
1429                 if ((phba->cfg_enable_fc4_type == LPFC_ENABLE_BOTH) ||
1430                     (phba->cfg_enable_fc4_type == LPFC_ENABLE_FCP))
1431                         CtReq->un.rft.fcpReg = 1;
1432
1433                 /* Register NVME type if enabled.  Defined LE and swapped.
1434                  * rsvd[0] is used as word1 because of the hard-coded
1435                  * word0 usage in the ct_request data structure.
1436                  */
1437                 if ((phba->cfg_enable_fc4_type == LPFC_ENABLE_BOTH) ||
1438                     (phba->cfg_enable_fc4_type == LPFC_ENABLE_NVME))
1439                         CtReq->un.rft.rsvd[0] = cpu_to_be32(0x00000100);
1440
1441                 cmpl = lpfc_cmpl_ct_cmd_rft_id;
1442                 break;
1443
1444         case SLI_CTNS_RNN_ID:
1445                 vport->ct_flags &= ~FC_CT_RNN_ID;
1446                 CtReq->CommandResponse.bits.CmdRsp =
1447                     cpu_to_be16(SLI_CTNS_RNN_ID);
1448                 CtReq->un.rnn.PortId = cpu_to_be32(vport->fc_myDID);
1449                 memcpy(CtReq->un.rnn.wwnn,  &vport->fc_nodename,
1450                        sizeof(struct lpfc_name));
1451                 cmpl = lpfc_cmpl_ct_cmd_rnn_id;
1452                 break;
1453
1454         case SLI_CTNS_RSPN_ID:
1455                 vport->ct_flags &= ~FC_CT_RSPN_ID;
1456                 CtReq->CommandResponse.bits.CmdRsp =
1457                     cpu_to_be16(SLI_CTNS_RSPN_ID);
1458                 CtReq->un.rspn.PortId = cpu_to_be32(vport->fc_myDID);
1459                 size = sizeof(CtReq->un.rspn.symbname);
1460                 CtReq->un.rspn.len =
1461                         lpfc_vport_symbolic_port_name(vport,
1462                         CtReq->un.rspn.symbname, size);
1463                 cmpl = lpfc_cmpl_ct_cmd_rspn_id;
1464                 break;
1465         case SLI_CTNS_RSNN_NN:
1466                 vport->ct_flags &= ~FC_CT_RSNN_NN;
1467                 CtReq->CommandResponse.bits.CmdRsp =
1468                     cpu_to_be16(SLI_CTNS_RSNN_NN);
1469                 memcpy(CtReq->un.rsnn.wwnn, &vport->fc_nodename,
1470                        sizeof(struct lpfc_name));
1471                 size = sizeof(CtReq->un.rsnn.symbname);
1472                 CtReq->un.rsnn.len =
1473                         lpfc_vport_symbolic_node_name(vport,
1474                         CtReq->un.rsnn.symbname, size);
1475                 cmpl = lpfc_cmpl_ct_cmd_rsnn_nn;
1476                 break;
1477         case SLI_CTNS_DA_ID:
1478                 /* Implement DA_ID Nameserver request */
1479                 CtReq->CommandResponse.bits.CmdRsp =
1480                         cpu_to_be16(SLI_CTNS_DA_ID);
1481                 CtReq->un.da_id.port_id = cpu_to_be32(vport->fc_myDID);
1482                 cmpl = lpfc_cmpl_ct_cmd_da_id;
1483                 break;
1484         case SLI_CTNS_RFF_ID:
1485                 vport->ct_flags &= ~FC_CT_RFF_ID;
1486                 CtReq->CommandResponse.bits.CmdRsp =
1487                     cpu_to_be16(SLI_CTNS_RFF_ID);
1488                 CtReq->un.rff.PortId = cpu_to_be32(vport->fc_myDID);
1489                 CtReq->un.rff.fbits = FC4_FEATURE_INIT;
1490
1491                 /* The driver always supports FC_TYPE_FCP.  However, the
1492                  * caller can specify NVME (type x28) as well.  But only
1493                  * these that FC4 type is supported.
1494                  */
1495                 if (((phba->cfg_enable_fc4_type == LPFC_ENABLE_BOTH) ||
1496                      (phba->cfg_enable_fc4_type == LPFC_ENABLE_NVME)) &&
1497                     (context == FC_TYPE_NVME)) {
1498                         if ((vport == phba->pport) && phba->nvmet_support) {
1499                                 CtReq->un.rff.fbits = (FC4_FEATURE_TARGET |
1500                                         FC4_FEATURE_NVME_DISC);
1501                                 lpfc_nvmet_update_targetport(phba);
1502                         } else {
1503                                 lpfc_nvme_update_localport(vport);
1504                         }
1505                         CtReq->un.rff.type_code = context;
1506
1507                 } else if (((phba->cfg_enable_fc4_type == LPFC_ENABLE_BOTH) ||
1508                             (phba->cfg_enable_fc4_type == LPFC_ENABLE_FCP)) &&
1509                            (context == FC_TYPE_FCP))
1510                         CtReq->un.rff.type_code = context;
1511
1512                 else
1513                         goto ns_cmd_free_bmpvirt;
1514
1515                 cmpl = lpfc_cmpl_ct_cmd_rff_id;
1516                 break;
1517         }
1518         /* The lpfc_ct_cmd/lpfc_get_req shall increment ndlp reference count
1519          * to hold ndlp reference for the corresponding callback function.
1520          */
1521         if (!lpfc_ct_cmd(vport, mp, bmp, ndlp, cmpl, rsp_size, retry)) {
1522                 /* On success, The cmpl function will free the buffers */
1523                 lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
1524                         "Issue CT cmd:    cmd:x%x did:x%x",
1525                         cmdcode, ndlp->nlp_DID, 0);
1526                 return 0;
1527         }
1528         rc=6;
1529
1530         /* Decrement ndlp reference count to release ndlp reference held
1531          * for the failed command's callback function.
1532          */
1533         lpfc_nlp_put(ndlp);
1534
1535 ns_cmd_free_bmpvirt:
1536         lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
1537 ns_cmd_free_bmp:
1538         kfree(bmp);
1539 ns_cmd_free_mpvirt:
1540         lpfc_mbuf_free(phba, mp->virt, mp->phys);
1541 ns_cmd_free_mp:
1542         kfree(mp);
1543 ns_cmd_exit:
1544         lpfc_printf_vlog(vport, KERN_ERR, LOG_DISCOVERY,
1545                          "0266 Issue NameServer Req x%x err %d Data: x%x x%x\n",
1546                          cmdcode, rc, vport->fc_flag, vport->fc_rscn_id_cnt);
1547         return 1;
1548 }
1549
1550 /**
1551  * lpfc_cmpl_ct_disc_fdmi - Handle a discovery FDMI completion
1552  * @phba: Pointer to HBA context object.
1553  * @cmdiocb: Pointer to the command IOCBQ.
1554  * @rspiocb: Pointer to the response IOCBQ.
1555  *
1556  * This function to handle the completion of a driver initiated FDMI
1557  * CT command issued during discovery.
1558  */
1559 static void
1560 lpfc_cmpl_ct_disc_fdmi(struct lpfc_hba *phba, struct lpfc_iocbq *cmdiocb,
1561                        struct lpfc_iocbq *rspiocb)
1562 {
1563         struct lpfc_vport *vport = cmdiocb->vport;
1564         struct lpfc_dmabuf *inp = cmdiocb->context1;
1565         struct lpfc_dmabuf *outp = cmdiocb->context2;
1566         struct lpfc_sli_ct_request *CTcmd = inp->virt;
1567         struct lpfc_sli_ct_request *CTrsp = outp->virt;
1568         uint16_t fdmi_cmd = CTcmd->CommandResponse.bits.CmdRsp;
1569         uint16_t fdmi_rsp = CTrsp->CommandResponse.bits.CmdRsp;
1570         IOCB_t *irsp = &rspiocb->iocb;
1571         struct lpfc_nodelist *ndlp;
1572         uint32_t latt, cmd, err;
1573
1574         latt = lpfc_els_chk_latt(vport);
1575         lpfc_debugfs_disc_trc(vport, LPFC_DISC_TRC_CT,
1576                 "FDMI cmpl:       status:x%x/x%x latt:%d",
1577                 irsp->ulpStatus, irsp->un.ulpWord[4], latt);
1578
1579         if (latt || irsp->ulpStatus) {
1580
1581                 /* Look for a retryable error */
1582                 if (irsp->ulpStatus == IOSTAT_LOCAL_REJECT) {
1583                         switch ((irsp->un.ulpWord[4] & IOERR_PARAM_MASK)) {
1584                         case IOERR_SLI_ABORTED:
1585                         case IOERR_ABORT_IN_PROGRESS:
1586                         case IOERR_SEQUENCE_TIMEOUT:
1587                         case IOERR_ILLEGAL_FRAME:
1588                         case IOERR_NO_RESOURCES:
1589                         case IOERR_ILLEGAL_COMMAND:
1590                                 cmdiocb->retry++;
1591                                 if (cmdiocb->retry >= LPFC_FDMI_MAX_RETRY)
1592                                         break;
1593
1594                                 /* Retry the same FDMI command */
1595                                 err = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING,
1596                                                           cmdiocb, 0);
1597                                 if (err == IOCB_ERROR)
1598                                         break;
1599                                 return;
1600                         default:
1601                                 break;
1602                         }
1603                 }
1604
1605                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1606                                  "0229 FDMI cmd %04x failed, latt = %d "
1607                                  "ulpStatus: x%x, rid x%x\n",
1608                                  be16_to_cpu(fdmi_cmd), latt, irsp->ulpStatus,
1609                                  irsp->un.ulpWord[4]);
1610         }
1611         lpfc_ct_free_iocb(phba, cmdiocb);
1612
1613         ndlp = lpfc_findnode_did(vport, FDMI_DID);
1614         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp))
1615                 return;
1616
1617         /* Check for a CT LS_RJT response */
1618         cmd =  be16_to_cpu(fdmi_cmd);
1619         if (fdmi_rsp == cpu_to_be16(SLI_CT_RESPONSE_FS_RJT)) {
1620                 /* FDMI rsp failed */
1621                 lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
1622                                  "0220 FDMI cmd failed FS_RJT Data: x%x", cmd);
1623
1624                 /* Should we fallback to FDMI-2 / FDMI-1 ? */
1625                 switch (cmd) {
1626                 case SLI_MGMT_RHBA:
1627                         if (vport->fdmi_hba_mask == LPFC_FDMI2_HBA_ATTR) {
1628                                 /* Fallback to FDMI-1 */
1629                                 vport->fdmi_hba_mask = LPFC_FDMI1_HBA_ATTR;
1630                                 vport->fdmi_port_mask = LPFC_FDMI1_PORT_ATTR;
1631                                 /* Start over */
1632                                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_DHBA, 0);
1633                         }
1634                         return;
1635
1636                 case SLI_MGMT_RPRT:
1637                         if (vport->fdmi_port_mask == LPFC_FDMI2_PORT_ATTR) {
1638                                 /* Fallback to FDMI-1 */
1639                                 vport->fdmi_port_mask = LPFC_FDMI1_PORT_ATTR;
1640                                 /* Start over */
1641                                 lpfc_fdmi_cmd(vport, ndlp, cmd, 0);
1642                         }
1643                         if (vport->fdmi_port_mask == LPFC_FDMI2_SMART_ATTR) {
1644                                 vport->fdmi_port_mask = LPFC_FDMI2_PORT_ATTR;
1645                                 /* Retry the same command */
1646                                 lpfc_fdmi_cmd(vport, ndlp, cmd, 0);
1647                         }
1648                         return;
1649
1650                 case SLI_MGMT_RPA:
1651                         if (vport->fdmi_port_mask == LPFC_FDMI2_PORT_ATTR) {
1652                                 /* Fallback to FDMI-1 */
1653                                 vport->fdmi_hba_mask = LPFC_FDMI1_HBA_ATTR;
1654                                 vport->fdmi_port_mask = LPFC_FDMI1_PORT_ATTR;
1655                                 /* Start over */
1656                                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_DHBA, 0);
1657                         }
1658                         if (vport->fdmi_port_mask == LPFC_FDMI2_SMART_ATTR) {
1659                                 vport->fdmi_port_mask = LPFC_FDMI2_PORT_ATTR;
1660                                 /* Retry the same command */
1661                                 lpfc_fdmi_cmd(vport, ndlp, cmd, 0);
1662                         }
1663                         return;
1664                 }
1665         }
1666
1667         /*
1668          * On success, need to cycle thru FDMI registration for discovery
1669          * DHBA -> DPRT -> RHBA -> RPA  (physical port)
1670          * DPRT -> RPRT (vports)
1671          */
1672         switch (cmd) {
1673         case SLI_MGMT_RHBA:
1674                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RPA, 0);
1675                 break;
1676
1677         case SLI_MGMT_DHBA:
1678                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_DPRT, 0);
1679                 break;
1680
1681         case SLI_MGMT_DPRT:
1682                 if (vport->port_type == LPFC_PHYSICAL_PORT)
1683                         lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RHBA, 0);
1684                 else
1685                         lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RPRT, 0);
1686                 break;
1687         }
1688         return;
1689 }
1690
1691
1692 /**
1693  * lpfc_fdmi_num_disc_check - Check how many mapped NPorts we are connected to
1694  * @vport: pointer to a host virtual N_Port data structure.
1695  *
1696  * Called from hbeat timeout routine to check if the number of discovered
1697  * ports has changed. If so, re-register thar port Attribute.
1698  */
1699 void
1700 lpfc_fdmi_num_disc_check(struct lpfc_vport *vport)
1701 {
1702         struct lpfc_hba *phba = vport->phba;
1703         struct lpfc_nodelist *ndlp;
1704         uint16_t cnt;
1705
1706         if (!lpfc_is_link_up(phba))
1707                 return;
1708
1709         /* Must be connected to a Fabric */
1710         if (!(vport->fc_flag & FC_FABRIC))
1711                 return;
1712
1713         if (!(vport->fdmi_port_mask & LPFC_FDMI_PORT_ATTR_num_disc))
1714                 return;
1715
1716         cnt = lpfc_find_map_node(vport);
1717         if (cnt == vport->fdmi_num_disc)
1718                 return;
1719
1720         ndlp = lpfc_findnode_did(vport, FDMI_DID);
1721         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp))
1722                 return;
1723
1724         if (vport->port_type == LPFC_PHYSICAL_PORT) {
1725                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RPA,
1726                               LPFC_FDMI_PORT_ATTR_num_disc);
1727         } else {
1728                 lpfc_fdmi_cmd(vport, ndlp, SLI_MGMT_RPRT,
1729                               LPFC_FDMI_PORT_ATTR_num_disc);
1730         }
1731 }
1732
1733 /* Routines for all individual HBA attributes */
1734 static int
1735 lpfc_fdmi_hba_attr_wwnn(struct lpfc_vport *vport, struct lpfc_fdmi_attr_def *ad)
1736 {
1737         struct lpfc_fdmi_attr_entry *ae;
1738         uint32_t size;
1739
1740         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1741         memset(ae, 0, sizeof(struct lpfc_name));
1742
1743         memcpy(&ae->un.AttrWWN, &vport->fc_sparam.nodeName,
1744                sizeof(struct lpfc_name));
1745         size = FOURBYTES + sizeof(struct lpfc_name);
1746         ad->AttrLen = cpu_to_be16(size);
1747         ad->AttrType = cpu_to_be16(RHBA_NODENAME);
1748         return size;
1749 }
1750 static int
1751 lpfc_fdmi_hba_attr_manufacturer(struct lpfc_vport *vport,
1752                                 struct lpfc_fdmi_attr_def *ad)
1753 {
1754         struct lpfc_fdmi_attr_entry *ae;
1755         uint32_t len, size;
1756
1757         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1758         memset(ae, 0, 256);
1759
1760         strncpy(ae->un.AttrString,
1761                 "Emulex Corporation",
1762                        sizeof(ae->un.AttrString));
1763         len = strnlen(ae->un.AttrString,
1764                           sizeof(ae->un.AttrString));
1765         len += (len & 3) ? (4 - (len & 3)) : 4;
1766         size = FOURBYTES + len;
1767         ad->AttrLen = cpu_to_be16(size);
1768         ad->AttrType = cpu_to_be16(RHBA_MANUFACTURER);
1769         return size;
1770 }
1771
1772 static int
1773 lpfc_fdmi_hba_attr_sn(struct lpfc_vport *vport, struct lpfc_fdmi_attr_def *ad)
1774 {
1775         struct lpfc_hba *phba = vport->phba;
1776         struct lpfc_fdmi_attr_entry *ae;
1777         uint32_t len, size;
1778
1779         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1780         memset(ae, 0, 256);
1781
1782         strncpy(ae->un.AttrString, phba->SerialNumber,
1783                 sizeof(ae->un.AttrString));
1784         len = strnlen(ae->un.AttrString,
1785                           sizeof(ae->un.AttrString));
1786         len += (len & 3) ? (4 - (len & 3)) : 4;
1787         size = FOURBYTES + len;
1788         ad->AttrLen = cpu_to_be16(size);
1789         ad->AttrType = cpu_to_be16(RHBA_SERIAL_NUMBER);
1790         return size;
1791 }
1792
1793 static int
1794 lpfc_fdmi_hba_attr_model(struct lpfc_vport *vport,
1795                          struct lpfc_fdmi_attr_def *ad)
1796 {
1797         struct lpfc_hba *phba = vport->phba;
1798         struct lpfc_fdmi_attr_entry *ae;
1799         uint32_t len, size;
1800
1801         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1802         memset(ae, 0, 256);
1803
1804         strncpy(ae->un.AttrString, phba->ModelName,
1805                 sizeof(ae->un.AttrString));
1806         len = strnlen(ae->un.AttrString, sizeof(ae->un.AttrString));
1807         len += (len & 3) ? (4 - (len & 3)) : 4;
1808         size = FOURBYTES + len;
1809         ad->AttrLen = cpu_to_be16(size);
1810         ad->AttrType = cpu_to_be16(RHBA_MODEL);
1811         return size;
1812 }
1813
1814 static int
1815 lpfc_fdmi_hba_attr_description(struct lpfc_vport *vport,
1816                                struct lpfc_fdmi_attr_def *ad)
1817 {
1818         struct lpfc_hba *phba = vport->phba;
1819         struct lpfc_fdmi_attr_entry *ae;
1820         uint32_t len, size;
1821
1822         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1823         memset(ae, 0, 256);
1824
1825         strncpy(ae->un.AttrString, phba->ModelDesc,
1826                 sizeof(ae->un.AttrString));
1827         len = strnlen(ae->un.AttrString,
1828                                   sizeof(ae->un.AttrString));
1829         len += (len & 3) ? (4 - (len & 3)) : 4;
1830         size = FOURBYTES + len;
1831         ad->AttrLen = cpu_to_be16(size);
1832         ad->AttrType = cpu_to_be16(RHBA_MODEL_DESCRIPTION);
1833         return size;
1834 }
1835
1836 static int
1837 lpfc_fdmi_hba_attr_hdw_ver(struct lpfc_vport *vport,
1838                            struct lpfc_fdmi_attr_def *ad)
1839 {
1840         struct lpfc_hba *phba = vport->phba;
1841         lpfc_vpd_t *vp = &phba->vpd;
1842         struct lpfc_fdmi_attr_entry *ae;
1843         uint32_t i, j, incr, size;
1844
1845         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1846         memset(ae, 0, 256);
1847
1848         /* Convert JEDEC ID to ascii for hardware version */
1849         incr = vp->rev.biuRev;
1850         for (i = 0; i < 8; i++) {
1851                 j = (incr & 0xf);
1852                 if (j <= 9)
1853                         ae->un.AttrString[7 - i] =
1854                             (char)((uint8_t) 0x30 +
1855                                    (uint8_t) j);
1856                 else
1857                         ae->un.AttrString[7 - i] =
1858                             (char)((uint8_t) 0x61 +
1859                                    (uint8_t) (j - 10));
1860                 incr = (incr >> 4);
1861         }
1862         size = FOURBYTES + 8;
1863         ad->AttrLen = cpu_to_be16(size);
1864         ad->AttrType = cpu_to_be16(RHBA_HARDWARE_VERSION);
1865         return size;
1866 }
1867
1868 static int
1869 lpfc_fdmi_hba_attr_drvr_ver(struct lpfc_vport *vport,
1870                             struct lpfc_fdmi_attr_def *ad)
1871 {
1872         struct lpfc_fdmi_attr_entry *ae;
1873         uint32_t len, size;
1874
1875         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1876         memset(ae, 0, 256);
1877
1878         strncpy(ae->un.AttrString, lpfc_release_version,
1879                 sizeof(ae->un.AttrString));
1880         len = strnlen(ae->un.AttrString,
1881                           sizeof(ae->un.AttrString));
1882         len += (len & 3) ? (4 - (len & 3)) : 4;
1883         size = FOURBYTES + len;
1884         ad->AttrLen = cpu_to_be16(size);
1885         ad->AttrType = cpu_to_be16(RHBA_DRIVER_VERSION);
1886         return size;
1887 }
1888
1889 static int
1890 lpfc_fdmi_hba_attr_rom_ver(struct lpfc_vport *vport,
1891                            struct lpfc_fdmi_attr_def *ad)
1892 {
1893         struct lpfc_hba *phba = vport->phba;
1894         struct lpfc_fdmi_attr_entry *ae;
1895         uint32_t len, size;
1896
1897         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1898         memset(ae, 0, 256);
1899
1900         if (phba->sli_rev == LPFC_SLI_REV4)
1901                 lpfc_decode_firmware_rev(phba, ae->un.AttrString, 1);
1902         else
1903                 strncpy(ae->un.AttrString, phba->OptionROMVersion,
1904                         sizeof(ae->un.AttrString));
1905         len = strnlen(ae->un.AttrString,
1906                           sizeof(ae->un.AttrString));
1907         len += (len & 3) ? (4 - (len & 3)) : 4;
1908         size = FOURBYTES + len;
1909         ad->AttrLen = cpu_to_be16(size);
1910         ad->AttrType = cpu_to_be16(RHBA_OPTION_ROM_VERSION);
1911         return size;
1912 }
1913
1914 static int
1915 lpfc_fdmi_hba_attr_fmw_ver(struct lpfc_vport *vport,
1916                            struct lpfc_fdmi_attr_def *ad)
1917 {
1918         struct lpfc_hba *phba = vport->phba;
1919         struct lpfc_fdmi_attr_entry *ae;
1920         uint32_t len, size;
1921
1922         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1923         memset(ae, 0, 256);
1924
1925         lpfc_decode_firmware_rev(phba, ae->un.AttrString, 1);
1926         len = strnlen(ae->un.AttrString,
1927                           sizeof(ae->un.AttrString));
1928         len += (len & 3) ? (4 - (len & 3)) : 4;
1929         size = FOURBYTES + len;
1930         ad->AttrLen = cpu_to_be16(size);
1931         ad->AttrType = cpu_to_be16(RHBA_FIRMWARE_VERSION);
1932         return size;
1933 }
1934
1935 static int
1936 lpfc_fdmi_hba_attr_os_ver(struct lpfc_vport *vport,
1937                           struct lpfc_fdmi_attr_def *ad)
1938 {
1939         struct lpfc_fdmi_attr_entry *ae;
1940         uint32_t len, size;
1941
1942         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1943         memset(ae, 0, 256);
1944
1945         snprintf(ae->un.AttrString, sizeof(ae->un.AttrString), "%s %s %s",
1946                  init_utsname()->sysname,
1947                  init_utsname()->release,
1948                  init_utsname()->version);
1949
1950         len = strnlen(ae->un.AttrString, sizeof(ae->un.AttrString));
1951         len += (len & 3) ? (4 - (len & 3)) : 4;
1952         size = FOURBYTES + len;
1953         ad->AttrLen = cpu_to_be16(size);
1954         ad->AttrType = cpu_to_be16(RHBA_OS_NAME_VERSION);
1955         return size;
1956 }
1957
1958 static int
1959 lpfc_fdmi_hba_attr_ct_len(struct lpfc_vport *vport,
1960                           struct lpfc_fdmi_attr_def *ad)
1961 {
1962         struct lpfc_fdmi_attr_entry *ae;
1963         uint32_t size;
1964
1965         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1966
1967         ae->un.AttrInt =  cpu_to_be32(LPFC_MAX_CT_SIZE);
1968         size = FOURBYTES + sizeof(uint32_t);
1969         ad->AttrLen = cpu_to_be16(size);
1970         ad->AttrType = cpu_to_be16(RHBA_MAX_CT_PAYLOAD_LEN);
1971         return size;
1972 }
1973
1974 static int
1975 lpfc_fdmi_hba_attr_symbolic_name(struct lpfc_vport *vport,
1976                                  struct lpfc_fdmi_attr_def *ad)
1977 {
1978         struct lpfc_fdmi_attr_entry *ae;
1979         uint32_t len, size;
1980
1981         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
1982         memset(ae, 0, 256);
1983
1984         len = lpfc_vport_symbolic_node_name(vport,
1985                                 ae->un.AttrString, 256);
1986         len += (len & 3) ? (4 - (len & 3)) : 4;
1987         size = FOURBYTES + len;
1988         ad->AttrLen = cpu_to_be16(size);
1989         ad->AttrType = cpu_to_be16(RHBA_SYM_NODENAME);
1990         return size;
1991 }
1992
1993 static int
1994 lpfc_fdmi_hba_attr_vendor_info(struct lpfc_vport *vport,
1995                                struct lpfc_fdmi_attr_def *ad)
1996 {
1997         struct lpfc_fdmi_attr_entry *ae;
1998         uint32_t size;
1999
2000         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2001
2002         /* Nothing is defined for this currently */
2003         ae->un.AttrInt =  cpu_to_be32(0);
2004         size = FOURBYTES + sizeof(uint32_t);
2005         ad->AttrLen = cpu_to_be16(size);
2006         ad->AttrType = cpu_to_be16(RHBA_VENDOR_INFO);
2007         return size;
2008 }
2009
2010 static int
2011 lpfc_fdmi_hba_attr_num_ports(struct lpfc_vport *vport,
2012                              struct lpfc_fdmi_attr_def *ad)
2013 {
2014         struct lpfc_fdmi_attr_entry *ae;
2015         uint32_t size;
2016
2017         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2018
2019         /* Each driver instance corresponds to a single port */
2020         ae->un.AttrInt =  cpu_to_be32(1);
2021         size = FOURBYTES + sizeof(uint32_t);
2022         ad->AttrLen = cpu_to_be16(size);
2023         ad->AttrType = cpu_to_be16(RHBA_NUM_PORTS);
2024         return size;
2025 }
2026
2027 static int
2028 lpfc_fdmi_hba_attr_fabric_wwnn(struct lpfc_vport *vport,
2029                                struct lpfc_fdmi_attr_def *ad)
2030 {
2031         struct lpfc_fdmi_attr_entry *ae;
2032         uint32_t size;
2033
2034         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2035         memset(ae, 0, sizeof(struct lpfc_name));
2036
2037         memcpy(&ae->un.AttrWWN, &vport->fabric_nodename,
2038                sizeof(struct lpfc_name));
2039         size = FOURBYTES + sizeof(struct lpfc_name);
2040         ad->AttrLen = cpu_to_be16(size);
2041         ad->AttrType = cpu_to_be16(RHBA_FABRIC_WWNN);
2042         return size;
2043 }
2044
2045 static int
2046 lpfc_fdmi_hba_attr_bios_ver(struct lpfc_vport *vport,
2047                             struct lpfc_fdmi_attr_def *ad)
2048 {
2049         struct lpfc_hba *phba = vport->phba;
2050         struct lpfc_fdmi_attr_entry *ae;
2051         uint32_t len, size;
2052
2053         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2054         memset(ae, 0, 256);
2055
2056         lpfc_decode_firmware_rev(phba, ae->un.AttrString, 1);
2057         len = strnlen(ae->un.AttrString,
2058                           sizeof(ae->un.AttrString));
2059         len += (len & 3) ? (4 - (len & 3)) : 4;
2060         size = FOURBYTES + len;
2061         ad->AttrLen = cpu_to_be16(size);
2062         ad->AttrType = cpu_to_be16(RHBA_BIOS_VERSION);
2063         return size;
2064 }
2065
2066 static int
2067 lpfc_fdmi_hba_attr_bios_state(struct lpfc_vport *vport,
2068                               struct lpfc_fdmi_attr_def *ad)
2069 {
2070         struct lpfc_fdmi_attr_entry *ae;
2071         uint32_t size;
2072
2073         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2074
2075         /* Driver doesn't have access to this information */
2076         ae->un.AttrInt =  cpu_to_be32(0);
2077         size = FOURBYTES + sizeof(uint32_t);
2078         ad->AttrLen = cpu_to_be16(size);
2079         ad->AttrType = cpu_to_be16(RHBA_BIOS_STATE);
2080         return size;
2081 }
2082
2083 static int
2084 lpfc_fdmi_hba_attr_vendor_id(struct lpfc_vport *vport,
2085                              struct lpfc_fdmi_attr_def *ad)
2086 {
2087         struct lpfc_fdmi_attr_entry *ae;
2088         uint32_t len, size;
2089
2090         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2091         memset(ae, 0, 256);
2092
2093         strncpy(ae->un.AttrString, "EMULEX",
2094                 sizeof(ae->un.AttrString));
2095         len = strnlen(ae->un.AttrString,
2096                           sizeof(ae->un.AttrString));
2097         len += (len & 3) ? (4 - (len & 3)) : 4;
2098         size = FOURBYTES + len;
2099         ad->AttrLen = cpu_to_be16(size);
2100         ad->AttrType = cpu_to_be16(RHBA_VENDOR_ID);
2101         return size;
2102 }
2103
2104 /* Routines for all individual PORT attributes */
2105 static int
2106 lpfc_fdmi_port_attr_fc4type(struct lpfc_vport *vport,
2107                             struct lpfc_fdmi_attr_def *ad)
2108 {
2109         struct lpfc_fdmi_attr_entry *ae;
2110         uint32_t size;
2111
2112         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2113         memset(ae, 0, 32);
2114
2115         ae->un.AttrTypes[3] = 0x02; /* Type 1 - ELS */
2116         ae->un.AttrTypes[2] = 0x01; /* Type 8 - FCP */
2117         ae->un.AttrTypes[6] = 0x01; /* Type 40 - NVME */
2118         ae->un.AttrTypes[7] = 0x01; /* Type 32 - CT */
2119         size = FOURBYTES + 32;
2120         ad->AttrLen = cpu_to_be16(size);
2121         ad->AttrType = cpu_to_be16(RPRT_SUPPORTED_FC4_TYPES);
2122         return size;
2123 }
2124
2125 static int
2126 lpfc_fdmi_port_attr_support_speed(struct lpfc_vport *vport,
2127                                   struct lpfc_fdmi_attr_def *ad)
2128 {
2129         struct lpfc_hba   *phba = vport->phba;
2130         struct lpfc_fdmi_attr_entry *ae;
2131         uint32_t size;
2132
2133         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2134
2135         ae->un.AttrInt = 0;
2136         if (!(phba->hba_flag & HBA_FCOE_MODE)) {
2137                 if (phba->lmt & LMT_64Gb)
2138                         ae->un.AttrInt |= HBA_PORTSPEED_64GFC;
2139                 if (phba->lmt & LMT_32Gb)
2140                         ae->un.AttrInt |= HBA_PORTSPEED_32GFC;
2141                 if (phba->lmt & LMT_16Gb)
2142                         ae->un.AttrInt |= HBA_PORTSPEED_16GFC;
2143                 if (phba->lmt & LMT_10Gb)
2144                         ae->un.AttrInt |= HBA_PORTSPEED_10GFC;
2145                 if (phba->lmt & LMT_8Gb)
2146                         ae->un.AttrInt |= HBA_PORTSPEED_8GFC;
2147                 if (phba->lmt & LMT_4Gb)
2148                         ae->un.AttrInt |= HBA_PORTSPEED_4GFC;
2149                 if (phba->lmt & LMT_2Gb)
2150                         ae->un.AttrInt |= HBA_PORTSPEED_2GFC;
2151                 if (phba->lmt & LMT_1Gb)
2152                         ae->un.AttrInt |= HBA_PORTSPEED_1GFC;
2153         } else {
2154                 /* FCoE links support only one speed */
2155                 switch (phba->fc_linkspeed) {
2156                 case LPFC_ASYNC_LINK_SPEED_10GBPS:
2157                         ae->un.AttrInt = HBA_PORTSPEED_10GE;
2158                         break;
2159                 case LPFC_ASYNC_LINK_SPEED_25GBPS:
2160                         ae->un.AttrInt = HBA_PORTSPEED_25GE;
2161                         break;
2162                 case LPFC_ASYNC_LINK_SPEED_40GBPS:
2163                         ae->un.AttrInt = HBA_PORTSPEED_40GE;
2164                         break;
2165                 case LPFC_ASYNC_LINK_SPEED_100GBPS:
2166                         ae->un.AttrInt = HBA_PORTSPEED_100GE;
2167                         break;
2168                 }
2169         }
2170         ae->un.AttrInt = cpu_to_be32(ae->un.AttrInt);
2171         size = FOURBYTES + sizeof(uint32_t);
2172         ad->AttrLen = cpu_to_be16(size);
2173         ad->AttrType = cpu_to_be16(RPRT_SUPPORTED_SPEED);
2174         return size;
2175 }
2176
2177 static int
2178 lpfc_fdmi_port_attr_speed(struct lpfc_vport *vport,
2179                           struct lpfc_fdmi_attr_def *ad)
2180 {
2181         struct lpfc_hba   *phba = vport->phba;
2182         struct lpfc_fdmi_attr_entry *ae;
2183         uint32_t size;
2184
2185         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2186
2187         if (!(phba->hba_flag & HBA_FCOE_MODE)) {
2188                 switch (phba->fc_linkspeed) {
2189                 case LPFC_LINK_SPEED_1GHZ:
2190                         ae->un.AttrInt = HBA_PORTSPEED_1GFC;
2191                         break;
2192                 case LPFC_LINK_SPEED_2GHZ:
2193                         ae->un.AttrInt = HBA_PORTSPEED_2GFC;
2194                         break;
2195                 case LPFC_LINK_SPEED_4GHZ:
2196                         ae->un.AttrInt = HBA_PORTSPEED_4GFC;
2197                         break;
2198                 case LPFC_LINK_SPEED_8GHZ:
2199                         ae->un.AttrInt = HBA_PORTSPEED_8GFC;
2200                         break;
2201                 case LPFC_LINK_SPEED_10GHZ:
2202                         ae->un.AttrInt = HBA_PORTSPEED_10GFC;
2203                         break;
2204                 case LPFC_LINK_SPEED_16GHZ:
2205                         ae->un.AttrInt = HBA_PORTSPEED_16GFC;
2206                         break;
2207                 case LPFC_LINK_SPEED_32GHZ:
2208                         ae->un.AttrInt = HBA_PORTSPEED_32GFC;
2209                         break;
2210                 case LPFC_LINK_SPEED_64GHZ:
2211                         ae->un.AttrInt = HBA_PORTSPEED_64GFC;
2212                         break;
2213                 default:
2214                         ae->un.AttrInt = HBA_PORTSPEED_UNKNOWN;
2215                         break;
2216                 }
2217         } else {
2218                 switch (phba->fc_linkspeed) {
2219                 case LPFC_ASYNC_LINK_SPEED_10GBPS:
2220                         ae->un.AttrInt = HBA_PORTSPEED_10GE;
2221                         break;
2222                 case LPFC_ASYNC_LINK_SPEED_25GBPS:
2223                         ae->un.AttrInt = HBA_PORTSPEED_25GE;
2224                         break;
2225                 case LPFC_ASYNC_LINK_SPEED_40GBPS:
2226                         ae->un.AttrInt = HBA_PORTSPEED_40GE;
2227                         break;
2228                 case LPFC_ASYNC_LINK_SPEED_100GBPS:
2229                         ae->un.AttrInt = HBA_PORTSPEED_100GE;
2230                         break;
2231                 default:
2232                         ae->un.AttrInt = HBA_PORTSPEED_UNKNOWN;
2233                         break;
2234                 }
2235         }
2236
2237         ae->un.AttrInt = cpu_to_be32(ae->un.AttrInt);
2238         size = FOURBYTES + sizeof(uint32_t);
2239         ad->AttrLen = cpu_to_be16(size);
2240         ad->AttrType = cpu_to_be16(RPRT_PORT_SPEED);
2241         return size;
2242 }
2243
2244 static int
2245 lpfc_fdmi_port_attr_max_frame(struct lpfc_vport *vport,
2246                               struct lpfc_fdmi_attr_def *ad)
2247 {
2248         struct serv_parm *hsp;
2249         struct lpfc_fdmi_attr_entry *ae;
2250         uint32_t size;
2251
2252         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2253
2254         hsp = (struct serv_parm *)&vport->fc_sparam;
2255         ae->un.AttrInt = (((uint32_t) hsp->cmn.bbRcvSizeMsb) << 8) |
2256                           (uint32_t) hsp->cmn.bbRcvSizeLsb;
2257         ae->un.AttrInt = cpu_to_be32(ae->un.AttrInt);
2258         size = FOURBYTES + sizeof(uint32_t);
2259         ad->AttrLen = cpu_to_be16(size);
2260         ad->AttrType = cpu_to_be16(RPRT_MAX_FRAME_SIZE);
2261         return size;
2262 }
2263
2264 static int
2265 lpfc_fdmi_port_attr_os_devname(struct lpfc_vport *vport,
2266                                struct lpfc_fdmi_attr_def *ad)
2267 {
2268         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2269         struct lpfc_fdmi_attr_entry *ae;
2270         uint32_t len, size;
2271
2272         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2273         memset(ae, 0, 256);
2274
2275         snprintf(ae->un.AttrString, sizeof(ae->un.AttrString),
2276                  "/sys/class/scsi_host/host%d", shost->host_no);
2277         len = strnlen((char *)ae->un.AttrString,
2278                           sizeof(ae->un.AttrString));
2279         len += (len & 3) ? (4 - (len & 3)) : 4;
2280         size = FOURBYTES + len;
2281         ad->AttrLen = cpu_to_be16(size);
2282         ad->AttrType = cpu_to_be16(RPRT_OS_DEVICE_NAME);
2283         return size;
2284 }
2285
2286 static int
2287 lpfc_fdmi_port_attr_host_name(struct lpfc_vport *vport,
2288                               struct lpfc_fdmi_attr_def *ad)
2289 {
2290         struct lpfc_fdmi_attr_entry *ae;
2291         uint32_t len, size;
2292
2293         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2294         memset(ae, 0, 256);
2295
2296         snprintf(ae->un.AttrString, sizeof(ae->un.AttrString), "%s",
2297                  init_utsname()->nodename);
2298
2299         len = strnlen(ae->un.AttrString, sizeof(ae->un.AttrString));
2300         len += (len & 3) ? (4 - (len & 3)) : 4;
2301         size = FOURBYTES + len;
2302         ad->AttrLen = cpu_to_be16(size);
2303         ad->AttrType = cpu_to_be16(RPRT_HOST_NAME);
2304         return size;
2305 }
2306
2307 static int
2308 lpfc_fdmi_port_attr_wwnn(struct lpfc_vport *vport,
2309                          struct lpfc_fdmi_attr_def *ad)
2310 {
2311         struct lpfc_fdmi_attr_entry *ae;
2312         uint32_t size;
2313
2314         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2315         memset(ae, 0,  sizeof(struct lpfc_name));
2316
2317         memcpy(&ae->un.AttrWWN, &vport->fc_sparam.nodeName,
2318                sizeof(struct lpfc_name));
2319         size = FOURBYTES + sizeof(struct lpfc_name);
2320         ad->AttrLen = cpu_to_be16(size);
2321         ad->AttrType = cpu_to_be16(RPRT_NODENAME);
2322         return size;
2323 }
2324
2325 static int
2326 lpfc_fdmi_port_attr_wwpn(struct lpfc_vport *vport,
2327                          struct lpfc_fdmi_attr_def *ad)
2328 {
2329         struct lpfc_fdmi_attr_entry *ae;
2330         uint32_t size;
2331
2332         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2333         memset(ae, 0,  sizeof(struct lpfc_name));
2334
2335         memcpy(&ae->un.AttrWWN, &vport->fc_sparam.portName,
2336                sizeof(struct lpfc_name));
2337         size = FOURBYTES + sizeof(struct lpfc_name);
2338         ad->AttrLen = cpu_to_be16(size);
2339         ad->AttrType = cpu_to_be16(RPRT_PORTNAME);
2340         return size;
2341 }
2342
2343 static int
2344 lpfc_fdmi_port_attr_symbolic_name(struct lpfc_vport *vport,
2345                                   struct lpfc_fdmi_attr_def *ad)
2346 {
2347         struct lpfc_fdmi_attr_entry *ae;
2348         uint32_t len, size;
2349
2350         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2351         memset(ae, 0, 256);
2352
2353         len = lpfc_vport_symbolic_port_name(vport, ae->un.AttrString, 256);
2354         len += (len & 3) ? (4 - (len & 3)) : 4;
2355         size = FOURBYTES + len;
2356         ad->AttrLen = cpu_to_be16(size);
2357         ad->AttrType = cpu_to_be16(RPRT_SYM_PORTNAME);
2358         return size;
2359 }
2360
2361 static int
2362 lpfc_fdmi_port_attr_port_type(struct lpfc_vport *vport,
2363                               struct lpfc_fdmi_attr_def *ad)
2364 {
2365         struct lpfc_hba *phba = vport->phba;
2366         struct lpfc_fdmi_attr_entry *ae;
2367         uint32_t size;
2368
2369         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2370         if (phba->fc_topology == LPFC_TOPOLOGY_LOOP)
2371                 ae->un.AttrInt =  cpu_to_be32(LPFC_FDMI_PORTTYPE_NLPORT);
2372         else
2373                 ae->un.AttrInt =  cpu_to_be32(LPFC_FDMI_PORTTYPE_NPORT);
2374         size = FOURBYTES + sizeof(uint32_t);
2375         ad->AttrLen = cpu_to_be16(size);
2376         ad->AttrType = cpu_to_be16(RPRT_PORT_TYPE);
2377         return size;
2378 }
2379
2380 static int
2381 lpfc_fdmi_port_attr_class(struct lpfc_vport *vport,
2382                           struct lpfc_fdmi_attr_def *ad)
2383 {
2384         struct lpfc_fdmi_attr_entry *ae;
2385         uint32_t size;
2386
2387         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2388         ae->un.AttrInt = cpu_to_be32(FC_COS_CLASS2 | FC_COS_CLASS3);
2389         size = FOURBYTES + sizeof(uint32_t);
2390         ad->AttrLen = cpu_to_be16(size);
2391         ad->AttrType = cpu_to_be16(RPRT_SUPPORTED_CLASS);
2392         return size;
2393 }
2394
2395 static int
2396 lpfc_fdmi_port_attr_fabric_wwpn(struct lpfc_vport *vport,
2397                                 struct lpfc_fdmi_attr_def *ad)
2398 {
2399         struct lpfc_fdmi_attr_entry *ae;
2400         uint32_t size;
2401
2402         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2403         memset(ae, 0,  sizeof(struct lpfc_name));
2404
2405         memcpy(&ae->un.AttrWWN, &vport->fabric_portname,
2406                sizeof(struct lpfc_name));
2407         size = FOURBYTES + sizeof(struct lpfc_name);
2408         ad->AttrLen = cpu_to_be16(size);
2409         ad->AttrType = cpu_to_be16(RPRT_FABRICNAME);
2410         return size;
2411 }
2412
2413 static int
2414 lpfc_fdmi_port_attr_active_fc4type(struct lpfc_vport *vport,
2415                                    struct lpfc_fdmi_attr_def *ad)
2416 {
2417         struct lpfc_fdmi_attr_entry *ae;
2418         uint32_t size;
2419
2420         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2421         memset(ae, 0, 32);
2422
2423         ae->un.AttrTypes[3] = 0x02; /* Type 1 - ELS */
2424         ae->un.AttrTypes[2] = 0x01; /* Type 8 - FCP */
2425         ae->un.AttrTypes[7] = 0x01; /* Type 32 - CT */
2426         size = FOURBYTES + 32;
2427         ad->AttrLen = cpu_to_be16(size);
2428         ad->AttrType = cpu_to_be16(RPRT_ACTIVE_FC4_TYPES);
2429         return size;
2430 }
2431
2432 static int
2433 lpfc_fdmi_port_attr_port_state(struct lpfc_vport *vport,
2434                                struct lpfc_fdmi_attr_def *ad)
2435 {
2436         struct lpfc_fdmi_attr_entry *ae;
2437         uint32_t size;
2438
2439         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2440         /* Link Up - operational */
2441         ae->un.AttrInt =  cpu_to_be32(LPFC_FDMI_PORTSTATE_ONLINE);
2442         size = FOURBYTES + sizeof(uint32_t);
2443         ad->AttrLen = cpu_to_be16(size);
2444         ad->AttrType = cpu_to_be16(RPRT_PORT_STATE);
2445         return size;
2446 }
2447
2448 static int
2449 lpfc_fdmi_port_attr_num_disc(struct lpfc_vport *vport,
2450                              struct lpfc_fdmi_attr_def *ad)
2451 {
2452         struct lpfc_fdmi_attr_entry *ae;
2453         uint32_t size;
2454
2455         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2456         vport->fdmi_num_disc = lpfc_find_map_node(vport);
2457         ae->un.AttrInt = cpu_to_be32(vport->fdmi_num_disc);
2458         size = FOURBYTES + sizeof(uint32_t);
2459         ad->AttrLen = cpu_to_be16(size);
2460         ad->AttrType = cpu_to_be16(RPRT_DISC_PORT);
2461         return size;
2462 }
2463
2464 static int
2465 lpfc_fdmi_port_attr_nportid(struct lpfc_vport *vport,
2466                             struct lpfc_fdmi_attr_def *ad)
2467 {
2468         struct lpfc_fdmi_attr_entry *ae;
2469         uint32_t size;
2470
2471         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2472         ae->un.AttrInt =  cpu_to_be32(vport->fc_myDID);
2473         size = FOURBYTES + sizeof(uint32_t);
2474         ad->AttrLen = cpu_to_be16(size);
2475         ad->AttrType = cpu_to_be16(RPRT_PORT_ID);
2476         return size;
2477 }
2478
2479 static int
2480 lpfc_fdmi_smart_attr_service(struct lpfc_vport *vport,
2481                              struct lpfc_fdmi_attr_def *ad)
2482 {
2483         struct lpfc_fdmi_attr_entry *ae;
2484         uint32_t len, size;
2485
2486         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2487         memset(ae, 0, 256);
2488
2489         strncpy(ae->un.AttrString, "Smart SAN Initiator",
2490                 sizeof(ae->un.AttrString));
2491         len = strnlen(ae->un.AttrString,
2492                           sizeof(ae->un.AttrString));
2493         len += (len & 3) ? (4 - (len & 3)) : 4;
2494         size = FOURBYTES + len;
2495         ad->AttrLen = cpu_to_be16(size);
2496         ad->AttrType = cpu_to_be16(RPRT_SMART_SERVICE);
2497         return size;
2498 }
2499
2500 static int
2501 lpfc_fdmi_smart_attr_guid(struct lpfc_vport *vport,
2502                           struct lpfc_fdmi_attr_def *ad)
2503 {
2504         struct lpfc_fdmi_attr_entry *ae;
2505         uint32_t size;
2506
2507         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2508         memset(ae, 0, 256);
2509
2510         memcpy(&ae->un.AttrString, &vport->fc_sparam.nodeName,
2511                sizeof(struct lpfc_name));
2512         memcpy((((uint8_t *)&ae->un.AttrString) +
2513                 sizeof(struct lpfc_name)),
2514                 &vport->fc_sparam.portName, sizeof(struct lpfc_name));
2515         size = FOURBYTES + (2 * sizeof(struct lpfc_name));
2516         ad->AttrLen =  cpu_to_be16(size);
2517         ad->AttrType = cpu_to_be16(RPRT_SMART_GUID);
2518         return size;
2519 }
2520
2521 static int
2522 lpfc_fdmi_smart_attr_version(struct lpfc_vport *vport,
2523                              struct lpfc_fdmi_attr_def *ad)
2524 {
2525         struct lpfc_fdmi_attr_entry *ae;
2526         uint32_t len, size;
2527
2528         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2529         memset(ae, 0, 256);
2530
2531         strncpy(ae->un.AttrString, "Smart SAN Version 2.0",
2532                 sizeof(ae->un.AttrString));
2533         len = strnlen(ae->un.AttrString,
2534                           sizeof(ae->un.AttrString));
2535         len += (len & 3) ? (4 - (len & 3)) : 4;
2536         size = FOURBYTES + len;
2537         ad->AttrLen =  cpu_to_be16(size);
2538         ad->AttrType = cpu_to_be16(RPRT_SMART_VERSION);
2539         return size;
2540 }
2541
2542 static int
2543 lpfc_fdmi_smart_attr_model(struct lpfc_vport *vport,
2544                            struct lpfc_fdmi_attr_def *ad)
2545 {
2546         struct lpfc_hba *phba = vport->phba;
2547         struct lpfc_fdmi_attr_entry *ae;
2548         uint32_t len, size;
2549
2550         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2551         memset(ae, 0, 256);
2552
2553         strncpy(ae->un.AttrString, phba->ModelName,
2554                 sizeof(ae->un.AttrString));
2555         len = strnlen(ae->un.AttrString, sizeof(ae->un.AttrString));
2556         len += (len & 3) ? (4 - (len & 3)) : 4;
2557         size = FOURBYTES + len;
2558         ad->AttrLen = cpu_to_be16(size);
2559         ad->AttrType = cpu_to_be16(RPRT_SMART_MODEL);
2560         return size;
2561 }
2562
2563 static int
2564 lpfc_fdmi_smart_attr_port_info(struct lpfc_vport *vport,
2565                                struct lpfc_fdmi_attr_def *ad)
2566 {
2567         struct lpfc_fdmi_attr_entry *ae;
2568         uint32_t size;
2569
2570         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2571
2572         /* SRIOV (type 3) is not supported */
2573         if (vport->vpi)
2574                 ae->un.AttrInt =  cpu_to_be32(2);  /* NPIV */
2575         else
2576                 ae->un.AttrInt =  cpu_to_be32(1);  /* Physical */
2577         size = FOURBYTES + sizeof(uint32_t);
2578         ad->AttrLen = cpu_to_be16(size);
2579         ad->AttrType = cpu_to_be16(RPRT_SMART_PORT_INFO);
2580         return size;
2581 }
2582
2583 static int
2584 lpfc_fdmi_smart_attr_qos(struct lpfc_vport *vport,
2585                          struct lpfc_fdmi_attr_def *ad)
2586 {
2587         struct lpfc_fdmi_attr_entry *ae;
2588         uint32_t size;
2589
2590         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2591         ae->un.AttrInt =  cpu_to_be32(0);
2592         size = FOURBYTES + sizeof(uint32_t);
2593         ad->AttrLen = cpu_to_be16(size);
2594         ad->AttrType = cpu_to_be16(RPRT_SMART_QOS);
2595         return size;
2596 }
2597
2598 static int
2599 lpfc_fdmi_smart_attr_security(struct lpfc_vport *vport,
2600                               struct lpfc_fdmi_attr_def *ad)
2601 {
2602         struct lpfc_fdmi_attr_entry *ae;
2603         uint32_t size;
2604
2605         ae = (struct lpfc_fdmi_attr_entry *)&ad->AttrValue;
2606         ae->un.AttrInt =  cpu_to_be32(1);
2607         size = FOURBYTES + sizeof(uint32_t);
2608         ad->AttrLen = cpu_to_be16(size);
2609         ad->AttrType = cpu_to_be16(RPRT_SMART_SECURITY);
2610         return size;
2611 }
2612
2613 /* RHBA attribute jump table */
2614 int (*lpfc_fdmi_hba_action[])
2615         (struct lpfc_vport *vport, struct lpfc_fdmi_attr_def *ad) = {
2616         /* Action routine                 Mask bit     Attribute type */
2617         lpfc_fdmi_hba_attr_wwnn,          /* bit0     RHBA_NODENAME           */
2618         lpfc_fdmi_hba_attr_manufacturer,  /* bit1     RHBA_MANUFACTURER       */
2619         lpfc_fdmi_hba_attr_sn,            /* bit2     RHBA_SERIAL_NUMBER      */
2620         lpfc_fdmi_hba_attr_model,         /* bit3     RHBA_MODEL              */
2621         lpfc_fdmi_hba_attr_description,   /* bit4     RHBA_MODEL_DESCRIPTION  */
2622         lpfc_fdmi_hba_attr_hdw_ver,       /* bit5     RHBA_HARDWARE_VERSION   */
2623         lpfc_fdmi_hba_attr_drvr_ver,      /* bit6     RHBA_DRIVER_VERSION     */
2624         lpfc_fdmi_hba_attr_rom_ver,       /* bit7     RHBA_OPTION_ROM_VERSION */
2625         lpfc_fdmi_hba_attr_fmw_ver,       /* bit8     RHBA_FIRMWARE_VERSION   */
2626         lpfc_fdmi_hba_attr_os_ver,        /* bit9     RHBA_OS_NAME_VERSION    */
2627         lpfc_fdmi_hba_attr_ct_len,        /* bit10    RHBA_MAX_CT_PAYLOAD_LEN */
2628         lpfc_fdmi_hba_attr_symbolic_name, /* bit11    RHBA_SYM_NODENAME       */
2629         lpfc_fdmi_hba_attr_vendor_info,   /* bit12    RHBA_VENDOR_INFO        */
2630         lpfc_fdmi_hba_attr_num_ports,     /* bit13    RHBA_NUM_PORTS          */
2631         lpfc_fdmi_hba_attr_fabric_wwnn,   /* bit14    RHBA_FABRIC_WWNN        */
2632         lpfc_fdmi_hba_attr_bios_ver,      /* bit15    RHBA_BIOS_VERSION       */
2633         lpfc_fdmi_hba_attr_bios_state,    /* bit16    RHBA_BIOS_STATE         */
2634         lpfc_fdmi_hba_attr_vendor_id,     /* bit17    RHBA_VENDOR_ID          */
2635 };
2636
2637 /* RPA / RPRT attribute jump table */
2638 int (*lpfc_fdmi_port_action[])
2639         (struct lpfc_vport *vport, struct lpfc_fdmi_attr_def *ad) = {
2640         /* Action routine                   Mask bit   Attribute type */
2641         lpfc_fdmi_port_attr_fc4type,        /* bit0   RPRT_SUPPORT_FC4_TYPES  */
2642         lpfc_fdmi_port_attr_support_speed,  /* bit1   RPRT_SUPPORTED_SPEED    */
2643         lpfc_fdmi_port_attr_speed,          /* bit2   RPRT_PORT_SPEED         */
2644         lpfc_fdmi_port_attr_max_frame,      /* bit3   RPRT_MAX_FRAME_SIZE     */
2645         lpfc_fdmi_port_attr_os_devname,     /* bit4   RPRT_OS_DEVICE_NAME     */
2646         lpfc_fdmi_port_attr_host_name,      /* bit5   RPRT_HOST_NAME          */
2647         lpfc_fdmi_port_attr_wwnn,           /* bit6   RPRT_NODENAME           */
2648         lpfc_fdmi_port_attr_wwpn,           /* bit7   RPRT_PORTNAME           */
2649         lpfc_fdmi_port_attr_symbolic_name,  /* bit8   RPRT_SYM_PORTNAME       */
2650         lpfc_fdmi_port_attr_port_type,      /* bit9   RPRT_PORT_TYPE          */
2651         lpfc_fdmi_port_attr_class,          /* bit10  RPRT_SUPPORTED_CLASS    */
2652         lpfc_fdmi_port_attr_fabric_wwpn,    /* bit11  RPRT_FABRICNAME         */
2653         lpfc_fdmi_port_attr_active_fc4type, /* bit12  RPRT_ACTIVE_FC4_TYPES   */
2654         lpfc_fdmi_port_attr_port_state,     /* bit13  RPRT_PORT_STATE         */
2655         lpfc_fdmi_port_attr_num_disc,       /* bit14  RPRT_DISC_PORT          */
2656         lpfc_fdmi_port_attr_nportid,        /* bit15  RPRT_PORT_ID            */
2657         lpfc_fdmi_smart_attr_service,       /* bit16  RPRT_SMART_SERVICE      */
2658         lpfc_fdmi_smart_attr_guid,          /* bit17  RPRT_SMART_GUID         */
2659         lpfc_fdmi_smart_attr_version,       /* bit18  RPRT_SMART_VERSION      */
2660         lpfc_fdmi_smart_attr_model,         /* bit19  RPRT_SMART_MODEL        */
2661         lpfc_fdmi_smart_attr_port_info,     /* bit20  RPRT_SMART_PORT_INFO    */
2662         lpfc_fdmi_smart_attr_qos,           /* bit21  RPRT_SMART_QOS          */
2663         lpfc_fdmi_smart_attr_security,      /* bit22  RPRT_SMART_SECURITY     */
2664 };
2665
2666 /**
2667  * lpfc_fdmi_cmd - Build and send a FDMI cmd to the specified NPort
2668  * @vport: pointer to a host virtual N_Port data structure.
2669  * @ndlp: ndlp to send FDMI cmd to (if NULL use FDMI_DID)
2670  * cmdcode: FDMI command to send
2671  * mask: Mask of HBA or PORT Attributes to send
2672  *
2673  * Builds and sends a FDMI command using the CT subsystem.
2674  */
2675 int
2676 lpfc_fdmi_cmd(struct lpfc_vport *vport, struct lpfc_nodelist *ndlp,
2677               int cmdcode, uint32_t new_mask)
2678 {
2679         struct lpfc_hba *phba = vport->phba;
2680         struct lpfc_dmabuf *mp, *bmp;
2681         struct lpfc_sli_ct_request *CtReq;
2682         struct ulp_bde64 *bpl;
2683         uint32_t bit_pos;
2684         uint32_t size;
2685         uint32_t rsp_size;
2686         uint32_t mask;
2687         struct lpfc_fdmi_reg_hba *rh;
2688         struct lpfc_fdmi_port_entry *pe;
2689         struct lpfc_fdmi_reg_portattr *pab = NULL;
2690         struct lpfc_fdmi_attr_block *ab = NULL;
2691         int  (*func)(struct lpfc_vport *vport, struct lpfc_fdmi_attr_def *ad);
2692         void (*cmpl)(struct lpfc_hba *, struct lpfc_iocbq *,
2693                      struct lpfc_iocbq *);
2694
2695         if (!ndlp || !NLP_CHK_NODE_ACT(ndlp))
2696                 return 0;
2697
2698         cmpl = lpfc_cmpl_ct_disc_fdmi; /* called from discovery */
2699
2700         /* fill in BDEs for command */
2701         /* Allocate buffer for command payload */
2702         mp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
2703         if (!mp)
2704                 goto fdmi_cmd_exit;
2705
2706         mp->virt = lpfc_mbuf_alloc(phba, 0, &(mp->phys));
2707         if (!mp->virt)
2708                 goto fdmi_cmd_free_mp;
2709
2710         /* Allocate buffer for Buffer ptr list */
2711         bmp = kmalloc(sizeof(struct lpfc_dmabuf), GFP_KERNEL);
2712         if (!bmp)
2713                 goto fdmi_cmd_free_mpvirt;
2714
2715         bmp->virt = lpfc_mbuf_alloc(phba, 0, &(bmp->phys));
2716         if (!bmp->virt)
2717                 goto fdmi_cmd_free_bmp;
2718
2719         INIT_LIST_HEAD(&mp->list);
2720         INIT_LIST_HEAD(&bmp->list);
2721
2722         /* FDMI request */
2723         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
2724                          "0218 FDMI Request Data: x%x x%x x%x\n",
2725                          vport->fc_flag, vport->port_state, cmdcode);
2726         CtReq = (struct lpfc_sli_ct_request *)mp->virt;
2727
2728         /* First populate the CT_IU preamble */
2729         memset(CtReq, 0, sizeof(struct lpfc_sli_ct_request));
2730         CtReq->RevisionId.bits.Revision = SLI_CT_REVISION;
2731         CtReq->RevisionId.bits.InId = 0;
2732
2733         CtReq->FsType = SLI_CT_MANAGEMENT_SERVICE;
2734         CtReq->FsSubType = SLI_CT_FDMI_Subtypes;
2735
2736         CtReq->CommandResponse.bits.CmdRsp = cpu_to_be16(cmdcode);
2737         rsp_size = LPFC_BPL_SIZE;
2738         size = 0;
2739
2740         /* Next fill in the specific FDMI cmd information */
2741         switch (cmdcode) {
2742         case SLI_MGMT_RHAT:
2743         case SLI_MGMT_RHBA:
2744                 rh = (struct lpfc_fdmi_reg_hba *)&CtReq->un.PortID;
2745                 /* HBA Identifier */
2746                 memcpy(&rh->hi.PortName, &phba->pport->fc_sparam.portName,
2747                        sizeof(struct lpfc_name));
2748
2749                 if (cmdcode == SLI_MGMT_RHBA) {
2750                         /* Registered Port List */
2751                         /* One entry (port) per adapter */
2752                         rh->rpl.EntryCnt = cpu_to_be32(1);
2753                         memcpy(&rh->rpl.pe, &phba->pport->fc_sparam.portName,
2754                                sizeof(struct lpfc_name));
2755
2756                         /* point to the HBA attribute block */
2757                         size = 2 * sizeof(struct lpfc_name) +
2758                                 FOURBYTES;
2759                 } else {
2760                         size = sizeof(struct lpfc_name);
2761                 }
2762                 ab = (struct lpfc_fdmi_attr_block *)((uint8_t *)rh + size);
2763                 ab->EntryCnt = 0;
2764                 size += FOURBYTES;
2765                 bit_pos = 0;
2766                 if (new_mask)
2767                         mask = new_mask;
2768                 else
2769                         mask = vport->fdmi_hba_mask;
2770
2771                 /* Mask will dictate what attributes to build in the request */
2772                 while (mask) {
2773                         if (mask & 0x1) {
2774                                 func = lpfc_fdmi_hba_action[bit_pos];
2775                                 size += func(vport,
2776                                              (struct lpfc_fdmi_attr_def *)
2777                                              ((uint8_t *)rh + size));
2778                                 ab->EntryCnt++;
2779                                 if ((size + 256) >
2780                                     (LPFC_BPL_SIZE - LPFC_CT_PREAMBLE))
2781                                         goto hba_out;
2782                         }
2783                         mask = mask >> 1;
2784                         bit_pos++;
2785                 }
2786 hba_out:
2787                 ab->EntryCnt = cpu_to_be32(ab->EntryCnt);
2788                 /* Total size */
2789                 size = GID_REQUEST_SZ - 4 + size;
2790                 break;
2791
2792         case SLI_MGMT_RPRT:
2793         case SLI_MGMT_RPA:
2794                 pab = (struct lpfc_fdmi_reg_portattr *)&CtReq->un.PortID;
2795                 if (cmdcode == SLI_MGMT_RPRT) {
2796                         rh = (struct lpfc_fdmi_reg_hba *)pab;
2797                         /* HBA Identifier */
2798                         memcpy(&rh->hi.PortName,
2799                                &phba->pport->fc_sparam.portName,
2800                                sizeof(struct lpfc_name));
2801                         pab = (struct lpfc_fdmi_reg_portattr *)
2802                                 ((uint8_t *)pab +  sizeof(struct lpfc_name));
2803                 }
2804
2805                 memcpy((uint8_t *)&pab->PortName,
2806                        (uint8_t *)&vport->fc_sparam.portName,
2807                        sizeof(struct lpfc_name));
2808                 size += sizeof(struct lpfc_name) + FOURBYTES;
2809                 pab->ab.EntryCnt = 0;
2810                 bit_pos = 0;
2811                 if (new_mask)
2812                         mask = new_mask;
2813                 else
2814                         mask = vport->fdmi_port_mask;
2815
2816                 /* Mask will dictate what attributes to build in the request */
2817                 while (mask) {
2818                         if (mask & 0x1) {
2819                                 func = lpfc_fdmi_port_action[bit_pos];
2820                                 size += func(vport,
2821                                              (struct lpfc_fdmi_attr_def *)
2822                                              ((uint8_t *)pab + size));
2823                                 pab->ab.EntryCnt++;
2824                                 if ((size + 256) >
2825                                     (LPFC_BPL_SIZE - LPFC_CT_PREAMBLE))
2826                                         goto port_out;
2827                         }
2828                         mask = mask >> 1;
2829                         bit_pos++;
2830                 }
2831 port_out:
2832                 pab->ab.EntryCnt = cpu_to_be32(pab->ab.EntryCnt);
2833                 /* Total size */
2834                 if (cmdcode == SLI_MGMT_RPRT)
2835                         size += sizeof(struct lpfc_name);
2836                 size = GID_REQUEST_SZ - 4 + size;
2837                 break;
2838
2839         case SLI_MGMT_GHAT:
2840         case SLI_MGMT_GRPL:
2841                 rsp_size = FC_MAX_NS_RSP;
2842         case SLI_MGMT_DHBA:
2843         case SLI_MGMT_DHAT:
2844                 pe = (struct lpfc_fdmi_port_entry *)&CtReq->un.PortID;
2845                 memcpy((uint8_t *)&pe->PortName,
2846                        (uint8_t *)&vport->fc_sparam.portName,
2847                        sizeof(struct lpfc_name));
2848                 size = GID_REQUEST_SZ - 4 + sizeof(struct lpfc_name);
2849                 break;
2850
2851         case SLI_MGMT_GPAT:
2852         case SLI_MGMT_GPAS:
2853                 rsp_size = FC_MAX_NS_RSP;
2854         case SLI_MGMT_DPRT:
2855         case SLI_MGMT_DPA:
2856                 pe = (struct lpfc_fdmi_port_entry *)&CtReq->un.PortID;
2857                 memcpy((uint8_t *)&pe->PortName,
2858                        (uint8_t *)&vport->fc_sparam.portName,
2859                        sizeof(struct lpfc_name));
2860                 size = GID_REQUEST_SZ - 4 + sizeof(struct lpfc_name);
2861                 break;
2862         case SLI_MGMT_GRHL:
2863                 size = GID_REQUEST_SZ - 4;
2864                 break;
2865         default:
2866                 lpfc_printf_vlog(vport, KERN_WARNING, LOG_DISCOVERY,
2867                                  "0298 FDMI cmdcode x%x not supported\n",
2868                                  cmdcode);
2869                 goto fdmi_cmd_free_bmpvirt;
2870         }
2871         CtReq->CommandResponse.bits.Size = cpu_to_be16(rsp_size);
2872
2873         bpl = (struct ulp_bde64 *)bmp->virt;
2874         bpl->addrHigh = le32_to_cpu(putPaddrHigh(mp->phys));
2875         bpl->addrLow = le32_to_cpu(putPaddrLow(mp->phys));
2876         bpl->tus.f.bdeFlags = 0;
2877         bpl->tus.f.bdeSize = size;
2878
2879         /*
2880          * The lpfc_ct_cmd/lpfc_get_req shall increment ndlp reference count
2881          * to hold ndlp reference for the corresponding callback function.
2882          */
2883         if (!lpfc_ct_cmd(vport, mp, bmp, ndlp, cmpl, rsp_size, 0))
2884                 return 0;
2885
2886         /*
2887          * Decrement ndlp reference count to release ndlp reference held
2888          * for the failed command's callback function.
2889          */
2890         lpfc_nlp_put(ndlp);
2891
2892 fdmi_cmd_free_bmpvirt:
2893         lpfc_mbuf_free(phba, bmp->virt, bmp->phys);
2894 fdmi_cmd_free_bmp:
2895         kfree(bmp);
2896 fdmi_cmd_free_mpvirt:
2897         lpfc_mbuf_free(phba, mp->virt, mp->phys);
2898 fdmi_cmd_free_mp:
2899         kfree(mp);
2900 fdmi_cmd_exit:
2901         /* Issue FDMI request failed */
2902         lpfc_printf_vlog(vport, KERN_INFO, LOG_DISCOVERY,
2903                          "0244 Issue FDMI request failed Data: x%x\n",
2904                          cmdcode);
2905         return 1;
2906 }
2907
2908 /**
2909  * lpfc_delayed_disc_tmo - Timeout handler for delayed discovery timer.
2910  * @ptr - Context object of the timer.
2911  *
2912  * This function set the WORKER_DELAYED_DISC_TMO flag and wake up
2913  * the worker thread.
2914  **/
2915 void
2916 lpfc_delayed_disc_tmo(struct timer_list *t)
2917 {
2918         struct lpfc_vport *vport = from_timer(vport, t, delayed_disc_tmo);
2919         struct lpfc_hba   *phba = vport->phba;
2920         uint32_t tmo_posted;
2921         unsigned long iflag;
2922
2923         spin_lock_irqsave(&vport->work_port_lock, iflag);
2924         tmo_posted = vport->work_port_events & WORKER_DELAYED_DISC_TMO;
2925         if (!tmo_posted)
2926                 vport->work_port_events |= WORKER_DELAYED_DISC_TMO;
2927         spin_unlock_irqrestore(&vport->work_port_lock, iflag);
2928
2929         if (!tmo_posted)
2930                 lpfc_worker_wake_up(phba);
2931         return;
2932 }
2933
2934 /**
2935  * lpfc_delayed_disc_timeout_handler - Function called by worker thread to
2936  *      handle delayed discovery.
2937  * @vport: pointer to a host virtual N_Port data structure.
2938  *
2939  * This function start nport discovery of the vport.
2940  **/
2941 void
2942 lpfc_delayed_disc_timeout_handler(struct lpfc_vport *vport)
2943 {
2944         struct Scsi_Host *shost = lpfc_shost_from_vport(vport);
2945
2946         spin_lock_irq(shost->host_lock);
2947         if (!(vport->fc_flag & FC_DISC_DELAYED)) {
2948                 spin_unlock_irq(shost->host_lock);
2949                 return;
2950         }
2951         vport->fc_flag &= ~FC_DISC_DELAYED;
2952         spin_unlock_irq(shost->host_lock);
2953
2954         lpfc_do_scr_ns_plogi(vport->phba, vport);
2955 }
2956
2957 void
2958 lpfc_decode_firmware_rev(struct lpfc_hba *phba, char *fwrevision, int flag)
2959 {
2960         struct lpfc_sli *psli = &phba->sli;
2961         lpfc_vpd_t *vp = &phba->vpd;
2962         uint32_t b1, b2, b3, b4, i, rev;
2963         char c;
2964         uint32_t *ptr, str[4];
2965         uint8_t *fwname;
2966
2967         if (phba->sli_rev == LPFC_SLI_REV4)
2968                 snprintf(fwrevision, FW_REV_STR_SIZE, "%s", vp->rev.opFwName);
2969         else if (vp->rev.rBit) {
2970                 if (psli->sli_flag & LPFC_SLI_ACTIVE)
2971                         rev = vp->rev.sli2FwRev;
2972                 else
2973                         rev = vp->rev.sli1FwRev;
2974
2975                 b1 = (rev & 0x0000f000) >> 12;
2976                 b2 = (rev & 0x00000f00) >> 8;
2977                 b3 = (rev & 0x000000c0) >> 6;
2978                 b4 = (rev & 0x00000030) >> 4;
2979
2980                 switch (b4) {
2981                 case 0:
2982                         c = 'N';
2983                         break;
2984                 case 1:
2985                         c = 'A';
2986                         break;
2987                 case 2:
2988                         c = 'B';
2989                         break;
2990                 case 3:
2991                         c = 'X';
2992                         break;
2993                 default:
2994                         c = 0;
2995                         break;
2996                 }
2997                 b4 = (rev & 0x0000000f);
2998
2999                 if (psli->sli_flag & LPFC_SLI_ACTIVE)
3000                         fwname = vp->rev.sli2FwName;
3001                 else
3002                         fwname = vp->rev.sli1FwName;
3003
3004                 for (i = 0; i < 16; i++)
3005                         if (fwname[i] == 0x20)
3006                                 fwname[i] = 0;
3007
3008                 ptr = (uint32_t*)fwname;
3009
3010                 for (i = 0; i < 3; i++)
3011                         str[i] = be32_to_cpu(*ptr++);
3012
3013                 if (c == 0) {
3014                         if (flag)
3015                                 sprintf(fwrevision, "%d.%d%d (%s)",
3016                                         b1, b2, b3, (char *)str);
3017                         else
3018                                 sprintf(fwrevision, "%d.%d%d", b1,
3019                                         b2, b3);
3020                 } else {
3021                         if (flag)
3022                                 sprintf(fwrevision, "%d.%d%d%c%d (%s)",
3023                                         b1, b2, b3, c,
3024                                         b4, (char *)str);
3025                         else
3026                                 sprintf(fwrevision, "%d.%d%d%c%d",
3027                                         b1, b2, b3, c, b4);
3028                 }
3029         } else {
3030                 rev = vp->rev.smFwRev;
3031
3032                 b1 = (rev & 0xff000000) >> 24;
3033                 b2 = (rev & 0x00f00000) >> 20;
3034                 b3 = (rev & 0x000f0000) >> 16;
3035                 c  = (rev & 0x0000ff00) >> 8;
3036                 b4 = (rev & 0x000000ff);
3037
3038                 sprintf(fwrevision, "%d.%d%d%c%d", b1, b2, b3, c, b4);
3039         }
3040         return;
3041 }